// SPDX-License-Identifier: GPL-2.0
/*
* pcm3724.c
* Comedi driver for Advantech PCM-3724 Digital I/O board
*
* Drew Csillag <[email protected]>
*/
/*
* Driver: pcm3724
* Description: Advantech PCM-3724
* Devices: [Advantech] PCM-3724 (pcm3724)
* Author: Drew Csillag <[email protected]>
* Status: tested
*
* This is driver for digital I/O boards PCM-3724 with 48 DIO.
* It needs 8255.o for operations and only immediate mode is supported.
* See the source for configuration details.
*
* Copy/pasted/hacked from pcm724.c
*
* Configuration Options:
* [0] - I/O port base address
*/
#include <linux/module.h>
#include <linux/comedi/comedidev.h>
#include <linux/comedi/comedi_8255.h>
/*
* Register I/O Map
*
* This board has two standard 8255 devices that provide six 8-bit DIO ports
* (48 channels total). Six 74HCT245 chips (one for each port) buffer the
* I/O lines to increase driving capability. Because the 74HCT245 is a
* bidirectional, tri-state line buffer, two additional I/O ports are used
* to control the direction of data and the enable of each port.
*/
#define PCM3724_8255_0_BASE 0x00
#define PCM3724_8255_1_BASE 0x04
#define PCM3724_DIO_DIR_REG 0x08
#define PCM3724_DIO_DIR_C0_OUT BIT(0)
#define PCM3724_DIO_DIR_B0_OUT BIT(1)
#define PCM3724_DIO_DIR_A0_OUT BIT(2)
#define PCM3724_DIO_DIR_C1_OUT BIT(3)
#define PCM3724_DIO_DIR_B1_OUT BIT(4)
#define PCM3724_DIO_DIR_A1_OUT BIT(5)
#define PCM3724_GATE_CTRL_REG 0x09
#define PCM3724_GATE_CTRL_C0_ENA BIT(0)
#define PCM3724_GATE_CTRL_B0_ENA BIT(1)
#define PCM3724_GATE_CTRL_A0_ENA BIT(2)
#define PCM3724_GATE_CTRL_C1_ENA BIT(3)
#define PCM3724_GATE_CTRL_B1_ENA BIT(4)
#define PCM3724_GATE_CTRL_A1_ENA BIT(5)
/* used to track configured dios */
struct priv_pcm3724 {
int dio_1;
int dio_2;
};
static int compute_buffer(int config, int devno, struct comedi_subdevice *s)
{
/* 1 in io_bits indicates output */
if (s->io_bits & 0x0000ff) {
if (devno == 0)
config |= PCM3724_DIO_DIR_A0_OUT;
else
config |= PCM3724_DIO_DIR_A1_OUT;
}
if (s->io_bits & 0x00ff00) {
if (devno == 0)
config |= PCM3724_DIO_DIR_B0_OUT;
else
config |= PCM3724_DIO_DIR_B1_OUT;
}
if (s->io_bits & 0xff0000) {
if (devno == 0)
config |= PCM3724_DIO_DIR_C0_OUT;
else
config |= PCM3724_DIO_DIR_C1_OUT;
}
return config;
}
static void do_3724_config(struct comedi_device *dev,
struct comedi_subdevice *s, int chanspec)
{
struct comedi_subdevice *s_dio1 = &dev->subdevices[0];
struct comedi_subdevice *s_dio2 = &dev->subdevices[1];
int config;
int buffer_config;
unsigned long port_8255_cfg;
config = I8255_CTRL_CW;
/* 1 in io_bits indicates output, 1 in config indicates input */
if (!(s->io_bits & 0x0000ff))
config |= I8255_CTRL_A_IO;
if (!(s->io_bits & 0x00ff00))
config |= I8255_CTRL_B_IO;
if (!(s->io_bits & 0xff0000))
config |= I8255_CTRL_C_HI_IO | I8255_CTRL_C_LO_IO;
buffer_config = compute_buffer(0, 0, s_dio1);
buffer_config = compute_buffer(buffer_config, 1, s_dio2);
if (s == s_dio1)
port_8255_cfg = dev->iobase + I8255_CTRL_REG;
else
port_8255_cfg = dev->iobase + I8255_SIZE + I8255_CTRL_REG;
outb(buffer_config, dev->iobase + PCM3724_DIO_DIR_REG);
outb(config, port_8255_cfg);
}
static void enable_chan(struct comedi_device *dev, struct comedi_subdevice *s,
int chanspec)
{
struct priv_pcm3724 *priv = dev->private;
struct comedi_subdevice *s_dio1 = &dev->subdevices[0];
unsigned int mask;
int gatecfg;
gatecfg = 0;
mask = 1 << CR_CHAN(chanspec);
if (s == s_dio1)
priv->dio_1 |= mask;
else
priv->dio_2 |= mask;
if (priv->dio_1 & 0xff0000)
gatecfg |= PCM3724_GATE_CTRL_C0_ENA;
if (priv->dio_1 & 0xff00)
gatecfg |= PCM3724_GATE_CTRL_B0_ENA;
if (priv->dio_1 & 0xff)
gatecfg |= PCM3724_GATE_CTRL_A0_ENA;
if (priv->dio_2 & 0xff0000)
gatecfg |= PCM3724_GATE_CTRL_C1_ENA;
if (priv->dio_2 & 0xff00)
gatecfg |= PCM3724_GATE_CTRL_B1_ENA;
if (priv->dio_2 & 0xff)
gatecfg |= PCM3724_GATE_CTRL_A1_ENA;
outb(gatecfg, dev->iobase + PCM3724_GATE_CTRL_REG);
}
/* overriding the 8255 insn config */
static int subdev_3724_insn_config(struct comedi_device *dev,
struct comedi_subdevice *s,
struct comedi_insn *insn,
unsigned int *data)
{
unsigned int chan = CR_CHAN(insn->chanspec);
unsigned int mask;
int ret;
if (chan < 8)
mask = 0x0000ff;
else if (chan < 16)
mask = 0x00ff00;
else if (chan < 20)
mask = 0x0f0000;
else
mask = 0xf00000;
ret = comedi_dio_insn_config(dev, s, insn, data, mask);
if (ret)
return ret;
do_3724_config(dev, s, insn->chanspec);
enable_chan(dev, s, insn->chanspec);
return insn->n;
}
static int pcm3724_attach(struct comedi_device *dev,
struct comedi_devconfig *it)
{
struct priv_pcm3724 *priv;
struct comedi_subdevice *s;
int ret, i;
priv = comedi_alloc_devpriv(dev, sizeof(*priv));
if (!priv)
return -ENOMEM;
ret = comedi_request_region(dev, it->options[0], 0x10);
if (ret)
return ret;
ret = comedi_alloc_subdevices(dev, 2);
if (ret)
return ret;
for (i = 0; i < dev->n_subdevices; i++) {
s = &dev->subdevices[i];
ret = subdev_8255_io_init(dev, s, i * I8255_SIZE);
if (ret)
return ret;
s->insn_config = subdev_3724_insn_config;
}
return 0;
}
static struct comedi_driver pcm3724_driver = {
.driver_name = "pcm3724",
.module = THIS_MODULE,
.attach = pcm3724_attach,
.detach = comedi_legacy_detach,
};
module_comedi_driver(pcm3724_driver);
MODULE_AUTHOR("Comedi https://www.comedi.org");
MODULE_DESCRIPTION("Comedi driver for Advantech PCM-3724 Digital I/O board");
MODULE_LICENSE("GPL");
Codebase Browser
linux