1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* |
3 | * pcm3724.c |
4 | * Comedi driver for Advantech PCM-3724 Digital I/O board |
5 | * |
6 | * Drew Csillag <drew_csillag@yahoo.com> |
7 | */ |
8 | |
9 | /* |
10 | * Driver: pcm3724 |
11 | * Description: Advantech PCM-3724 |
12 | * Devices: [Advantech] PCM-3724 (pcm3724) |
13 | * Author: Drew Csillag <drew_csillag@yahoo.com> |
14 | * Status: tested |
15 | * |
16 | * This is driver for digital I/O boards PCM-3724 with 48 DIO. |
17 | * It needs 8255.o for operations and only immediate mode is supported. |
18 | * See the source for configuration details. |
19 | * |
20 | * Copy/pasted/hacked from pcm724.c |
21 | * |
22 | * Configuration Options: |
23 | * [0] - I/O port base address |
24 | */ |
25 | |
26 | #include <linux/module.h> |
27 | #include <linux/comedi/comedidev.h> |
28 | #include <linux/comedi/comedi_8255.h> |
29 | |
30 | /* |
31 | * Register I/O Map |
32 | * |
33 | * This board has two standard 8255 devices that provide six 8-bit DIO ports |
34 | * (48 channels total). Six 74HCT245 chips (one for each port) buffer the |
35 | * I/O lines to increase driving capability. Because the 74HCT245 is a |
36 | * bidirectional, tri-state line buffer, two additional I/O ports are used |
37 | * to control the direction of data and the enable of each port. |
38 | */ |
39 | #define PCM3724_8255_0_BASE 0x00 |
40 | #define PCM3724_8255_1_BASE 0x04 |
41 | #define PCM3724_DIO_DIR_REG 0x08 |
42 | #define PCM3724_DIO_DIR_C0_OUT BIT(0) |
43 | #define PCM3724_DIO_DIR_B0_OUT BIT(1) |
44 | #define PCM3724_DIO_DIR_A0_OUT BIT(2) |
45 | #define PCM3724_DIO_DIR_C1_OUT BIT(3) |
46 | #define PCM3724_DIO_DIR_B1_OUT BIT(4) |
47 | #define PCM3724_DIO_DIR_A1_OUT BIT(5) |
48 | #define PCM3724_GATE_CTRL_REG 0x09 |
49 | #define PCM3724_GATE_CTRL_C0_ENA BIT(0) |
50 | #define PCM3724_GATE_CTRL_B0_ENA BIT(1) |
51 | #define PCM3724_GATE_CTRL_A0_ENA BIT(2) |
52 | #define PCM3724_GATE_CTRL_C1_ENA BIT(3) |
53 | #define PCM3724_GATE_CTRL_B1_ENA BIT(4) |
54 | #define PCM3724_GATE_CTRL_A1_ENA BIT(5) |
55 | |
56 | /* used to track configured dios */ |
57 | struct priv_pcm3724 { |
58 | int dio_1; |
59 | int dio_2; |
60 | }; |
61 | |
62 | static int compute_buffer(int config, int devno, struct comedi_subdevice *s) |
63 | { |
64 | /* 1 in io_bits indicates output */ |
65 | if (s->io_bits & 0x0000ff) { |
66 | if (devno == 0) |
67 | config |= PCM3724_DIO_DIR_A0_OUT; |
68 | else |
69 | config |= PCM3724_DIO_DIR_A1_OUT; |
70 | } |
71 | if (s->io_bits & 0x00ff00) { |
72 | if (devno == 0) |
73 | config |= PCM3724_DIO_DIR_B0_OUT; |
74 | else |
75 | config |= PCM3724_DIO_DIR_B1_OUT; |
76 | } |
77 | if (s->io_bits & 0xff0000) { |
78 | if (devno == 0) |
79 | config |= PCM3724_DIO_DIR_C0_OUT; |
80 | else |
81 | config |= PCM3724_DIO_DIR_C1_OUT; |
82 | } |
83 | return config; |
84 | } |
85 | |
86 | static void do_3724_config(struct comedi_device *dev, |
87 | struct comedi_subdevice *s, int chanspec) |
88 | { |
89 | struct comedi_subdevice *s_dio1 = &dev->subdevices[0]; |
90 | struct comedi_subdevice *s_dio2 = &dev->subdevices[1]; |
91 | int config; |
92 | int buffer_config; |
93 | unsigned long port_8255_cfg; |
94 | |
95 | config = I8255_CTRL_CW; |
96 | |
97 | /* 1 in io_bits indicates output, 1 in config indicates input */ |
98 | if (!(s->io_bits & 0x0000ff)) |
99 | config |= I8255_CTRL_A_IO; |
100 | |
101 | if (!(s->io_bits & 0x00ff00)) |
102 | config |= I8255_CTRL_B_IO; |
103 | |
104 | if (!(s->io_bits & 0xff0000)) |
105 | config |= I8255_CTRL_C_HI_IO | I8255_CTRL_C_LO_IO; |
106 | |
107 | buffer_config = compute_buffer(config: 0, devno: 0, s: s_dio1); |
108 | buffer_config = compute_buffer(config: buffer_config, devno: 1, s: s_dio2); |
109 | |
110 | if (s == s_dio1) |
111 | port_8255_cfg = dev->iobase + I8255_CTRL_REG; |
112 | else |
113 | port_8255_cfg = dev->iobase + I8255_SIZE + I8255_CTRL_REG; |
114 | |
115 | outb(value: buffer_config, port: dev->iobase + PCM3724_DIO_DIR_REG); |
116 | |
117 | outb(value: config, port: port_8255_cfg); |
118 | } |
119 | |
120 | static void enable_chan(struct comedi_device *dev, struct comedi_subdevice *s, |
121 | int chanspec) |
122 | { |
123 | struct priv_pcm3724 *priv = dev->private; |
124 | struct comedi_subdevice *s_dio1 = &dev->subdevices[0]; |
125 | unsigned int mask; |
126 | int gatecfg; |
127 | |
128 | gatecfg = 0; |
129 | |
130 | mask = 1 << CR_CHAN(chanspec); |
131 | if (s == s_dio1) |
132 | priv->dio_1 |= mask; |
133 | else |
134 | priv->dio_2 |= mask; |
135 | |
136 | if (priv->dio_1 & 0xff0000) |
137 | gatecfg |= PCM3724_GATE_CTRL_C0_ENA; |
138 | |
139 | if (priv->dio_1 & 0xff00) |
140 | gatecfg |= PCM3724_GATE_CTRL_B0_ENA; |
141 | |
142 | if (priv->dio_1 & 0xff) |
143 | gatecfg |= PCM3724_GATE_CTRL_A0_ENA; |
144 | |
145 | if (priv->dio_2 & 0xff0000) |
146 | gatecfg |= PCM3724_GATE_CTRL_C1_ENA; |
147 | |
148 | if (priv->dio_2 & 0xff00) |
149 | gatecfg |= PCM3724_GATE_CTRL_B1_ENA; |
150 | |
151 | if (priv->dio_2 & 0xff) |
152 | gatecfg |= PCM3724_GATE_CTRL_A1_ENA; |
153 | |
154 | outb(value: gatecfg, port: dev->iobase + PCM3724_GATE_CTRL_REG); |
155 | } |
156 | |
157 | /* overriding the 8255 insn config */ |
158 | static int subdev_3724_insn_config(struct comedi_device *dev, |
159 | struct comedi_subdevice *s, |
160 | struct comedi_insn *insn, |
161 | unsigned int *data) |
162 | { |
163 | unsigned int chan = CR_CHAN(insn->chanspec); |
164 | unsigned int mask; |
165 | int ret; |
166 | |
167 | if (chan < 8) |
168 | mask = 0x0000ff; |
169 | else if (chan < 16) |
170 | mask = 0x00ff00; |
171 | else if (chan < 20) |
172 | mask = 0x0f0000; |
173 | else |
174 | mask = 0xf00000; |
175 | |
176 | ret = comedi_dio_insn_config(dev, s, insn, data, mask); |
177 | if (ret) |
178 | return ret; |
179 | |
180 | do_3724_config(dev, s, chanspec: insn->chanspec); |
181 | enable_chan(dev, s, chanspec: insn->chanspec); |
182 | |
183 | return insn->n; |
184 | } |
185 | |
186 | static int pcm3724_attach(struct comedi_device *dev, |
187 | struct comedi_devconfig *it) |
188 | { |
189 | struct priv_pcm3724 *priv; |
190 | struct comedi_subdevice *s; |
191 | int ret, i; |
192 | |
193 | priv = comedi_alloc_devpriv(dev, size: sizeof(*priv)); |
194 | if (!priv) |
195 | return -ENOMEM; |
196 | |
197 | ret = comedi_request_region(dev, start: it->options[0], len: 0x10); |
198 | if (ret) |
199 | return ret; |
200 | |
201 | ret = comedi_alloc_subdevices(dev, num_subdevices: 2); |
202 | if (ret) |
203 | return ret; |
204 | |
205 | for (i = 0; i < dev->n_subdevices; i++) { |
206 | s = &dev->subdevices[i]; |
207 | ret = subdev_8255_io_init(dev, s, regbase: i * I8255_SIZE); |
208 | if (ret) |
209 | return ret; |
210 | s->insn_config = subdev_3724_insn_config; |
211 | } |
212 | return 0; |
213 | } |
214 | |
215 | static struct comedi_driver pcm3724_driver = { |
216 | .driver_name = "pcm3724" , |
217 | .module = THIS_MODULE, |
218 | .attach = pcm3724_attach, |
219 | .detach = comedi_legacy_detach, |
220 | }; |
221 | module_comedi_driver(pcm3724_driver); |
222 | |
223 | MODULE_AUTHOR("Comedi https://www.comedi.org" ); |
224 | MODULE_DESCRIPTION("Comedi driver for Advantech PCM-3724 Digital I/O board" ); |
225 | MODULE_LICENSE("GPL" ); |
226 | |