blob: 0246b1fddffe5c75516d3885383323e3c9939c6d [file] [log] [blame]
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +02001/**
2 * tpci200.c
3 *
4 * driver for the TEWS TPCI-200 device
Samuel Iglesias Gonsalvez76859722012-11-16 16:19:58 +01005 *
6 * Copyright (C) 2009-2012 CERN (www.cern.ch)
7 * Author: Nicolas Serafini, EIC2 SA
8 * Author: Samuel Iglesias Gonsalvez <siglesias@igalia.com>
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +02009 *
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
Samuel Iglesias Gonsalvezb9950692012-05-11 10:17:14 +020012 * Software Foundation; version 2 of the License.
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020013 */
14
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020015#include <linux/module.h>
Samuel Iglesias Gonsalvez9f3059c2012-10-22 09:36:48 +020016#include <linux/slab.h>
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020017#include "tpci200.h"
18
Jens Taprogge6114aea2012-09-27 12:37:30 +020019static const u16 tpci200_status_timeout[] = {
Jens Taproggeeb12d882012-09-11 13:34:56 +020020 TPCI200_A_TIMEOUT,
21 TPCI200_B_TIMEOUT,
22 TPCI200_C_TIMEOUT,
23 TPCI200_D_TIMEOUT,
24};
25
Jens Taprogge6114aea2012-09-27 12:37:30 +020026static const u16 tpci200_status_error[] = {
Jens Taproggeeb12d882012-09-11 13:34:56 +020027 TPCI200_A_ERROR,
28 TPCI200_B_ERROR,
29 TPCI200_C_ERROR,
30 TPCI200_D_ERROR,
31};
32
Jens Taproggea19ad7d2012-09-27 12:37:31 +020033static const size_t tpci200_space_size[IPACK_SPACE_COUNT] = {
Jens Taproggefe4a3ed2012-09-27 12:37:36 +020034 [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,
Jens Taprogge48a97352012-09-27 12:37:37 +020038 [IPACK_MEM16_SPACE] = TPCI200_MEM16_SPACE_SIZE,
Jens Taproggea19ad7d2012-09-27 12:37:31 +020039};
40
41static const size_t tpci200_space_interval[IPACK_SPACE_COUNT] = {
Jens Taproggefe4a3ed2012-09-27 12:37:36 +020042 [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,
Jens Taprogge48a97352012-09-27 12:37:37 +020046 [IPACK_MEM16_SPACE] = TPCI200_MEM16_SPACE_INTERVAL,
Jens Taproggea19ad7d2012-09-27 12:37:31 +020047};
48
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020049static struct tpci200_board *check_slot(struct ipack_device *dev)
50{
51 struct tpci200_board *tpci200;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020052
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +020053 if (dev == NULL)
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020054 return NULL;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020055
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020056
Samuel Iglesias Gonsálvezf45651f2012-07-20 09:39:04 +020057 tpci200 = dev_get_drvdata(dev->bus->parent);
58
59 if (tpci200 == NULL) {
60 dev_info(&dev->dev, "carrier board not found\n");
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020061 return NULL;
62 }
63
64 if (dev->slot >= TPCI200_NB_SLOT) {
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +020065 dev_info(&dev->dev,
66 "Slot [%d:%d] doesn't exist! Last tpci200 slot is %d.\n",
Jens Taproggef9e314d2012-09-27 12:37:25 +020067 dev->bus->bus_nr, dev->slot, TPCI200_NB_SLOT-1);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020068 return NULL;
69 }
70
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020071 return tpci200;
72}
73
Jens Taprogge01186812012-09-12 14:55:23 +020074static void tpci200_clear_mask(struct tpci200_board *tpci200,
75 __le16 __iomem *addr, u16 mask)
76{
Jens Taprogge487e0a62012-09-12 14:55:33 +020077 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);
Jens Taprogge01186812012-09-12 14:55:23 +020081}
82
83static void tpci200_set_mask(struct tpci200_board *tpci200,
84 __le16 __iomem *addr, u16 mask)
85{
Jens Taprogge487e0a62012-09-12 14:55:33 +020086 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);
Jens Taprogge01186812012-09-12 14:55:23 +020090}
91
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020092static void tpci200_unregister(struct tpci200_board *tpci200)
93{
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020094 free_irq(tpci200->info->pdev->irq, (void *) tpci200);
95
96 pci_iounmap(tpci200->info->pdev, tpci200->info->interface_regs);
Samuel Iglesias Gonsálvez79878122012-09-11 13:35:04 +020097 pci_iounmap(tpci200->info->pdev, tpci200->info->cfg_regs);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +020098
99 pci_release_region(tpci200->info->pdev, TPCI200_IP_INTERFACE_BAR);
100 pci_release_region(tpci200->info->pdev, TPCI200_IO_ID_INT_SPACES_BAR);
Jens Taprogge48a97352012-09-27 12:37:37 +0200101 pci_release_region(tpci200->info->pdev, TPCI200_MEM16_SPACE_BAR);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200102 pci_release_region(tpci200->info->pdev, TPCI200_MEM8_SPACE_BAR);
Samuel Iglesias Gonsálvez79878122012-09-11 13:35:04 +0200103 pci_release_region(tpci200->info->pdev, TPCI200_CFG_MEM_BAR);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200104
105 pci_disable_device(tpci200->info->pdev);
106 pci_dev_put(tpci200->info->pdev);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200107}
108
Jens Taprogge877adc42012-09-12 14:55:36 +0200109static 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
117static 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
Jens Taproggeaf2140ce2012-09-12 14:55:25 +0200125static irqreturn_t tpci200_slot_irq(struct slot_irq *slot_irq)
126{
Jens Taproggeab0deff2012-09-12 14:55:35 +0200127 irqreturn_t ret;
Jens Taproggeaf2140ce2012-09-12 14:55:25 +0200128
Jens Taproggeab0deff2012-09-12 14:55:35 +0200129 if (!slot_irq)
130 return -ENODEV;
131 ret = slot_irq->handler(slot_irq->arg);
132
Jens Taproggeaf2140ce2012-09-12 14:55:25 +0200133 return ret;
134}
135
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200136static irqreturn_t tpci200_interrupt(int irq, void *dev_id)
137{
138 struct tpci200_board *tpci200 = (struct tpci200_board *) dev_id;
Jens Taprogge6f2c12a2012-09-11 13:35:13 +0200139 struct slot_irq *slot_irq;
Jens Taproggeab0deff2012-09-12 14:55:35 +0200140 irqreturn_t ret;
141 u16 status_reg;
142 int i;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200143
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200144 /* Read status register */
Jens Taproggeab0deff2012-09-12 14:55:35 +0200145 status_reg = ioread16(&tpci200->info->interface_regs->status);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200146
Jens Taproggeab0deff2012-09-12 14:55:35 +0200147 /* Did we cause the interrupt? */
148 if (!(status_reg & TPCI200_SLOT_INT_MASK))
Jens Taprogge88ff8482012-09-12 14:55:34 +0200149 return IRQ_NONE;
Jens Taproggeab0deff2012-09-12 14:55:35 +0200150
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);
Jens Taprogge877adc42012-09-12 14:55:36 +0200162 tpci200_disable_irq(tpci200, i);
Jens Taproggeab0deff2012-09-12 14:55:35 +0200163 }
Jens Taprogge88ff8482012-09-12 14:55:34 +0200164 }
Jens Taproggeab0deff2012-09-12 14:55:35 +0200165 rcu_read_unlock();
166
167 return IRQ_HANDLED;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200168}
169
Jens Taprogge40733ed2012-09-12 14:55:37 +0200170static 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
Jens Taproggec6e2dfa2012-09-13 12:32:21 +0200197static int tpci200_request_irq(struct ipack_device *dev,
Jens Taproggefaa75c42012-09-12 14:55:38 +0200198 irqreturn_t (*handler)(void *), void *arg)
Jens Taprogge40733ed2012-09-12 14:55:37 +0200199{
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,
Johan Meiring9d10b222012-11-11 22:41:13 +0200213 "Slot [%d:%d] IRQ already registered !\n",
214 dev->bus->bus_nr,
Jens Taprogge40733ed2012-09-12 14:55:37 +0200215 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",
Jens Taproggef9e314d2012-09-27 12:37:25 +0200224 dev->bus->bus_nr, dev->slot);
Jens Taprogge40733ed2012-09-12 14:55:37 +0200225 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 */
Jens Taprogge40733ed2012-09-12 14:55:37 +0200235 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
242out_unlock:
243 mutex_unlock(&tpci200->mutex);
244 return res;
245}
246
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200247static int tpci200_register(struct tpci200_board *tpci200)
248{
Samuel Iglesias Gonsalvez862fe872012-05-23 15:54:40 +0200249 int i;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200250 int res;
Jens Taproggebb29ab82012-09-27 12:37:28 +0200251 phys_addr_t ioidint_base;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200252 unsigned short slot_ctrl;
253
254 if (pci_enable_device(tpci200->info->pdev) < 0)
255 return -ENODEV;
256
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200257 /* 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) {
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +0200261 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);
Samuel Iglesias Gonsalvez862fe872012-05-23 15:54:40 +0200265 goto out_disable_pci;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200266 }
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) {
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +0200273 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);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200277 goto out_release_ip_space;
278 }
279
Jens Taproggefe4a3ed2012-09-27 12:37:36 +0200280 /* Request MEM8 space (Bar 5) */
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200281 res = pci_request_region(tpci200->info->pdev, TPCI200_MEM8_SPACE_BAR,
Jens Taproggefe4a3ed2012-09-27 12:37:36 +0200282 "Carrier MEM8 space");
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200283 if (res) {
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +0200284 dev_err(&tpci200->info->pdev->dev,
Jens Taproggefe4a3ed2012-09-27 12:37:36 +0200285 "(bn 0x%X, sn 0x%X) failed to allocate PCI resource for BAR 5!",
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +0200286 tpci200->info->pdev->bus->number,
287 tpci200->info->pdev->devfn);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200288 goto out_release_ioid_int_space;
289 }
290
Jens Taprogge48a97352012-09-27 12:37:37 +0200291 /* 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
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200302 /* Map internal tpci200 driver user space */
303 tpci200->info->interface_regs =
Samuel Iglesias Gonsálvez5b47f3c2012-07-20 09:39:05 +0200304 ioremap_nocache(pci_resource_start(tpci200->info->pdev,
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200305 TPCI200_IP_INTERFACE_BAR),
306 TPCI200_IFACE_SIZE);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200307
Jens Taprogge487e0a62012-09-12 14:55:33 +0200308 /* Initialize lock that protects interface_regs */
309 spin_lock_init(&tpci200->regs_lock);
310
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200311 ioidint_base = pci_resource_start(tpci200->info->pdev,
312 TPCI200_IO_ID_INT_SPACES_BAR);
Jens Taprogge84a08fa2012-09-27 12:37:29 +0200313 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;
Jens Taproggefe4a3ed2012-09-27 12:37:36 +0200317 tpci200->mod_mem[IPACK_MEM8_SPACE] =
Jens Taprogge84a08fa2012-09-27 12:37:29 +0200318 pci_resource_start(tpci200->info->pdev,
Jens Taprogge6114aea2012-09-27 12:37:30 +0200319 TPCI200_MEM8_SPACE_BAR);
Jens Taprogge48a97352012-09-27 12:37:37 +0200320 tpci200->mod_mem[IPACK_MEM16_SPACE] =
321 pci_resource_start(tpci200->info->pdev,
322 TPCI200_MEM16_SPACE_BAR);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200323
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;
Jens Taproggea93963a2012-09-27 12:37:35 +0200333 for (i = 0; i < TPCI200_NB_SLOT; i++)
Jens Taprogge28086cb2012-09-11 13:34:54 +0200334 writew(slot_ctrl, &tpci200->info->interface_regs->control[i]);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200335
336 res = request_irq(tpci200->info->pdev->irq,
337 tpci200_interrupt, IRQF_SHARED,
Samuel Iglesias Gonsalvezc63a7dd2012-05-18 11:10:07 +0200338 KBUILD_MODNAME, (void *) tpci200);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200339 if (res) {
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +0200340 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);
Samuel Iglesias Gonsalvez862fe872012-05-23 15:54:40 +0200344 goto out_release_ioid_int_space;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200345 }
346
347 return 0;
348
Jens Taprogge48a97352012-09-27 12:37:37 +0200349out_release_mem8_space:
350 pci_release_region(tpci200->info->pdev, TPCI200_MEM8_SPACE_BAR);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200351out_release_ioid_int_space:
352 pci_release_region(tpci200->info->pdev, TPCI200_IO_ID_INT_SPACES_BAR);
353out_release_ip_space:
354 pci_release_region(tpci200->info->pdev, TPCI200_IP_INTERFACE_BAR);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200355out_disable_pci:
356 pci_disable_device(tpci200->info->pdev);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200357 return res;
358}
359
Jens Taproggeeb12d882012-09-11 13:34:56 +0200360static int tpci200_get_clockrate(struct ipack_device *dev)
361{
362 struct tpci200_board *tpci200 = check_slot(dev);
Jens Taprogge7dd73b82012-09-12 14:55:46 +0200363 __le16 __iomem *addr;
Jens Taproggeeb12d882012-09-11 13:34:56 +0200364
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
372static int tpci200_set_clockrate(struct ipack_device *dev, int mherz)
373{
374 struct tpci200_board *tpci200 = check_slot(dev);
Jens Taprogge7dd73b82012-09-12 14:55:46 +0200375 __le16 __iomem *addr;
Jens Taproggeeb12d882012-09-11 13:34:56 +0200376
377 if (!tpci200)
378 return -ENODEV;
379
380 addr = &tpci200->info->interface_regs->control[dev->slot];
381
Jens Taproggeeb12d882012-09-11 13:34:56 +0200382 switch (mherz) {
383 case 8:
Jens Taprogge01186812012-09-12 14:55:23 +0200384 tpci200_clear_mask(tpci200, addr, TPCI200_CLK32);
Jens Taproggeeb12d882012-09-11 13:34:56 +0200385 break;
386 case 32:
Jens Taprogge01186812012-09-12 14:55:23 +0200387 tpci200_set_mask(tpci200, addr, TPCI200_CLK32);
Jens Taproggeeb12d882012-09-11 13:34:56 +0200388 break;
389 default:
Jens Taproggeeb12d882012-09-11 13:34:56 +0200390 return -EINVAL;
391 }
Jens Taproggeeb12d882012-09-11 13:34:56 +0200392 return 0;
393}
394
395static int tpci200_get_error(struct ipack_device *dev)
396{
397 struct tpci200_board *tpci200 = check_slot(dev);
Jens Taprogge7dd73b82012-09-12 14:55:46 +0200398 __le16 __iomem *addr;
Jens Taproggeeb12d882012-09-11 13:34:56 +0200399 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
409static int tpci200_get_timeout(struct ipack_device *dev)
410{
411 struct tpci200_board *tpci200 = check_slot(dev);
Jens Taprogge7dd73b82012-09-12 14:55:46 +0200412 __le16 __iomem *addr;
Jens Taproggeeb12d882012-09-11 13:34:56 +0200413 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
424static int tpci200_reset_timeout(struct ipack_device *dev)
425{
426 struct tpci200_board *tpci200 = check_slot(dev);
Jens Taprogge7dd73b82012-09-12 14:55:46 +0200427 __le16 __iomem *addr;
Jens Taproggeeb12d882012-09-11 13:34:56 +0200428 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
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200440static void tpci200_uninstall(struct tpci200_board *tpci200)
441{
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200442 tpci200_unregister(tpci200);
443 kfree(tpci200->slots);
444}
445
Stephen Hemminger9869a932012-09-10 11:14:01 -0700446static const struct ipack_bus_ops tpci200_bus_ops = {
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200447 .request_irq = tpci200_request_irq,
448 .free_irq = tpci200_free_irq,
Jens Taproggeeb12d882012-09-11 13:34:56 +0200449 .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,
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200454};
455
456static 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);
Miguel Gómezec0ceb92012-06-07 10:24:54 +0200462 if (tpci200->slots == NULL)
463 return -ENOMEM;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200464
465 res = tpci200_register(tpci200);
Miguel Gómezec0ceb92012-06-07 10:24:54 +0200466 if (res) {
467 kfree(tpci200->slots);
468 tpci200->slots = NULL;
469 return res;
470 }
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200471
472 mutex_init(&tpci200->mutex);
473 return 0;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200474}
475
Jens Taprogge1e917952012-09-27 12:37:26 +0200476static void tpci200_release_device(struct ipack_device *dev)
477{
478 kfree(dev);
479}
480
481static int tpci200_create_device(struct tpci200_board *tpci200, int i)
482{
Jens Taproggea19ad7d2012-09-27 12:37:31 +0200483 enum ipack_space space;
Jens Taprogge1e917952012-09-27 12:37:26 +0200484 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;
Jens Taproggea19ad7d2012-09-27 12:37:31 +0200491
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 }
Jens Taprogge1e917952012-09-27 12:37:26 +0200498 return ipack_device_register(dev);
499}
500
Stephen Hemminger20659452012-09-07 08:50:54 -0700501static int tpci200_pci_probe(struct pci_dev *pdev,
502 const struct pci_device_id *id)
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200503{
Samuel Iglesias Gonsalvez862fe872012-05-23 15:54:40 +0200504 int ret, i;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200505 struct tpci200_board *tpci200;
Jens Taproggeeb12d882012-09-11 13:34:56 +0200506 u32 reg32;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200507
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) {
Jens Taprogge5e15a752012-09-04 17:01:06 +0200514 ret = -ENOMEM;
515 goto out_err_info;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200516 }
517
Samuel Iglesias Gonsálvezb442bf72012-09-11 13:35:05 +0200518 pci_dev_get(pdev);
519
Jens Taproggecea2f7c2012-09-04 17:01:07 +0200520 /* 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
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200548 /* 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) {
Jens Taprogge5e15a752012-09-04 17:01:06 +0200555 dev_err(&pdev->dev, "error during tpci200 install\n");
556 ret = -ENODEV;
557 goto out_err_install;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200558 }
559
Samuel Iglesias Gonsalvezec440332012-05-18 11:10:05 +0200560 /* 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) {
Samuel Iglesias Gonsalveza23d3202012-05-25 13:08:12 +0200565 dev_err(&pdev->dev,
566 "error registering the carrier on ipack driver\n");
Jens Taprogge5e15a752012-09-04 17:01:06 +0200567 ret = -EFAULT;
568 goto out_err_bus_register;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200569 }
Samuel Iglesias Gonsalvezec440332012-05-18 11:10:05 +0200570
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200571 /* save the bus number given by ipack to logging purpose */
Samuel Iglesias Gonsalvezec440332012-05-18 11:10:05 +0200572 tpci200->number = tpci200->info->ipack_bus->bus_nr;
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200573 dev_set_drvdata(&pdev->dev, tpci200);
Samuel Iglesias Gonsalvez862fe872012-05-23 15:54:40 +0200574
Samuel Iglesias Gonsalvez862fe872012-05-23 15:54:40 +0200575 for (i = 0; i < TPCI200_NB_SLOT; i++)
Jens Taprogge1e917952012-09-27 12:37:26 +0200576 tpci200_create_device(tpci200, i);
Jens Taprogge5e15a752012-09-04 17:01:06 +0200577 return 0;
578
579out_err_bus_register:
580 tpci200_uninstall(tpci200);
581out_err_install:
Jens Taproggecea2f7c2012-09-04 17:01:07 +0200582 iounmap(tpci200->info->cfg_regs);
583out_err_ioremap:
584 pci_release_region(pdev, TPCI200_CFG_MEM_BAR);
585out_err_pci_request:
Samuel Iglesias Gonsálvezb442bf72012-09-11 13:35:05 +0200586 pci_dev_put(pdev);
Jens Taprogge5e15a752012-09-04 17:01:06 +0200587 kfree(tpci200->info);
588out_err_info:
589 kfree(tpci200);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200590 return ret;
591}
592
593static void __tpci200_pci_remove(struct tpci200_board *tpci200)
594{
Samuel Iglesias Gonsalvezec440332012-05-18 11:10:05 +0200595 ipack_bus_unregister(tpci200->info->ipack_bus);
Samuel Iglesias Gonsálvez9c0d1692012-09-11 13:35:10 +0200596 tpci200_uninstall(tpci200);
Jens Taproggecea2f7c2012-09-04 17:01:07 +0200597
Samuel Iglesias Gonsalvezec440332012-05-18 11:10:05 +0200598 kfree(tpci200->info);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200599 kfree(tpci200);
600}
601
Bill Pemberton29c35442012-11-19 13:26:39 -0500602static void tpci200_pci_remove(struct pci_dev *dev)
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200603{
Samuel Iglesias Gonsálvezf45651f2012-07-20 09:39:04 +0200604 struct tpci200_board *tpci200 = pci_get_drvdata(dev);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200605
Samuel Iglesias Gonsálvezf45651f2012-07-20 09:39:04 +0200606 __tpci200_pci_remove(tpci200);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200607}
608
Miguel Gómez39535032012-06-07 10:24:58 +0200609static DEFINE_PCI_DEVICE_TABLE(tpci200_idtable) = {
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200610 { TPCI200_VENDOR_ID, TPCI200_DEVICE_ID, TPCI200_SUBVENDOR_ID,
611 TPCI200_SUBDEVICE_ID },
612 { 0, },
613};
614
Miguel Gómez39535032012-06-07 10:24:58 +0200615MODULE_DEVICE_TABLE(pci, tpci200_idtable);
616
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200617static struct pci_driver tpci200_pci_drv = {
618 .name = "tpci200",
619 .id_table = tpci200_idtable,
Stephen Hemminger20659452012-09-07 08:50:54 -0700620 .probe = tpci200_pci_probe,
Bill Pembertonc5dee462012-11-19 13:21:31 -0500621 .remove = tpci200_pci_remove,
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200622};
623
Wei Yongjun1bc7c1c2012-10-18 23:18:46 +0800624module_pci_driver(tpci200_pci_drv);
Samuel Iglesias Gonsalvez0eeca142012-05-09 15:27:20 +0200625
626MODULE_DESCRIPTION("TEWS TPCI-200 device driver");
627MODULE_LICENSE("GPL");