diff options
author | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2012-11-16 11:14:18 -0500 |
---|---|---|
committer | Greg Kroah-Hartman <gregkh@linuxfoundation.org> | 2012-11-16 11:14:18 -0500 |
commit | 05e5027efc9c0bb6d1d04cde279afbafca0a7929 (patch) | |
tree | 733b0291db6cc6c13844b97e3c7bf593b6711d66 /drivers/ipack | |
parent | 76859725ad31ac480d55bf176e5bbe0f9ab6e6cb (diff) |
Staging: ipack: move out of staging
The ipack subsystem is cleaned up enough to now move out of the staging
tree, and into drivers/ipack.
Cc: Samuel Iglesias Gonsalvez <siglesias@igalia.com>
Cc: Jens Taprogge <jens.taprogge@taprogge.org>
Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
Diffstat (limited to 'drivers/ipack')
-rw-r--r-- | drivers/ipack/Kconfig | 24 | ||||
-rw-r--r-- | drivers/ipack/Makefile | 6 | ||||
-rw-r--r-- | drivers/ipack/carriers/Kconfig | 7 | ||||
-rw-r--r-- | drivers/ipack/carriers/Makefile | 1 | ||||
-rw-r--r-- | drivers/ipack/carriers/tpci200.c | 627 | ||||
-rw-r--r-- | drivers/ipack/carriers/tpci200.h | 168 | ||||
-rw-r--r-- | drivers/ipack/devices/Kconfig | 6 | ||||
-rw-r--r-- | drivers/ipack/devices/Makefile | 1 | ||||
-rw-r--r-- | drivers/ipack/devices/ipoctal.c | 751 | ||||
-rw-r--r-- | drivers/ipack/devices/ipoctal.h | 42 | ||||
-rw-r--r-- | drivers/ipack/devices/scc2698.h | 228 | ||||
-rw-r--r-- | drivers/ipack/ipack.c | 481 | ||||
-rw-r--r-- | drivers/ipack/ipack.h | 215 | ||||
-rw-r--r-- | drivers/ipack/ipack_ids.h | 32 |
14 files changed, 2589 insertions, 0 deletions
diff --git a/drivers/ipack/Kconfig b/drivers/ipack/Kconfig new file mode 100644 index 000000000000..3949e5589560 --- /dev/null +++ b/drivers/ipack/Kconfig | |||
@@ -0,0 +1,24 @@ | |||
1 | # | ||
2 | # IPACK configuration. | ||
3 | # | ||
4 | |||
5 | menuconfig IPACK_BUS | ||
6 | tristate "IndustryPack bus support" | ||
7 | depends on HAS_IOMEM | ||
8 | ---help--- | ||
9 | This option provides support for the IndustryPack framework. There | ||
10 | are IndustryPack carrier boards, which interface another bus (such as | ||
11 | PCI) to an IndustryPack bus, and IndustryPack modules, that are | ||
12 | hosted on these buses. While IndustryPack modules can provide a | ||
13 | large variety of functionality, they are most often found in | ||
14 | industrial control applications. | ||
15 | |||
16 | Say N if unsure. | ||
17 | |||
18 | if IPACK_BUS | ||
19 | |||
20 | source "drivers/ipack/carriers/Kconfig" | ||
21 | |||
22 | source "drivers/ipack/devices/Kconfig" | ||
23 | |||
24 | endif # IPACK | ||
diff --git a/drivers/ipack/Makefile b/drivers/ipack/Makefile new file mode 100644 index 000000000000..6f14ade0f8f3 --- /dev/null +++ b/drivers/ipack/Makefile | |||
@@ -0,0 +1,6 @@ | |||
1 | # | ||
2 | # Makefile for the IPACK bridge device drivers. | ||
3 | # | ||
4 | obj-$(CONFIG_IPACK_BUS) += ipack.o | ||
5 | obj-y += devices/ | ||
6 | obj-y += carriers/ | ||
diff --git a/drivers/ipack/carriers/Kconfig b/drivers/ipack/carriers/Kconfig new file mode 100644 index 000000000000..922ff5c35acc --- /dev/null +++ b/drivers/ipack/carriers/Kconfig | |||
@@ -0,0 +1,7 @@ | |||
1 | config BOARD_TPCI200 | ||
2 | tristate "Support for the TEWS TPCI-200 IndustryPack carrier board" | ||
3 | depends on IPACK_BUS | ||
4 | depends on PCI | ||
5 | help | ||
6 | This driver adds support for the TEWS TPCI200 IndustryPack carrier board. | ||
7 | default n | ||
diff --git a/drivers/ipack/carriers/Makefile b/drivers/ipack/carriers/Makefile new file mode 100644 index 000000000000..d8b76459300f --- /dev/null +++ b/drivers/ipack/carriers/Makefile | |||
@@ -0,0 +1 @@ | |||
obj-$(CONFIG_BOARD_TPCI200) += tpci200.o | |||
diff --git a/drivers/ipack/carriers/tpci200.c b/drivers/ipack/carriers/tpci200.c new file mode 100644 index 000000000000..c1a19b274c23 --- /dev/null +++ b/drivers/ipack/carriers/tpci200.c | |||
@@ -0,0 +1,627 @@ | |||
1 | /** | ||
2 | * tpci200.c | ||
3 | * | ||
4 | * driver for the TEWS TPCI-200 device | ||
5 | * | ||
6 | * Copyright (C) 2009-2012 CERN (www.cern.ch) | ||
7 | * Author: Nicolas Serafini, EIC2 SA | ||
8 | * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com> | ||
9 | * | ||
10 | * This program is free software; you can redistribute it and/or modify it | ||
11 | * under the terms of the GNU General Public License as published by the Free | ||
12 | * Software Foundation; version 2 of the License. | ||
13 | */ | ||
14 | |||
15 | #include <linux/module.h> | ||
16 | #include <linux/slab.h> | ||
17 | #include "tpci200.h" | ||
18 | |||
19 | static const u16 tpci200_status_timeout[] = { | ||
20 | TPCI200_A_TIMEOUT, | ||
21 | TPCI200_B_TIMEOUT, | ||
22 | TPCI200_C_TIMEOUT, | ||
23 | TPCI200_D_TIMEOUT, | ||
24 | }; | ||
25 | |||
26 | static const u16 tpci200_status_error[] = { | ||
27 | TPCI200_A_ERROR, | ||
28 | TPCI200_B_ERROR, | ||
29 | TPCI200_C_ERROR, | ||
30 | TPCI200_D_ERROR, | ||
31 | }; | ||
32 | |||
33 | static const size_t tpci200_space_size[IPACK_SPACE_COUNT] = { | ||
34 | [IPACK_IO_SPACE] = TPCI200_IO_SPACE_SIZE, | ||
35 | [IPACK_ID_SPACE] = TPCI200_ID_SPACE_SIZE, | ||
36 | [IPACK_INT_SPACE] = TPCI200_INT_SPACE_SIZE, | ||
37 | [IPACK_MEM8_SPACE] = TPCI200_MEM8_SPACE_SIZE, | ||
38 | [IPACK_MEM16_SPACE] = TPCI200_MEM16_SPACE_SIZE, | ||
39 | }; | ||
40 | |||
41 | static const size_t tpci200_space_interval[IPACK_SPACE_COUNT] = { | ||
42 | [IPACK_IO_SPACE] = TPCI200_IO_SPACE_INTERVAL, | ||
43 | [IPACK_ID_SPACE] = TPCI200_ID_SPACE_INTERVAL, | ||
44 | [IPACK_INT_SPACE] = TPCI200_INT_SPACE_INTERVAL, | ||
45 | [IPACK_MEM8_SPACE] = TPCI200_MEM8_SPACE_INTERVAL, | ||
46 | [IPACK_MEM16_SPACE] = TPCI200_MEM16_SPACE_INTERVAL, | ||
47 | }; | ||
48 | |||
49 | static struct tpci200_board *check_slot(struct ipack_device *dev) | ||
50 | { | ||
51 | struct tpci200_board *tpci200; | ||
52 | |||
53 | if (dev == NULL) | ||
54 | return NULL; | ||
55 | |||
56 | |||
57 | tpci200 = dev_get_drvdata(dev->bus->parent); | ||
58 | |||
59 | if (tpci200 == NULL) { | ||
60 | dev_info(&dev->dev, "carrier board not found\n"); | ||
61 | return NULL; | ||
62 | } | ||
63 | |||
64 | if (dev->slot >= TPCI200_NB_SLOT) { | ||
65 | dev_info(&dev->dev, | ||
66 | "Slot [%d:%d] doesn't exist! Last tpci200 slot is %d.\n", | ||
67 | dev->bus->bus_nr, dev->slot, TPCI200_NB_SLOT-1); | ||
68 | return NULL; | ||
69 | } | ||
70 | |||
71 | return tpci200; | ||
72 | } | ||
73 | |||
74 | static void tpci200_clear_mask(struct tpci200_board *tpci200, | ||
75 | __le16 __iomem *addr, u16 mask) | ||
76 | { | ||
77 | unsigned long flags; | ||
78 | spin_lock_irqsave(&tpci200->regs_lock, flags); | ||
79 | iowrite16(ioread16(addr) & (~mask), addr); | ||
80 | spin_unlock_irqrestore(&tpci200->regs_lock, flags); | ||
81 | } | ||
82 | |||
83 | static void tpci200_set_mask(struct tpci200_board *tpci200, | ||
84 | __le16 __iomem *addr, u16 mask) | ||
85 | { | ||
86 | unsigned long flags; | ||
87 | spin_lock_irqsave(&tpci200->regs_lock, flags); | ||
88 | iowrite16(ioread16(addr) | mask, addr); | ||
89 | spin_unlock_irqrestore(&tpci200->regs_lock, flags); | ||
90 | } | ||
91 | |||
92 | static void tpci200_unregister(struct tpci200_board *tpci200) | ||
93 | { | ||
94 | free_irq(tpci200->info->pdev->irq, (void *) tpci200); | ||
95 | |||
96 | pci_iounmap(tpci200->info->pdev, tpci200->info->interface_regs); | ||
97 | pci_iounmap(tpci200->info->pdev, tpci200->info->cfg_regs); | ||
98 | |||
99 | pci_release_region(tpci200->info->pdev, TPCI200_IP_INTERFACE_BAR); | ||
100 | pci_release_region(tpci200->info->pdev, TPCI200_IO_ID_INT_SPACES_BAR); | ||
101 | pci_release_region(tpci200->info->pdev, TPCI200_MEM16_SPACE_BAR); | ||
102 | pci_release_region(tpci200->info->pdev, TPCI200_MEM8_SPACE_BAR); | ||
103 | pci_release_region(tpci200->info->pdev, TPCI200_CFG_MEM_BAR); | ||
104 | |||
105 | pci_disable_device(tpci200->info->pdev); | ||
106 | pci_dev_put(tpci200->info->pdev); | ||
107 | } | ||
108 | |||
109 | static void tpci200_enable_irq(struct tpci200_board *tpci200, | ||
110 | int islot) | ||
111 | { | ||
112 | tpci200_set_mask(tpci200, | ||
113 | &tpci200->info->interface_regs->control[islot], | ||
114 | TPCI200_INT0_EN | TPCI200_INT1_EN); | ||
115 | } | ||
116 | |||
117 | static void tpci200_disable_irq(struct tpci200_board *tpci200, | ||
118 | int islot) | ||
119 | { | ||
120 | tpci200_clear_mask(tpci200, | ||
121 | &tpci200->info->interface_regs->control[islot], | ||
122 | TPCI200_INT0_EN | TPCI200_INT1_EN); | ||
123 | } | ||
124 | |||
125 | static irqreturn_t tpci200_slot_irq(struct slot_irq *slot_irq) | ||
126 | { | ||
127 | irqreturn_t ret; | ||
128 | |||
129 | if (!slot_irq) | ||
130 | return -ENODEV; | ||
131 | ret = slot_irq->handler(slot_irq->arg); | ||
132 | |||
133 | return ret; | ||
134 | } | ||
135 | |||
136 | static irqreturn_t tpci200_interrupt(int irq, void *dev_id) | ||
137 | { | ||
138 | struct tpci200_board *tpci200 = (struct tpci200_board *) dev_id; | ||
139 | struct slot_irq *slot_irq; | ||
140 | irqreturn_t ret; | ||
141 | u16 status_reg; | ||
142 | int i; | ||
143 | |||
144 | /* Read status register */ | ||
145 | status_reg = ioread16(&tpci200->info->interface_regs->status); | ||
146 | |||
147 | /* Did we cause the interrupt? */ | ||
148 | if (!(status_reg & TPCI200_SLOT_INT_MASK)) | ||
149 | return IRQ_NONE; | ||
150 | |||
151 | /* callback to the IRQ handler for the corresponding slot */ | ||
152 | rcu_read_lock(); | ||
153 | for (i = 0; i < TPCI200_NB_SLOT; i++) { | ||
154 | if (!(status_reg & ((TPCI200_A_INT0 | TPCI200_A_INT1) << (2 * i)))) | ||
155 | continue; | ||
156 | slot_irq = rcu_dereference(tpci200->slots[i].irq); | ||
157 | ret = tpci200_slot_irq(slot_irq); | ||
158 | if (ret == -ENODEV) { | ||
159 | dev_info(&tpci200->info->pdev->dev, | ||
160 | "No registered ISR for slot [%d:%d]!. IRQ will be disabled.\n", | ||
161 | tpci200->number, i); | ||
162 | tpci200_disable_irq(tpci200, i); | ||
163 | } | ||
164 | } | ||
165 | rcu_read_unlock(); | ||
166 | |||
167 | return IRQ_HANDLED; | ||
168 | } | ||
169 | |||
170 | static int tpci200_free_irq(struct ipack_device *dev) | ||
171 | { | ||
172 | struct slot_irq *slot_irq; | ||
173 | struct tpci200_board *tpci200; | ||
174 | |||
175 | tpci200 = check_slot(dev); | ||
176 | if (tpci200 == NULL) | ||
177 | return -EINVAL; | ||
178 | |||
179 | if (mutex_lock_interruptible(&tpci200->mutex)) | ||
180 | return -ERESTARTSYS; | ||
181 | |||
182 | if (tpci200->slots[dev->slot].irq == NULL) { | ||
183 | mutex_unlock(&tpci200->mutex); | ||
184 | return -EINVAL; | ||
185 | } | ||
186 | |||
187 | tpci200_disable_irq(tpci200, dev->slot); | ||
188 | slot_irq = tpci200->slots[dev->slot].irq; | ||
189 | /* uninstall handler */ | ||
190 | RCU_INIT_POINTER(tpci200->slots[dev->slot].irq, NULL); | ||
191 | synchronize_rcu(); | ||
192 | kfree(slot_irq); | ||
193 | mutex_unlock(&tpci200->mutex); | ||
194 | return 0; | ||
195 | } | ||
196 | |||
197 | static int tpci200_request_irq(struct ipack_device *dev, | ||
198 | irqreturn_t (*handler)(void *), void *arg) | ||
199 | { | ||
200 | int res = 0; | ||
201 | struct slot_irq *slot_irq; | ||
202 | struct tpci200_board *tpci200; | ||
203 | |||
204 | tpci200 = check_slot(dev); | ||
205 | if (tpci200 == NULL) | ||
206 | return -EINVAL; | ||
207 | |||
208 | if (mutex_lock_interruptible(&tpci200->mutex)) | ||
209 | return -ERESTARTSYS; | ||
210 | |||
211 | if (tpci200->slots[dev->slot].irq != NULL) { | ||
212 | dev_err(&dev->dev, | ||
213 | "Slot [%d:%d] IRQ already registered !\n", | ||
214 | dev->bus->bus_nr, | ||
215 | dev->slot); | ||
216 | res = -EINVAL; | ||
217 | goto out_unlock; | ||
218 | } | ||
219 | |||
220 | slot_irq = kzalloc(sizeof(struct slot_irq), GFP_KERNEL); | ||
221 | if (slot_irq == NULL) { | ||
222 | dev_err(&dev->dev, | ||
223 | "Slot [%d:%d] unable to allocate memory for IRQ !\n", | ||
224 | dev->bus->bus_nr, dev->slot); | ||
225 | res = -ENOMEM; | ||
226 | goto out_unlock; | ||
227 | } | ||
228 | |||
229 | /* | ||
230 | * WARNING: Setup Interrupt Vector in the IndustryPack device | ||
231 | * before an IRQ request. | ||
232 | * Read the User Manual of your IndustryPack device to know | ||
233 | * where to write the vector in memory. | ||
234 | */ | ||
235 | slot_irq->handler = handler; | ||
236 | slot_irq->arg = arg; | ||
237 | slot_irq->holder = dev; | ||
238 | |||
239 | rcu_assign_pointer(tpci200->slots[dev->slot].irq, slot_irq); | ||
240 | tpci200_enable_irq(tpci200, dev->slot); | ||
241 | |||
242 | out_unlock: | ||
243 | mutex_unlock(&tpci200->mutex); | ||
244 | return res; | ||
245 | } | ||
246 | |||
247 | static int tpci200_register(struct tpci200_board *tpci200) | ||
248 | { | ||
249 | int i; | ||
250 | int res; | ||
251 | phys_addr_t ioidint_base; | ||
252 | unsigned short slot_ctrl; | ||
253 | |||
254 | if (pci_enable_device(tpci200->info->pdev) < 0) | ||
255 | return -ENODEV; | ||
256 | |||
257 | /* Request IP interface register (Bar 2) */ | ||
258 | res = pci_request_region(tpci200->info->pdev, TPCI200_IP_INTERFACE_BAR, | ||
259 | "Carrier IP interface registers"); | ||
260 | if (res) { | ||
261 | dev_err(&tpci200->info->pdev->dev, | ||
262 | "(bn 0x%X, sn 0x%X) failed to allocate PCI resource for BAR 2 !", | ||
263 | tpci200->info->pdev->bus->number, | ||
264 | tpci200->info->pdev->devfn); | ||
265 | goto out_disable_pci; | ||
266 | } | ||
267 | |||
268 | /* Request IO ID INT space (Bar 3) */ | ||
269 | res = pci_request_region(tpci200->info->pdev, | ||
270 | TPCI200_IO_ID_INT_SPACES_BAR, | ||
271 | "Carrier IO ID INT space"); | ||
272 | if (res) { | ||
273 | dev_err(&tpci200->info->pdev->dev, | ||
274 | "(bn 0x%X, sn 0x%X) failed to allocate PCI resource for BAR 3 !", | ||
275 | tpci200->info->pdev->bus->number, | ||
276 | tpci200->info->pdev->devfn); | ||
277 | goto out_release_ip_space; | ||
278 | } | ||
279 | |||
280 | /* Request MEM8 space (Bar 5) */ | ||
281 | res = pci_request_region(tpci200->info->pdev, TPCI200_MEM8_SPACE_BAR, | ||
282 | "Carrier MEM8 space"); | ||
283 | if (res) { | ||
284 | dev_err(&tpci200->info->pdev->dev, | ||
285 | "(bn 0x%X, sn 0x%X) failed to allocate PCI resource for BAR 5!", | ||
286 | tpci200->info->pdev->bus->number, | ||
287 | tpci200->info->pdev->devfn); | ||
288 | goto out_release_ioid_int_space; | ||
289 | } | ||
290 | |||
291 | /* Request MEM16 space (Bar 4) */ | ||
292 | res = pci_request_region(tpci200->info->pdev, TPCI200_MEM16_SPACE_BAR, | ||
293 | "Carrier MEM16 space"); | ||
294 | if (res) { | ||
295 | dev_err(&tpci200->info->pdev->dev, | ||
296 | "(bn 0x%X, sn 0x%X) failed to allocate PCI resource for BAR 4!", | ||
297 | tpci200->info->pdev->bus->number, | ||
298 | tpci200->info->pdev->devfn); | ||
299 | goto out_release_mem8_space; | ||
300 | } | ||
301 | |||
302 | /* Map internal tpci200 driver user space */ | ||
303 | tpci200->info->interface_regs = | ||
304 | ioremap_nocache(pci_resource_start(tpci200->info->pdev, | ||
305 | TPCI200_IP_INTERFACE_BAR), | ||
306 | TPCI200_IFACE_SIZE); | ||
307 | |||
308 | /* Initialize lock that protects interface_regs */ | ||
309 | spin_lock_init(&tpci200->regs_lock); | ||
310 | |||
311 | ioidint_base = pci_resource_start(tpci200->info->pdev, | ||
312 | TPCI200_IO_ID_INT_SPACES_BAR); | ||
313 | tpci200->mod_mem[IPACK_IO_SPACE] = ioidint_base + TPCI200_IO_SPACE_OFF; | ||
314 | tpci200->mod_mem[IPACK_ID_SPACE] = ioidint_base + TPCI200_ID_SPACE_OFF; | ||
315 | tpci200->mod_mem[IPACK_INT_SPACE] = | ||
316 | ioidint_base + TPCI200_INT_SPACE_OFF; | ||
317 | tpci200->mod_mem[IPACK_MEM8_SPACE] = | ||
318 | pci_resource_start(tpci200->info->pdev, | ||
319 | TPCI200_MEM8_SPACE_BAR); | ||
320 | tpci200->mod_mem[IPACK_MEM16_SPACE] = | ||
321 | pci_resource_start(tpci200->info->pdev, | ||
322 | TPCI200_MEM16_SPACE_BAR); | ||
323 | |||
324 | /* Set the default parameters of the slot | ||
325 | * INT0 disabled, level sensitive | ||
326 | * INT1 disabled, level sensitive | ||
327 | * error interrupt disabled | ||
328 | * timeout interrupt disabled | ||
329 | * recover time disabled | ||
330 | * clock rate 8 MHz | ||
331 | */ | ||
332 | slot_ctrl = 0; | ||
333 | for (i = 0; i < TPCI200_NB_SLOT; i++) | ||
334 | writew(slot_ctrl, &tpci200->info->interface_regs->control[i]); | ||
335 | |||
336 | res = request_irq(tpci200->info->pdev->irq, | ||
337 | tpci200_interrupt, IRQF_SHARED, | ||
338 | KBUILD_MODNAME, (void *) tpci200); | ||
339 | if (res) { | ||
340 | dev_err(&tpci200->info->pdev->dev, | ||
341 | "(bn 0x%X, sn 0x%X) unable to register IRQ !", | ||
342 | tpci200->info->pdev->bus->number, | ||
343 | tpci200->info->pdev->devfn); | ||
344 | goto out_release_ioid_int_space; | ||
345 | } | ||
346 | |||
347 | return 0; | ||
348 | |||
349 | out_release_mem8_space: | ||
350 | pci_release_region(tpci200->info->pdev, TPCI200_MEM8_SPACE_BAR); | ||
351 | out_release_ioid_int_space: | ||
352 | pci_release_region(tpci200->info->pdev, TPCI200_IO_ID_INT_SPACES_BAR); | ||
353 | out_release_ip_space: | ||
354 | pci_release_region(tpci200->info->pdev, TPCI200_IP_INTERFACE_BAR); | ||
355 | out_disable_pci: | ||
356 | pci_disable_device(tpci200->info->pdev); | ||
357 | return res; | ||
358 | } | ||
359 | |||
360 | static int tpci200_get_clockrate(struct ipack_device *dev) | ||
361 | { | ||
362 | struct tpci200_board *tpci200 = check_slot(dev); | ||
363 | __le16 __iomem *addr; | ||
364 | |||
365 | if (!tpci200) | ||
366 | return -ENODEV; | ||
367 | |||
368 | addr = &tpci200->info->interface_regs->control[dev->slot]; | ||
369 | return (ioread16(addr) & TPCI200_CLK32) ? 32 : 8; | ||
370 | } | ||
371 | |||
372 | static int tpci200_set_clockrate(struct ipack_device *dev, int mherz) | ||
373 | { | ||
374 | struct tpci200_board *tpci200 = check_slot(dev); | ||
375 | __le16 __iomem *addr; | ||
376 | |||
377 | if (!tpci200) | ||
378 | return -ENODEV; | ||
379 | |||
380 | addr = &tpci200->info->interface_regs->control[dev->slot]; | ||
381 | |||
382 | switch (mherz) { | ||
383 | case 8: | ||
384 | tpci200_clear_mask(tpci200, addr, TPCI200_CLK32); | ||
385 | break; | ||
386 | case 32: | ||
387 | tpci200_set_mask(tpci200, addr, TPCI200_CLK32); | ||
388 | break; | ||
389 | default: | ||
390 | return -EINVAL; | ||
391 | } | ||
392 | return 0; | ||
393 | } | ||
394 | |||
395 | static int tpci200_get_error(struct ipack_device *dev) | ||
396 | { | ||
397 | struct tpci200_board *tpci200 = check_slot(dev); | ||
398 | __le16 __iomem *addr; | ||
399 | u16 mask; | ||
400 | |||
401 | if (!tpci200) | ||
402 | return -ENODEV; | ||
403 | |||
404 | addr = &tpci200->info->interface_regs->status; | ||
405 | mask = tpci200_status_error[dev->slot]; | ||
406 | return (ioread16(addr) & mask) ? 1 : 0; | ||
407 | } | ||
408 | |||
409 | static int tpci200_get_timeout(struct ipack_device *dev) | ||
410 | { | ||
411 | struct tpci200_board *tpci200 = check_slot(dev); | ||
412 | __le16 __iomem *addr; | ||
413 | u16 mask; | ||
414 | |||
415 | if (!tpci200) | ||
416 | return -ENODEV; | ||
417 | |||
418 | addr = &tpci200->info->interface_regs->status; | ||
419 | mask = tpci200_status_timeout[dev->slot]; | ||
420 | |||
421 | return (ioread16(addr) & mask) ? 1 : 0; | ||
422 | } | ||
423 | |||
424 | static int tpci200_reset_timeout(struct ipack_device *dev) | ||
425 | { | ||
426 | struct tpci200_board *tpci200 = check_slot(dev); | ||
427 | __le16 __iomem *addr; | ||
428 | u16 mask; | ||
429 | |||
430 | if (!tpci200) | ||
431 | return -ENODEV; | ||
432 | |||
433 | addr = &tpci200->info->interface_regs->status; | ||
434 | mask = tpci200_status_timeout[dev->slot]; | ||
435 | |||
436 | iowrite16(mask, addr); | ||
437 | return 0; | ||
438 | } | ||
439 | |||
440 | static void tpci200_uninstall(struct tpci200_board *tpci200) | ||
441 | { | ||
442 | tpci200_unregister(tpci200); | ||
443 | kfree(tpci200->slots); | ||
444 | } | ||
445 | |||
446 | static const struct ipack_bus_ops tpci200_bus_ops = { | ||
447 | .request_irq = tpci200_request_irq, | ||
448 | .free_irq = tpci200_free_irq, | ||
449 | .get_clockrate = tpci200_get_clockrate, | ||
450 | .set_clockrate = tpci200_set_clockrate, | ||
451 | .get_error = tpci200_get_error, | ||
452 | .get_timeout = tpci200_get_timeout, | ||
453 | .reset_timeout = tpci200_reset_timeout, | ||
454 | }; | ||
455 | |||
456 | static int tpci200_install(struct tpci200_board *tpci200) | ||
457 | { | ||
458 | int res; | ||
459 | |||
460 | tpci200->slots = kzalloc( | ||
461 | TPCI200_NB_SLOT * sizeof(struct tpci200_slot), GFP_KERNEL); | ||
462 | if (tpci200->slots == NULL) | ||
463 | return -ENOMEM; | ||
464 | |||
465 | res = tpci200_register(tpci200); | ||
466 | if (res) { | ||
467 | kfree(tpci200->slots); | ||
468 | tpci200->slots = NULL; | ||
469 | return res; | ||
470 | } | ||
471 | |||
472 | mutex_init(&tpci200->mutex); | ||
473 | return 0; | ||
474 | } | ||
475 | |||
476 | static void tpci200_release_device(struct ipack_device *dev) | ||
477 | { | ||
478 | kfree(dev); | ||
479 | } | ||
480 | |||
481 | static int tpci200_create_device(struct tpci200_board *tpci200, int i) | ||
482 | { | ||
483 | enum ipack_space space; | ||
484 | struct ipack_device *dev = | ||
485 | kzalloc(sizeof(struct ipack_device), GFP_KERNEL); | ||
486 | if (!dev) | ||
487 | return -ENOMEM; | ||
488 | dev->slot = i; | ||
489 | dev->bus = tpci200->info->ipack_bus; | ||
490 | dev->release = tpci200_release_device; | ||
491 | |||
492 | for (space = 0; space < IPACK_SPACE_COUNT; space++) { | ||
493 | dev->region[space].start = | ||
494 | tpci200->mod_mem[space] | ||
495 | + tpci200_space_interval[space] * i; | ||
496 | dev->region[space].size = tpci200_space_size[space]; | ||
497 | } | ||
498 | return ipack_device_register(dev); | ||
499 | } | ||
500 | |||
501 | static int tpci200_pci_probe(struct pci_dev *pdev, | ||
502 | const struct pci_device_id *id) | ||
503 | { | ||
504 | int ret, i; | ||
505 | struct tpci200_board *tpci200; | ||
506 | u32 reg32; | ||
507 | |||
508 | tpci200 = kzalloc(sizeof(struct tpci200_board), GFP_KERNEL); | ||
509 | if (!tpci200) | ||
510 | return -ENOMEM; | ||
511 | |||
512 | tpci200->info = kzalloc(sizeof(struct tpci200_infos), GFP_KERNEL); | ||
513 | if (!tpci200->info) { | ||
514 | ret = -ENOMEM; | ||
515 | goto out_err_info; | ||
516 | } | ||
517 | |||
518 | pci_dev_get(pdev); | ||
519 | |||
520 | /* Obtain a mapping of the carrier's PCI configuration registers */ | ||
521 | ret = pci_request_region(pdev, TPCI200_CFG_MEM_BAR, | ||
522 | KBUILD_MODNAME " Configuration Memory"); | ||
523 | if (ret) { | ||
524 | dev_err(&pdev->dev, "Failed to allocate PCI Configuration Memory"); | ||
525 | ret = -EBUSY; | ||
526 | goto out_err_pci_request; | ||
527 | } | ||
528 | tpci200->info->cfg_regs = ioremap_nocache( | ||
529 | pci_resource_start(pdev, TPCI200_CFG_MEM_BAR), | ||
530 | pci_resource_len(pdev, TPCI200_CFG_MEM_BAR)); | ||
531 | if (!tpci200->info->cfg_regs) { | ||
532 | dev_err(&pdev->dev, "Failed to map PCI Configuration Memory"); | ||
533 | ret = -EFAULT; | ||
534 | goto out_err_ioremap; | ||
535 | } | ||
536 | |||
537 | /* Disable byte swapping for 16 bit IP module access. This will ensure | ||
538 | * that the Industrypack big endian byte order is preserved by the | ||
539 | * carrier. */ | ||
540 | reg32 = ioread32(tpci200->info->cfg_regs + LAS1_DESC); | ||
541 | reg32 |= 1 << LAS_BIT_BIGENDIAN; | ||
542 | iowrite32(reg32, tpci200->info->cfg_regs + LAS1_DESC); | ||
543 | |||
544 | reg32 = ioread32(tpci200->info->cfg_regs + LAS2_DESC); | ||
545 | reg32 |= 1 << LAS_BIT_BIGENDIAN; | ||
546 | iowrite32(reg32, tpci200->info->cfg_regs + LAS2_DESC); | ||
547 | |||
548 | /* Save struct pci_dev pointer */ | ||
549 | tpci200->info->pdev = pdev; | ||
550 | tpci200->info->id_table = (struct pci_device_id *)id; | ||
551 | |||
552 | /* register the device and initialize it */ | ||
553 | ret = tpci200_install(tpci200); | ||
554 | if (ret) { | ||
555 | dev_err(&pdev->dev, "error during tpci200 install\n"); | ||
556 | ret = -ENODEV; | ||
557 | goto out_err_install; | ||
558 | } | ||
559 | |||
560 | /* Register the carrier in the industry pack bus driver */ | ||
561 | tpci200->info->ipack_bus = ipack_bus_register(&pdev->dev, | ||
562 | TPCI200_NB_SLOT, | ||
563 | &tpci200_bus_ops); | ||
564 | if (!tpci200->info->ipack_bus) { | ||
565 | dev_err(&pdev->dev, | ||
566 | "error registering the carrier on ipack driver\n"); | ||
567 | ret = -EFAULT; | ||
568 | goto out_err_bus_register; | ||
569 | } | ||
570 | |||
571 | /* save the bus number given by ipack to logging purpose */ | ||
572 | tpci200->number = tpci200->info->ipack_bus->bus_nr; | ||
573 | dev_set_drvdata(&pdev->dev, tpci200); | ||
574 | |||
575 | for (i = 0; i < TPCI200_NB_SLOT; i++) | ||
576 | tpci200_create_device(tpci200, i); | ||
577 | return 0; | ||
578 | |||
579 | out_err_bus_register: | ||
580 | tpci200_uninstall(tpci200); | ||
581 | out_err_install: | ||
582 | iounmap(tpci200->info->cfg_regs); | ||
583 | out_err_ioremap: | ||
584 | pci_release_region(pdev, TPCI200_CFG_MEM_BAR); | ||
585 | out_err_pci_request: | ||
586 | pci_dev_put(pdev); | ||
587 | kfree(tpci200->info); | ||
588 | out_err_info: | ||
589 | kfree(tpci200); | ||
590 | return ret; | ||
591 | } | ||
592 | |||
593 | static void __tpci200_pci_remove(struct tpci200_board *tpci200) | ||
594 | { | ||
595 | ipack_bus_unregister(tpci200->info->ipack_bus); | ||
596 | tpci200_uninstall(tpci200); | ||
597 | |||
598 | kfree(tpci200->info); | ||
599 | kfree(tpci200); | ||
600 | } | ||
601 | |||
602 | static void __devexit tpci200_pci_remove(struct pci_dev *dev) | ||
603 | { | ||
604 | struct tpci200_board *tpci200 = pci_get_drvdata(dev); | ||
605 | |||
606 | __tpci200_pci_remove(tpci200); | ||
607 | } | ||
608 | |||
609 | static DEFINE_PCI_DEVICE_TABLE(tpci200_idtable) = { | ||
610 | { TPCI200_VENDOR_ID, TPCI200_DEVICE_ID, TPCI200_SUBVENDOR_ID, | ||
611 | TPCI200_SUBDEVICE_ID }, | ||
612 | { 0, }, | ||
613 | }; | ||
614 | |||
615 | MODULE_DEVICE_TABLE(pci, tpci200_idtable); | ||
616 | |||
617 | static struct pci_driver tpci200_pci_drv = { | ||
618 | .name = "tpci200", | ||
619 | .id_table = tpci200_idtable, | ||
620 | .probe = tpci200_pci_probe, | ||
621 | .remove = __devexit_p(tpci200_pci_remove), | ||
622 | }; | ||
623 | |||
624 | module_pci_driver(tpci200_pci_drv); | ||
625 | |||
626 | MODULE_DESCRIPTION("TEWS TPCI-200 device driver"); | ||
627 | MODULE_LICENSE("GPL"); | ||
diff --git a/drivers/ipack/carriers/tpci200.h b/drivers/ipack/carriers/tpci200.h new file mode 100644 index 000000000000..8d9be277b34d --- /dev/null +++ b/drivers/ipack/carriers/tpci200.h | |||
@@ -0,0 +1,168 @@ | |||
1 | /** | ||
2 | * tpci200.h | ||
3 | * | ||
4 | * driver for the carrier TEWS TPCI-200 | ||
5 | * | ||
6 | * Copyright (C) 2009-2012 CERN (www.cern.ch) | ||
7 | * Author: Nicolas Serafini, EIC2 SA | ||
8 | * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com> | ||
9 | * | ||
10 | * This program is free software; you can redistribute it and/or modify it | ||
11 | * under the terms of the GNU General Public License as published by the Free | ||
12 | * Software Foundation; version 2 of the License. | ||
13 | */ | ||
14 | |||
15 | #ifndef _TPCI200_H_ | ||
16 | #define _TPCI200_H_ | ||
17 | |||
18 | #include <linux/limits.h> | ||
19 | #include <linux/pci.h> | ||
20 | #include <linux/spinlock.h> | ||
21 | #include <linux/swab.h> | ||
22 | #include <linux/io.h> | ||
23 | |||
24 | #include "../ipack.h" | ||
25 | |||
26 | #define TPCI200_NB_SLOT 0x4 | ||
27 | #define TPCI200_NB_BAR 0x6 | ||
28 | |||
29 | #define TPCI200_VENDOR_ID 0x1498 | ||
30 | #define TPCI200_DEVICE_ID 0x30C8 | ||
31 | #define TPCI200_SUBVENDOR_ID 0x1498 | ||
32 | #define TPCI200_SUBDEVICE_ID 0x300A | ||
33 | |||
34 | #define TPCI200_CFG_MEM_BAR 0 | ||
35 | #define TPCI200_IP_INTERFACE_BAR 2 | ||
36 | #define TPCI200_IO_ID_INT_SPACES_BAR 3 | ||
37 | #define TPCI200_MEM16_SPACE_BAR 4 | ||
38 | #define TPCI200_MEM8_SPACE_BAR 5 | ||
39 | |||
40 | struct tpci200_regs { | ||
41 | __le16 revision; | ||
42 | /* writes to control should occur with the mutex held to protect | ||
43 | * read-modify-write operations */ | ||
44 | __le16 control[4]; | ||
45 | __le16 reset; | ||
46 | __le16 status; | ||
47 | u8 reserved[242]; | ||
48 | } __packed; | ||
49 | |||
50 | #define TPCI200_IFACE_SIZE 0x100 | ||
51 | |||
52 | #define TPCI200_IO_SPACE_OFF 0x0000 | ||
53 | #define TPCI200_IO_SPACE_INTERVAL 0x0100 | ||
54 | #define TPCI200_IO_SPACE_SIZE 0x0080 | ||
55 | #define TPCI200_ID_SPACE_OFF 0x0080 | ||
56 | #define TPCI200_ID_SPACE_INTERVAL 0x0100 | ||
57 | #define TPCI200_ID_SPACE_SIZE 0x0040 | ||
58 | #define TPCI200_INT_SPACE_OFF 0x00C0 | ||
59 | #define TPCI200_INT_SPACE_INTERVAL 0x0100 | ||
60 | #define TPCI200_INT_SPACE_SIZE 0x0040 | ||
61 | #define TPCI200_IOIDINT_SIZE 0x0400 | ||
62 | |||
63 | #define TPCI200_MEM8_SPACE_INTERVAL 0x00400000 | ||
64 | #define TPCI200_MEM8_SPACE_SIZE 0x00400000 | ||
65 | #define TPCI200_MEM16_SPACE_INTERVAL 0x00800000 | ||
66 | #define TPCI200_MEM16_SPACE_SIZE 0x00800000 | ||
67 | |||
68 | /* control field in tpci200_regs */ | ||
69 | #define TPCI200_INT0_EN 0x0040 | ||
70 | #define TPCI200_INT1_EN 0x0080 | ||
71 | #define TPCI200_INT0_EDGE 0x0010 | ||
72 | #define TPCI200_INT1_EDGE 0x0020 | ||
73 | #define TPCI200_ERR_INT_EN 0x0008 | ||
74 | #define TPCI200_TIME_INT_EN 0x0004 | ||
75 | #define TPCI200_RECOVER_EN 0x0002 | ||
76 | #define TPCI200_CLK32 0x0001 | ||
77 | |||
78 | /* reset field in tpci200_regs */ | ||
79 | #define TPCI200_A_RESET 0x0001 | ||
80 | #define TPCI200_B_RESET 0x0002 | ||
81 | #define TPCI200_C_RESET 0x0004 | ||
82 | #define TPCI200_D_RESET 0x0008 | ||
83 | |||
84 | /* status field in tpci200_regs */ | ||
85 | #define TPCI200_A_TIMEOUT 0x1000 | ||
86 | #define TPCI200_B_TIMEOUT 0x2000 | ||
87 | #define TPCI200_C_TIMEOUT 0x4000 | ||
88 | #define TPCI200_D_TIMEOUT 0x8000 | ||
89 | |||
90 | #define TPCI200_A_ERROR 0x0100 | ||
91 | #define TPCI200_B_ERROR 0x0200 | ||
92 | #define TPCI200_C_ERROR 0x0400 | ||
93 | #define TPCI200_D_ERROR 0x0800 | ||
94 | |||
95 | #define TPCI200_A_INT0 0x0001 | ||
96 | #define TPCI200_A_INT1 0x0002 | ||
97 | #define TPCI200_B_INT0 0x0004 | ||
98 | #define TPCI200_B_INT1 0x0008 | ||
99 | #define TPCI200_C_INT0 0x0010 | ||
100 | #define TPCI200_C_INT1 0x0020 | ||
101 | #define TPCI200_D_INT0 0x0040 | ||
102 | #define TPCI200_D_INT1 0x0080 | ||
103 | |||
104 | #define TPCI200_SLOT_INT_MASK 0x00FF | ||
105 | |||
106 | /* PCI Configuration registers. The PCI bridge is a PLX Technology PCI9030. */ | ||
107 | #define LAS1_DESC 0x2C | ||
108 | #define LAS2_DESC 0x30 | ||
109 | |||
110 | /* Bits in the LAS?_DESC registers */ | ||
111 | #define LAS_BIT_BIGENDIAN 24 | ||
112 | |||
113 | #define VME_IOID_SPACE "IOID" | ||
114 | #define VME_MEM_SPACE "MEM" | ||
115 | |||
116 | /** | ||
117 | * struct slot_irq - slot IRQ definition. | ||
118 | * @vector Vector number | ||
119 | * @handler Handler called when IRQ arrives | ||
120 | * @arg Handler argument | ||
121 | * | ||
122 | */ | ||
123 | struct slot_irq { | ||
124 | struct ipack_device *holder; | ||
125 | int vector; | ||
126 | irqreturn_t (*handler)(void *); | ||
127 | void *arg; | ||
128 | }; | ||
129 | |||
130 | /** | ||
131 | * struct tpci200_slot - data specific to the tpci200 slot. | ||
132 | * @slot_id Slot identification gived to external interface | ||
133 | * @irq Slot IRQ infos | ||
134 | * @io_phys IO physical base address register of the slot | ||
135 | * @id_phys ID physical base address register of the slot | ||
136 | * @int_phys INT physical base address register of the slot | ||
137 | * @mem_phys MEM physical base address register of the slot | ||
138 | * | ||
139 | */ | ||
140 | struct tpci200_slot { | ||
141 | struct slot_irq *irq; | ||
142 | }; | ||
143 | |||
144 | /** | ||
145 | * struct tpci200_infos - informations specific of the TPCI200 tpci200. | ||
146 | * @pci_dev PCI device | ||
147 | * @interface_regs Pointer to IP interface space (Bar 2) | ||
148 | * @ioidint_space Pointer to IP ID, IO and INT space (Bar 3) | ||
149 | * @mem8_space Pointer to MEM space (Bar 4) | ||
150 | * | ||
151 | */ | ||
152 | struct tpci200_infos { | ||
153 | struct pci_dev *pdev; | ||
154 | struct pci_device_id *id_table; | ||
155 | struct tpci200_regs __iomem *interface_regs; | ||
156 | void __iomem *cfg_regs; | ||
157 | struct ipack_bus_device *ipack_bus; | ||
158 | }; | ||
159 | struct tpci200_board { | ||
160 | unsigned int number; | ||
161 | struct mutex mutex; | ||
162 | spinlock_t regs_lock; | ||
163 | struct tpci200_slot *slots; | ||
164 | struct tpci200_infos *info; | ||
165 | phys_addr_t mod_mem[IPACK_SPACE_COUNT]; | ||
166 | }; | ||
167 | |||
168 | #endif /* _TPCI200_H_ */ | ||
diff --git a/drivers/ipack/devices/Kconfig b/drivers/ipack/devices/Kconfig new file mode 100644 index 000000000000..0b82fdc198c0 --- /dev/null +++ b/drivers/ipack/devices/Kconfig | |||
@@ -0,0 +1,6 @@ | |||
1 | config SERIAL_IPOCTAL | ||
2 | tristate "IndustryPack IP-OCTAL uart support" | ||
3 | depends on IPACK_BUS | ||
4 | help | ||
5 | This driver supports the IPOCTAL serial port device for the IndustryPack bus. | ||
6 | default n | ||
diff --git a/drivers/ipack/devices/Makefile b/drivers/ipack/devices/Makefile new file mode 100644 index 000000000000..6de18bda4a9a --- /dev/null +++ b/drivers/ipack/devices/Makefile | |||
@@ -0,0 +1 @@ | |||
obj-$(CONFIG_SERIAL_IPOCTAL) += ipoctal.o | |||
diff --git a/drivers/ipack/devices/ipoctal.c b/drivers/ipack/devices/ipoctal.c new file mode 100644 index 000000000000..783f120338d1 --- /dev/null +++ b/drivers/ipack/devices/ipoctal.c | |||
@@ -0,0 +1,751 @@ | |||
1 | /** | ||
2 | * ipoctal.c | ||
3 | * | ||
4 | * driver for the GE IP-OCTAL boards | ||
5 | * | ||
6 | * Copyright (C) 2009-2012 CERN (www.cern.ch) | ||
7 | * Author: Nicolas Serafini, EIC2 SA | ||
8 | * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com> | ||
9 | * | ||
10 | * This program is free software; you can redistribute it and/or modify it | ||
11 | * under the terms of the GNU General Public License as published by the Free | ||
12 | * Software Foundation; version 2 of the License. | ||
13 | */ | ||
14 | |||
15 | #include <linux/device.h> | ||
16 | #include <linux/module.h> | ||
17 | #include <linux/interrupt.h> | ||
18 | #include <linux/sched.h> | ||
19 | #include <linux/tty.h> | ||
20 | #include <linux/serial.h> | ||
21 | #include <linux/tty_flip.h> | ||
22 | #include <linux/slab.h> | ||
23 | #include <linux/atomic.h> | ||
24 | #include <linux/io.h> | ||
25 | #include "../ipack.h" | ||
26 | #include "ipoctal.h" | ||
27 | #include "scc2698.h" | ||
28 | |||
29 | #define IP_OCTAL_ID_SPACE_VECTOR 0x41 | ||
30 | #define IP_OCTAL_NB_BLOCKS 4 | ||
31 | |||
32 | static const struct tty_operations ipoctal_fops; | ||
33 | |||
34 | struct ipoctal_channel { | ||
35 | struct ipoctal_stats stats; | ||
36 | unsigned int nb_bytes; | ||
37 | wait_queue_head_t queue; | ||
38 | spinlock_t lock; | ||
39 | unsigned int pointer_read; | ||
40 | unsigned int pointer_write; | ||
41 | atomic_t open; | ||
42 | struct tty_port tty_port; | ||
43 | union scc2698_channel __iomem *regs; | ||
44 | union scc2698_block __iomem *block_regs; | ||
45 | unsigned int board_id; | ||
46 | unsigned char *board_write; | ||
47 | u8 isr_rx_rdy_mask; | ||
48 | u8 isr_tx_rdy_mask; | ||
49 | }; | ||
50 | |||
51 | struct ipoctal { | ||
52 | struct ipack_device *dev; | ||
53 | unsigned int board_id; | ||
54 | struct ipoctal_channel channel[NR_CHANNELS]; | ||
55 | unsigned char write; | ||
56 | struct tty_driver *tty_drv; | ||
57 | u8 __iomem *mem8_space; | ||
58 | u8 __iomem *int_space; | ||
59 | }; | ||
60 | |||
61 | static int ipoctal_port_activate(struct tty_port *port, struct tty_struct *tty) | ||
62 | { | ||
63 | struct ipoctal_channel *channel; | ||
64 | |||
65 | channel = dev_get_drvdata(tty->dev); | ||
66 | |||
67 | iowrite8(CR_ENABLE_RX, &channel->regs->w.cr); | ||
68 | return 0; | ||
69 | } | ||
70 | |||
71 | static int ipoctal_open(struct tty_struct *tty, struct file *file) | ||
72 | { | ||
73 | int res; | ||
74 | struct ipoctal_channel *channel; | ||
75 | |||
76 | channel = dev_get_drvdata(tty->dev); | ||
77 | |||
78 | if (atomic_read(&channel->open)) | ||
79 | return -EBUSY; | ||
80 | |||
81 | tty->driver_data = channel; | ||
82 | |||
83 | res = tty_port_open(&channel->tty_port, tty, file); | ||
84 | if (res) | ||
85 | return res; | ||
86 | |||
87 | atomic_inc(&channel->open); | ||
88 | return 0; | ||
89 | } | ||
90 | |||
91 | static void ipoctal_reset_stats(struct ipoctal_stats *stats) | ||
92 | { | ||
93 | stats->tx = 0; | ||
94 | stats->rx = 0; | ||
95 | stats->rcv_break = 0; | ||
96 | stats->framing_err = 0; | ||
97 | stats->overrun_err = 0; | ||
98 | stats->parity_err = 0; | ||
99 | } | ||
100 | |||
101 | static void ipoctal_free_channel(struct ipoctal_channel *channel) | ||
102 | { | ||
103 | ipoctal_reset_stats(&channel->stats); | ||
104 | channel->pointer_read = 0; | ||
105 | channel->pointer_write = 0; | ||
106 | channel->nb_bytes = 0; | ||
107 | } | ||
108 | |||
109 | static void ipoctal_close(struct tty_struct *tty, struct file *filp) | ||
110 | { | ||
111 | struct ipoctal_channel *channel = tty->driver_data; | ||
112 | |||
113 | tty_port_close(&channel->tty_port, tty, filp); | ||
114 | |||
115 | if (atomic_dec_and_test(&channel->open)) | ||
116 | ipoctal_free_channel(channel); | ||
117 | } | ||
118 | |||
119 | static int ipoctal_get_icount(struct tty_struct *tty, | ||
120 | struct serial_icounter_struct *icount) | ||
121 | { | ||
122 | struct ipoctal_channel *channel = tty->driver_data; | ||
123 | |||
124 | icount->cts = 0; | ||
125 | icount->dsr = 0; | ||
126 | icount->rng = 0; | ||
127 | icount->dcd = 0; | ||
128 | icount->rx = channel->stats.rx; | ||
129 | icount->tx = channel->stats.tx; | ||
130 | icount->frame = channel->stats.framing_err; | ||
131 | icount->parity = channel->stats.parity_err; | ||
132 | icount->brk = channel->stats.rcv_break; | ||
133 | return 0; | ||
134 | } | ||
135 | |||
136 | static void ipoctal_irq_rx(struct ipoctal_channel *channel, | ||
137 | struct tty_struct *tty, u8 sr) | ||
138 | { | ||
139 | unsigned char value; | ||
140 | unsigned char flag = TTY_NORMAL; | ||
141 | u8 isr; | ||
142 | |||
143 | do { | ||
144 | value = ioread8(&channel->regs->r.rhr); | ||
145 | /* Error: count statistics */ | ||
146 | if (sr & SR_ERROR) { | ||
147 | iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr); | ||
148 | |||
149 | if (sr & SR_OVERRUN_ERROR) { | ||
150 | channel->stats.overrun_err++; | ||
151 | /* Overrun doesn't affect the current character*/ | ||
152 | tty_insert_flip_char(tty, 0, TTY_OVERRUN); | ||
153 | } | ||
154 | if (sr & SR_PARITY_ERROR) { | ||
155 | channel->stats.parity_err++; | ||
156 | flag = TTY_PARITY; | ||
157 | } | ||
158 | if (sr & SR_FRAMING_ERROR) { | ||
159 | channel->stats.framing_err++; | ||
160 | flag = TTY_FRAME; | ||
161 | } | ||
162 | if (sr & SR_RECEIVED_BREAK) { | ||
163 | iowrite8(CR_CMD_RESET_BREAK_CHANGE, &channel->regs->w.cr); | ||
164 | channel->stats.rcv_break++; | ||
165 | flag = TTY_BREAK; | ||
166 | } | ||
167 | } | ||
168 | tty_insert_flip_char(tty, value, flag); | ||
169 | |||
170 | /* Check if there are more characters in RX FIFO | ||
171 | * If there are more, the isr register for this channel | ||
172 | * has enabled the RxRDY|FFULL bit. | ||
173 | */ | ||
174 | isr = ioread8(&channel->block_regs->r.isr); | ||
175 | sr = ioread8(&channel->regs->r.sr); | ||
176 | } while (isr & channel->isr_rx_rdy_mask); | ||
177 | |||
178 | tty_flip_buffer_push(tty); | ||
179 | } | ||
180 | |||
181 | static void ipoctal_irq_tx(struct ipoctal_channel *channel) | ||
182 | { | ||
183 | unsigned char value; | ||
184 | unsigned int *pointer_write = &channel->pointer_write; | ||
185 | |||
186 | if (channel->nb_bytes <= 0) { | ||
187 | channel->nb_bytes = 0; | ||
188 | return; | ||
189 | } | ||
190 | |||
191 | value = channel->tty_port.xmit_buf[*pointer_write]; | ||
192 | iowrite8(value, &channel->regs->w.thr); | ||
193 | channel->stats.tx++; | ||
194 | (*pointer_write)++; | ||
195 | *pointer_write = *pointer_write % PAGE_SIZE; | ||
196 | channel->nb_bytes--; | ||
197 | |||
198 | if ((channel->nb_bytes == 0) && | ||
199 | (waitqueue_active(&channel->queue))) { | ||
200 | |||
201 | if (channel->board_id != IPACK1_DEVICE_ID_SBS_OCTAL_485) { | ||
202 | *channel->board_write = 1; | ||
203 | wake_up_interruptible(&channel->queue); | ||
204 | } | ||
205 | } | ||
206 | } | ||
207 | |||
208 | static void ipoctal_irq_channel(struct ipoctal_channel *channel) | ||
209 | { | ||
210 | u8 isr, sr; | ||
211 | struct tty_struct *tty; | ||
212 | |||
213 | /* If there is no client, skip the check */ | ||
214 | if (!atomic_read(&channel->open)) | ||
215 | return; | ||
216 | |||
217 | tty = tty_port_tty_get(&channel->tty_port); | ||
218 | if (!tty) | ||
219 | return; | ||
220 | /* The HW is organized in pair of channels. See which register we need | ||
221 | * to read from */ | ||
222 | isr = ioread8(&channel->block_regs->r.isr); | ||
223 | sr = ioread8(&channel->regs->r.sr); | ||
224 | |||
225 | /* In case of RS-485, change from TX to RX when finishing TX. | ||
226 | * Half-duplex. */ | ||
227 | if ((channel->board_id == IPACK1_DEVICE_ID_SBS_OCTAL_485) && | ||
228 | (sr & SR_TX_EMPTY) && (channel->nb_bytes == 0)) { | ||
229 | iowrite8(CR_DISABLE_TX, &channel->regs->w.cr); | ||
230 | iowrite8(CR_CMD_NEGATE_RTSN, &channel->regs->w.cr); | ||
231 | iowrite8(CR_ENABLE_RX, &channel->regs->w.cr); | ||
232 | *channel->board_write = 1; | ||
233 | wake_up_interruptible(&channel->queue); | ||
234 | } | ||
235 | |||
236 | /* RX data */ | ||
237 | if ((isr & channel->isr_rx_rdy_mask) && (sr & SR_RX_READY)) | ||
238 | ipoctal_irq_rx(channel, tty, sr); | ||
239 | |||
240 | /* TX of each character */ | ||
241 | if ((isr & channel->isr_tx_rdy_mask) && (sr & SR_TX_READY)) | ||
242 | ipoctal_irq_tx(channel); | ||
243 | |||
244 | tty_flip_buffer_push(tty); | ||
245 | tty_kref_put(tty); | ||
246 | } | ||
247 | |||
248 | static irqreturn_t ipoctal_irq_handler(void *arg) | ||
249 | { | ||
250 | unsigned int i; | ||
251 | struct ipoctal *ipoctal = (struct ipoctal *) arg; | ||
252 | |||
253 | /* Check all channels */ | ||
254 | for (i = 0; i < NR_CHANNELS; i++) | ||
255 | ipoctal_irq_channel(&ipoctal->channel[i]); | ||
256 | |||
257 | /* Clear the IPack device interrupt */ | ||
258 | readw(ipoctal->int_space + ACK_INT_REQ0); | ||
259 | readw(ipoctal->int_space + ACK_INT_REQ1); | ||
260 | |||
261 | return IRQ_HANDLED; | ||
262 | } | ||
263 | |||
264 | static const struct tty_port_operations ipoctal_tty_port_ops = { | ||
265 | .dtr_rts = NULL, | ||
266 | .activate = ipoctal_port_activate, | ||
267 | }; | ||
268 | |||
269 | static int ipoctal_inst_slot(struct ipoctal *ipoctal, unsigned int bus_nr, | ||
270 | unsigned int slot) | ||
271 | { | ||
272 | int res; | ||
273 | int i; | ||
274 | struct tty_driver *tty; | ||
275 | char name[20]; | ||
276 | struct ipoctal_channel *channel; | ||
277 | struct ipack_region *region; | ||
278 | void __iomem *addr; | ||
279 | union scc2698_channel __iomem *chan_regs; | ||
280 | union scc2698_block __iomem *block_regs; | ||
281 | |||
282 | ipoctal->board_id = ipoctal->dev->id_device; | ||
283 | |||
284 | region = &ipoctal->dev->region[IPACK_IO_SPACE]; | ||
285 | addr = devm_ioremap_nocache(&ipoctal->dev->dev, | ||
286 | region->start, region->size); | ||
287 | if (!addr) { | ||
288 | dev_err(&ipoctal->dev->dev, | ||
289 | "Unable to map slot [%d:%d] IO space!\n", | ||
290 | bus_nr, slot); | ||
291 | return -EADDRNOTAVAIL; | ||
292 | } | ||
293 | /* Save the virtual address to access the registers easily */ | ||
294 | chan_regs = | ||
295 | (union scc2698_channel __iomem *) addr; | ||
296 | block_regs = | ||
297 | (union scc2698_block __iomem *) addr; | ||
298 | |||
299 | region = &ipoctal->dev->region[IPACK_INT_SPACE]; | ||
300 | ipoctal->int_space = | ||
301 | devm_ioremap_nocache(&ipoctal->dev->dev, | ||
302 | region->start, region->size); | ||
303 | if (!ipoctal->int_space) { | ||
304 | dev_err(&ipoctal->dev->dev, | ||
305 | "Unable to map slot [%d:%d] INT space!\n", | ||
306 | bus_nr, slot); | ||
307 | return -EADDRNOTAVAIL; | ||
308 | } | ||
309 | |||
310 | region = &ipoctal->dev->region[IPACK_MEM8_SPACE]; | ||
311 | ipoctal->mem8_space = | ||
312 | devm_ioremap_nocache(&ipoctal->dev->dev, | ||
313 | region->start, 0x8000); | ||
314 | if (!addr) { | ||
315 | dev_err(&ipoctal->dev->dev, | ||
316 | "Unable to map slot [%d:%d] MEM8 space!\n", | ||
317 | bus_nr, slot); | ||
318 | return -EADDRNOTAVAIL; | ||
319 | } | ||
320 | |||
321 | |||
322 | /* Disable RX and TX before touching anything */ | ||
323 | for (i = 0; i < NR_CHANNELS ; i++) { | ||
324 | struct ipoctal_channel *channel = &ipoctal->channel[i]; | ||
325 | channel->regs = chan_regs + i; | ||
326 | channel->block_regs = block_regs + (i >> 1); | ||
327 | channel->board_write = &ipoctal->write; | ||
328 | channel->board_id = ipoctal->board_id; | ||
329 | if (i & 1) { | ||
330 | channel->isr_tx_rdy_mask = ISR_TxRDY_B; | ||
331 | channel->isr_rx_rdy_mask = ISR_RxRDY_FFULL_B; | ||
332 | } else { | ||
333 | channel->isr_tx_rdy_mask = ISR_TxRDY_A; | ||
334 | channel->isr_rx_rdy_mask = ISR_RxRDY_FFULL_A; | ||
335 | } | ||
336 | |||
337 | iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr); | ||
338 | iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr); | ||
339 | iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr); | ||
340 | iowrite8(MR1_CHRL_8_BITS | MR1_ERROR_CHAR | MR1_RxINT_RxRDY, | ||
341 | &channel->regs->w.mr); /* mr1 */ | ||
342 | iowrite8(0, &channel->regs->w.mr); /* mr2 */ | ||
343 | iowrite8(TX_CLK_9600 | RX_CLK_9600, &channel->regs->w.csr); | ||
344 | } | ||
345 | |||
346 | for (i = 0; i < IP_OCTAL_NB_BLOCKS; i++) { | ||
347 | iowrite8(ACR_BRG_SET2, &block_regs[i].w.acr); | ||
348 | iowrite8(OPCR_MPP_OUTPUT | OPCR_MPOa_RTSN | OPCR_MPOb_RTSN, | ||
349 | &block_regs[i].w.opcr); | ||
350 | iowrite8(IMR_TxRDY_A | IMR_RxRDY_FFULL_A | IMR_DELTA_BREAK_A | | ||
351 | IMR_TxRDY_B | IMR_RxRDY_FFULL_B | IMR_DELTA_BREAK_B, | ||
352 | &block_regs[i].w.imr); | ||
353 | } | ||
354 | |||
355 | /* | ||
356 | * IP-OCTAL has different addresses to copy its IRQ vector. | ||
357 | * Depending of the carrier these addresses are accesible or not. | ||
358 | * More info in the datasheet. | ||
359 | */ | ||
360 | ipoctal->dev->bus->ops->request_irq(ipoctal->dev, | ||
361 | ipoctal_irq_handler, ipoctal); | ||
362 | /* Dummy write */ | ||
363 | iowrite8(1, ipoctal->mem8_space + 1); | ||
364 | |||
365 | /* Register the TTY device */ | ||
366 | |||
367 | /* Each IP-OCTAL channel is a TTY port */ | ||
368 | tty = alloc_tty_driver(NR_CHANNELS); | ||
369 | |||
370 | if (!tty) | ||
371 | return -ENOMEM; | ||
372 | |||
373 | /* Fill struct tty_driver with ipoctal data */ | ||
374 | tty->owner = THIS_MODULE; | ||
375 | tty->driver_name = KBUILD_MODNAME; | ||
376 | sprintf(name, KBUILD_MODNAME ".%d.%d.", bus_nr, slot); | ||
377 | tty->name = name; | ||
378 | tty->major = 0; | ||
379 | |||
380 | tty->minor_start = 0; | ||
381 | tty->type = TTY_DRIVER_TYPE_SERIAL; | ||
382 | tty->subtype = SERIAL_TYPE_NORMAL; | ||
383 | tty->flags = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV; | ||
384 | tty->init_termios = tty_std_termios; | ||
385 | tty->init_termios.c_cflag = B9600 | CS8 | CREAD | HUPCL | CLOCAL; | ||
386 | tty->init_termios.c_ispeed = 9600; | ||
387 | tty->init_termios.c_ospeed = 9600; | ||
388 | |||
389 | tty_set_operations(tty, &ipoctal_fops); | ||
390 | res = tty_register_driver(tty); | ||
391 | if (res) { | ||
392 | dev_err(&ipoctal->dev->dev, "Can't register tty driver.\n"); | ||
393 | put_tty_driver(tty); | ||
394 | return res; | ||
395 | } | ||
396 | |||
397 | /* Save struct tty_driver for use it when uninstalling the device */ | ||
398 | ipoctal->tty_drv = tty; | ||
399 | |||
400 | for (i = 0; i < NR_CHANNELS; i++) { | ||
401 | struct device *tty_dev; | ||
402 | |||
403 | channel = &ipoctal->channel[i]; | ||
404 | tty_port_init(&channel->tty_port); | ||
405 | tty_port_alloc_xmit_buf(&channel->tty_port); | ||
406 | channel->tty_port.ops = &ipoctal_tty_port_ops; | ||
407 | |||
408 | ipoctal_reset_stats(&channel->stats); | ||
409 | channel->nb_bytes = 0; | ||
410 | init_waitqueue_head(&channel->queue); | ||
411 | |||
412 | spin_lock_init(&channel->lock); | ||
413 | channel->pointer_read = 0; | ||
414 | channel->pointer_write = 0; | ||
415 | tty_dev = tty_port_register_device(&channel->tty_port, tty, i, NULL); | ||
416 | if (IS_ERR(tty_dev)) { | ||
417 | dev_err(&ipoctal->dev->dev, "Failed to register tty device.\n"); | ||
418 | continue; | ||
419 | } | ||
420 | dev_set_drvdata(tty_dev, channel); | ||
421 | |||
422 | /* | ||
423 | * Enable again the RX. TX will be enabled when | ||
424 | * there is something to send | ||
425 | */ | ||
426 | iowrite8(CR_ENABLE_RX, &channel->regs->w.cr); | ||
427 | } | ||
428 | |||
429 | return 0; | ||
430 | } | ||
431 | |||
432 | static inline int ipoctal_copy_write_buffer(struct ipoctal_channel *channel, | ||
433 | const unsigned char *buf, | ||
434 | int count) | ||
435 | { | ||
436 | unsigned long flags; | ||
437 | int i; | ||
438 | unsigned int *pointer_read = &channel->pointer_read; | ||
439 | |||
440 | /* Copy the bytes from the user buffer to the internal one */ | ||
441 | for (i = 0; i < count; i++) { | ||
442 | if (i <= (PAGE_SIZE - channel->nb_bytes)) { | ||
443 | spin_lock_irqsave(&channel->lock, flags); | ||
444 | channel->tty_port.xmit_buf[*pointer_read] = buf[i]; | ||
445 | *pointer_read = (*pointer_read + 1) % PAGE_SIZE; | ||
446 | channel->nb_bytes++; | ||
447 | spin_unlock_irqrestore(&channel->lock, flags); | ||
448 | } else { | ||
449 | break; | ||
450 | } | ||
451 | } | ||
452 | return i; | ||
453 | } | ||
454 | |||
455 | static int ipoctal_write_tty(struct tty_struct *tty, | ||
456 | const unsigned char *buf, int count) | ||
457 | { | ||
458 | struct ipoctal_channel *channel = tty->driver_data; | ||
459 | unsigned int char_copied; | ||
460 | |||
461 | char_copied = ipoctal_copy_write_buffer(channel, buf, count); | ||
462 | |||
463 | /* As the IP-OCTAL 485 only supports half duplex, do it manually */ | ||
464 | if (channel->board_id == IPACK1_DEVICE_ID_SBS_OCTAL_485) { | ||
465 | iowrite8(CR_DISABLE_RX, &channel->regs->w.cr); | ||
466 | iowrite8(CR_CMD_ASSERT_RTSN, &channel->regs->w.cr); | ||
467 | } | ||
468 | |||
469 | /* | ||
470 | * Send a packet and then disable TX to avoid failure after several send | ||
471 | * operations | ||
472 | */ | ||
473 | iowrite8(CR_ENABLE_TX, &channel->regs->w.cr); | ||
474 | wait_event_interruptible(channel->queue, *channel->board_write); | ||
475 | iowrite8(CR_DISABLE_TX, &channel->regs->w.cr); | ||
476 | |||
477 | *channel->board_write = 0; | ||
478 | return char_copied; | ||
479 | } | ||
480 | |||
481 | static int ipoctal_write_room(struct tty_struct *tty) | ||
482 | { | ||
483 | struct ipoctal_channel *channel = tty->driver_data; | ||
484 | |||
485 | return PAGE_SIZE - channel->nb_bytes; | ||
486 | } | ||
487 | |||
488 | static int ipoctal_chars_in_buffer(struct tty_struct *tty) | ||
489 | { | ||
490 | struct ipoctal_channel *channel = tty->driver_data; | ||
491 | |||
492 | return channel->nb_bytes; | ||
493 | } | ||
494 | |||
495 | static void ipoctal_set_termios(struct tty_struct *tty, | ||
496 | struct ktermios *old_termios) | ||
497 | { | ||
498 | unsigned int cflag; | ||
499 | unsigned char mr1 = 0; | ||
500 | unsigned char mr2 = 0; | ||
501 | unsigned char csr = 0; | ||
502 | struct ipoctal_channel *channel = tty->driver_data; | ||
503 | speed_t baud; | ||
504 | |||
505 | cflag = tty->termios.c_cflag; | ||
506 | |||
507 | /* Disable and reset everything before change the setup */ | ||
508 | iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr); | ||
509 | iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr); | ||
510 | iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr); | ||
511 | iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr); | ||
512 | iowrite8(CR_CMD_RESET_MR, &channel->regs->w.cr); | ||
513 | |||
514 | /* Set Bits per chars */ | ||
515 | switch (cflag & CSIZE) { | ||
516 | case CS6: | ||
517 | mr1 |= MR1_CHRL_6_BITS; | ||
518 | break; | ||
519 | case CS7: | ||
520 | mr1 |= MR1_CHRL_7_BITS; | ||
521 | break; | ||
522 | case CS8: | ||
523 | default: | ||
524 | mr1 |= MR1_CHRL_8_BITS; | ||
525 | /* By default, select CS8 */ | ||
526 | tty->termios.c_cflag = (cflag & ~CSIZE) | CS8; | ||
527 | break; | ||
528 | } | ||
529 | |||
530 | /* Set Parity */ | ||
531 | if (cflag & PARENB) | ||
532 | if (cflag & PARODD) | ||
533 | mr1 |= MR1_PARITY_ON | MR1_PARITY_ODD; | ||
534 | else | ||
535 | mr1 |= MR1_PARITY_ON | MR1_PARITY_EVEN; | ||
536 | else | ||
537 | mr1 |= MR1_PARITY_OFF; | ||
538 | |||
539 | /* Mark or space parity is not supported */ | ||
540 | tty->termios.c_cflag &= ~CMSPAR; | ||
541 | |||
542 | /* Set stop bits */ | ||
543 | if (cflag & CSTOPB) | ||
544 | mr2 |= MR2_STOP_BITS_LENGTH_2; | ||
545 | else | ||
546 | mr2 |= MR2_STOP_BITS_LENGTH_1; | ||
547 | |||
548 | /* Set the flow control */ | ||
549 | switch (channel->board_id) { | ||
550 | case IPACK1_DEVICE_ID_SBS_OCTAL_232: | ||
551 | if (cflag & CRTSCTS) { | ||
552 | mr1 |= MR1_RxRTS_CONTROL_ON; | ||
553 | mr2 |= MR2_TxRTS_CONTROL_OFF | MR2_CTS_ENABLE_TX_ON; | ||
554 | } else { | ||
555 | mr1 |= MR1_RxRTS_CONTROL_OFF; | ||
556 | mr2 |= MR2_TxRTS_CONTROL_OFF | MR2_CTS_ENABLE_TX_OFF; | ||
557 | } | ||
558 | break; | ||
559 | case IPACK1_DEVICE_ID_SBS_OCTAL_422: | ||
560 | mr1 |= MR1_RxRTS_CONTROL_OFF; | ||
561 | mr2 |= MR2_TxRTS_CONTROL_OFF | MR2_CTS_ENABLE_TX_OFF; | ||
562 | break; | ||
563 | case IPACK1_DEVICE_ID_SBS_OCTAL_485: | ||
564 | mr1 |= MR1_RxRTS_CONTROL_OFF; | ||
565 | mr2 |= MR2_TxRTS_CONTROL_ON | MR2_CTS_ENABLE_TX_OFF; | ||
566 | break; | ||
567 | default: | ||
568 | return; | ||
569 | break; | ||
570 | } | ||
571 | |||
572 | baud = tty_get_baud_rate(tty); | ||
573 | tty_termios_encode_baud_rate(&tty->termios, baud, baud); | ||
574 | |||
575 | /* Set baud rate */ | ||
576 | switch (baud) { | ||
577 | case 75: | ||
578 | csr |= TX_CLK_75 | RX_CLK_75; | ||
579 | break; | ||
580 | case 110: | ||
581 | csr |= TX_CLK_110 | RX_CLK_110; | ||
582 | break; | ||
583 | case 150: | ||
584 | csr |= TX_CLK_150 | RX_CLK_150; | ||
585 | break; | ||
586 | case 300: | ||
587 | csr |= TX_CLK_300 | RX_CLK_300; | ||
588 | break; | ||
589 | case 600: | ||
590 | csr |= TX_CLK_600 | RX_CLK_600; | ||
591 | break; | ||
592 | case 1200: | ||
593 | csr |= TX_CLK_1200 | RX_CLK_1200; | ||
594 | break; | ||
595 | case 1800: | ||
596 | csr |= TX_CLK_1800 | RX_CLK_1800; | ||
597 | break; | ||
598 | case 2000: | ||
599 | csr |= TX_CLK_2000 | RX_CLK_2000; | ||
600 | break; | ||
601 | case 2400: | ||
602 | csr |= TX_CLK_2400 | RX_CLK_2400; | ||
603 | break; | ||
604 | case 4800: | ||
605 | csr |= TX_CLK_4800 | RX_CLK_4800; | ||
606 | break; | ||
607 | case 9600: | ||
608 | csr |= TX_CLK_9600 | RX_CLK_9600; | ||
609 | break; | ||
610 | case 19200: | ||
611 | csr |= TX_CLK_19200 | RX_CLK_19200; | ||
612 | break; | ||
613 | case 38400: | ||
614 | default: | ||
615 | csr |= TX_CLK_38400 | RX_CLK_38400; | ||
616 | /* In case of default, we establish 38400 bps */ | ||
617 | tty_termios_encode_baud_rate(&tty->termios, 38400, 38400); | ||
618 | break; | ||
619 | } | ||
620 | |||
621 | mr1 |= MR1_ERROR_CHAR; | ||
622 | mr1 |= MR1_RxINT_RxRDY; | ||
623 | |||
624 | /* Write the control registers */ | ||
625 | iowrite8(mr1, &channel->regs->w.mr); | ||
626 | iowrite8(mr2, &channel->regs->w.mr); | ||
627 | iowrite8(csr, &channel->regs->w.csr); | ||
628 | |||
629 | /* Enable again the RX */ | ||
630 | iowrite8(CR_ENABLE_RX, &channel->regs->w.cr); | ||
631 | } | ||
632 | |||
633 | static void ipoctal_hangup(struct tty_struct *tty) | ||
634 | { | ||
635 | unsigned long flags; | ||
636 | struct ipoctal_channel *channel = tty->driver_data; | ||
637 | |||
638 | if (channel == NULL) | ||
639 | return; | ||
640 | |||
641 | spin_lock_irqsave(&channel->lock, flags); | ||
642 | channel->nb_bytes = 0; | ||
643 | channel->pointer_read = 0; | ||
644 | channel->pointer_write = 0; | ||
645 | spin_unlock_irqrestore(&channel->lock, flags); | ||
646 | |||
647 | tty_port_hangup(&channel->tty_port); | ||
648 | |||
649 | iowrite8(CR_DISABLE_RX | CR_DISABLE_TX, &channel->regs->w.cr); | ||
650 | iowrite8(CR_CMD_RESET_RX, &channel->regs->w.cr); | ||
651 | iowrite8(CR_CMD_RESET_TX, &channel->regs->w.cr); | ||
652 | iowrite8(CR_CMD_RESET_ERR_STATUS, &channel->regs->w.cr); | ||
653 | iowrite8(CR_CMD_RESET_MR, &channel->regs->w.cr); | ||
654 | |||
655 | clear_bit(ASYNCB_INITIALIZED, &channel->tty_port.flags); | ||
656 | wake_up_interruptible(&channel->tty_port.open_wait); | ||
657 | } | ||
658 | |||
659 | static const struct tty_operations ipoctal_fops = { | ||
660 | .ioctl = NULL, | ||
661 | .open = ipoctal_open, | ||
662 | .close = ipoctal_close, | ||
663 | .write = ipoctal_write_tty, | ||
664 | .set_termios = ipoctal_set_termios, | ||
665 | .write_room = ipoctal_write_room, | ||
666 | .chars_in_buffer = ipoctal_chars_in_buffer, | ||
667 | .get_icount = ipoctal_get_icount, | ||
668 | .hangup = ipoctal_hangup, | ||
669 | }; | ||
670 | |||
671 | static int ipoctal_probe(struct ipack_device *dev) | ||
672 | { | ||
673 | int res; | ||
674 | struct ipoctal *ipoctal; | ||
675 | |||
676 | ipoctal = kzalloc(sizeof(struct ipoctal), GFP_KERNEL); | ||
677 | if (ipoctal == NULL) | ||
678 | return -ENOMEM; | ||
679 | |||
680 | ipoctal->dev = dev; | ||
681 | res = ipoctal_inst_slot(ipoctal, dev->bus->bus_nr, dev->slot); | ||
682 | if (res) | ||
683 | goto out_uninst; | ||
684 | |||
685 | dev_set_drvdata(&dev->dev, ipoctal); | ||
686 | return 0; | ||
687 | |||
688 | out_uninst: | ||
689 | kfree(ipoctal); | ||
690 | return res; | ||
691 | } | ||
692 | |||
693 | static void __ipoctal_remove(struct ipoctal *ipoctal) | ||
694 | { | ||
695 | int i; | ||
696 | |||
697 | ipoctal->dev->bus->ops->free_irq(ipoctal->dev); | ||
698 | |||
699 | for (i = 0; i < NR_CHANNELS; i++) { | ||
700 | struct ipoctal_channel *channel = &ipoctal->channel[i]; | ||
701 | tty_unregister_device(ipoctal->tty_drv, i); | ||
702 | tty_port_free_xmit_buf(&channel->tty_port); | ||
703 | } | ||
704 | |||
705 | tty_unregister_driver(ipoctal->tty_drv); | ||
706 | put_tty_driver(ipoctal->tty_drv); | ||
707 | kfree(ipoctal); | ||
708 | } | ||
709 | |||
710 | static void ipoctal_remove(struct ipack_device *idev) | ||
711 | { | ||
712 | __ipoctal_remove(dev_get_drvdata(&idev->dev)); | ||
713 | } | ||
714 | |||
715 | static DEFINE_IPACK_DEVICE_TABLE(ipoctal_ids) = { | ||
716 | { IPACK_DEVICE(IPACK_ID_VERSION_1, IPACK1_VENDOR_ID_SBS, | ||
717 | IPACK1_DEVICE_ID_SBS_OCTAL_232) }, | ||
718 | { IPACK_DEVICE(IPACK_ID_VERSION_1, IPACK1_VENDOR_ID_SBS, | ||
719 | IPACK1_DEVICE_ID_SBS_OCTAL_422) }, | ||
720 | { IPACK_DEVICE(IPACK_ID_VERSION_1, IPACK1_VENDOR_ID_SBS, | ||
721 | IPACK1_DEVICE_ID_SBS_OCTAL_485) }, | ||
722 | { 0, }, | ||
723 | }; | ||
724 | |||
725 | MODULE_DEVICE_TABLE(ipack, ipoctal_ids); | ||
726 | |||
727 | static const struct ipack_driver_ops ipoctal_drv_ops = { | ||
728 | .probe = ipoctal_probe, | ||
729 | .remove = ipoctal_remove, | ||
730 | }; | ||
731 | |||
732 | static struct ipack_driver driver = { | ||
733 | .ops = &ipoctal_drv_ops, | ||
734 | .id_table = ipoctal_ids, | ||
735 | }; | ||
736 | |||
737 | static int __init ipoctal_init(void) | ||
738 | { | ||
739 | return ipack_driver_register(&driver, THIS_MODULE, KBUILD_MODNAME); | ||
740 | } | ||
741 | |||
742 | static void __exit ipoctal_exit(void) | ||
743 | { | ||
744 | ipack_driver_unregister(&driver); | ||
745 | } | ||
746 | |||
747 | MODULE_DESCRIPTION("IP-Octal 232, 422 and 485 device driver"); | ||
748 | MODULE_LICENSE("GPL"); | ||
749 | |||
750 | module_init(ipoctal_init); | ||
751 | module_exit(ipoctal_exit); | ||
diff --git a/drivers/ipack/devices/ipoctal.h b/drivers/ipack/devices/ipoctal.h new file mode 100644 index 000000000000..28f1c4233154 --- /dev/null +++ b/drivers/ipack/devices/ipoctal.h | |||
@@ -0,0 +1,42 @@ | |||
1 | /** | ||
2 | * ipoctal.h | ||
3 | * | ||
4 | * driver for the IPOCTAL boards | ||
5 | |||
6 | * Copyright (C) 2009-2012 CERN (www.cern.ch) | ||
7 | * Author: Nicolas Serafini, EIC2 SA | ||
8 | * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com> | ||
9 | * | ||
10 | * This program is free software; you can redistribute it and/or modify it | ||
11 | * under the terms of the GNU General Public License as published by the Free | ||
12 | * Software Foundation; version 2 of the License. | ||
13 | */ | ||
14 | |||
15 | #ifndef _IPOCTAL_H | ||
16 | #define _IPOCTAL_H_ | ||
17 | |||
18 | #define NR_CHANNELS 8 | ||
19 | #define IPOCTAL_MAX_BOARDS 16 | ||
20 | #define MAX_DEVICES (NR_CHANNELS * IPOCTAL_MAX_BOARDS) | ||
21 | #define RELEVANT_IFLAG(iflag) ((iflag) & (IGNBRK|BRKINT|IGNPAR|PARMRK|INPCK)) | ||
22 | |||
23 | /** | ||
24 | * struct ipoctal_stats -- Stats since last reset | ||
25 | * | ||
26 | * @tx: Number of transmitted bytes | ||
27 | * @rx: Number of received bytes | ||
28 | * @overrun: Number of overrun errors | ||
29 | * @parity_err: Number of parity errors | ||
30 | * @framing_err: Number of framing errors | ||
31 | * @rcv_break: Number of break received | ||
32 | */ | ||
33 | struct ipoctal_stats { | ||
34 | unsigned long tx; | ||
35 | unsigned long rx; | ||
36 | unsigned long overrun_err; | ||
37 | unsigned long parity_err; | ||
38 | unsigned long framing_err; | ||
39 | unsigned long rcv_break; | ||
40 | }; | ||
41 | |||
42 | #endif /* _IPOCTAL_H_ */ | ||
diff --git a/drivers/ipack/devices/scc2698.h b/drivers/ipack/devices/scc2698.h new file mode 100644 index 000000000000..2ad6acd513fa --- /dev/null +++ b/drivers/ipack/devices/scc2698.h | |||
@@ -0,0 +1,228 @@ | |||
1 | /* | ||
2 | * scc2698.h | ||
3 | * | ||
4 | * driver for the IPOCTAL boards | ||
5 | * | ||
6 | * Copyright (C) 2009-2012 CERN (www.cern.ch) | ||
7 | * Author: Nicolas Serafini, EIC2 SA | ||
8 | * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com> | ||
9 | * | ||
10 | * This program is free software; you can redistribute it and/or modify it | ||
11 | * under the terms of the GNU General Public License as published by the Free | ||
12 | * Software Foundation; version 2 of the License. | ||
13 | */ | ||
14 | |||
15 | #ifndef SCC2698_H_ | ||
16 | #define SCC2698_H_ | ||
17 | |||
18 | /* | ||
19 | * union scc2698_channel - Channel access to scc2698 IO | ||
20 | * | ||
21 | * dn value are only spacer. | ||
22 | * | ||
23 | */ | ||
24 | union scc2698_channel { | ||
25 | struct { | ||
26 | u8 d0, mr; /* Mode register 1/2*/ | ||
27 | u8 d1, sr; /* Status register */ | ||
28 | u8 d2, r1; /* reserved */ | ||
29 | u8 d3, rhr; /* Receive holding register (R) */ | ||
30 | u8 junk[8]; /* other crap for block control */ | ||
31 | } __packed r; /* Read access */ | ||
32 | struct { | ||
33 | u8 d0, mr; /* Mode register 1/2 */ | ||
34 | u8 d1, csr; /* Clock select register */ | ||
35 | u8 d2, cr; /* Command register */ | ||
36 | u8 d3, thr; /* Transmit holding register */ | ||
37 | u8 junk[8]; /* other crap for block control */ | ||
38 | } __packed w; /* Write access */ | ||
39 | }; | ||
40 | |||
41 | /* | ||
42 | * union scc2698_block - Block access to scc2698 IO | ||
43 | * | ||
44 | * The scc2698 contain 4 block. | ||
45 | * Each block containt two channel a and b. | ||
46 | * dn value are only spacer. | ||
47 | * | ||
48 | */ | ||
49 | union scc2698_block { | ||
50 | struct { | ||
51 | u8 d0, mra; /* Mode register 1/2 (a) */ | ||
52 | u8 d1, sra; /* Status register (a) */ | ||
53 | u8 d2, r1; /* reserved */ | ||
54 | u8 d3, rhra; /* Receive holding register (a) */ | ||
55 | u8 d4, ipcr; /* Input port change register of block */ | ||
56 | u8 d5, isr; /* Interrupt status register of block */ | ||
57 | u8 d6, ctur; /* Counter timer upper register of block */ | ||
58 | u8 d7, ctlr; /* Counter timer lower register of block */ | ||
59 | u8 d8, mrb; /* Mode register 1/2 (b) */ | ||
60 | u8 d9, srb; /* Status register (b) */ | ||
61 | u8 da, r2; /* reserved */ | ||
62 | u8 db, rhrb; /* Receive holding register (b) */ | ||
63 | u8 dc, r3; /* reserved */ | ||
64 | u8 dd, ip; /* Input port register of block */ | ||
65 | u8 de, ctg; /* Start counter timer of block */ | ||
66 | u8 df, cts; /* Stop counter timer of block */ | ||
67 | } __packed r; /* Read access */ | ||
68 | struct { | ||
69 | u8 d0, mra; /* Mode register 1/2 (a) */ | ||
70 | u8 d1, csra; /* Clock select register (a) */ | ||
71 | u8 d2, cra; /* Command register (a) */ | ||
72 | u8 d3, thra; /* Transmit holding register (a) */ | ||
73 | u8 d4, acr; /* Auxiliary control register of block */ | ||
74 | u8 d5, imr; /* Interrupt mask register of block */ | ||
75 | u8 d6, ctu; /* Counter timer upper register of block */ | ||
76 | u8 d7, ctl; /* Counter timer lower register of block */ | ||
77 | u8 d8, mrb; /* Mode register 1/2 (b) */ | ||
78 | u8 d9, csrb; /* Clock select register (a) */ | ||
79 | u8 da, crb; /* Command register (b) */ | ||
80 | u8 db, thrb; /* Transmit holding register (b) */ | ||
81 | u8 dc, r1; /* reserved */ | ||
82 | u8 dd, opcr; /* Output port configuration register of block */ | ||
83 | u8 de, r2; /* reserved */ | ||
84 | u8 df, r3; /* reserved */ | ||
85 | } __packed w; /* Write access */ | ||
86 | }; | ||
87 | |||
88 | #define MR1_CHRL_5_BITS (0x0 << 0) | ||
89 | #define MR1_CHRL_6_BITS (0x1 << 0) | ||
90 | #define MR1_CHRL_7_BITS (0x2 << 0) | ||
91 | #define MR1_CHRL_8_BITS (0x3 << 0) | ||
92 | #define MR1_PARITY_EVEN (0x1 << 2) | ||
93 | #define MR1_PARITY_ODD (0x0 << 2) | ||
94 | #define MR1_PARITY_ON (0x0 << 3) | ||
95 | #define MR1_PARITY_FORCE (0x1 << 3) | ||
96 | #define MR1_PARITY_OFF (0x2 << 3) | ||
97 | #define MR1_PARITY_SPECIAL (0x3 << 3) | ||
98 | #define MR1_ERROR_CHAR (0x0 << 5) | ||
99 | #define MR1_ERROR_BLOCK (0x1 << 5) | ||
100 | #define MR1_RxINT_RxRDY (0x0 << 6) | ||
101 | #define MR1_RxINT_FFULL (0x1 << 6) | ||
102 | #define MR1_RxRTS_CONTROL_ON (0x1 << 7) | ||
103 | #define MR1_RxRTS_CONTROL_OFF (0x0 << 7) | ||
104 | |||
105 | #define MR2_STOP_BITS_LENGTH_1 (0x7 << 0) | ||
106 | #define MR2_STOP_BITS_LENGTH_2 (0xF << 0) | ||
107 | #define MR2_CTS_ENABLE_TX_ON (0x1 << 4) | ||
108 | #define MR2_CTS_ENABLE_TX_OFF (0x0 << 4) | ||
109 | #define MR2_TxRTS_CONTROL_ON (0x1 << 5) | ||
110 | #define MR2_TxRTS_CONTROL_OFF (0x0 << 5) | ||
111 | #define MR2_CH_MODE_NORMAL (0x0 << 6) | ||
112 | #define MR2_CH_MODE_ECHO (0x1 << 6) | ||
113 | #define MR2_CH_MODE_LOCAL (0x2 << 6) | ||
114 | #define MR2_CH_MODE_REMOTE (0x3 << 6) | ||
115 | |||
116 | #define CR_ENABLE_RX (0x1 << 0) | ||
117 | #define CR_DISABLE_RX (0x1 << 1) | ||
118 | #define CR_ENABLE_TX (0x1 << 2) | ||
119 | #define CR_DISABLE_TX (0x1 << 3) | ||
120 | #define CR_CMD_RESET_MR (0x1 << 4) | ||
121 | #define CR_CMD_RESET_RX (0x2 << 4) | ||
122 | #define CR_CMD_RESET_TX (0x3 << 4) | ||
123 | #define CR_CMD_RESET_ERR_STATUS (0x4 << 4) | ||
124 | #define CR_CMD_RESET_BREAK_CHANGE (0x5 << 4) | ||
125 | #define CR_CMD_START_BREAK (0x6 << 4) | ||
126 | #define CR_CMD_STOP_BREAK (0x7 << 4) | ||
127 | #define CR_CMD_ASSERT_RTSN (0x8 << 4) | ||
128 | #define CR_CMD_NEGATE_RTSN (0x9 << 4) | ||
129 | #define CR_CMD_SET_TIMEOUT_MODE (0xA << 4) | ||
130 | #define CR_CMD_DISABLE_TIMEOUT_MODE (0xC << 4) | ||
131 | |||
132 | #define SR_RX_READY (0x1 << 0) | ||
133 | #define SR_FIFO_FULL (0x1 << 1) | ||
134 | #define SR_TX_READY (0x1 << 2) | ||
135 | #define SR_TX_EMPTY (0x1 << 3) | ||
136 | #define SR_OVERRUN_ERROR (0x1 << 4) | ||
137 | #define SR_PARITY_ERROR (0x1 << 5) | ||
138 | #define SR_FRAMING_ERROR (0x1 << 6) | ||
139 | #define SR_RECEIVED_BREAK (0x1 << 7) | ||
140 | |||
141 | #define SR_ERROR (0xF0) | ||
142 | |||
143 | #define ACR_DELTA_IP0_IRQ_EN (0x1 << 0) | ||
144 | #define ACR_DELTA_IP1_IRQ_EN (0x1 << 1) | ||
145 | #define ACR_DELTA_IP2_IRQ_EN (0x1 << 2) | ||
146 | #define ACR_DELTA_IP3_IRQ_EN (0x1 << 3) | ||
147 | #define ACR_CT_Mask (0x7 << 4) | ||
148 | #define ACR_CExt (0x0 << 4) | ||
149 | #define ACR_CTxCA (0x1 << 4) | ||
150 | #define ACR_CTxCB (0x2 << 4) | ||
151 | #define ACR_CClk16 (0x3 << 4) | ||
152 | #define ACR_TExt (0x4 << 4) | ||
153 | #define ACR_TExt16 (0x5 << 4) | ||
154 | #define ACR_TClk (0x6 << 4) | ||
155 | #define ACR_TClk16 (0x7 << 4) | ||
156 | #define ACR_BRG_SET1 (0x0 << 7) | ||
157 | #define ACR_BRG_SET2 (0x1 << 7) | ||
158 | |||
159 | #define TX_CLK_75 (0x0 << 0) | ||
160 | #define TX_CLK_110 (0x1 << 0) | ||
161 | #define TX_CLK_38400 (0x2 << 0) | ||
162 | #define TX_CLK_150 (0x3 << 0) | ||
163 | #define TX_CLK_300 (0x4 << 0) | ||
164 | #define TX_CLK_600 (0x5 << 0) | ||
165 | #define TX_CLK_1200 (0x6 << 0) | ||
166 | #define TX_CLK_2000 (0x7 << 0) | ||
167 | #define TX_CLK_2400 (0x8 << 0) | ||
168 | #define TX_CLK_4800 (0x9 << 0) | ||
169 | #define TX_CLK_1800 (0xA << 0) | ||
170 | #define TX_CLK_9600 (0xB << 0) | ||
171 | #define TX_CLK_19200 (0xC << 0) | ||
172 | #define RX_CLK_75 (0x0 << 4) | ||
173 | #define RX_CLK_110 (0x1 << 4) | ||
174 | #define RX_CLK_38400 (0x2 << 4) | ||
175 | #define RX_CLK_150 (0x3 << 4) | ||
176 | #define RX_CLK_300 (0x4 << 4) | ||
177 | #define RX_CLK_600 (0x5 << 4) | ||
178 | #define RX_CLK_1200 (0x6 << 4) | ||
179 | #define RX_CLK_2000 (0x7 << 4) | ||
180 | #define RX_CLK_2400 (0x8 << 4) | ||
181 | #define RX_CLK_4800 (0x9 << 4) | ||
182 | #define RX_CLK_1800 (0xA << 4) | ||
183 | #define RX_CLK_9600 (0xB << 4) | ||
184 | #define RX_CLK_19200 (0xC << 4) | ||
185 | |||
186 | #define OPCR_MPOa_RTSN (0x0 << 0) | ||
187 | #define OPCR_MPOa_C_TO (0x1 << 0) | ||
188 | #define OPCR_MPOa_TxC1X (0x2 << 0) | ||
189 | #define OPCR_MPOa_TxC16X (0x3 << 0) | ||
190 | #define OPCR_MPOa_RxC1X (0x4 << 0) | ||
191 | #define OPCR_MPOa_RxC16X (0x5 << 0) | ||
192 | #define OPCR_MPOa_TxRDY (0x6 << 0) | ||
193 | #define OPCR_MPOa_RxRDY_FF (0x7 << 0) | ||
194 | |||
195 | #define OPCR_MPOb_RTSN (0x0 << 4) | ||
196 | #define OPCR_MPOb_C_TO (0x1 << 4) | ||
197 | #define OPCR_MPOb_TxC1X (0x2 << 4) | ||
198 | #define OPCR_MPOb_TxC16X (0x3 << 4) | ||
199 | #define OPCR_MPOb_RxC1X (0x4 << 4) | ||
200 | #define OPCR_MPOb_RxC16X (0x5 << 4) | ||
201 | #define OPCR_MPOb_TxRDY (0x6 << 4) | ||
202 | #define OPCR_MPOb_RxRDY_FF (0x7 << 4) | ||
203 | |||
204 | #define OPCR_MPP_INPUT (0x0 << 7) | ||
205 | #define OPCR_MPP_OUTPUT (0x1 << 7) | ||
206 | |||
207 | #define IMR_TxRDY_A (0x1 << 0) | ||
208 | #define IMR_RxRDY_FFULL_A (0x1 << 1) | ||
209 | #define IMR_DELTA_BREAK_A (0x1 << 2) | ||
210 | #define IMR_COUNTER_READY (0x1 << 3) | ||
211 | #define IMR_TxRDY_B (0x1 << 4) | ||
212 | #define IMR_RxRDY_FFULL_B (0x1 << 5) | ||
213 | #define IMR_DELTA_BREAK_B (0x1 << 6) | ||
214 | #define IMR_INPUT_PORT_CHANGE (0x1 << 7) | ||
215 | |||
216 | #define ISR_TxRDY_A (0x1 << 0) | ||
217 | #define ISR_RxRDY_FFULL_A (0x1 << 1) | ||
218 | #define ISR_DELTA_BREAK_A (0x1 << 2) | ||
219 | #define ISR_COUNTER_READY (0x1 << 3) | ||
220 | #define ISR_TxRDY_B (0x1 << 4) | ||
221 | #define ISR_RxRDY_FFULL_B (0x1 << 5) | ||
222 | #define ISR_DELTA_BREAK_B (0x1 << 6) | ||
223 | #define ISR_INPUT_PORT_CHANGE (0x1 << 7) | ||
224 | |||
225 | #define ACK_INT_REQ0 0 | ||
226 | #define ACK_INT_REQ1 2 | ||
227 | |||
228 | #endif /* SCC2698_H_ */ | ||
diff --git a/drivers/ipack/ipack.c b/drivers/ipack/ipack.c new file mode 100644 index 000000000000..6d5079de52b9 --- /dev/null +++ b/drivers/ipack/ipack.c | |||
@@ -0,0 +1,481 @@ | |||
1 | /* | ||
2 | * Industry-pack bus support functions. | ||
3 | * | ||
4 | * Copyright (C) 2011-2012 CERN (www.cern.ch) | ||
5 | * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com> | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify it | ||
8 | * under the terms of the GNU General Public License as published by the Free | ||
9 | * Software Foundation; version 2 of the License. | ||
10 | */ | ||
11 | |||
12 | #include <linux/module.h> | ||
13 | #include <linux/slab.h> | ||
14 | #include <linux/idr.h> | ||
15 | #include <linux/io.h> | ||
16 | #include "ipack.h" | ||
17 | |||
18 | #define to_ipack_dev(device) container_of(device, struct ipack_device, dev) | ||
19 | #define to_ipack_driver(drv) container_of(drv, struct ipack_driver, driver) | ||
20 | |||
21 | static DEFINE_IDA(ipack_ida); | ||
22 | |||
23 | static void ipack_device_release(struct device *dev) | ||
24 | { | ||
25 | struct ipack_device *device = to_ipack_dev(dev); | ||
26 | kfree(device->id); | ||
27 | device->release(device); | ||
28 | } | ||
29 | |||
30 | static inline const struct ipack_device_id * | ||
31 | ipack_match_one_device(const struct ipack_device_id *id, | ||
32 | const struct ipack_device *device) | ||
33 | { | ||
34 | if ((id->format == IPACK_ANY_FORMAT || | ||
35 | id->format == device->id_format) && | ||
36 | (id->vendor == IPACK_ANY_ID || id->vendor == device->id_vendor) && | ||
37 | (id->device == IPACK_ANY_ID || id->device == device->id_device)) | ||
38 | return id; | ||
39 | return NULL; | ||
40 | } | ||
41 | |||
42 | static const struct ipack_device_id * | ||
43 | ipack_match_id(const struct ipack_device_id *ids, struct ipack_device *idev) | ||
44 | { | ||
45 | if (ids) { | ||
46 | while (ids->vendor || ids->device) { | ||
47 | if (ipack_match_one_device(ids, idev)) | ||
48 | return ids; | ||
49 | ids++; | ||
50 | } | ||
51 | } | ||
52 | return NULL; | ||
53 | } | ||
54 | |||
55 | static int ipack_bus_match(struct device *dev, struct device_driver *drv) | ||
56 | { | ||
57 | struct ipack_device *idev = to_ipack_dev(dev); | ||
58 | struct ipack_driver *idrv = to_ipack_driver(drv); | ||
59 | const struct ipack_device_id *found_id; | ||
60 | |||
61 | found_id = ipack_match_id(idrv->id_table, idev); | ||
62 | return found_id ? 1 : 0; | ||
63 | } | ||
64 | |||
65 | static int ipack_bus_probe(struct device *device) | ||
66 | { | ||
67 | struct ipack_device *dev = to_ipack_dev(device); | ||
68 | struct ipack_driver *drv = to_ipack_driver(device->driver); | ||
69 | |||
70 | if (!drv->ops->probe) | ||
71 | return -EINVAL; | ||
72 | |||
73 | return drv->ops->probe(dev); | ||
74 | } | ||
75 | |||
76 | static int ipack_bus_remove(struct device *device) | ||
77 | { | ||
78 | struct ipack_device *dev = to_ipack_dev(device); | ||
79 | struct ipack_driver *drv = to_ipack_driver(device->driver); | ||
80 | |||
81 | if (!drv->ops->remove) | ||
82 | return -EINVAL; | ||
83 | |||
84 | drv->ops->remove(dev); | ||
85 | return 0; | ||
86 | } | ||
87 | |||
88 | static int ipack_uevent(struct device *dev, struct kobj_uevent_env *env) | ||
89 | { | ||
90 | struct ipack_device *idev; | ||
91 | |||
92 | if (!dev) | ||
93 | return -ENODEV; | ||
94 | |||
95 | idev = to_ipack_dev(dev); | ||
96 | |||
97 | if (add_uevent_var(env, | ||
98 | "MODALIAS=ipack:f%02Xv%08Xd%08X", idev->id_format, | ||
99 | idev->id_vendor, idev->id_device)) | ||
100 | return -ENOMEM; | ||
101 | |||
102 | return 0; | ||
103 | } | ||
104 | |||
105 | #define ipack_device_attr(field, format_string) \ | ||
106 | static ssize_t \ | ||
107 | field##_show(struct device *dev, struct device_attribute *attr, \ | ||
108 | char *buf) \ | ||
109 | { \ | ||
110 | struct ipack_device *idev = to_ipack_dev(dev); \ | ||
111 | return sprintf(buf, format_string, idev->field); \ | ||
112 | } | ||
113 | |||
114 | static ssize_t id_show(struct device *dev, | ||
115 | struct device_attribute *attr, char *buf) | ||
116 | { | ||
117 | unsigned int i, c, l, s; | ||
118 | struct ipack_device *idev = to_ipack_dev(dev); | ||
119 | |||
120 | |||
121 | switch (idev->id_format) { | ||
122 | case IPACK_ID_VERSION_1: | ||
123 | l = 0x7; s = 1; break; | ||
124 | case IPACK_ID_VERSION_2: | ||
125 | l = 0xf; s = 2; break; | ||
126 | default: | ||
127 | return -EIO; | ||
128 | } | ||
129 | c = 0; | ||
130 | for (i = 0; i < idev->id_avail; i++) { | ||
131 | if (i > 0) { | ||
132 | if ((i & l) == 0) | ||
133 | buf[c++] = '\n'; | ||
134 | else if ((i & s) == 0) | ||
135 | buf[c++] = ' '; | ||
136 | } | ||
137 | sprintf(&buf[c], "%02x", idev->id[i]); | ||
138 | c += 2; | ||
139 | } | ||
140 | buf[c++] = '\n'; | ||
141 | return c; | ||
142 | } | ||
143 | |||
144 | static ssize_t | ||
145 | id_vendor_show(struct device *dev, struct device_attribute *attr, char *buf) | ||
146 | { | ||
147 | struct ipack_device *idev = to_ipack_dev(dev); | ||
148 | switch (idev->id_format) { | ||
149 | case IPACK_ID_VERSION_1: | ||
150 | return sprintf(buf, "0x%02x\n", idev->id_vendor); | ||
151 | case IPACK_ID_VERSION_2: | ||
152 | return sprintf(buf, "0x%06x\n", idev->id_vendor); | ||
153 | default: | ||
154 | return -EIO; | ||
155 | } | ||
156 | } | ||
157 | |||
158 | static ssize_t | ||
159 | id_device_show(struct device *dev, struct device_attribute *attr, char *buf) | ||
160 | { | ||
161 | struct ipack_device *idev = to_ipack_dev(dev); | ||
162 | switch (idev->id_format) { | ||
163 | case IPACK_ID_VERSION_1: | ||
164 | return sprintf(buf, "0x%02x\n", idev->id_device); | ||
165 | case IPACK_ID_VERSION_2: | ||
166 | return sprintf(buf, "0x%04x\n", idev->id_device); | ||
167 | default: | ||
168 | return -EIO; | ||
169 | } | ||
170 | } | ||
171 | |||
172 | static ssize_t modalias_show(struct device *dev, struct device_attribute *attr, | ||
173 | char *buf) | ||
174 | { | ||
175 | struct ipack_device *idev = to_ipack_dev(dev); | ||
176 | |||
177 | return sprintf(buf, "ipac:f%02Xv%08Xd%08X", idev->id_format, | ||
178 | idev->id_vendor, idev->id_device); | ||
179 | } | ||
180 | |||
181 | ipack_device_attr(id_format, "0x%hhu\n"); | ||
182 | |||
183 | static struct device_attribute ipack_dev_attrs[] = { | ||
184 | __ATTR_RO(id), | ||
185 | __ATTR_RO(id_device), | ||
186 | __ATTR_RO(id_format), | ||
187 | __ATTR_RO(id_vendor), | ||
188 | __ATTR_RO(modalias), | ||
189 | }; | ||
190 | |||
191 | static struct bus_type ipack_bus_type = { | ||
192 | .name = "ipack", | ||
193 | .probe = ipack_bus_probe, | ||
194 | .match = ipack_bus_match, | ||
195 | .remove = ipack_bus_remove, | ||
196 | .dev_attrs = ipack_dev_attrs, | ||
197 | .uevent = ipack_uevent, | ||
198 | }; | ||
199 | |||
200 | struct ipack_bus_device *ipack_bus_register(struct device *parent, int slots, | ||
201 | const struct ipack_bus_ops *ops) | ||
202 | { | ||
203 | int bus_nr; | ||
204 | struct ipack_bus_device *bus; | ||
205 | |||
206 | bus = kzalloc(sizeof(struct ipack_bus_device), GFP_KERNEL); | ||
207 | if (!bus) | ||
208 | return NULL; | ||
209 | |||
210 | bus_nr = ida_simple_get(&ipack_ida, 0, 0, GFP_KERNEL); | ||
211 | if (bus_nr < 0) { | ||
212 | kfree(bus); | ||
213 | return NULL; | ||
214 | } | ||
215 | |||
216 | bus->bus_nr = bus_nr; | ||
217 | bus->parent = parent; | ||
218 | bus->slots = slots; | ||
219 | bus->ops = ops; | ||
220 | return bus; | ||
221 | } | ||
222 | EXPORT_SYMBOL_GPL(ipack_bus_register); | ||
223 | |||
224 | static int ipack_unregister_bus_member(struct device *dev, void *data) | ||
225 | { | ||
226 | struct ipack_device *idev = to_ipack_dev(dev); | ||
227 | struct ipack_bus_device *bus = data; | ||
228 | |||
229 | if (idev->bus == bus) | ||
230 | ipack_device_unregister(idev); | ||
231 | |||
232 | return 1; | ||
233 | } | ||
234 | |||
235 | int ipack_bus_unregister(struct ipack_bus_device *bus) | ||
236 | { | ||
237 | bus_for_each_dev(&ipack_bus_type, NULL, bus, | ||
238 | ipack_unregister_bus_member); | ||
239 | ida_simple_remove(&ipack_ida, bus->bus_nr); | ||
240 | kfree(bus); | ||
241 | return 0; | ||
242 | } | ||
243 | EXPORT_SYMBOL_GPL(ipack_bus_unregister); | ||
244 | |||
245 | int ipack_driver_register(struct ipack_driver *edrv, struct module *owner, | ||
246 | const char *name) | ||
247 | { | ||
248 | edrv->driver.owner = owner; | ||
249 | edrv->driver.name = name; | ||
250 | edrv->driver.bus = &ipack_bus_type; | ||
251 | return driver_register(&edrv->driver); | ||
252 | } | ||
253 | EXPORT_SYMBOL_GPL(ipack_driver_register); | ||
254 | |||
255 | void ipack_driver_unregister(struct ipack_driver *edrv) | ||
256 | { | ||
257 | driver_unregister(&edrv->driver); | ||
258 | } | ||
259 | EXPORT_SYMBOL_GPL(ipack_driver_unregister); | ||
260 | |||
261 | static u16 ipack_crc_byte(u16 crc, u8 c) | ||
262 | { | ||
263 | int i; | ||
264 | |||
265 | crc ^= c << 8; | ||
266 | for (i = 0; i < 8; i++) | ||
267 | crc = (crc << 1) ^ ((crc & 0x8000) ? 0x1021 : 0); | ||
268 | return crc; | ||
269 | } | ||
270 | |||
271 | /* | ||
272 | * The algorithm in lib/crc-ccitt.c does not seem to apply since it uses the | ||
273 | * opposite bit ordering. | ||
274 | */ | ||
275 | static u8 ipack_calc_crc1(struct ipack_device *dev) | ||
276 | { | ||
277 | u8 c; | ||
278 | u16 crc; | ||
279 | unsigned int i; | ||
280 | |||
281 | crc = 0xffff; | ||
282 | for (i = 0; i < dev->id_avail; i++) { | ||
283 | c = (i != 11) ? dev->id[i] : 0; | ||
284 | crc = ipack_crc_byte(crc, c); | ||
285 | } | ||
286 | crc = ~crc; | ||
287 | return crc & 0xff; | ||
288 | } | ||
289 | |||
290 | static u16 ipack_calc_crc2(struct ipack_device *dev) | ||
291 | { | ||
292 | u8 c; | ||
293 | u16 crc; | ||
294 | unsigned int i; | ||
295 | |||
296 | crc = 0xffff; | ||
297 | for (i = 0; i < dev->id_avail; i++) { | ||
298 | c = ((i != 0x18) && (i != 0x19)) ? dev->id[i] : 0; | ||
299 | crc = ipack_crc_byte(crc, c); | ||
300 | } | ||
301 | crc = ~crc; | ||
302 | return crc; | ||
303 | } | ||
304 | |||
305 | static void ipack_parse_id1(struct ipack_device *dev) | ||
306 | { | ||
307 | u8 *id = dev->id; | ||
308 | u8 crc; | ||
309 | |||
310 | dev->id_vendor = id[4]; | ||
311 | dev->id_device = id[5]; | ||
312 | dev->speed_8mhz = 1; | ||
313 | dev->speed_32mhz = (id[7] == 'H'); | ||
314 | crc = ipack_calc_crc1(dev); | ||
315 | dev->id_crc_correct = (crc == id[11]); | ||
316 | if (!dev->id_crc_correct) { | ||
317 | dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", | ||
318 | id[11], crc); | ||
319 | } | ||
320 | } | ||
321 | |||
322 | static void ipack_parse_id2(struct ipack_device *dev) | ||
323 | { | ||
324 | __be16 *id = (__be16 *) dev->id; | ||
325 | u16 flags, crc; | ||
326 | |||
327 | dev->id_vendor = ((be16_to_cpu(id[3]) & 0xff) << 16) | ||
328 | + be16_to_cpu(id[4]); | ||
329 | dev->id_device = be16_to_cpu(id[5]); | ||
330 | flags = be16_to_cpu(id[10]); | ||
331 | dev->speed_8mhz = !!(flags & 2); | ||
332 | dev->speed_32mhz = !!(flags & 4); | ||
333 | crc = ipack_calc_crc2(dev); | ||
334 | dev->id_crc_correct = (crc == be16_to_cpu(id[12])); | ||
335 | if (!dev->id_crc_correct) { | ||
336 | dev_warn(&dev->dev, "ID CRC invalid found 0x%x, expected 0x%x.\n", | ||
337 | id[11], crc); | ||
338 | } | ||
339 | } | ||
340 | |||
341 | static int ipack_device_read_id(struct ipack_device *dev) | ||
342 | { | ||
343 | u8 __iomem *idmem; | ||
344 | int i; | ||
345 | int ret = 0; | ||
346 | |||
347 | idmem = ioremap(dev->region[IPACK_ID_SPACE].start, | ||
348 | dev->region[IPACK_ID_SPACE].size); | ||
349 | if (!idmem) { | ||
350 | dev_err(&dev->dev, "error mapping memory\n"); | ||
351 | return -ENOMEM; | ||
352 | } | ||
353 | |||
354 | /* Determine ID PROM Data Format. If we find the ids "IPAC" or "IPAH" | ||
355 | * we are dealing with a IndustryPack format 1 device. If we detect | ||
356 | * "VITA4 " (16 bit big endian formatted) we are dealing with a | ||
357 | * IndustryPack format 2 device */ | ||
358 | if ((ioread8(idmem + 1) == 'I') && | ||
359 | (ioread8(idmem + 3) == 'P') && | ||
360 | (ioread8(idmem + 5) == 'A') && | ||
361 | ((ioread8(idmem + 7) == 'C') || | ||
362 | (ioread8(idmem + 7) == 'H'))) { | ||
363 | dev->id_format = IPACK_ID_VERSION_1; | ||
364 | dev->id_avail = ioread8(idmem + 0x15); | ||
365 | if ((dev->id_avail < 0x0c) || (dev->id_avail > 0x40)) { | ||
366 | dev_warn(&dev->dev, "invalid id size"); | ||
367 | dev->id_avail = 0x0c; | ||
368 | } | ||
369 | } else if ((ioread8(idmem + 0) == 'I') && | ||
370 | (ioread8(idmem + 1) == 'V') && | ||
371 | (ioread8(idmem + 2) == 'A') && | ||
372 | (ioread8(idmem + 3) == 'T') && | ||
373 | (ioread8(idmem + 4) == ' ') && | ||
374 | (ioread8(idmem + 5) == '4')) { | ||
375 | dev->id_format = IPACK_ID_VERSION_2; | ||
376 | dev->id_avail = ioread16be(idmem + 0x16); | ||
377 | if ((dev->id_avail < 0x1a) || (dev->id_avail > 0x40)) { | ||
378 | dev_warn(&dev->dev, "invalid id size"); | ||
379 | dev->id_avail = 0x1a; | ||
380 | } | ||
381 | } else { | ||
382 | dev->id_format = IPACK_ID_VERSION_INVALID; | ||
383 | dev->id_avail = 0; | ||
384 | } | ||
385 | |||
386 | if (!dev->id_avail) { | ||
387 | ret = -ENODEV; | ||
388 | goto out; | ||
389 | } | ||
390 | |||
391 | /* Obtain the amount of memory required to store a copy of the complete | ||
392 | * ID ROM contents */ | ||
393 | dev->id = kmalloc(dev->id_avail, GFP_KERNEL); | ||
394 | if (!dev->id) { | ||
395 | dev_err(&dev->dev, "dev->id alloc failed.\n"); | ||
396 | ret = -ENOMEM; | ||
397 | goto out; | ||
398 | } | ||
399 | for (i = 0; i < dev->id_avail; i++) { | ||
400 | if (dev->id_format == IPACK_ID_VERSION_1) | ||
401 | dev->id[i] = ioread8(idmem + (i << 1) + 1); | ||
402 | else | ||
403 | dev->id[i] = ioread8(idmem + i); | ||
404 | } | ||
405 | |||
406 | /* now we can finally work with the copy */ | ||
407 | switch (dev->id_format) { | ||
408 | case IPACK_ID_VERSION_1: | ||
409 | ipack_parse_id1(dev); | ||
410 | break; | ||
411 | case IPACK_ID_VERSION_2: | ||
412 | ipack_parse_id2(dev); | ||
413 | break; | ||
414 | } | ||
415 | |||
416 | out: | ||
417 | iounmap(idmem); | ||
418 | |||
419 | return ret; | ||
420 | } | ||
421 | |||
422 | int ipack_device_register(struct ipack_device *dev) | ||
423 | { | ||
424 | int ret; | ||
425 | |||
426 | dev->dev.bus = &ipack_bus_type; | ||
427 | dev->dev.release = ipack_device_release; | ||
428 | dev->dev.parent = dev->bus->parent; | ||
429 | dev_set_name(&dev->dev, | ||
430 | "ipack-dev.%u.%u", dev->bus->bus_nr, dev->slot); | ||
431 | |||
432 | if (dev->bus->ops->set_clockrate(dev, 8)) | ||
433 | dev_warn(&dev->dev, "failed to switch to 8 MHz operation for reading of device ID.\n"); | ||
434 | if (dev->bus->ops->reset_timeout(dev)) | ||
435 | dev_warn(&dev->dev, "failed to reset potential timeout."); | ||
436 | |||
437 | ret = ipack_device_read_id(dev); | ||
438 | if (ret < 0) { | ||
439 | dev_err(&dev->dev, "error reading device id section.\n"); | ||
440 | return ret; | ||
441 | } | ||
442 | |||
443 | /* if the device supports 32 MHz operation, use it. */ | ||
444 | if (dev->speed_32mhz) { | ||
445 | ret = dev->bus->ops->set_clockrate(dev, 32); | ||
446 | if (ret < 0) | ||
447 | dev_err(&dev->dev, "failed to switch to 32 MHz operation.\n"); | ||
448 | } | ||
449 | |||
450 | ret = device_register(&dev->dev); | ||
451 | if (ret < 0) | ||
452 | kfree(dev->id); | ||
453 | |||
454 | return ret; | ||
455 | } | ||
456 | EXPORT_SYMBOL_GPL(ipack_device_register); | ||
457 | |||
458 | void ipack_device_unregister(struct ipack_device *dev) | ||
459 | { | ||
460 | device_unregister(&dev->dev); | ||
461 | } | ||
462 | EXPORT_SYMBOL_GPL(ipack_device_unregister); | ||
463 | |||
464 | static int __init ipack_init(void) | ||
465 | { | ||
466 | ida_init(&ipack_ida); | ||
467 | return bus_register(&ipack_bus_type); | ||
468 | } | ||
469 | |||
470 | static void __exit ipack_exit(void) | ||
471 | { | ||
472 | bus_unregister(&ipack_bus_type); | ||
473 | ida_destroy(&ipack_ida); | ||
474 | } | ||
475 | |||
476 | module_init(ipack_init); | ||
477 | module_exit(ipack_exit); | ||
478 | |||
479 | MODULE_AUTHOR("Samuel Iglesias Gonsalvez <siglesias@igalia.com>"); | ||
480 | MODULE_LICENSE("GPL"); | ||
481 | MODULE_DESCRIPTION("Industry-pack bus core"); | ||
diff --git a/drivers/ipack/ipack.h b/drivers/ipack/ipack.h new file mode 100644 index 000000000000..6760bfaf0ac4 --- /dev/null +++ b/drivers/ipack/ipack.h | |||
@@ -0,0 +1,215 @@ | |||
1 | /* | ||
2 | * Industry-pack bus. | ||
3 | * | ||
4 | * Copyright (C) 2011-2012 CERN (www.cern.ch) | ||
5 | * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com> | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify it | ||
8 | * under the terms of the GNU General Public License as published by the Free | ||
9 | * Software Foundation; version 2 of the License. | ||
10 | */ | ||
11 | |||
12 | #include <linux/mod_devicetable.h> | ||
13 | #include <linux/device.h> | ||
14 | #include <linux/interrupt.h> | ||
15 | |||
16 | #include "ipack_ids.h" | ||
17 | |||
18 | #define IPACK_IDPROM_OFFSET_I 0x01 | ||
19 | #define IPACK_IDPROM_OFFSET_P 0x03 | ||
20 | #define IPACK_IDPROM_OFFSET_A 0x05 | ||
21 | #define IPACK_IDPROM_OFFSET_C 0x07 | ||
22 | #define IPACK_IDPROM_OFFSET_MANUFACTURER_ID 0x09 | ||
23 | #define IPACK_IDPROM_OFFSET_MODEL 0x0B | ||
24 | #define IPACK_IDPROM_OFFSET_REVISION 0x0D | ||
25 | #define IPACK_IDPROM_OFFSET_RESERVED 0x0F | ||
26 | #define IPACK_IDPROM_OFFSET_DRIVER_ID_L 0x11 | ||
27 | #define IPACK_IDPROM_OFFSET_DRIVER_ID_H 0x13 | ||
28 | #define IPACK_IDPROM_OFFSET_NUM_BYTES 0x15 | ||
29 | #define IPACK_IDPROM_OFFSET_CRC 0x17 | ||
30 | |||
31 | struct ipack_bus_ops; | ||
32 | struct ipack_driver; | ||
33 | |||
34 | enum ipack_space { | ||
35 | IPACK_IO_SPACE = 0, | ||
36 | IPACK_ID_SPACE, | ||
37 | IPACK_INT_SPACE, | ||
38 | IPACK_MEM8_SPACE, | ||
39 | IPACK_MEM16_SPACE, | ||
40 | /* Dummy for counting the number of entries. Must remain the last | ||
41 | * entry */ | ||
42 | IPACK_SPACE_COUNT, | ||
43 | }; | ||
44 | |||
45 | /** | ||
46 | */ | ||
47 | struct ipack_region { | ||
48 | phys_addr_t start; | ||
49 | size_t size; | ||
50 | }; | ||
51 | |||
52 | /** | ||
53 | * struct ipack_device | ||
54 | * | ||
55 | * @slot: Slot where the device is plugged in the carrier board | ||
56 | * @bus: ipack_bus_device where the device is plugged to. | ||
57 | * @id_space: Virtual address to ID space. | ||
58 | * @io_space: Virtual address to IO space. | ||
59 | * @mem_space: Virtual address to MEM space. | ||
60 | * @dev: device in kernel representation. | ||
61 | * | ||
62 | * Warning: Direct access to mapped memory is possible but the endianness | ||
63 | * is not the same with PCI carrier or VME carrier. The endianness is managed | ||
64 | * by the carrier board throught bus->ops. | ||
65 | */ | ||
66 | struct ipack_device { | ||
67 | unsigned int slot; | ||
68 | struct ipack_bus_device *bus; | ||
69 | struct device dev; | ||
70 | void (*release) (struct ipack_device *dev); | ||
71 | struct ipack_region region[IPACK_SPACE_COUNT]; | ||
72 | u8 *id; | ||
73 | size_t id_avail; | ||
74 | u32 id_vendor; | ||
75 | u32 id_device; | ||
76 | u8 id_format; | ||
77 | unsigned int id_crc_correct:1; | ||
78 | unsigned int speed_8mhz:1; | ||
79 | unsigned int speed_32mhz:1; | ||
80 | }; | ||
81 | |||
82 | /** | ||
83 | * struct ipack_driver_ops -- Callbacks to IPack device driver | ||
84 | * | ||
85 | * @probe: Probe function | ||
86 | * @remove: Prepare imminent removal of the device. Services provided by the | ||
87 | * device should be revoked. | ||
88 | */ | ||
89 | |||
90 | struct ipack_driver_ops { | ||
91 | int (*probe) (struct ipack_device *dev); | ||
92 | void (*remove) (struct ipack_device *dev); | ||
93 | }; | ||
94 | |||
95 | /** | ||
96 | * struct ipack_driver -- Specific data to each ipack device driver | ||
97 | * | ||
98 | * @driver: Device driver kernel representation | ||
99 | * @ops: Callbacks provided by the IPack device driver | ||
100 | */ | ||
101 | struct ipack_driver { | ||
102 | struct device_driver driver; | ||
103 | const struct ipack_device_id *id_table; | ||
104 | const struct ipack_driver_ops *ops; | ||
105 | }; | ||
106 | |||
107 | /** | ||
108 | * struct ipack_bus_ops - available operations on a bridge module | ||
109 | * | ||
110 | * @map_space: map IP address space | ||
111 | * @unmap_space: unmap IP address space | ||
112 | * @request_irq: request IRQ | ||
113 | * @free_irq: free IRQ | ||
114 | * @get_clockrate: Returns the clockrate the carrier is currently | ||
115 | * communicating with the device at. | ||
116 | * @set_clockrate: Sets the clock-rate for carrier / module communication. | ||
117 | * Should return -EINVAL if the requested speed is not supported. | ||
118 | * @get_error: Returns the error state for the slot the device is attached | ||
119 | * to. | ||
120 | * @get_timeout: Returns 1 if the communication with the device has | ||
121 | * previously timed out. | ||
122 | * @reset_timeout: Resets the state returned by get_timeout. | ||
123 | */ | ||
124 | struct ipack_bus_ops { | ||
125 | int (*request_irq) (struct ipack_device *dev, | ||
126 | irqreturn_t (*handler)(void *), void *arg); | ||
127 | int (*free_irq) (struct ipack_device *dev); | ||
128 | int (*get_clockrate) (struct ipack_device *dev); | ||
129 | int (*set_clockrate) (struct ipack_device *dev, int mherz); | ||
130 | int (*get_error) (struct ipack_device *dev); | ||
131 | int (*get_timeout) (struct ipack_device *dev); | ||
132 | int (*reset_timeout) (struct ipack_device *dev); | ||
133 | }; | ||
134 | |||
135 | /** | ||
136 | * struct ipack_bus_device | ||
137 | * | ||
138 | * @dev: pointer to carrier device | ||
139 | * @slots: number of slots available | ||
140 | * @bus_nr: ipack bus number | ||
141 | * @ops: bus operations for the mezzanine drivers | ||
142 | */ | ||
143 | struct ipack_bus_device { | ||
144 | struct device *parent; | ||
145 | int slots; | ||
146 | int bus_nr; | ||
147 | const struct ipack_bus_ops *ops; | ||
148 | }; | ||
149 | |||
150 | /** | ||
151 | * ipack_bus_register -- register a new ipack bus | ||
152 | * | ||
153 | * @parent: pointer to the parent device, if any. | ||
154 | * @slots: number of slots available in the bus device. | ||
155 | * @ops: bus operations for the mezzanine drivers. | ||
156 | * | ||
157 | * The carrier board device should call this function to register itself as | ||
158 | * available bus device in ipack. | ||
159 | */ | ||
160 | struct ipack_bus_device *ipack_bus_register(struct device *parent, int slots, | ||
161 | const struct ipack_bus_ops *ops); | ||
162 | |||
163 | /** | ||
164 | * ipack_bus_unregister -- unregister an ipack bus | ||
165 | */ | ||
166 | int ipack_bus_unregister(struct ipack_bus_device *bus); | ||
167 | |||
168 | /** | ||
169 | * ipack_driver_register -- Register a new ipack device driver | ||
170 | * | ||
171 | * Called by a ipack driver to register itself as a driver | ||
172 | * that can manage ipack devices. | ||
173 | */ | ||
174 | int ipack_driver_register(struct ipack_driver *edrv, struct module *owner, | ||
175 | const char *name); | ||
176 | void ipack_driver_unregister(struct ipack_driver *edrv); | ||
177 | |||
178 | /** | ||
179 | * ipack_device_register -- register an IPack device with the kernel | ||
180 | * @dev: the new device to register. | ||
181 | * | ||
182 | * Register a new IPack device ("module" in IndustryPack jargon). The call | ||
183 | * is done by the carrier driver. The carrier should populate the fields | ||
184 | * bus and slot as well as the region array of @dev prior to calling this | ||
185 | * function. The rest of the fields will be allocated and populated | ||
186 | * during registration. | ||
187 | * | ||
188 | * Return zero on success or error code on failure. | ||
189 | */ | ||
190 | int ipack_device_register(struct ipack_device *dev); | ||
191 | void ipack_device_unregister(struct ipack_device *dev); | ||
192 | |||
193 | /** | ||
194 | * DEFINE_IPACK_DEVICE_TABLE - macro used to describe a IndustryPack table | ||
195 | * @_table: device table name | ||
196 | * | ||
197 | * This macro is used to create a struct ipack_device_id array (a device table) | ||
198 | * in a generic manner. | ||
199 | */ | ||
200 | #define DEFINE_IPACK_DEVICE_TABLE(_table) \ | ||
201 | const struct ipack_device_id _table[] __devinitconst | ||
202 | |||
203 | /** | ||
204 | * IPACK_DEVICE - macro used to describe a specific IndustryPack device | ||
205 | * @_format: the format version (currently either 1 or 2, 8 bit value) | ||
206 | * @vend: the 8 or 24 bit IndustryPack Vendor ID | ||
207 | * @dev: the 8 or 16 bit IndustryPack Device ID | ||
208 | * | ||
209 | * This macro is used to create a struct ipack_device_id that matches a specific | ||
210 | * device. | ||
211 | */ | ||
212 | #define IPACK_DEVICE(_format, vend, dev) \ | ||
213 | .format = (_format), \ | ||
214 | .vendor = (vend), \ | ||
215 | .device = (dev) | ||
diff --git a/drivers/ipack/ipack_ids.h b/drivers/ipack/ipack_ids.h new file mode 100644 index 000000000000..8153fee3f2f7 --- /dev/null +++ b/drivers/ipack/ipack_ids.h | |||
@@ -0,0 +1,32 @@ | |||
1 | /* | ||
2 | * IndustryPack Fromat, Vendor and Device IDs. | ||
3 | */ | ||
4 | |||
5 | /* ID section format versions */ | ||
6 | #define IPACK_ID_VERSION_INVALID 0x00 | ||
7 | #define IPACK_ID_VERSION_1 0x01 | ||
8 | #define IPACK_ID_VERSION_2 0x02 | ||
9 | |||
10 | /* Vendors and devices. Sort key: vendor first, device next. */ | ||
11 | #define IPACK1_VENDOR_ID_RESERVED1 0x00 | ||
12 | #define IPACK1_VENDOR_ID_RESERVED2 0xFF | ||
13 | #define IPACK1_VENDOR_ID_UNREGISTRED01 0x01 | ||
14 | #define IPACK1_VENDOR_ID_UNREGISTRED02 0x02 | ||
15 | #define IPACK1_VENDOR_ID_UNREGISTRED03 0x03 | ||
16 | #define IPACK1_VENDOR_ID_UNREGISTRED04 0x04 | ||
17 | #define IPACK1_VENDOR_ID_UNREGISTRED05 0x05 | ||
18 | #define IPACK1_VENDOR_ID_UNREGISTRED06 0x06 | ||
19 | #define IPACK1_VENDOR_ID_UNREGISTRED07 0x07 | ||
20 | #define IPACK1_VENDOR_ID_UNREGISTRED08 0x08 | ||
21 | #define IPACK1_VENDOR_ID_UNREGISTRED09 0x09 | ||
22 | #define IPACK1_VENDOR_ID_UNREGISTRED10 0x0A | ||
23 | #define IPACK1_VENDOR_ID_UNREGISTRED11 0x0B | ||
24 | #define IPACK1_VENDOR_ID_UNREGISTRED12 0x0C | ||
25 | #define IPACK1_VENDOR_ID_UNREGISTRED13 0x0D | ||
26 | #define IPACK1_VENDOR_ID_UNREGISTRED14 0x0E | ||
27 | #define IPACK1_VENDOR_ID_UNREGISTRED15 0x0F | ||
28 | |||
29 | #define IPACK1_VENDOR_ID_SBS 0xF0 | ||
30 | #define IPACK1_DEVICE_ID_SBS_OCTAL_232 0x22 | ||
31 | #define IPACK1_DEVICE_ID_SBS_OCTAL_422 0x2A | ||
32 | #define IPACK1_DEVICE_ID_SBS_OCTAL_485 0x48 | ||