blob: 9c1aa4dc39c9051e95c9e1407d9ec335735bb1d8 [file] [log] [blame]
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001/*
2 * Support for the Tundra TSI148 VME-PCI Bridge Chip
3 *
Martyn Welch66bd8db2010-02-18 15:12:52 +00004 * Author: Martyn Welch <martyn.welch@ge.com>
5 * Copyright 2008 GE Intelligent Platforms Embedded Systems, Inc.
Martyn Welchd22b8ed2009-07-31 09:28:17 +01006 *
7 * Based on work by Tom Armistead and Ajit Prem
8 * Copyright 2004 Motorola Inc.
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
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
14 */
15
Martyn Welchd22b8ed2009-07-31 09:28:17 +010016#include <linux/module.h>
17#include <linux/moduleparam.h>
18#include <linux/mm.h>
19#include <linux/types.h>
20#include <linux/errno.h>
21#include <linux/proc_fs.h>
22#include <linux/pci.h>
23#include <linux/poll.h>
24#include <linux/dma-mapping.h>
25#include <linux/interrupt.h>
26#include <linux/spinlock.h>
Greg Kroah-Hartman6af783c2009-10-12 15:00:08 -070027#include <linux/sched.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090028#include <linux/slab.h>
Martyn Welch79463282010-03-22 14:58:57 +000029#include <linux/time.h>
30#include <linux/io.h>
31#include <linux/uaccess.h>
Martyn Welchac1a4f22012-03-22 13:27:30 +000032#include <linux/byteorder/generic.h>
Greg Kroah-Hartmandb3b9e92012-04-26 12:34:58 -070033#include <linux/vme.h>
Martyn Welchd22b8ed2009-07-31 09:28:17 +010034
Martyn Welchd22b8ed2009-07-31 09:28:17 +010035#include "../vme_bridge.h"
36#include "vme_tsi148.h"
37
Martyn Welchd22b8ed2009-07-31 09:28:17 +010038static int tsi148_probe(struct pci_dev *, const struct pci_device_id *);
39static void tsi148_remove(struct pci_dev *);
Martyn Welchd22b8ed2009-07-31 09:28:17 +010040
41
Martyn Welch29848ac2010-02-18 15:13:05 +000042/* Module parameter */
Rusty Russell90ab5ee2012-01-13 09:32:20 +103043static bool err_chk;
Martyn Welch638f1992009-12-15 08:42:49 +000044static int geoid;
Martyn Welchd22b8ed2009-07-31 09:28:17 +010045
Vincent Bossier584721c2011-06-03 10:07:39 +010046static const char driver_name[] = "vme_tsi148";
Martyn Welchd22b8ed2009-07-31 09:28:17 +010047
Namhyung Kim270b64b2010-12-10 01:40:29 +090048static DEFINE_PCI_DEVICE_TABLE(tsi148_ids) = {
Martyn Welchd22b8ed2009-07-31 09:28:17 +010049 { PCI_DEVICE(PCI_VENDOR_ID_TUNDRA, PCI_DEVICE_ID_TUNDRA_TSI148) },
50 { },
51};
52
53static struct pci_driver tsi148_driver = {
54 .name = driver_name,
55 .id_table = tsi148_ids,
56 .probe = tsi148_probe,
57 .remove = tsi148_remove,
58};
59
60static void reg_join(unsigned int high, unsigned int low,
61 unsigned long long *variable)
62{
63 *variable = (unsigned long long)high << 32;
64 *variable |= (unsigned long long)low;
65}
66
67static void reg_split(unsigned long long variable, unsigned int *high,
68 unsigned int *low)
69{
70 *low = (unsigned int)variable & 0xFFFFFFFF;
71 *high = (unsigned int)(variable >> 32);
72}
73
74/*
75 * Wakes up DMA queue.
76 */
Martyn Welch29848ac2010-02-18 15:13:05 +000077static u32 tsi148_DMA_irqhandler(struct tsi148_driver *bridge,
78 int channel_mask)
Martyn Welchd22b8ed2009-07-31 09:28:17 +010079{
80 u32 serviced = 0;
81
82 if (channel_mask & TSI148_LCSR_INTS_DMA0S) {
Emilio G. Cota886953e2010-11-12 11:14:07 +000083 wake_up(&bridge->dma_queue[0]);
Martyn Welchd22b8ed2009-07-31 09:28:17 +010084 serviced |= TSI148_LCSR_INTC_DMA0C;
85 }
86 if (channel_mask & TSI148_LCSR_INTS_DMA1S) {
Emilio G. Cota886953e2010-11-12 11:14:07 +000087 wake_up(&bridge->dma_queue[1]);
Martyn Welchd22b8ed2009-07-31 09:28:17 +010088 serviced |= TSI148_LCSR_INTC_DMA1C;
89 }
90
91 return serviced;
92}
93
94/*
95 * Wake up location monitor queue
96 */
Martyn Welch29848ac2010-02-18 15:13:05 +000097static u32 tsi148_LM_irqhandler(struct tsi148_driver *bridge, u32 stat)
Martyn Welchd22b8ed2009-07-31 09:28:17 +010098{
99 int i;
100 u32 serviced = 0;
101
102 for (i = 0; i < 4; i++) {
Martyn Welch79463282010-03-22 14:58:57 +0000103 if (stat & TSI148_LCSR_INTS_LMS[i]) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100104 /* We only enable interrupts if the callback is set */
Martyn Welch29848ac2010-02-18 15:13:05 +0000105 bridge->lm_callback[i](i);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100106 serviced |= TSI148_LCSR_INTC_LMC[i];
107 }
108 }
109
110 return serviced;
111}
112
113/*
114 * Wake up mail box queue.
115 *
116 * XXX This functionality is not exposed up though API.
117 */
Martyn Welch48d9356e2010-03-22 14:58:50 +0000118static u32 tsi148_MB_irqhandler(struct vme_bridge *tsi148_bridge, u32 stat)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100119{
120 int i;
121 u32 val;
122 u32 serviced = 0;
Martyn Welch48d9356e2010-03-22 14:58:50 +0000123 struct tsi148_driver *bridge;
124
125 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100126
127 for (i = 0; i < 4; i++) {
Martyn Welch79463282010-03-22 14:58:57 +0000128 if (stat & TSI148_LCSR_INTS_MBS[i]) {
Martyn Welch29848ac2010-02-18 15:13:05 +0000129 val = ioread32be(bridge->base + TSI148_GCSR_MBOX[i]);
Martyn Welch48d9356e2010-03-22 14:58:50 +0000130 dev_err(tsi148_bridge->parent, "VME Mailbox %d received"
131 ": 0x%x\n", i, val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100132 serviced |= TSI148_LCSR_INTC_MBC[i];
133 }
134 }
135
136 return serviced;
137}
138
139/*
140 * Display error & status message when PERR (PCI) exception interrupt occurs.
141 */
Martyn Welch48d9356e2010-03-22 14:58:50 +0000142static u32 tsi148_PERR_irqhandler(struct vme_bridge *tsi148_bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100143{
Martyn Welch48d9356e2010-03-22 14:58:50 +0000144 struct tsi148_driver *bridge;
145
146 bridge = tsi148_bridge->driver_priv;
147
148 dev_err(tsi148_bridge->parent, "PCI Exception at address: 0x%08x:%08x, "
149 "attributes: %08x\n",
Martyn Welch29848ac2010-02-18 15:13:05 +0000150 ioread32be(bridge->base + TSI148_LCSR_EDPAU),
151 ioread32be(bridge->base + TSI148_LCSR_EDPAL),
Martyn Welch48d9356e2010-03-22 14:58:50 +0000152 ioread32be(bridge->base + TSI148_LCSR_EDPAT));
153
154 dev_err(tsi148_bridge->parent, "PCI-X attribute reg: %08x, PCI-X split "
155 "completion reg: %08x\n",
Martyn Welch29848ac2010-02-18 15:13:05 +0000156 ioread32be(bridge->base + TSI148_LCSR_EDPXA),
Martyn Welch48d9356e2010-03-22 14:58:50 +0000157 ioread32be(bridge->base + TSI148_LCSR_EDPXS));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100158
Martyn Welch29848ac2010-02-18 15:13:05 +0000159 iowrite32be(TSI148_LCSR_EDPAT_EDPCL, bridge->base + TSI148_LCSR_EDPAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100160
161 return TSI148_LCSR_INTC_PERRC;
162}
163
164/*
165 * Save address and status when VME error interrupt occurs.
166 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000167static u32 tsi148_VERR_irqhandler(struct vme_bridge *tsi148_bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100168{
169 unsigned int error_addr_high, error_addr_low;
170 unsigned long long error_addr;
171 u32 error_attrib;
172 struct vme_bus_error *error;
Martyn Welch29848ac2010-02-18 15:13:05 +0000173 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100174
Martyn Welch29848ac2010-02-18 15:13:05 +0000175 bridge = tsi148_bridge->driver_priv;
176
177 error_addr_high = ioread32be(bridge->base + TSI148_LCSR_VEAU);
178 error_addr_low = ioread32be(bridge->base + TSI148_LCSR_VEAL);
179 error_attrib = ioread32be(bridge->base + TSI148_LCSR_VEAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100180
181 reg_join(error_addr_high, error_addr_low, &error_addr);
182
183 /* Check for exception register overflow (we have lost error data) */
Martyn Welch79463282010-03-22 14:58:57 +0000184 if (error_attrib & TSI148_LCSR_VEAT_VEOF) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000185 dev_err(tsi148_bridge->parent, "VME Bus Exception Overflow "
186 "Occurred\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100187 }
188
Martyn Welch79463282010-03-22 14:58:57 +0000189 error = kmalloc(sizeof(struct vme_bus_error), GFP_ATOMIC);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100190 if (error) {
191 error->address = error_addr;
192 error->attributes = error_attrib;
Emilio G. Cota886953e2010-11-12 11:14:07 +0000193 list_add_tail(&error->list, &tsi148_bridge->vme_errors);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100194 } else {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000195 dev_err(tsi148_bridge->parent, "Unable to alloc memory for "
196 "VMEbus Error reporting\n");
197 dev_err(tsi148_bridge->parent, "VME Bus Error at address: "
198 "0x%llx, attributes: %08x\n", error_addr, error_attrib);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100199 }
200
201 /* Clear Status */
Martyn Welch29848ac2010-02-18 15:13:05 +0000202 iowrite32be(TSI148_LCSR_VEAT_VESCL, bridge->base + TSI148_LCSR_VEAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100203
204 return TSI148_LCSR_INTC_VERRC;
205}
206
207/*
208 * Wake up IACK queue.
209 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000210static u32 tsi148_IACK_irqhandler(struct tsi148_driver *bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100211{
Emilio G. Cota886953e2010-11-12 11:14:07 +0000212 wake_up(&bridge->iack_queue);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100213
214 return TSI148_LCSR_INTC_IACKC;
215}
216
217/*
218 * Calling VME bus interrupt callback if provided.
219 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000220static u32 tsi148_VIRQ_irqhandler(struct vme_bridge *tsi148_bridge,
221 u32 stat)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100222{
223 int vec, i, serviced = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +0000224 struct tsi148_driver *bridge;
225
226 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100227
228 for (i = 7; i > 0; i--) {
229 if (stat & (1 << i)) {
230 /*
Martyn Welch79463282010-03-22 14:58:57 +0000231 * Note: Even though the registers are defined as
232 * 32-bits in the spec, we only want to issue 8-bit
233 * IACK cycles on the bus, read from offset 3.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100234 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000235 vec = ioread8(bridge->base + TSI148_LCSR_VIACK[i] + 3);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100236
Martyn Welchc813f592009-10-29 16:34:54 +0000237 vme_irq_handler(tsi148_bridge, i, vec);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100238
239 serviced |= (1 << i);
240 }
241 }
242
243 return serviced;
244}
245
246/*
247 * Top level interrupt handler. Clears appropriate interrupt status bits and
248 * then calls appropriate sub handler(s).
249 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000250static irqreturn_t tsi148_irqhandler(int irq, void *ptr)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100251{
252 u32 stat, enable, serviced = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +0000253 struct vme_bridge *tsi148_bridge;
254 struct tsi148_driver *bridge;
255
256 tsi148_bridge = ptr;
257
258 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100259
260 /* Determine which interrupts are unmasked and set */
Martyn Welch29848ac2010-02-18 15:13:05 +0000261 enable = ioread32be(bridge->base + TSI148_LCSR_INTEO);
262 stat = ioread32be(bridge->base + TSI148_LCSR_INTS);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100263
264 /* Only look at unmasked interrupts */
265 stat &= enable;
266
Martyn Welch79463282010-03-22 14:58:57 +0000267 if (unlikely(!stat))
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100268 return IRQ_NONE;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100269
270 /* Call subhandlers as appropriate */
271 /* DMA irqs */
272 if (stat & (TSI148_LCSR_INTS_DMA1S | TSI148_LCSR_INTS_DMA0S))
Martyn Welch29848ac2010-02-18 15:13:05 +0000273 serviced |= tsi148_DMA_irqhandler(bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100274
275 /* Location monitor irqs */
276 if (stat & (TSI148_LCSR_INTS_LM3S | TSI148_LCSR_INTS_LM2S |
277 TSI148_LCSR_INTS_LM1S | TSI148_LCSR_INTS_LM0S))
Martyn Welch29848ac2010-02-18 15:13:05 +0000278 serviced |= tsi148_LM_irqhandler(bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100279
280 /* Mail box irqs */
281 if (stat & (TSI148_LCSR_INTS_MB3S | TSI148_LCSR_INTS_MB2S |
282 TSI148_LCSR_INTS_MB1S | TSI148_LCSR_INTS_MB0S))
Martyn Welch48d9356e2010-03-22 14:58:50 +0000283 serviced |= tsi148_MB_irqhandler(tsi148_bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100284
285 /* PCI bus error */
286 if (stat & TSI148_LCSR_INTS_PERRS)
Martyn Welch48d9356e2010-03-22 14:58:50 +0000287 serviced |= tsi148_PERR_irqhandler(tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100288
289 /* VME bus error */
290 if (stat & TSI148_LCSR_INTS_VERRS)
Martyn Welch29848ac2010-02-18 15:13:05 +0000291 serviced |= tsi148_VERR_irqhandler(tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100292
293 /* IACK irq */
294 if (stat & TSI148_LCSR_INTS_IACKS)
Martyn Welch29848ac2010-02-18 15:13:05 +0000295 serviced |= tsi148_IACK_irqhandler(bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100296
297 /* VME bus irqs */
298 if (stat & (TSI148_LCSR_INTS_IRQ7S | TSI148_LCSR_INTS_IRQ6S |
299 TSI148_LCSR_INTS_IRQ5S | TSI148_LCSR_INTS_IRQ4S |
300 TSI148_LCSR_INTS_IRQ3S | TSI148_LCSR_INTS_IRQ2S |
301 TSI148_LCSR_INTS_IRQ1S))
Martyn Welch29848ac2010-02-18 15:13:05 +0000302 serviced |= tsi148_VIRQ_irqhandler(tsi148_bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100303
304 /* Clear serviced interrupts */
Martyn Welch29848ac2010-02-18 15:13:05 +0000305 iowrite32be(serviced, bridge->base + TSI148_LCSR_INTC);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100306
307 return IRQ_HANDLED;
308}
309
Martyn Welch29848ac2010-02-18 15:13:05 +0000310static int tsi148_irq_init(struct vme_bridge *tsi148_bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100311{
312 int result;
313 unsigned int tmp;
314 struct pci_dev *pdev;
Martyn Welch29848ac2010-02-18 15:13:05 +0000315 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100316
Martyn Welch29848ac2010-02-18 15:13:05 +0000317 pdev = container_of(tsi148_bridge->parent, struct pci_dev, dev);
318
319 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100320
321 /* Initialise list for VME bus errors */
Emilio G. Cota886953e2010-11-12 11:14:07 +0000322 INIT_LIST_HEAD(&tsi148_bridge->vme_errors);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100323
Emilio G. Cota886953e2010-11-12 11:14:07 +0000324 mutex_init(&tsi148_bridge->irq_mtx);
Martyn Welchc813f592009-10-29 16:34:54 +0000325
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100326 result = request_irq(pdev->irq,
327 tsi148_irqhandler,
328 IRQF_SHARED,
Martyn Welch29848ac2010-02-18 15:13:05 +0000329 driver_name, tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100330 if (result) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000331 dev_err(tsi148_bridge->parent, "Can't get assigned pci irq "
332 "vector %02X\n", pdev->irq);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100333 return result;
334 }
335
336 /* Enable and unmask interrupts */
337 tmp = TSI148_LCSR_INTEO_DMA1EO | TSI148_LCSR_INTEO_DMA0EO |
338 TSI148_LCSR_INTEO_MB3EO | TSI148_LCSR_INTEO_MB2EO |
339 TSI148_LCSR_INTEO_MB1EO | TSI148_LCSR_INTEO_MB0EO |
340 TSI148_LCSR_INTEO_PERREO | TSI148_LCSR_INTEO_VERREO |
341 TSI148_LCSR_INTEO_IACKEO;
342
Martyn Welch29848ac2010-02-18 15:13:05 +0000343 /* This leaves the following interrupts masked.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100344 * TSI148_LCSR_INTEO_VIEEO
345 * TSI148_LCSR_INTEO_SYSFLEO
346 * TSI148_LCSR_INTEO_ACFLEO
347 */
348
349 /* Don't enable Location Monitor interrupts here - they will be
350 * enabled when the location monitors are properly configured and
351 * a callback has been attached.
352 * TSI148_LCSR_INTEO_LM0EO
353 * TSI148_LCSR_INTEO_LM1EO
354 * TSI148_LCSR_INTEO_LM2EO
355 * TSI148_LCSR_INTEO_LM3EO
356 */
357
358 /* Don't enable VME interrupts until we add a handler, else the board
359 * will respond to it and we don't want that unless it knows how to
360 * properly deal with it.
361 * TSI148_LCSR_INTEO_IRQ7EO
362 * TSI148_LCSR_INTEO_IRQ6EO
363 * TSI148_LCSR_INTEO_IRQ5EO
364 * TSI148_LCSR_INTEO_IRQ4EO
365 * TSI148_LCSR_INTEO_IRQ3EO
366 * TSI148_LCSR_INTEO_IRQ2EO
367 * TSI148_LCSR_INTEO_IRQ1EO
368 */
369
370 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
371 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
372
373 return 0;
374}
375
Emilio G. Cotaa82ad052010-11-12 11:14:47 +0000376static void tsi148_irq_exit(struct vme_bridge *tsi148_bridge,
377 struct pci_dev *pdev)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100378{
Emilio G. Cotaa82ad052010-11-12 11:14:47 +0000379 struct tsi148_driver *bridge = tsi148_bridge->driver_priv;
380
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100381 /* Turn off interrupts */
Martyn Welch29848ac2010-02-18 15:13:05 +0000382 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTEO);
383 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100384
385 /* Clear all interrupts */
Martyn Welch29848ac2010-02-18 15:13:05 +0000386 iowrite32be(0xFFFFFFFF, bridge->base + TSI148_LCSR_INTC);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100387
388 /* Detach interrupt handler */
Emilio G. Cotaa82ad052010-11-12 11:14:47 +0000389 free_irq(pdev->irq, tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100390}
391
392/*
393 * Check to see if an IACk has been received, return true (1) or false (0).
394 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000395static int tsi148_iack_received(struct tsi148_driver *bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100396{
397 u32 tmp;
398
Martyn Welch29848ac2010-02-18 15:13:05 +0000399 tmp = ioread32be(bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100400
401 if (tmp & TSI148_LCSR_VICR_IRQS)
402 return 0;
403 else
404 return 1;
405}
406
407/*
Martyn Welchc813f592009-10-29 16:34:54 +0000408 * Configure VME interrupt
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100409 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000410static void tsi148_irq_set(struct vme_bridge *tsi148_bridge, int level,
Martyn Welch29848ac2010-02-18 15:13:05 +0000411 int state, int sync)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100412{
Martyn Welch75155022009-08-11 13:50:49 +0100413 struct pci_dev *pdev;
Martyn Welchc813f592009-10-29 16:34:54 +0000414 u32 tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +0000415 struct tsi148_driver *bridge;
416
417 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100418
Martyn Welchc813f592009-10-29 16:34:54 +0000419 /* We need to do the ordering differently for enabling and disabling */
420 if (state == 0) {
Martyn Welch29848ac2010-02-18 15:13:05 +0000421 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100422 tmp &= ~TSI148_LCSR_INTEN_IRQEN[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000423 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchdf455172009-08-05 17:38:31 +0100424
Martyn Welch29848ac2010-02-18 15:13:05 +0000425 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchdf455172009-08-05 17:38:31 +0100426 tmp &= ~TSI148_LCSR_INTEO_IRQEO[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000427 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welch75155022009-08-11 13:50:49 +0100428
Martyn Welchc813f592009-10-29 16:34:54 +0000429 if (sync != 0) {
430 pdev = container_of(tsi148_bridge->parent,
431 struct pci_dev, dev);
Martyn Welch75155022009-08-11 13:50:49 +0100432
Martyn Welchc813f592009-10-29 16:34:54 +0000433 synchronize_irq(pdev->irq);
434 }
435 } else {
Martyn Welch29848ac2010-02-18 15:13:05 +0000436 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchc813f592009-10-29 16:34:54 +0000437 tmp |= TSI148_LCSR_INTEO_IRQEO[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000438 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welchc813f592009-10-29 16:34:54 +0000439
Martyn Welch29848ac2010-02-18 15:13:05 +0000440 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchc813f592009-10-29 16:34:54 +0000441 tmp |= TSI148_LCSR_INTEN_IRQEN[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000442 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100443 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100444}
445
446/*
447 * Generate a VME bus interrupt at the requested level & vector. Wait for
448 * interrupt to be acked.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100449 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000450static int tsi148_irq_generate(struct vme_bridge *tsi148_bridge, int level,
451 int statid)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100452{
453 u32 tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +0000454 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100455
Martyn Welch29848ac2010-02-18 15:13:05 +0000456 bridge = tsi148_bridge->driver_priv;
457
Emilio G. Cota886953e2010-11-12 11:14:07 +0000458 mutex_lock(&bridge->vme_int);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100459
460 /* Read VICR register */
Martyn Welch29848ac2010-02-18 15:13:05 +0000461 tmp = ioread32be(bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100462
463 /* Set Status/ID */
464 tmp = (tmp & ~TSI148_LCSR_VICR_STID_M) |
465 (statid & TSI148_LCSR_VICR_STID_M);
Martyn Welch29848ac2010-02-18 15:13:05 +0000466 iowrite32be(tmp, bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100467
468 /* Assert VMEbus IRQ */
469 tmp = tmp | TSI148_LCSR_VICR_IRQL[level];
Martyn Welch29848ac2010-02-18 15:13:05 +0000470 iowrite32be(tmp, bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100471
472 /* XXX Consider implementing a timeout? */
Martyn Welch29848ac2010-02-18 15:13:05 +0000473 wait_event_interruptible(bridge->iack_queue,
474 tsi148_iack_received(bridge));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100475
Emilio G. Cota886953e2010-11-12 11:14:07 +0000476 mutex_unlock(&bridge->vme_int);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100477
478 return 0;
479}
480
481/*
482 * Find the first error in this address range
483 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000484static struct vme_bus_error *tsi148_find_error(struct vme_bridge *tsi148_bridge,
Martyn Welch6af04b02011-12-01 17:06:29 +0000485 u32 aspace, unsigned long long address, size_t count)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100486{
487 struct list_head *err_pos;
488 struct vme_bus_error *vme_err, *valid = NULL;
489 unsigned long long bound;
490
491 bound = address + count;
492
493 /*
494 * XXX We are currently not looking at the address space when parsing
495 * for errors. This is because parsing the Address Modifier Codes
496 * is going to be quite resource intensive to do properly. We
497 * should be OK just looking at the addresses and this is certainly
498 * much better than what we had before.
499 */
500 err_pos = NULL;
501 /* Iterate through errors */
Emilio G. Cota886953e2010-11-12 11:14:07 +0000502 list_for_each(err_pos, &tsi148_bridge->vme_errors) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100503 vme_err = list_entry(err_pos, struct vme_bus_error, list);
Martyn Welch79463282010-03-22 14:58:57 +0000504 if ((vme_err->address >= address) &&
505 (vme_err->address < bound)) {
506
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100507 valid = vme_err;
508 break;
509 }
510 }
511
512 return valid;
513}
514
515/*
516 * Clear errors in the provided address range.
517 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000518static void tsi148_clear_errors(struct vme_bridge *tsi148_bridge,
Martyn Welch6af04b02011-12-01 17:06:29 +0000519 u32 aspace, unsigned long long address, size_t count)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100520{
521 struct list_head *err_pos, *temp;
522 struct vme_bus_error *vme_err;
523 unsigned long long bound;
524
525 bound = address + count;
526
527 /*
528 * XXX We are currently not looking at the address space when parsing
529 * for errors. This is because parsing the Address Modifier Codes
530 * is going to be quite resource intensive to do properly. We
531 * should be OK just looking at the addresses and this is certainly
532 * much better than what we had before.
533 */
534 err_pos = NULL;
535 /* Iterate through errors */
Emilio G. Cota886953e2010-11-12 11:14:07 +0000536 list_for_each_safe(err_pos, temp, &tsi148_bridge->vme_errors) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100537 vme_err = list_entry(err_pos, struct vme_bus_error, list);
538
Martyn Welch79463282010-03-22 14:58:57 +0000539 if ((vme_err->address >= address) &&
540 (vme_err->address < bound)) {
541
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100542 list_del(err_pos);
543 kfree(vme_err);
544 }
545 }
546}
547
548/*
549 * Initialize a slave window with the requested attributes.
550 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000551static int tsi148_slave_set(struct vme_slave_resource *image, int enabled,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100552 unsigned long long vme_base, unsigned long long size,
Martyn Welch6af04b02011-12-01 17:06:29 +0000553 dma_addr_t pci_base, u32 aspace, u32 cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100554{
555 unsigned int i, addr = 0, granularity = 0;
556 unsigned int temp_ctl = 0;
557 unsigned int vme_base_low, vme_base_high;
558 unsigned int vme_bound_low, vme_bound_high;
559 unsigned int pci_offset_low, pci_offset_high;
560 unsigned long long vme_bound, pci_offset;
Martyn Welch48d9356e2010-03-22 14:58:50 +0000561 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +0000562 struct tsi148_driver *bridge;
563
Martyn Welch48d9356e2010-03-22 14:58:50 +0000564 tsi148_bridge = image->parent;
565 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100566
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100567 i = image->number;
568
569 switch (aspace) {
570 case VME_A16:
571 granularity = 0x10;
572 addr |= TSI148_LCSR_ITAT_AS_A16;
573 break;
574 case VME_A24:
575 granularity = 0x1000;
576 addr |= TSI148_LCSR_ITAT_AS_A24;
577 break;
578 case VME_A32:
579 granularity = 0x10000;
580 addr |= TSI148_LCSR_ITAT_AS_A32;
581 break;
582 case VME_A64:
583 granularity = 0x10000;
584 addr |= TSI148_LCSR_ITAT_AS_A64;
585 break;
586 case VME_CRCSR:
587 case VME_USER1:
588 case VME_USER2:
589 case VME_USER3:
590 case VME_USER4:
591 default:
Martyn Welch48d9356e2010-03-22 14:58:50 +0000592 dev_err(tsi148_bridge->parent, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100593 return -EINVAL;
594 break;
595 }
596
597 /* Convert 64-bit variables to 2x 32-bit variables */
598 reg_split(vme_base, &vme_base_high, &vme_base_low);
599
600 /*
601 * Bound address is a valid address for the window, adjust
602 * accordingly
603 */
604 vme_bound = vme_base + size - granularity;
605 reg_split(vme_bound, &vme_bound_high, &vme_bound_low);
606 pci_offset = (unsigned long long)pci_base - vme_base;
607 reg_split(pci_offset, &pci_offset_high, &pci_offset_low);
608
609 if (vme_base_low & (granularity - 1)) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000610 dev_err(tsi148_bridge->parent, "Invalid VME base alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100611 return -EINVAL;
612 }
613 if (vme_bound_low & (granularity - 1)) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000614 dev_err(tsi148_bridge->parent, "Invalid VME bound alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100615 return -EINVAL;
616 }
617 if (pci_offset_low & (granularity - 1)) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000618 dev_err(tsi148_bridge->parent, "Invalid PCI Offset "
619 "alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100620 return -EINVAL;
621 }
622
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100623 /* Disable while we are mucking around */
Martyn Welch29848ac2010-02-18 15:13:05 +0000624 temp_ctl = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100625 TSI148_LCSR_OFFSET_ITAT);
626 temp_ctl &= ~TSI148_LCSR_ITAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +0000627 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100628 TSI148_LCSR_OFFSET_ITAT);
629
630 /* Setup mapping */
Martyn Welch29848ac2010-02-18 15:13:05 +0000631 iowrite32be(vme_base_high, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100632 TSI148_LCSR_OFFSET_ITSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000633 iowrite32be(vme_base_low, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100634 TSI148_LCSR_OFFSET_ITSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000635 iowrite32be(vme_bound_high, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100636 TSI148_LCSR_OFFSET_ITEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000637 iowrite32be(vme_bound_low, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100638 TSI148_LCSR_OFFSET_ITEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000639 iowrite32be(pci_offset_high, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100640 TSI148_LCSR_OFFSET_ITOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000641 iowrite32be(pci_offset_low, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100642 TSI148_LCSR_OFFSET_ITOFL);
643
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100644 /* Setup 2eSST speeds */
645 temp_ctl &= ~TSI148_LCSR_ITAT_2eSSTM_M;
646 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
647 case VME_2eSST160:
648 temp_ctl |= TSI148_LCSR_ITAT_2eSSTM_160;
649 break;
650 case VME_2eSST267:
651 temp_ctl |= TSI148_LCSR_ITAT_2eSSTM_267;
652 break;
653 case VME_2eSST320:
654 temp_ctl |= TSI148_LCSR_ITAT_2eSSTM_320;
655 break;
656 }
657
658 /* Setup cycle types */
659 temp_ctl &= ~(0x1F << 7);
660 if (cycle & VME_BLT)
661 temp_ctl |= TSI148_LCSR_ITAT_BLT;
662 if (cycle & VME_MBLT)
663 temp_ctl |= TSI148_LCSR_ITAT_MBLT;
664 if (cycle & VME_2eVME)
665 temp_ctl |= TSI148_LCSR_ITAT_2eVME;
666 if (cycle & VME_2eSST)
667 temp_ctl |= TSI148_LCSR_ITAT_2eSST;
668 if (cycle & VME_2eSSTB)
669 temp_ctl |= TSI148_LCSR_ITAT_2eSSTB;
670
671 /* Setup address space */
672 temp_ctl &= ~TSI148_LCSR_ITAT_AS_M;
673 temp_ctl |= addr;
674
675 temp_ctl &= ~0xF;
676 if (cycle & VME_SUPER)
677 temp_ctl |= TSI148_LCSR_ITAT_SUPR ;
678 if (cycle & VME_USER)
679 temp_ctl |= TSI148_LCSR_ITAT_NPRIV;
680 if (cycle & VME_PROG)
681 temp_ctl |= TSI148_LCSR_ITAT_PGM;
682 if (cycle & VME_DATA)
683 temp_ctl |= TSI148_LCSR_ITAT_DATA;
684
685 /* Write ctl reg without enable */
Martyn Welch29848ac2010-02-18 15:13:05 +0000686 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100687 TSI148_LCSR_OFFSET_ITAT);
688
689 if (enabled)
690 temp_ctl |= TSI148_LCSR_ITAT_EN;
691
Martyn Welch29848ac2010-02-18 15:13:05 +0000692 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100693 TSI148_LCSR_OFFSET_ITAT);
694
695 return 0;
696}
697
698/*
699 * Get slave window configuration.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100700 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000701static int tsi148_slave_get(struct vme_slave_resource *image, int *enabled,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100702 unsigned long long *vme_base, unsigned long long *size,
Martyn Welch6af04b02011-12-01 17:06:29 +0000703 dma_addr_t *pci_base, u32 *aspace, u32 *cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100704{
705 unsigned int i, granularity = 0, ctl = 0;
706 unsigned int vme_base_low, vme_base_high;
707 unsigned int vme_bound_low, vme_bound_high;
708 unsigned int pci_offset_low, pci_offset_high;
709 unsigned long long vme_bound, pci_offset;
Martyn Welch29848ac2010-02-18 15:13:05 +0000710 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100711
Martyn Welch29848ac2010-02-18 15:13:05 +0000712 bridge = image->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100713
714 i = image->number;
715
716 /* Read registers */
Martyn Welch29848ac2010-02-18 15:13:05 +0000717 ctl = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100718 TSI148_LCSR_OFFSET_ITAT);
719
Martyn Welch29848ac2010-02-18 15:13:05 +0000720 vme_base_high = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100721 TSI148_LCSR_OFFSET_ITSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000722 vme_base_low = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100723 TSI148_LCSR_OFFSET_ITSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000724 vme_bound_high = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100725 TSI148_LCSR_OFFSET_ITEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000726 vme_bound_low = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100727 TSI148_LCSR_OFFSET_ITEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000728 pci_offset_high = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100729 TSI148_LCSR_OFFSET_ITOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000730 pci_offset_low = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100731 TSI148_LCSR_OFFSET_ITOFL);
732
733 /* Convert 64-bit variables to 2x 32-bit variables */
734 reg_join(vme_base_high, vme_base_low, vme_base);
735 reg_join(vme_bound_high, vme_bound_low, &vme_bound);
736 reg_join(pci_offset_high, pci_offset_low, &pci_offset);
737
738 *pci_base = (dma_addr_t)vme_base + pci_offset;
739
740 *enabled = 0;
741 *aspace = 0;
742 *cycle = 0;
743
744 if (ctl & TSI148_LCSR_ITAT_EN)
745 *enabled = 1;
746
747 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A16) {
748 granularity = 0x10;
749 *aspace |= VME_A16;
750 }
751 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A24) {
752 granularity = 0x1000;
753 *aspace |= VME_A24;
754 }
755 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A32) {
756 granularity = 0x10000;
757 *aspace |= VME_A32;
758 }
759 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A64) {
760 granularity = 0x10000;
761 *aspace |= VME_A64;
762 }
763
764 /* Need granularity before we set the size */
765 *size = (unsigned long long)((vme_bound - *vme_base) + granularity);
766
767
768 if ((ctl & TSI148_LCSR_ITAT_2eSSTM_M) == TSI148_LCSR_ITAT_2eSSTM_160)
769 *cycle |= VME_2eSST160;
770 if ((ctl & TSI148_LCSR_ITAT_2eSSTM_M) == TSI148_LCSR_ITAT_2eSSTM_267)
771 *cycle |= VME_2eSST267;
772 if ((ctl & TSI148_LCSR_ITAT_2eSSTM_M) == TSI148_LCSR_ITAT_2eSSTM_320)
773 *cycle |= VME_2eSST320;
774
775 if (ctl & TSI148_LCSR_ITAT_BLT)
776 *cycle |= VME_BLT;
777 if (ctl & TSI148_LCSR_ITAT_MBLT)
778 *cycle |= VME_MBLT;
779 if (ctl & TSI148_LCSR_ITAT_2eVME)
780 *cycle |= VME_2eVME;
781 if (ctl & TSI148_LCSR_ITAT_2eSST)
782 *cycle |= VME_2eSST;
783 if (ctl & TSI148_LCSR_ITAT_2eSSTB)
784 *cycle |= VME_2eSSTB;
785
786 if (ctl & TSI148_LCSR_ITAT_SUPR)
787 *cycle |= VME_SUPER;
788 if (ctl & TSI148_LCSR_ITAT_NPRIV)
789 *cycle |= VME_USER;
790 if (ctl & TSI148_LCSR_ITAT_PGM)
791 *cycle |= VME_PROG;
792 if (ctl & TSI148_LCSR_ITAT_DATA)
793 *cycle |= VME_DATA;
794
795 return 0;
796}
797
798/*
799 * Allocate and map PCI Resource
800 */
801static int tsi148_alloc_resource(struct vme_master_resource *image,
802 unsigned long long size)
803{
804 unsigned long long existing_size;
805 int retval = 0;
806 struct pci_dev *pdev;
Martyn Welch29848ac2010-02-18 15:13:05 +0000807 struct vme_bridge *tsi148_bridge;
808
809 tsi148_bridge = image->parent;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100810
Martyn Welch48d9356e2010-03-22 14:58:50 +0000811 pdev = container_of(tsi148_bridge->parent, struct pci_dev, dev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100812
Martyn Welch8fafb472010-02-18 15:13:12 +0000813 existing_size = (unsigned long long)(image->bus_resource.end -
814 image->bus_resource.start);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100815
816 /* If the existing size is OK, return */
Martyn Welch59c22902009-10-29 16:35:01 +0000817 if ((size != 0) && (existing_size == (size - 1)))
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100818 return 0;
819
820 if (existing_size != 0) {
821 iounmap(image->kern_base);
822 image->kern_base = NULL;
Ilia Mirkin794a8942011-03-13 00:29:13 -0500823 kfree(image->bus_resource.name);
Emilio G. Cota886953e2010-11-12 11:14:07 +0000824 release_resource(&image->bus_resource);
825 memset(&image->bus_resource, 0, sizeof(struct resource));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100826 }
827
Martyn Welch59c22902009-10-29 16:35:01 +0000828 /* Exit here if size is zero */
Martyn Welch79463282010-03-22 14:58:57 +0000829 if (size == 0)
Martyn Welch59c22902009-10-29 16:35:01 +0000830 return 0;
Martyn Welch59c22902009-10-29 16:35:01 +0000831
Martyn Welch8fafb472010-02-18 15:13:12 +0000832 if (image->bus_resource.name == NULL) {
Julia Lawall0aa3f132010-05-30 22:27:46 +0200833 image->bus_resource.name = kmalloc(VMENAMSIZ+3, GFP_ATOMIC);
Martyn Welch8fafb472010-02-18 15:13:12 +0000834 if (image->bus_resource.name == NULL) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000835 dev_err(tsi148_bridge->parent, "Unable to allocate "
836 "memory for resource name\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100837 retval = -ENOMEM;
838 goto err_name;
839 }
840 }
841
Martyn Welch8fafb472010-02-18 15:13:12 +0000842 sprintf((char *)image->bus_resource.name, "%s.%d", tsi148_bridge->name,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100843 image->number);
844
Martyn Welch8fafb472010-02-18 15:13:12 +0000845 image->bus_resource.start = 0;
846 image->bus_resource.end = (unsigned long)size;
847 image->bus_resource.flags = IORESOURCE_MEM;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100848
849 retval = pci_bus_alloc_resource(pdev->bus,
Emilio G. Cota886953e2010-11-12 11:14:07 +0000850 &image->bus_resource, size, size, PCIBIOS_MIN_MEM,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100851 0, NULL, NULL);
852 if (retval) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000853 dev_err(tsi148_bridge->parent, "Failed to allocate mem "
854 "resource for window %d size 0x%lx start 0x%lx\n",
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100855 image->number, (unsigned long)size,
Martyn Welch8fafb472010-02-18 15:13:12 +0000856 (unsigned long)image->bus_resource.start);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100857 goto err_resource;
858 }
859
860 image->kern_base = ioremap_nocache(
Martyn Welch8fafb472010-02-18 15:13:12 +0000861 image->bus_resource.start, size);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100862 if (image->kern_base == NULL) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000863 dev_err(tsi148_bridge->parent, "Failed to remap resource\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100864 retval = -ENOMEM;
865 goto err_remap;
866 }
867
868 return 0;
869
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100870err_remap:
Emilio G. Cota886953e2010-11-12 11:14:07 +0000871 release_resource(&image->bus_resource);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100872err_resource:
Martyn Welch8fafb472010-02-18 15:13:12 +0000873 kfree(image->bus_resource.name);
Emilio G. Cota886953e2010-11-12 11:14:07 +0000874 memset(&image->bus_resource, 0, sizeof(struct resource));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100875err_name:
876 return retval;
877}
878
879/*
880 * Free and unmap PCI Resource
881 */
882static void tsi148_free_resource(struct vme_master_resource *image)
883{
884 iounmap(image->kern_base);
885 image->kern_base = NULL;
Emilio G. Cota886953e2010-11-12 11:14:07 +0000886 release_resource(&image->bus_resource);
Martyn Welch8fafb472010-02-18 15:13:12 +0000887 kfree(image->bus_resource.name);
Emilio G. Cota886953e2010-11-12 11:14:07 +0000888 memset(&image->bus_resource, 0, sizeof(struct resource));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100889}
890
891/*
892 * Set the attributes of an outbound window.
893 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000894static int tsi148_master_set(struct vme_master_resource *image, int enabled,
Martyn Welch6af04b02011-12-01 17:06:29 +0000895 unsigned long long vme_base, unsigned long long size, u32 aspace,
896 u32 cycle, u32 dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100897{
898 int retval = 0;
899 unsigned int i;
900 unsigned int temp_ctl = 0;
901 unsigned int pci_base_low, pci_base_high;
902 unsigned int pci_bound_low, pci_bound_high;
903 unsigned int vme_offset_low, vme_offset_high;
904 unsigned long long pci_bound, vme_offset, pci_base;
Martyn Welch48d9356e2010-03-22 14:58:50 +0000905 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +0000906 struct tsi148_driver *bridge;
907
Martyn Welch48d9356e2010-03-22 14:58:50 +0000908 tsi148_bridge = image->parent;
909
910 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100911
912 /* Verify input data */
913 if (vme_base & 0xFFFF) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000914 dev_err(tsi148_bridge->parent, "Invalid VME Window "
915 "alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100916 retval = -EINVAL;
917 goto err_window;
918 }
Martyn Welch59c22902009-10-29 16:35:01 +0000919
920 if ((size == 0) && (enabled != 0)) {
Martyn Welch48d9356e2010-03-22 14:58:50 +0000921 dev_err(tsi148_bridge->parent, "Size must be non-zero for "
922 "enabled windows\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100923 retval = -EINVAL;
924 goto err_window;
925 }
926
Emilio G. Cota886953e2010-11-12 11:14:07 +0000927 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100928
929 /* Let's allocate the resource here rather than further up the stack as
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300930 * it avoids pushing loads of bus dependent stuff up the stack. If size
Martyn Welch59c22902009-10-29 16:35:01 +0000931 * is zero, any existing resource will be freed.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100932 */
933 retval = tsi148_alloc_resource(image, size);
934 if (retval) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000935 spin_unlock(&image->lock);
Martyn Welch48d9356e2010-03-22 14:58:50 +0000936 dev_err(tsi148_bridge->parent, "Unable to allocate memory for "
Martyn Welch59c22902009-10-29 16:35:01 +0000937 "resource\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100938 goto err_res;
939 }
940
Martyn Welch59c22902009-10-29 16:35:01 +0000941 if (size == 0) {
942 pci_base = 0;
943 pci_bound = 0;
944 vme_offset = 0;
945 } else {
Martyn Welch8fafb472010-02-18 15:13:12 +0000946 pci_base = (unsigned long long)image->bus_resource.start;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100947
Martyn Welch59c22902009-10-29 16:35:01 +0000948 /*
949 * Bound address is a valid address for the window, adjust
950 * according to window granularity.
951 */
952 pci_bound = pci_base + (size - 0x10000);
953 vme_offset = vme_base - pci_base;
954 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100955
956 /* Convert 64-bit variables to 2x 32-bit variables */
957 reg_split(pci_base, &pci_base_high, &pci_base_low);
958 reg_split(pci_bound, &pci_bound_high, &pci_bound_low);
959 reg_split(vme_offset, &vme_offset_high, &vme_offset_low);
960
961 if (pci_base_low & 0xFFFF) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000962 spin_unlock(&image->lock);
Martyn Welch48d9356e2010-03-22 14:58:50 +0000963 dev_err(tsi148_bridge->parent, "Invalid PCI base alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100964 retval = -EINVAL;
965 goto err_gran;
966 }
967 if (pci_bound_low & 0xFFFF) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000968 spin_unlock(&image->lock);
Martyn Welch48d9356e2010-03-22 14:58:50 +0000969 dev_err(tsi148_bridge->parent, "Invalid PCI bound alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100970 retval = -EINVAL;
971 goto err_gran;
972 }
973 if (vme_offset_low & 0xFFFF) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000974 spin_unlock(&image->lock);
Martyn Welch48d9356e2010-03-22 14:58:50 +0000975 dev_err(tsi148_bridge->parent, "Invalid VME Offset "
976 "alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100977 retval = -EINVAL;
978 goto err_gran;
979 }
980
981 i = image->number;
982
983 /* Disable while we are mucking around */
Martyn Welch29848ac2010-02-18 15:13:05 +0000984 temp_ctl = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100985 TSI148_LCSR_OFFSET_OTAT);
986 temp_ctl &= ~TSI148_LCSR_OTAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +0000987 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100988 TSI148_LCSR_OFFSET_OTAT);
989
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100990 /* Setup 2eSST speeds */
991 temp_ctl &= ~TSI148_LCSR_OTAT_2eSSTM_M;
992 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
993 case VME_2eSST160:
994 temp_ctl |= TSI148_LCSR_OTAT_2eSSTM_160;
995 break;
996 case VME_2eSST267:
997 temp_ctl |= TSI148_LCSR_OTAT_2eSSTM_267;
998 break;
999 case VME_2eSST320:
1000 temp_ctl |= TSI148_LCSR_OTAT_2eSSTM_320;
1001 break;
1002 }
1003
1004 /* Setup cycle types */
1005 if (cycle & VME_BLT) {
1006 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1007 temp_ctl |= TSI148_LCSR_OTAT_TM_BLT;
1008 }
1009 if (cycle & VME_MBLT) {
1010 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1011 temp_ctl |= TSI148_LCSR_OTAT_TM_MBLT;
1012 }
1013 if (cycle & VME_2eVME) {
1014 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1015 temp_ctl |= TSI148_LCSR_OTAT_TM_2eVME;
1016 }
1017 if (cycle & VME_2eSST) {
1018 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1019 temp_ctl |= TSI148_LCSR_OTAT_TM_2eSST;
1020 }
1021 if (cycle & VME_2eSSTB) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00001022 dev_warn(tsi148_bridge->parent, "Currently not setting "
1023 "Broadcast Select Registers\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001024 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1025 temp_ctl |= TSI148_LCSR_OTAT_TM_2eSSTB;
1026 }
1027
1028 /* Setup data width */
1029 temp_ctl &= ~TSI148_LCSR_OTAT_DBW_M;
1030 switch (dwidth) {
1031 case VME_D16:
1032 temp_ctl |= TSI148_LCSR_OTAT_DBW_16;
1033 break;
1034 case VME_D32:
1035 temp_ctl |= TSI148_LCSR_OTAT_DBW_32;
1036 break;
1037 default:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001038 spin_unlock(&image->lock);
Martyn Welch48d9356e2010-03-22 14:58:50 +00001039 dev_err(tsi148_bridge->parent, "Invalid data width\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001040 retval = -EINVAL;
1041 goto err_dwidth;
1042 }
1043
1044 /* Setup address space */
1045 temp_ctl &= ~TSI148_LCSR_OTAT_AMODE_M;
1046 switch (aspace) {
1047 case VME_A16:
1048 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A16;
1049 break;
1050 case VME_A24:
1051 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A24;
1052 break;
1053 case VME_A32:
1054 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A32;
1055 break;
1056 case VME_A64:
1057 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A64;
1058 break;
1059 case VME_CRCSR:
1060 temp_ctl |= TSI148_LCSR_OTAT_AMODE_CRCSR;
1061 break;
1062 case VME_USER1:
1063 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER1;
1064 break;
1065 case VME_USER2:
1066 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER2;
1067 break;
1068 case VME_USER3:
1069 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER3;
1070 break;
1071 case VME_USER4:
1072 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER4;
1073 break;
1074 default:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001075 spin_unlock(&image->lock);
Martyn Welch48d9356e2010-03-22 14:58:50 +00001076 dev_err(tsi148_bridge->parent, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001077 retval = -EINVAL;
1078 goto err_aspace;
1079 break;
1080 }
1081
1082 temp_ctl &= ~(3<<4);
1083 if (cycle & VME_SUPER)
1084 temp_ctl |= TSI148_LCSR_OTAT_SUP;
1085 if (cycle & VME_PROG)
1086 temp_ctl |= TSI148_LCSR_OTAT_PGM;
1087
1088 /* Setup mapping */
Martyn Welch29848ac2010-02-18 15:13:05 +00001089 iowrite32be(pci_base_high, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001090 TSI148_LCSR_OFFSET_OTSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001091 iowrite32be(pci_base_low, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001092 TSI148_LCSR_OFFSET_OTSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001093 iowrite32be(pci_bound_high, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001094 TSI148_LCSR_OFFSET_OTEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001095 iowrite32be(pci_bound_low, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001096 TSI148_LCSR_OFFSET_OTEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001097 iowrite32be(vme_offset_high, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001098 TSI148_LCSR_OFFSET_OTOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001099 iowrite32be(vme_offset_low, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001100 TSI148_LCSR_OFFSET_OTOFL);
1101
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001102 /* Write ctl reg without enable */
Martyn Welch29848ac2010-02-18 15:13:05 +00001103 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001104 TSI148_LCSR_OFFSET_OTAT);
1105
1106 if (enabled)
1107 temp_ctl |= TSI148_LCSR_OTAT_EN;
1108
Martyn Welch29848ac2010-02-18 15:13:05 +00001109 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001110 TSI148_LCSR_OFFSET_OTAT);
1111
Emilio G. Cota886953e2010-11-12 11:14:07 +00001112 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001113 return 0;
1114
1115err_aspace:
1116err_dwidth:
1117err_gran:
1118 tsi148_free_resource(image);
1119err_res:
1120err_window:
1121 return retval;
1122
1123}
1124
1125/*
1126 * Set the attributes of an outbound window.
1127 *
1128 * XXX Not parsing prefetch information.
1129 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001130static int __tsi148_master_get(struct vme_master_resource *image, int *enabled,
Martyn Welch6af04b02011-12-01 17:06:29 +00001131 unsigned long long *vme_base, unsigned long long *size, u32 *aspace,
1132 u32 *cycle, u32 *dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001133{
1134 unsigned int i, ctl;
1135 unsigned int pci_base_low, pci_base_high;
1136 unsigned int pci_bound_low, pci_bound_high;
1137 unsigned int vme_offset_low, vme_offset_high;
1138
1139 unsigned long long pci_base, pci_bound, vme_offset;
Martyn Welch29848ac2010-02-18 15:13:05 +00001140 struct tsi148_driver *bridge;
1141
1142 bridge = image->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001143
1144 i = image->number;
1145
Martyn Welch29848ac2010-02-18 15:13:05 +00001146 ctl = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001147 TSI148_LCSR_OFFSET_OTAT);
1148
Martyn Welch29848ac2010-02-18 15:13:05 +00001149 pci_base_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001150 TSI148_LCSR_OFFSET_OTSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001151 pci_base_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001152 TSI148_LCSR_OFFSET_OTSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001153 pci_bound_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001154 TSI148_LCSR_OFFSET_OTEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001155 pci_bound_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001156 TSI148_LCSR_OFFSET_OTEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001157 vme_offset_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001158 TSI148_LCSR_OFFSET_OTOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001159 vme_offset_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001160 TSI148_LCSR_OFFSET_OTOFL);
1161
1162 /* Convert 64-bit variables to 2x 32-bit variables */
1163 reg_join(pci_base_high, pci_base_low, &pci_base);
1164 reg_join(pci_bound_high, pci_bound_low, &pci_bound);
1165 reg_join(vme_offset_high, vme_offset_low, &vme_offset);
1166
1167 *vme_base = pci_base + vme_offset;
1168 *size = (unsigned long long)(pci_bound - pci_base) + 0x10000;
1169
1170 *enabled = 0;
1171 *aspace = 0;
1172 *cycle = 0;
1173 *dwidth = 0;
1174
1175 if (ctl & TSI148_LCSR_OTAT_EN)
1176 *enabled = 1;
1177
1178 /* Setup address space */
1179 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A16)
1180 *aspace |= VME_A16;
1181 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A24)
1182 *aspace |= VME_A24;
1183 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A32)
1184 *aspace |= VME_A32;
1185 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A64)
1186 *aspace |= VME_A64;
1187 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_CRCSR)
1188 *aspace |= VME_CRCSR;
1189 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER1)
1190 *aspace |= VME_USER1;
1191 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER2)
1192 *aspace |= VME_USER2;
1193 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER3)
1194 *aspace |= VME_USER3;
1195 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER4)
1196 *aspace |= VME_USER4;
1197
1198 /* Setup 2eSST speeds */
1199 if ((ctl & TSI148_LCSR_OTAT_2eSSTM_M) == TSI148_LCSR_OTAT_2eSSTM_160)
1200 *cycle |= VME_2eSST160;
1201 if ((ctl & TSI148_LCSR_OTAT_2eSSTM_M) == TSI148_LCSR_OTAT_2eSSTM_267)
1202 *cycle |= VME_2eSST267;
1203 if ((ctl & TSI148_LCSR_OTAT_2eSSTM_M) == TSI148_LCSR_OTAT_2eSSTM_320)
1204 *cycle |= VME_2eSST320;
1205
1206 /* Setup cycle types */
Martyn Welch79463282010-03-22 14:58:57 +00001207 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_SCT)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001208 *cycle |= VME_SCT;
Martyn Welch79463282010-03-22 14:58:57 +00001209 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_BLT)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001210 *cycle |= VME_BLT;
Martyn Welch79463282010-03-22 14:58:57 +00001211 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_MBLT)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001212 *cycle |= VME_MBLT;
Martyn Welch79463282010-03-22 14:58:57 +00001213 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_2eVME)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001214 *cycle |= VME_2eVME;
Martyn Welch79463282010-03-22 14:58:57 +00001215 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_2eSST)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001216 *cycle |= VME_2eSST;
Martyn Welch79463282010-03-22 14:58:57 +00001217 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_2eSSTB)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001218 *cycle |= VME_2eSSTB;
1219
1220 if (ctl & TSI148_LCSR_OTAT_SUP)
1221 *cycle |= VME_SUPER;
1222 else
1223 *cycle |= VME_USER;
1224
1225 if (ctl & TSI148_LCSR_OTAT_PGM)
1226 *cycle |= VME_PROG;
1227 else
1228 *cycle |= VME_DATA;
1229
1230 /* Setup data width */
1231 if ((ctl & TSI148_LCSR_OTAT_DBW_M) == TSI148_LCSR_OTAT_DBW_16)
1232 *dwidth = VME_D16;
1233 if ((ctl & TSI148_LCSR_OTAT_DBW_M) == TSI148_LCSR_OTAT_DBW_32)
1234 *dwidth = VME_D32;
1235
1236 return 0;
1237}
1238
1239
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001240static int tsi148_master_get(struct vme_master_resource *image, int *enabled,
Martyn Welch6af04b02011-12-01 17:06:29 +00001241 unsigned long long *vme_base, unsigned long long *size, u32 *aspace,
1242 u32 *cycle, u32 *dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001243{
1244 int retval;
1245
Emilio G. Cota886953e2010-11-12 11:14:07 +00001246 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001247
1248 retval = __tsi148_master_get(image, enabled, vme_base, size, aspace,
1249 cycle, dwidth);
1250
Emilio G. Cota886953e2010-11-12 11:14:07 +00001251 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001252
1253 return retval;
1254}
1255
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001256static ssize_t tsi148_master_read(struct vme_master_resource *image, void *buf,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001257 size_t count, loff_t offset)
1258{
1259 int retval, enabled;
1260 unsigned long long vme_base, size;
Martyn Welch6af04b02011-12-01 17:06:29 +00001261 u32 aspace, cycle, dwidth;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001262 struct vme_bus_error *vme_err = NULL;
Martyn Welch29848ac2010-02-18 15:13:05 +00001263 struct vme_bridge *tsi148_bridge;
Martyn Welch363e2e62012-07-19 17:48:46 +01001264 void *addr = image->kern_base + offset;
1265 unsigned int done = 0;
1266 unsigned int count32;
Martyn Welch29848ac2010-02-18 15:13:05 +00001267
1268 tsi148_bridge = image->parent;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001269
Emilio G. Cota886953e2010-11-12 11:14:07 +00001270 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001271
Martyn Welch363e2e62012-07-19 17:48:46 +01001272 /* The following code handles VME address alignment. We cannot use
1273 * memcpy_xxx directly here because it may cut small data transfers in
1274 * to 8-bit cycles, thus making D16 cycle impossible.
1275 * On the other hand, the bridge itself assures that the maximum data
1276 * cycle configured for the transfer is used and splits it
1277 * automatically for non-aligned addresses, so we don't want the
1278 * overhead of needlessly forcing small transfers for the entire cycle.
1279 */
1280 if ((uintptr_t)addr & 0x1) {
1281 *(u8 *)buf = ioread8(addr);
1282 done += 1;
1283 if (done == count)
1284 goto out;
1285 }
1286 if ((uintptr_t)addr & 0x2) {
1287 if ((count - done) < 2) {
1288 *(u8 *)(buf + done) = ioread8(addr + done);
1289 done += 1;
1290 goto out;
1291 } else {
1292 *(u16 *)(buf + done) = ioread16(addr + done);
1293 done += 2;
1294 }
1295 }
1296
1297 count32 = (count - done) & ~0x3;
1298 if (count32 > 0) {
1299 memcpy_fromio(buf + done, addr + done, count32);
1300 done += count32;
1301 }
1302
1303 if ((count - done) & 0x2) {
1304 *(u16 *)(buf + done) = ioread16(addr + done);
1305 done += 2;
1306 }
1307 if ((count - done) & 0x1) {
1308 *(u8 *)(buf + done) = ioread8(addr + done);
1309 done += 1;
1310 }
1311
1312out:
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001313 retval = count;
1314
1315 if (!err_chk)
1316 goto skip_chk;
1317
1318 __tsi148_master_get(image, &enabled, &vme_base, &size, &aspace, &cycle,
1319 &dwidth);
1320
Martyn Welch29848ac2010-02-18 15:13:05 +00001321 vme_err = tsi148_find_error(tsi148_bridge, aspace, vme_base + offset,
1322 count);
Martyn Welch79463282010-03-22 14:58:57 +00001323 if (vme_err != NULL) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001324 dev_err(image->parent->parent, "First VME read error detected "
1325 "an at address 0x%llx\n", vme_err->address);
1326 retval = vme_err->address - (vme_base + offset);
1327 /* Clear down save errors in this address range */
Martyn Welch29848ac2010-02-18 15:13:05 +00001328 tsi148_clear_errors(tsi148_bridge, aspace, vme_base + offset,
1329 count);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001330 }
1331
1332skip_chk:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001333 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001334
1335 return retval;
1336}
1337
1338
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001339static ssize_t tsi148_master_write(struct vme_master_resource *image, void *buf,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001340 size_t count, loff_t offset)
1341{
1342 int retval = 0, enabled;
1343 unsigned long long vme_base, size;
Martyn Welch6af04b02011-12-01 17:06:29 +00001344 u32 aspace, cycle, dwidth;
Martyn Welch363e2e62012-07-19 17:48:46 +01001345 void *addr = image->kern_base + offset;
1346 unsigned int done = 0;
1347 unsigned int count32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001348
1349 struct vme_bus_error *vme_err = NULL;
Martyn Welch29848ac2010-02-18 15:13:05 +00001350 struct vme_bridge *tsi148_bridge;
1351 struct tsi148_driver *bridge;
1352
1353 tsi148_bridge = image->parent;
1354
1355 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001356
Emilio G. Cota886953e2010-11-12 11:14:07 +00001357 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001358
Martyn Welch363e2e62012-07-19 17:48:46 +01001359 /* Here we apply for the same strategy we do in master_read
1360 * function in order to assure D16 cycle when required.
1361 */
1362 if ((uintptr_t)addr & 0x1) {
1363 iowrite8(*(u8 *)buf, addr);
1364 done += 1;
1365 if (done == count)
1366 goto out;
1367 }
1368 if ((uintptr_t)addr & 0x2) {
1369 if ((count - done) < 2) {
1370 iowrite8(*(u8 *)(buf + done), addr + done);
1371 done += 1;
1372 goto out;
1373 } else {
1374 iowrite16(*(u16 *)(buf + done), addr + done);
1375 done += 2;
1376 }
1377 }
1378
1379 count32 = (count - done) & ~0x3;
1380 if (count32 > 0) {
1381 memcpy_toio(addr + done, buf + done, count32);
1382 done += count32;
1383 }
1384
1385 if ((count - done) & 0x2) {
1386 iowrite16(*(u16 *)(buf + done), addr + done);
1387 done += 2;
1388 }
1389 if ((count - done) & 0x1) {
1390 iowrite8(*(u8 *)(buf + done), addr + done);
1391 done += 1;
1392 }
1393
1394out:
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001395 retval = count;
1396
1397 /*
1398 * Writes are posted. We need to do a read on the VME bus to flush out
Lucas De Marchi25985ed2011-03-30 22:57:33 -03001399 * all of the writes before we check for errors. We can't guarantee
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001400 * that reading the data we have just written is safe. It is believed
1401 * that there isn't any read, write re-ordering, so we can read any
1402 * location in VME space, so lets read the Device ID from the tsi148's
1403 * own registers as mapped into CR/CSR space.
1404 *
1405 * We check for saved errors in the written address range/space.
1406 */
1407
1408 if (!err_chk)
1409 goto skip_chk;
1410
1411 /*
1412 * Get window info first, to maximise the time that the buffers may
1413 * fluch on their own
1414 */
1415 __tsi148_master_get(image, &enabled, &vme_base, &size, &aspace, &cycle,
1416 &dwidth);
1417
Martyn Welch29848ac2010-02-18 15:13:05 +00001418 ioread16(bridge->flush_image->kern_base + 0x7F000);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001419
Martyn Welch29848ac2010-02-18 15:13:05 +00001420 vme_err = tsi148_find_error(tsi148_bridge, aspace, vme_base + offset,
1421 count);
Martyn Welch79463282010-03-22 14:58:57 +00001422 if (vme_err != NULL) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00001423 dev_warn(tsi148_bridge->parent, "First VME write error detected"
1424 " an at address 0x%llx\n", vme_err->address);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001425 retval = vme_err->address - (vme_base + offset);
1426 /* Clear down save errors in this address range */
Martyn Welch29848ac2010-02-18 15:13:05 +00001427 tsi148_clear_errors(tsi148_bridge, aspace, vme_base + offset,
1428 count);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001429 }
1430
1431skip_chk:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001432 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001433
1434 return retval;
1435}
1436
1437/*
1438 * Perform an RMW cycle on the VME bus.
1439 *
1440 * Requires a previously configured master window, returns final value.
1441 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001442static unsigned int tsi148_master_rmw(struct vme_master_resource *image,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001443 unsigned int mask, unsigned int compare, unsigned int swap,
1444 loff_t offset)
1445{
1446 unsigned long long pci_addr;
1447 unsigned int pci_addr_high, pci_addr_low;
1448 u32 tmp, result;
1449 int i;
Martyn Welch29848ac2010-02-18 15:13:05 +00001450 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001451
Martyn Welch29848ac2010-02-18 15:13:05 +00001452 bridge = image->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001453
1454 /* Find the PCI address that maps to the desired VME address */
1455 i = image->number;
1456
1457 /* Locking as we can only do one of these at a time */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001458 mutex_lock(&bridge->vme_rmw);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001459
1460 /* Lock image */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001461 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001462
Martyn Welch29848ac2010-02-18 15:13:05 +00001463 pci_addr_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001464 TSI148_LCSR_OFFSET_OTSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001465 pci_addr_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001466 TSI148_LCSR_OFFSET_OTSAL);
1467
1468 reg_join(pci_addr_high, pci_addr_low, &pci_addr);
1469 reg_split(pci_addr + offset, &pci_addr_high, &pci_addr_low);
1470
1471 /* Configure registers */
Martyn Welch29848ac2010-02-18 15:13:05 +00001472 iowrite32be(mask, bridge->base + TSI148_LCSR_RMWEN);
1473 iowrite32be(compare, bridge->base + TSI148_LCSR_RMWC);
1474 iowrite32be(swap, bridge->base + TSI148_LCSR_RMWS);
1475 iowrite32be(pci_addr_high, bridge->base + TSI148_LCSR_RMWAU);
1476 iowrite32be(pci_addr_low, bridge->base + TSI148_LCSR_RMWAL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001477
1478 /* Enable RMW */
Martyn Welch29848ac2010-02-18 15:13:05 +00001479 tmp = ioread32be(bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001480 tmp |= TSI148_LCSR_VMCTRL_RMWEN;
Martyn Welch29848ac2010-02-18 15:13:05 +00001481 iowrite32be(tmp, bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001482
1483 /* Kick process off with a read to the required address. */
1484 result = ioread32be(image->kern_base + offset);
1485
1486 /* Disable RMW */
Martyn Welch29848ac2010-02-18 15:13:05 +00001487 tmp = ioread32be(bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001488 tmp &= ~TSI148_LCSR_VMCTRL_RMWEN;
Martyn Welch29848ac2010-02-18 15:13:05 +00001489 iowrite32be(tmp, bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001490
Emilio G. Cota886953e2010-11-12 11:14:07 +00001491 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001492
Emilio G. Cota886953e2010-11-12 11:14:07 +00001493 mutex_unlock(&bridge->vme_rmw);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001494
1495 return result;
1496}
1497
Martyn Welchac1a4f22012-03-22 13:27:30 +00001498static int tsi148_dma_set_vme_src_attributes(struct device *dev, __be32 *attr,
Martyn Welch6af04b02011-12-01 17:06:29 +00001499 u32 aspace, u32 cycle, u32 dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001500{
Martyn Welchac1a4f22012-03-22 13:27:30 +00001501 u32 val;
1502
1503 val = be32_to_cpu(*attr);
1504
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001505 /* Setup 2eSST speeds */
1506 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
1507 case VME_2eSST160:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001508 val |= TSI148_LCSR_DSAT_2eSSTM_160;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001509 break;
1510 case VME_2eSST267:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001511 val |= TSI148_LCSR_DSAT_2eSSTM_267;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001512 break;
1513 case VME_2eSST320:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001514 val |= TSI148_LCSR_DSAT_2eSSTM_320;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001515 break;
1516 }
1517
1518 /* Setup cycle types */
Martyn Welch79463282010-03-22 14:58:57 +00001519 if (cycle & VME_SCT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001520 val |= TSI148_LCSR_DSAT_TM_SCT;
Martyn Welch79463282010-03-22 14:58:57 +00001521
1522 if (cycle & VME_BLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001523 val |= TSI148_LCSR_DSAT_TM_BLT;
Martyn Welch79463282010-03-22 14:58:57 +00001524
1525 if (cycle & VME_MBLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001526 val |= TSI148_LCSR_DSAT_TM_MBLT;
Martyn Welch79463282010-03-22 14:58:57 +00001527
1528 if (cycle & VME_2eVME)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001529 val |= TSI148_LCSR_DSAT_TM_2eVME;
Martyn Welch79463282010-03-22 14:58:57 +00001530
1531 if (cycle & VME_2eSST)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001532 val |= TSI148_LCSR_DSAT_TM_2eSST;
Martyn Welch79463282010-03-22 14:58:57 +00001533
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001534 if (cycle & VME_2eSSTB) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00001535 dev_err(dev, "Currently not setting Broadcast Select "
1536 "Registers\n");
Martyn Welchac1a4f22012-03-22 13:27:30 +00001537 val |= TSI148_LCSR_DSAT_TM_2eSSTB;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001538 }
1539
1540 /* Setup data width */
1541 switch (dwidth) {
1542 case VME_D16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001543 val |= TSI148_LCSR_DSAT_DBW_16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001544 break;
1545 case VME_D32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001546 val |= TSI148_LCSR_DSAT_DBW_32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001547 break;
1548 default:
Martyn Welch48d9356e2010-03-22 14:58:50 +00001549 dev_err(dev, "Invalid data width\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001550 return -EINVAL;
1551 }
1552
1553 /* Setup address space */
1554 switch (aspace) {
1555 case VME_A16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001556 val |= TSI148_LCSR_DSAT_AMODE_A16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001557 break;
1558 case VME_A24:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001559 val |= TSI148_LCSR_DSAT_AMODE_A24;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001560 break;
1561 case VME_A32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001562 val |= TSI148_LCSR_DSAT_AMODE_A32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001563 break;
1564 case VME_A64:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001565 val |= TSI148_LCSR_DSAT_AMODE_A64;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001566 break;
1567 case VME_CRCSR:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001568 val |= TSI148_LCSR_DSAT_AMODE_CRCSR;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001569 break;
1570 case VME_USER1:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001571 val |= TSI148_LCSR_DSAT_AMODE_USER1;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001572 break;
1573 case VME_USER2:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001574 val |= TSI148_LCSR_DSAT_AMODE_USER2;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001575 break;
1576 case VME_USER3:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001577 val |= TSI148_LCSR_DSAT_AMODE_USER3;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001578 break;
1579 case VME_USER4:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001580 val |= TSI148_LCSR_DSAT_AMODE_USER4;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001581 break;
1582 default:
Martyn Welch48d9356e2010-03-22 14:58:50 +00001583 dev_err(dev, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001584 return -EINVAL;
1585 break;
1586 }
1587
1588 if (cycle & VME_SUPER)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001589 val |= TSI148_LCSR_DSAT_SUP;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001590 if (cycle & VME_PROG)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001591 val |= TSI148_LCSR_DSAT_PGM;
1592
1593 *attr = cpu_to_be32(val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001594
1595 return 0;
1596}
1597
Martyn Welchac1a4f22012-03-22 13:27:30 +00001598static int tsi148_dma_set_vme_dest_attributes(struct device *dev, __be32 *attr,
Martyn Welch6af04b02011-12-01 17:06:29 +00001599 u32 aspace, u32 cycle, u32 dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001600{
Martyn Welchac1a4f22012-03-22 13:27:30 +00001601 u32 val;
1602
1603 val = be32_to_cpu(*attr);
1604
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001605 /* Setup 2eSST speeds */
1606 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
1607 case VME_2eSST160:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001608 val |= TSI148_LCSR_DDAT_2eSSTM_160;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001609 break;
1610 case VME_2eSST267:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001611 val |= TSI148_LCSR_DDAT_2eSSTM_267;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001612 break;
1613 case VME_2eSST320:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001614 val |= TSI148_LCSR_DDAT_2eSSTM_320;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001615 break;
1616 }
1617
1618 /* Setup cycle types */
Martyn Welch79463282010-03-22 14:58:57 +00001619 if (cycle & VME_SCT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001620 val |= TSI148_LCSR_DDAT_TM_SCT;
Martyn Welch79463282010-03-22 14:58:57 +00001621
1622 if (cycle & VME_BLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001623 val |= TSI148_LCSR_DDAT_TM_BLT;
Martyn Welch79463282010-03-22 14:58:57 +00001624
1625 if (cycle & VME_MBLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001626 val |= TSI148_LCSR_DDAT_TM_MBLT;
Martyn Welch79463282010-03-22 14:58:57 +00001627
1628 if (cycle & VME_2eVME)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001629 val |= TSI148_LCSR_DDAT_TM_2eVME;
Martyn Welch79463282010-03-22 14:58:57 +00001630
1631 if (cycle & VME_2eSST)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001632 val |= TSI148_LCSR_DDAT_TM_2eSST;
Martyn Welch79463282010-03-22 14:58:57 +00001633
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001634 if (cycle & VME_2eSSTB) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00001635 dev_err(dev, "Currently not setting Broadcast Select "
1636 "Registers\n");
Martyn Welchac1a4f22012-03-22 13:27:30 +00001637 val |= TSI148_LCSR_DDAT_TM_2eSSTB;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001638 }
1639
1640 /* Setup data width */
1641 switch (dwidth) {
1642 case VME_D16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001643 val |= TSI148_LCSR_DDAT_DBW_16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001644 break;
1645 case VME_D32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001646 val |= TSI148_LCSR_DDAT_DBW_32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001647 break;
1648 default:
Martyn Welch48d9356e2010-03-22 14:58:50 +00001649 dev_err(dev, "Invalid data width\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001650 return -EINVAL;
1651 }
1652
1653 /* Setup address space */
1654 switch (aspace) {
1655 case VME_A16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001656 val |= TSI148_LCSR_DDAT_AMODE_A16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001657 break;
1658 case VME_A24:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001659 val |= TSI148_LCSR_DDAT_AMODE_A24;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001660 break;
1661 case VME_A32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001662 val |= TSI148_LCSR_DDAT_AMODE_A32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001663 break;
1664 case VME_A64:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001665 val |= TSI148_LCSR_DDAT_AMODE_A64;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001666 break;
1667 case VME_CRCSR:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001668 val |= TSI148_LCSR_DDAT_AMODE_CRCSR;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001669 break;
1670 case VME_USER1:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001671 val |= TSI148_LCSR_DDAT_AMODE_USER1;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001672 break;
1673 case VME_USER2:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001674 val |= TSI148_LCSR_DDAT_AMODE_USER2;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001675 break;
1676 case VME_USER3:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001677 val |= TSI148_LCSR_DDAT_AMODE_USER3;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001678 break;
1679 case VME_USER4:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001680 val |= TSI148_LCSR_DDAT_AMODE_USER4;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001681 break;
1682 default:
Martyn Welch48d9356e2010-03-22 14:58:50 +00001683 dev_err(dev, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001684 return -EINVAL;
1685 break;
1686 }
1687
1688 if (cycle & VME_SUPER)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001689 val |= TSI148_LCSR_DDAT_SUP;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001690 if (cycle & VME_PROG)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001691 val |= TSI148_LCSR_DDAT_PGM;
1692
1693 *attr = cpu_to_be32(val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001694
1695 return 0;
1696}
1697
1698/*
1699 * Add a link list descriptor to the list
Martyn Welchac1a4f22012-03-22 13:27:30 +00001700 *
1701 * Note: DMA engine expects the DMA descriptor to be big endian.
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001702 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001703static int tsi148_dma_list_add(struct vme_dma_list *list,
1704 struct vme_dma_attr *src, struct vme_dma_attr *dest, size_t count)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001705{
1706 struct tsi148_dma_entry *entry, *prev;
Martyn Welchac1a4f22012-03-22 13:27:30 +00001707 u32 address_high, address_low, val;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001708 struct vme_dma_pattern *pattern_attr;
1709 struct vme_dma_pci *pci_attr;
1710 struct vme_dma_vme *vme_attr;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001711 int retval = 0;
Martyn Welch48d9356e2010-03-22 14:58:50 +00001712 struct vme_bridge *tsi148_bridge;
1713
1714 tsi148_bridge = list->parent->parent;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001715
Martyn Welchbb9ea892010-02-18 16:22:13 +00001716 /* Descriptor must be aligned on 64-bit boundaries */
Martyn Welch79463282010-03-22 14:58:57 +00001717 entry = kmalloc(sizeof(struct tsi148_dma_entry), GFP_KERNEL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001718 if (entry == NULL) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00001719 dev_err(tsi148_bridge->parent, "Failed to allocate memory for "
1720 "dma resource structure\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001721 retval = -ENOMEM;
1722 goto err_mem;
1723 }
1724
1725 /* Test descriptor alignment */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001726 if ((unsigned long)&entry->descriptor & 0x7) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00001727 dev_err(tsi148_bridge->parent, "Descriptor not aligned to 8 "
1728 "byte boundary as required: %p\n",
Emilio G. Cota886953e2010-11-12 11:14:07 +00001729 &entry->descriptor);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001730 retval = -EINVAL;
1731 goto err_align;
1732 }
1733
1734 /* Given we are going to fill out the structure, we probably don't
1735 * need to zero it, but better safe than sorry for now.
1736 */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001737 memset(&entry->descriptor, 0, sizeof(struct tsi148_dma_descriptor));
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001738
1739 /* Fill out source part */
1740 switch (src->type) {
1741 case VME_DMA_PATTERN:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001742 pattern_attr = src->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001743
Martyn Welchac1a4f22012-03-22 13:27:30 +00001744 entry->descriptor.dsal = cpu_to_be32(pattern_attr->pattern);
1745
1746 val = TSI148_LCSR_DSAT_TYP_PAT;
1747
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001748 /* Default behaviour is 32 bit pattern */
Martyn Welch79463282010-03-22 14:58:57 +00001749 if (pattern_attr->type & VME_DMA_PATTERN_BYTE)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001750 val |= TSI148_LCSR_DSAT_PSZ;
Martyn Welch79463282010-03-22 14:58:57 +00001751
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001752 /* It seems that the default behaviour is to increment */
Martyn Welch79463282010-03-22 14:58:57 +00001753 if ((pattern_attr->type & VME_DMA_PATTERN_INCREMENT) == 0)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001754 val |= TSI148_LCSR_DSAT_NIN;
1755 entry->descriptor.dsat = cpu_to_be32(val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001756 break;
1757 case VME_DMA_PCI:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001758 pci_attr = src->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001759
1760 reg_split((unsigned long long)pci_attr->address, &address_high,
1761 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001762 entry->descriptor.dsau = cpu_to_be32(address_high);
1763 entry->descriptor.dsal = cpu_to_be32(address_low);
1764 entry->descriptor.dsat = cpu_to_be32(TSI148_LCSR_DSAT_TYP_PCI);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001765 break;
1766 case VME_DMA_VME:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001767 vme_attr = src->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001768
1769 reg_split((unsigned long long)vme_attr->address, &address_high,
1770 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001771 entry->descriptor.dsau = cpu_to_be32(address_high);
1772 entry->descriptor.dsal = cpu_to_be32(address_low);
1773 entry->descriptor.dsat = cpu_to_be32(TSI148_LCSR_DSAT_TYP_VME);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001774
1775 retval = tsi148_dma_set_vme_src_attributes(
Emilio G. Cota886953e2010-11-12 11:14:07 +00001776 tsi148_bridge->parent, &entry->descriptor.dsat,
Martyn Welch48d9356e2010-03-22 14:58:50 +00001777 vme_attr->aspace, vme_attr->cycle, vme_attr->dwidth);
Martyn Welch79463282010-03-22 14:58:57 +00001778 if (retval < 0)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001779 goto err_source;
1780 break;
1781 default:
Martyn Welch48d9356e2010-03-22 14:58:50 +00001782 dev_err(tsi148_bridge->parent, "Invalid source type\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001783 retval = -EINVAL;
1784 goto err_source;
1785 break;
1786 }
1787
1788 /* Assume last link - this will be over-written by adding another */
Martyn Welchac1a4f22012-03-22 13:27:30 +00001789 entry->descriptor.dnlau = cpu_to_be32(0);
1790 entry->descriptor.dnlal = cpu_to_be32(TSI148_LCSR_DNLAL_LLA);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001791
1792 /* Fill out destination part */
1793 switch (dest->type) {
1794 case VME_DMA_PCI:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001795 pci_attr = dest->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001796
1797 reg_split((unsigned long long)pci_attr->address, &address_high,
1798 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001799 entry->descriptor.ddau = cpu_to_be32(address_high);
1800 entry->descriptor.ddal = cpu_to_be32(address_low);
1801 entry->descriptor.ddat = cpu_to_be32(TSI148_LCSR_DDAT_TYP_PCI);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001802 break;
1803 case VME_DMA_VME:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001804 vme_attr = dest->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001805
1806 reg_split((unsigned long long)vme_attr->address, &address_high,
1807 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001808 entry->descriptor.ddau = cpu_to_be32(address_high);
1809 entry->descriptor.ddal = cpu_to_be32(address_low);
1810 entry->descriptor.ddat = cpu_to_be32(TSI148_LCSR_DDAT_TYP_VME);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001811
1812 retval = tsi148_dma_set_vme_dest_attributes(
Emilio G. Cota886953e2010-11-12 11:14:07 +00001813 tsi148_bridge->parent, &entry->descriptor.ddat,
Martyn Welch48d9356e2010-03-22 14:58:50 +00001814 vme_attr->aspace, vme_attr->cycle, vme_attr->dwidth);
Martyn Welch79463282010-03-22 14:58:57 +00001815 if (retval < 0)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001816 goto err_dest;
1817 break;
1818 default:
Martyn Welch48d9356e2010-03-22 14:58:50 +00001819 dev_err(tsi148_bridge->parent, "Invalid destination type\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001820 retval = -EINVAL;
1821 goto err_dest;
1822 break;
1823 }
1824
1825 /* Fill out count */
Martyn Welchac1a4f22012-03-22 13:27:30 +00001826 entry->descriptor.dcnt = cpu_to_be32((u32)count);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001827
1828 /* Add to list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001829 list_add_tail(&entry->list, &list->entries);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001830
1831 /* Fill out previous descriptors "Next Address" */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001832 if (entry->list.prev != &list->entries) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001833 prev = list_entry(entry->list.prev, struct tsi148_dma_entry,
1834 list);
1835 /* We need the bus address for the pointer */
Martyn Welch3abc48a2012-03-22 13:27:29 +00001836 entry->dma_handle = dma_map_single(tsi148_bridge->parent,
1837 &entry->descriptor,
1838 sizeof(struct tsi148_dma_descriptor), DMA_TO_DEVICE);
1839
Martyn Welchac1a4f22012-03-22 13:27:30 +00001840 reg_split((unsigned long long)entry->dma_handle, &address_high,
1841 &address_low);
1842 entry->descriptor.dnlau = cpu_to_be32(address_high);
1843 entry->descriptor.dnlal = cpu_to_be32(address_low);
1844
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001845 }
1846
1847 return 0;
1848
1849err_dest:
1850err_source:
1851err_align:
1852 kfree(entry);
1853err_mem:
1854 return retval;
1855}
1856
1857/*
1858 * Check to see if the provided DMA channel is busy.
1859 */
Martyn Welch29848ac2010-02-18 15:13:05 +00001860static int tsi148_dma_busy(struct vme_bridge *tsi148_bridge, int channel)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001861{
1862 u32 tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +00001863 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001864
Martyn Welch29848ac2010-02-18 15:13:05 +00001865 bridge = tsi148_bridge->driver_priv;
1866
1867 tmp = ioread32be(bridge->base + TSI148_LCSR_DMA[channel] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001868 TSI148_LCSR_OFFSET_DSTA);
1869
1870 if (tmp & TSI148_LCSR_DSTA_BSY)
1871 return 0;
1872 else
1873 return 1;
1874
1875}
1876
1877/*
1878 * Execute a previously generated link list
1879 *
1880 * XXX Need to provide control register configuration.
1881 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001882static int tsi148_dma_list_exec(struct vme_dma_list *list)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001883{
1884 struct vme_dma_resource *ctrlr;
1885 int channel, retval = 0;
1886 struct tsi148_dma_entry *entry;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001887 u32 bus_addr_high, bus_addr_low;
1888 u32 val, dctlreg = 0;
Martyn Welch48d9356e2010-03-22 14:58:50 +00001889 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +00001890 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001891
1892 ctrlr = list->parent;
1893
Martyn Welch48d9356e2010-03-22 14:58:50 +00001894 tsi148_bridge = ctrlr->parent;
1895
1896 bridge = tsi148_bridge->driver_priv;
Martyn Welch29848ac2010-02-18 15:13:05 +00001897
Emilio G. Cota886953e2010-11-12 11:14:07 +00001898 mutex_lock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001899
1900 channel = ctrlr->number;
1901
Emilio G. Cota886953e2010-11-12 11:14:07 +00001902 if (!list_empty(&ctrlr->running)) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001903 /*
1904 * XXX We have an active DMA transfer and currently haven't
1905 * sorted out the mechanism for "pending" DMA transfers.
1906 * Return busy.
1907 */
1908 /* Need to add to pending here */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001909 mutex_unlock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001910 return -EBUSY;
1911 } else {
Emilio G. Cota886953e2010-11-12 11:14:07 +00001912 list_add(&list->list, &ctrlr->running);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001913 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001914
1915 /* Get first bus address and write into registers */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001916 entry = list_first_entry(&list->entries, struct tsi148_dma_entry,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001917 list);
1918
Martyn Welch3abc48a2012-03-22 13:27:29 +00001919 entry->dma_handle = dma_map_single(tsi148_bridge->parent,
1920 &entry->descriptor,
1921 sizeof(struct tsi148_dma_descriptor), DMA_TO_DEVICE);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001922
Emilio G. Cota886953e2010-11-12 11:14:07 +00001923 mutex_unlock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001924
Martyn Welch3abc48a2012-03-22 13:27:29 +00001925 reg_split(entry->dma_handle, &bus_addr_high, &bus_addr_low);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001926
Martyn Welch29848ac2010-02-18 15:13:05 +00001927 iowrite32be(bus_addr_high, bridge->base +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001928 TSI148_LCSR_DMA[channel] + TSI148_LCSR_OFFSET_DNLAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001929 iowrite32be(bus_addr_low, bridge->base +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001930 TSI148_LCSR_DMA[channel] + TSI148_LCSR_OFFSET_DNLAL);
1931
Martyn Welchac1a4f22012-03-22 13:27:30 +00001932 dctlreg = ioread32be(bridge->base + TSI148_LCSR_DMA[channel] +
1933 TSI148_LCSR_OFFSET_DCTL);
1934
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001935 /* Start the operation */
Martyn Welch29848ac2010-02-18 15:13:05 +00001936 iowrite32be(dctlreg | TSI148_LCSR_DCTL_DGO, bridge->base +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001937 TSI148_LCSR_DMA[channel] + TSI148_LCSR_OFFSET_DCTL);
1938
Martyn Welch29848ac2010-02-18 15:13:05 +00001939 wait_event_interruptible(bridge->dma_queue[channel],
1940 tsi148_dma_busy(ctrlr->parent, channel));
Martyn Welchac1a4f22012-03-22 13:27:30 +00001941
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001942 /*
1943 * Read status register, this register is valid until we kick off a
1944 * new transfer.
1945 */
Martyn Welch29848ac2010-02-18 15:13:05 +00001946 val = ioread32be(bridge->base + TSI148_LCSR_DMA[channel] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001947 TSI148_LCSR_OFFSET_DSTA);
1948
1949 if (val & TSI148_LCSR_DSTA_VBE) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00001950 dev_err(tsi148_bridge->parent, "DMA Error. DSTA=%08X\n", val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001951 retval = -EIO;
1952 }
1953
1954 /* Remove list from running list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001955 mutex_lock(&ctrlr->mtx);
1956 list_del(&list->list);
1957 mutex_unlock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001958
1959 return retval;
1960}
1961
1962/*
1963 * Clean up a previously generated link list
1964 *
1965 * We have a separate function, don't assume that the chain can't be reused.
1966 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001967static int tsi148_dma_list_empty(struct vme_dma_list *list)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001968{
1969 struct list_head *pos, *temp;
Martyn Welch79463282010-03-22 14:58:57 +00001970 struct tsi148_dma_entry *entry;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001971
Martyn Welch3abc48a2012-03-22 13:27:29 +00001972 struct vme_bridge *tsi148_bridge = list->parent->parent;
1973
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001974 /* detach and free each entry */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001975 list_for_each_safe(pos, temp, &list->entries) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001976 list_del(pos);
1977 entry = list_entry(pos, struct tsi148_dma_entry, list);
Martyn Welch3abc48a2012-03-22 13:27:29 +00001978
1979 dma_unmap_single(tsi148_bridge->parent, entry->dma_handle,
1980 sizeof(struct tsi148_dma_descriptor), DMA_TO_DEVICE);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001981 kfree(entry);
1982 }
1983
Martyn Welch79463282010-03-22 14:58:57 +00001984 return 0;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001985}
1986
1987/*
1988 * All 4 location monitors reside at the same base - this is therefore a
1989 * system wide configuration.
1990 *
1991 * This does not enable the LM monitor - that should be done when the first
1992 * callback is attached and disabled when the last callback is removed.
1993 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001994static int tsi148_lm_set(struct vme_lm_resource *lm, unsigned long long lm_base,
Martyn Welch6af04b02011-12-01 17:06:29 +00001995 u32 aspace, u32 cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001996{
1997 u32 lm_base_high, lm_base_low, lm_ctl = 0;
1998 int i;
Martyn Welch48d9356e2010-03-22 14:58:50 +00001999 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +00002000 struct tsi148_driver *bridge;
2001
Martyn Welch48d9356e2010-03-22 14:58:50 +00002002 tsi148_bridge = lm->parent;
2003
2004 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002005
Emilio G. Cota886953e2010-11-12 11:14:07 +00002006 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002007
2008 /* If we already have a callback attached, we can't move it! */
Martyn Welch42fb5032009-08-11 17:44:56 +01002009 for (i = 0; i < lm->monitors; i++) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002010 if (bridge->lm_callback[i] != NULL) {
Emilio G. Cota886953e2010-11-12 11:14:07 +00002011 mutex_unlock(&lm->mtx);
Martyn Welch48d9356e2010-03-22 14:58:50 +00002012 dev_err(tsi148_bridge->parent, "Location monitor "
2013 "callback attached, can't reset\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002014 return -EBUSY;
2015 }
2016 }
2017
2018 switch (aspace) {
2019 case VME_A16:
2020 lm_ctl |= TSI148_LCSR_LMAT_AS_A16;
2021 break;
2022 case VME_A24:
2023 lm_ctl |= TSI148_LCSR_LMAT_AS_A24;
2024 break;
2025 case VME_A32:
2026 lm_ctl |= TSI148_LCSR_LMAT_AS_A32;
2027 break;
2028 case VME_A64:
2029 lm_ctl |= TSI148_LCSR_LMAT_AS_A64;
2030 break;
2031 default:
Emilio G. Cota886953e2010-11-12 11:14:07 +00002032 mutex_unlock(&lm->mtx);
Martyn Welch48d9356e2010-03-22 14:58:50 +00002033 dev_err(tsi148_bridge->parent, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002034 return -EINVAL;
2035 break;
2036 }
2037
2038 if (cycle & VME_SUPER)
2039 lm_ctl |= TSI148_LCSR_LMAT_SUPR ;
2040 if (cycle & VME_USER)
2041 lm_ctl |= TSI148_LCSR_LMAT_NPRIV;
2042 if (cycle & VME_PROG)
2043 lm_ctl |= TSI148_LCSR_LMAT_PGM;
2044 if (cycle & VME_DATA)
2045 lm_ctl |= TSI148_LCSR_LMAT_DATA;
2046
2047 reg_split(lm_base, &lm_base_high, &lm_base_low);
2048
Martyn Welch29848ac2010-02-18 15:13:05 +00002049 iowrite32be(lm_base_high, bridge->base + TSI148_LCSR_LMBAU);
2050 iowrite32be(lm_base_low, bridge->base + TSI148_LCSR_LMBAL);
2051 iowrite32be(lm_ctl, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002052
Emilio G. Cota886953e2010-11-12 11:14:07 +00002053 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002054
2055 return 0;
2056}
2057
2058/* Get configuration of the callback monitor and return whether it is enabled
2059 * or disabled.
2060 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002061static int tsi148_lm_get(struct vme_lm_resource *lm,
Martyn Welch6af04b02011-12-01 17:06:29 +00002062 unsigned long long *lm_base, u32 *aspace, u32 *cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002063{
2064 u32 lm_base_high, lm_base_low, lm_ctl, enabled = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +00002065 struct tsi148_driver *bridge;
2066
2067 bridge = lm->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002068
Emilio G. Cota886953e2010-11-12 11:14:07 +00002069 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002070
Martyn Welch29848ac2010-02-18 15:13:05 +00002071 lm_base_high = ioread32be(bridge->base + TSI148_LCSR_LMBAU);
2072 lm_base_low = ioread32be(bridge->base + TSI148_LCSR_LMBAL);
2073 lm_ctl = ioread32be(bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002074
2075 reg_join(lm_base_high, lm_base_low, lm_base);
2076
2077 if (lm_ctl & TSI148_LCSR_LMAT_EN)
2078 enabled = 1;
2079
Martyn Welch79463282010-03-22 14:58:57 +00002080 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A16)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002081 *aspace |= VME_A16;
Martyn Welch79463282010-03-22 14:58:57 +00002082
2083 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A24)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002084 *aspace |= VME_A24;
Martyn Welch79463282010-03-22 14:58:57 +00002085
2086 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A32)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002087 *aspace |= VME_A32;
Martyn Welch79463282010-03-22 14:58:57 +00002088
2089 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A64)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002090 *aspace |= VME_A64;
Martyn Welch79463282010-03-22 14:58:57 +00002091
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002092
2093 if (lm_ctl & TSI148_LCSR_LMAT_SUPR)
2094 *cycle |= VME_SUPER;
2095 if (lm_ctl & TSI148_LCSR_LMAT_NPRIV)
2096 *cycle |= VME_USER;
2097 if (lm_ctl & TSI148_LCSR_LMAT_PGM)
2098 *cycle |= VME_PROG;
2099 if (lm_ctl & TSI148_LCSR_LMAT_DATA)
2100 *cycle |= VME_DATA;
2101
Emilio G. Cota886953e2010-11-12 11:14:07 +00002102 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002103
2104 return enabled;
2105}
2106
2107/*
2108 * Attach a callback to a specific location monitor.
2109 *
2110 * Callback will be passed the monitor triggered.
2111 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002112static int tsi148_lm_attach(struct vme_lm_resource *lm, int monitor,
Martyn Welch42fb5032009-08-11 17:44:56 +01002113 void (*callback)(int))
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002114{
2115 u32 lm_ctl, tmp;
Martyn Welch48d9356e2010-03-22 14:58:50 +00002116 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +00002117 struct tsi148_driver *bridge;
2118
Martyn Welch48d9356e2010-03-22 14:58:50 +00002119 tsi148_bridge = lm->parent;
2120
2121 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002122
Emilio G. Cota886953e2010-11-12 11:14:07 +00002123 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002124
2125 /* Ensure that the location monitor is configured - need PGM or DATA */
Martyn Welch29848ac2010-02-18 15:13:05 +00002126 lm_ctl = ioread32be(bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002127 if ((lm_ctl & (TSI148_LCSR_LMAT_PGM | TSI148_LCSR_LMAT_DATA)) == 0) {
Emilio G. Cota886953e2010-11-12 11:14:07 +00002128 mutex_unlock(&lm->mtx);
Martyn Welch48d9356e2010-03-22 14:58:50 +00002129 dev_err(tsi148_bridge->parent, "Location monitor not properly "
2130 "configured\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002131 return -EINVAL;
2132 }
2133
2134 /* Check that a callback isn't already attached */
Martyn Welch29848ac2010-02-18 15:13:05 +00002135 if (bridge->lm_callback[monitor] != NULL) {
Emilio G. Cota886953e2010-11-12 11:14:07 +00002136 mutex_unlock(&lm->mtx);
Martyn Welch48d9356e2010-03-22 14:58:50 +00002137 dev_err(tsi148_bridge->parent, "Existing callback attached\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002138 return -EBUSY;
2139 }
2140
2141 /* Attach callback */
Martyn Welch29848ac2010-02-18 15:13:05 +00002142 bridge->lm_callback[monitor] = callback;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002143
2144 /* Enable Location Monitor interrupt */
Martyn Welch29848ac2010-02-18 15:13:05 +00002145 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002146 tmp |= TSI148_LCSR_INTEN_LMEN[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002147 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002148
Martyn Welch29848ac2010-02-18 15:13:05 +00002149 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002150 tmp |= TSI148_LCSR_INTEO_LMEO[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002151 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002152
2153 /* Ensure that global Location Monitor Enable set */
2154 if ((lm_ctl & TSI148_LCSR_LMAT_EN) == 0) {
2155 lm_ctl |= TSI148_LCSR_LMAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +00002156 iowrite32be(lm_ctl, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002157 }
2158
Emilio G. Cota886953e2010-11-12 11:14:07 +00002159 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002160
2161 return 0;
2162}
2163
2164/*
2165 * Detach a callback function forn a specific location monitor.
2166 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002167static int tsi148_lm_detach(struct vme_lm_resource *lm, int monitor)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002168{
2169 u32 lm_en, tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +00002170 struct tsi148_driver *bridge;
2171
2172 bridge = lm->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002173
Emilio G. Cota886953e2010-11-12 11:14:07 +00002174 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002175
2176 /* Disable Location Monitor and ensure previous interrupts are clear */
Martyn Welch29848ac2010-02-18 15:13:05 +00002177 lm_en = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002178 lm_en &= ~TSI148_LCSR_INTEN_LMEN[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002179 iowrite32be(lm_en, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002180
Martyn Welch29848ac2010-02-18 15:13:05 +00002181 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002182 tmp &= ~TSI148_LCSR_INTEO_LMEO[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002183 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002184
2185 iowrite32be(TSI148_LCSR_INTC_LMC[monitor],
Martyn Welch29848ac2010-02-18 15:13:05 +00002186 bridge->base + TSI148_LCSR_INTC);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002187
2188 /* Detach callback */
Martyn Welch29848ac2010-02-18 15:13:05 +00002189 bridge->lm_callback[monitor] = NULL;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002190
2191 /* If all location monitors disabled, disable global Location Monitor */
2192 if ((lm_en & (TSI148_LCSR_INTS_LM0S | TSI148_LCSR_INTS_LM1S |
2193 TSI148_LCSR_INTS_LM2S | TSI148_LCSR_INTS_LM3S)) == 0) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002194 tmp = ioread32be(bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002195 tmp &= ~TSI148_LCSR_LMAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +00002196 iowrite32be(tmp, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002197 }
2198
Emilio G. Cota886953e2010-11-12 11:14:07 +00002199 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002200
2201 return 0;
2202}
2203
2204/*
2205 * Determine Geographical Addressing
2206 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002207static int tsi148_slot_get(struct vme_bridge *tsi148_bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002208{
Martyn Welch79463282010-03-22 14:58:57 +00002209 u32 slot = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +00002210 struct tsi148_driver *bridge;
2211
2212 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002213
Martyn Welch638f1992009-12-15 08:42:49 +00002214 if (!geoid) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002215 slot = ioread32be(bridge->base + TSI148_LCSR_VSTAT);
Martyn Welch638f1992009-12-15 08:42:49 +00002216 slot = slot & TSI148_LCSR_VSTAT_GA_M;
2217 } else
2218 slot = geoid;
2219
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002220 return (int)slot;
2221}
2222
H Hartley Sweeten lin8a508ff2012-05-02 17:08:38 -07002223static void *tsi148_alloc_consistent(struct device *parent, size_t size,
Manohar Vanga7f58f022011-08-10 11:33:46 +02002224 dma_addr_t *dma)
2225{
2226 struct pci_dev *pdev;
2227
2228 /* Find pci_dev container of dev */
2229 pdev = container_of(parent, struct pci_dev, dev);
2230
2231 return pci_alloc_consistent(pdev, size, dma);
2232}
2233
H Hartley Sweeten lin8a508ff2012-05-02 17:08:38 -07002234static void tsi148_free_consistent(struct device *parent, size_t size,
2235 void *vaddr, dma_addr_t dma)
Manohar Vanga7f58f022011-08-10 11:33:46 +02002236{
2237 struct pci_dev *pdev;
2238
2239 /* Find pci_dev container of dev */
2240 pdev = container_of(parent, struct pci_dev, dev);
2241
2242 pci_free_consistent(pdev, size, vaddr, dma);
2243}
2244
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002245/*
2246 * Configure CR/CSR space
2247 *
2248 * Access to the CR/CSR can be configured at power-up. The location of the
2249 * CR/CSR registers in the CR/CSR address space is determined by the boards
2250 * Auto-ID or Geographic address. This function ensures that the window is
2251 * enabled at an offset consistent with the boards geopgraphic address.
2252 *
2253 * Each board has a 512kB window, with the highest 4kB being used for the
2254 * boards registers, this means there is a fix length 508kB window which must
2255 * be mapped onto PCI memory.
2256 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002257static int tsi148_crcsr_init(struct vme_bridge *tsi148_bridge,
2258 struct pci_dev *pdev)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002259{
2260 u32 cbar, crat, vstat;
2261 u32 crcsr_bus_high, crcsr_bus_low;
2262 int retval;
Martyn Welch29848ac2010-02-18 15:13:05 +00002263 struct tsi148_driver *bridge;
2264
2265 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002266
2267 /* Allocate mem for CR/CSR image */
Martyn Welch29848ac2010-02-18 15:13:05 +00002268 bridge->crcsr_kernel = pci_alloc_consistent(pdev, VME_CRCSR_BUF_SIZE,
Emilio G. Cota886953e2010-11-12 11:14:07 +00002269 &bridge->crcsr_bus);
Martyn Welch29848ac2010-02-18 15:13:05 +00002270 if (bridge->crcsr_kernel == NULL) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00002271 dev_err(tsi148_bridge->parent, "Failed to allocate memory for "
2272 "CR/CSR image\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002273 return -ENOMEM;
2274 }
2275
Martyn Welch29848ac2010-02-18 15:13:05 +00002276 memset(bridge->crcsr_kernel, 0, VME_CRCSR_BUF_SIZE);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002277
Martyn Welch29848ac2010-02-18 15:13:05 +00002278 reg_split(bridge->crcsr_bus, &crcsr_bus_high, &crcsr_bus_low);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002279
Martyn Welch29848ac2010-02-18 15:13:05 +00002280 iowrite32be(crcsr_bus_high, bridge->base + TSI148_LCSR_CROU);
2281 iowrite32be(crcsr_bus_low, bridge->base + TSI148_LCSR_CROL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002282
2283 /* Ensure that the CR/CSR is configured at the correct offset */
Martyn Welch29848ac2010-02-18 15:13:05 +00002284 cbar = ioread32be(bridge->base + TSI148_CBAR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002285 cbar = (cbar & TSI148_CRCSR_CBAR_M)>>3;
2286
Martyn Welch29848ac2010-02-18 15:13:05 +00002287 vstat = tsi148_slot_get(tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002288
2289 if (cbar != vstat) {
Martyn Welch638f1992009-12-15 08:42:49 +00002290 cbar = vstat;
Martyn Welch48d9356e2010-03-22 14:58:50 +00002291 dev_info(tsi148_bridge->parent, "Setting CR/CSR offset\n");
Martyn Welch29848ac2010-02-18 15:13:05 +00002292 iowrite32be(cbar<<3, bridge->base + TSI148_CBAR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002293 }
Martyn Welch48d9356e2010-03-22 14:58:50 +00002294 dev_info(tsi148_bridge->parent, "CR/CSR Offset: %d\n", cbar);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002295
Martyn Welch29848ac2010-02-18 15:13:05 +00002296 crat = ioread32be(bridge->base + TSI148_LCSR_CRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002297 if (crat & TSI148_LCSR_CRAT_EN) {
Martyn Welch48d9356e2010-03-22 14:58:50 +00002298 dev_info(tsi148_bridge->parent, "Enabling CR/CSR space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002299 iowrite32be(crat | TSI148_LCSR_CRAT_EN,
Martyn Welch29848ac2010-02-18 15:13:05 +00002300 bridge->base + TSI148_LCSR_CRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002301 } else
Martyn Welch48d9356e2010-03-22 14:58:50 +00002302 dev_info(tsi148_bridge->parent, "CR/CSR already enabled\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002303
2304 /* If we want flushed, error-checked writes, set up a window
2305 * over the CR/CSR registers. We read from here to safely flush
2306 * through VME writes.
2307 */
Martyn Welch79463282010-03-22 14:58:57 +00002308 if (err_chk) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002309 retval = tsi148_master_set(bridge->flush_image, 1,
2310 (vstat * 0x80000), 0x80000, VME_CRCSR, VME_SCT,
2311 VME_D16);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002312 if (retval)
Martyn Welch48d9356e2010-03-22 14:58:50 +00002313 dev_err(tsi148_bridge->parent, "Configuring flush image"
2314 " failed\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002315 }
2316
2317 return 0;
2318
2319}
2320
Martyn Welch29848ac2010-02-18 15:13:05 +00002321static void tsi148_crcsr_exit(struct vme_bridge *tsi148_bridge,
2322 struct pci_dev *pdev)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002323{
2324 u32 crat;
Martyn Welch29848ac2010-02-18 15:13:05 +00002325 struct tsi148_driver *bridge;
2326
2327 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002328
2329 /* Turn off CR/CSR space */
Martyn Welch29848ac2010-02-18 15:13:05 +00002330 crat = ioread32be(bridge->base + TSI148_LCSR_CRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002331 iowrite32be(crat & ~TSI148_LCSR_CRAT_EN,
Martyn Welch29848ac2010-02-18 15:13:05 +00002332 bridge->base + TSI148_LCSR_CRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002333
2334 /* Free image */
Martyn Welch29848ac2010-02-18 15:13:05 +00002335 iowrite32be(0, bridge->base + TSI148_LCSR_CROU);
2336 iowrite32be(0, bridge->base + TSI148_LCSR_CROL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002337
Martyn Welch29848ac2010-02-18 15:13:05 +00002338 pci_free_consistent(pdev, VME_CRCSR_BUF_SIZE, bridge->crcsr_kernel,
2339 bridge->crcsr_bus);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002340}
2341
2342static int tsi148_probe(struct pci_dev *pdev, const struct pci_device_id *id)
2343{
2344 int retval, i, master_num;
2345 u32 data;
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002346 struct list_head *pos = NULL, *n;
Martyn Welch29848ac2010-02-18 15:13:05 +00002347 struct vme_bridge *tsi148_bridge;
2348 struct tsi148_driver *tsi148_device;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002349 struct vme_master_resource *master_image;
2350 struct vme_slave_resource *slave_image;
2351 struct vme_dma_resource *dma_ctrlr;
Martyn Welch42fb5032009-08-11 17:44:56 +01002352 struct vme_lm_resource *lm;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002353
2354 /* If we want to support more than one of each bridge, we need to
2355 * dynamically generate this so we get one per device
2356 */
Julia Lawall7a6cb0d2010-05-13 22:00:05 +02002357 tsi148_bridge = kzalloc(sizeof(struct vme_bridge), GFP_KERNEL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002358 if (tsi148_bridge == NULL) {
2359 dev_err(&pdev->dev, "Failed to allocate memory for device "
2360 "structure\n");
2361 retval = -ENOMEM;
2362 goto err_struct;
2363 }
2364
Julia Lawall7a6cb0d2010-05-13 22:00:05 +02002365 tsi148_device = kzalloc(sizeof(struct tsi148_driver), GFP_KERNEL);
Martyn Welch29848ac2010-02-18 15:13:05 +00002366 if (tsi148_device == NULL) {
2367 dev_err(&pdev->dev, "Failed to allocate memory for device "
2368 "structure\n");
2369 retval = -ENOMEM;
2370 goto err_driver;
2371 }
2372
Martyn Welch29848ac2010-02-18 15:13:05 +00002373 tsi148_bridge->driver_priv = tsi148_device;
2374
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002375 /* Enable the device */
2376 retval = pci_enable_device(pdev);
2377 if (retval) {
2378 dev_err(&pdev->dev, "Unable to enable device\n");
2379 goto err_enable;
2380 }
2381
2382 /* Map Registers */
2383 retval = pci_request_regions(pdev, driver_name);
2384 if (retval) {
2385 dev_err(&pdev->dev, "Unable to reserve resources\n");
2386 goto err_resource;
2387 }
2388
2389 /* map registers in BAR 0 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002390 tsi148_device->base = ioremap_nocache(pci_resource_start(pdev, 0),
2391 4096);
2392 if (!tsi148_device->base) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002393 dev_err(&pdev->dev, "Unable to remap CRG region\n");
2394 retval = -EIO;
2395 goto err_remap;
2396 }
2397
2398 /* Check to see if the mapping worked out */
Martyn Welch29848ac2010-02-18 15:13:05 +00002399 data = ioread32(tsi148_device->base + TSI148_PCFS_ID) & 0x0000FFFF;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002400 if (data != PCI_VENDOR_ID_TUNDRA) {
2401 dev_err(&pdev->dev, "CRG region check failed\n");
2402 retval = -EIO;
2403 goto err_test;
2404 }
2405
2406 /* Initialize wait queues & mutual exclusion flags */
Emilio G. Cota886953e2010-11-12 11:14:07 +00002407 init_waitqueue_head(&tsi148_device->dma_queue[0]);
2408 init_waitqueue_head(&tsi148_device->dma_queue[1]);
2409 init_waitqueue_head(&tsi148_device->iack_queue);
2410 mutex_init(&tsi148_device->vme_int);
2411 mutex_init(&tsi148_device->vme_rmw);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002412
Emilio G. Cota886953e2010-11-12 11:14:07 +00002413 tsi148_bridge->parent = &pdev->dev;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002414 strcpy(tsi148_bridge->name, driver_name);
2415
2416 /* Setup IRQ */
2417 retval = tsi148_irq_init(tsi148_bridge);
2418 if (retval != 0) {
2419 dev_err(&pdev->dev, "Chip Initialization failed.\n");
2420 goto err_irq;
2421 }
2422
2423 /* If we are going to flush writes, we need to read from the VME bus.
2424 * We need to do this safely, thus we read the devices own CR/CSR
2425 * register. To do this we must set up a window in CR/CSR space and
2426 * hence have one less master window resource available.
2427 */
2428 master_num = TSI148_MAX_MASTER;
Martyn Welch79463282010-03-22 14:58:57 +00002429 if (err_chk) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002430 master_num--;
Martyn Welch29848ac2010-02-18 15:13:05 +00002431
Julia Lawall32414872010-05-11 20:26:57 +02002432 tsi148_device->flush_image =
Martyn Welch29848ac2010-02-18 15:13:05 +00002433 kmalloc(sizeof(struct vme_master_resource), GFP_KERNEL);
2434 if (tsi148_device->flush_image == NULL) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002435 dev_err(&pdev->dev, "Failed to allocate memory for "
2436 "flush resource structure\n");
2437 retval = -ENOMEM;
2438 goto err_master;
2439 }
Martyn Welch29848ac2010-02-18 15:13:05 +00002440 tsi148_device->flush_image->parent = tsi148_bridge;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002441 spin_lock_init(&tsi148_device->flush_image->lock);
Martyn Welch29848ac2010-02-18 15:13:05 +00002442 tsi148_device->flush_image->locked = 1;
2443 tsi148_device->flush_image->number = master_num;
2444 tsi148_device->flush_image->address_attr = VME_A16 | VME_A24 |
2445 VME_A32 | VME_A64;
2446 tsi148_device->flush_image->cycle_attr = VME_SCT | VME_BLT |
2447 VME_MBLT | VME_2eVME | VME_2eSST | VME_2eSSTB |
2448 VME_2eSST160 | VME_2eSST267 | VME_2eSST320 | VME_SUPER |
2449 VME_USER | VME_PROG | VME_DATA;
2450 tsi148_device->flush_image->width_attr = VME_D16 | VME_D32;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002451 memset(&tsi148_device->flush_image->bus_resource, 0,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002452 sizeof(struct resource));
Martyn Welch29848ac2010-02-18 15:13:05 +00002453 tsi148_device->flush_image->kern_base = NULL;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002454 }
2455
2456 /* Add master windows to list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00002457 INIT_LIST_HEAD(&tsi148_bridge->master_resources);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002458 for (i = 0; i < master_num; i++) {
Martyn Welch79463282010-03-22 14:58:57 +00002459 master_image = kmalloc(sizeof(struct vme_master_resource),
2460 GFP_KERNEL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002461 if (master_image == NULL) {
2462 dev_err(&pdev->dev, "Failed to allocate memory for "
2463 "master resource structure\n");
2464 retval = -ENOMEM;
2465 goto err_master;
2466 }
2467 master_image->parent = tsi148_bridge;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002468 spin_lock_init(&master_image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002469 master_image->locked = 0;
2470 master_image->number = i;
2471 master_image->address_attr = VME_A16 | VME_A24 | VME_A32 |
2472 VME_A64;
2473 master_image->cycle_attr = VME_SCT | VME_BLT | VME_MBLT |
2474 VME_2eVME | VME_2eSST | VME_2eSSTB | VME_2eSST160 |
2475 VME_2eSST267 | VME_2eSST320 | VME_SUPER | VME_USER |
2476 VME_PROG | VME_DATA;
2477 master_image->width_attr = VME_D16 | VME_D32;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002478 memset(&master_image->bus_resource, 0,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002479 sizeof(struct resource));
2480 master_image->kern_base = NULL;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002481 list_add_tail(&master_image->list,
2482 &tsi148_bridge->master_resources);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002483 }
2484
2485 /* Add slave windows to list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00002486 INIT_LIST_HEAD(&tsi148_bridge->slave_resources);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002487 for (i = 0; i < TSI148_MAX_SLAVE; i++) {
Martyn Welch79463282010-03-22 14:58:57 +00002488 slave_image = kmalloc(sizeof(struct vme_slave_resource),
2489 GFP_KERNEL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002490 if (slave_image == NULL) {
2491 dev_err(&pdev->dev, "Failed to allocate memory for "
2492 "slave resource structure\n");
2493 retval = -ENOMEM;
2494 goto err_slave;
2495 }
2496 slave_image->parent = tsi148_bridge;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002497 mutex_init(&slave_image->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002498 slave_image->locked = 0;
2499 slave_image->number = i;
2500 slave_image->address_attr = VME_A16 | VME_A24 | VME_A32 |
2501 VME_A64 | VME_CRCSR | VME_USER1 | VME_USER2 |
2502 VME_USER3 | VME_USER4;
2503 slave_image->cycle_attr = VME_SCT | VME_BLT | VME_MBLT |
2504 VME_2eVME | VME_2eSST | VME_2eSSTB | VME_2eSST160 |
2505 VME_2eSST267 | VME_2eSST320 | VME_SUPER | VME_USER |
2506 VME_PROG | VME_DATA;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002507 list_add_tail(&slave_image->list,
2508 &tsi148_bridge->slave_resources);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002509 }
2510
2511 /* Add dma engines to list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00002512 INIT_LIST_HEAD(&tsi148_bridge->dma_resources);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002513 for (i = 0; i < TSI148_MAX_DMA; i++) {
Martyn Welch79463282010-03-22 14:58:57 +00002514 dma_ctrlr = kmalloc(sizeof(struct vme_dma_resource),
2515 GFP_KERNEL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002516 if (dma_ctrlr == NULL) {
2517 dev_err(&pdev->dev, "Failed to allocate memory for "
2518 "dma resource structure\n");
2519 retval = -ENOMEM;
2520 goto err_dma;
2521 }
2522 dma_ctrlr->parent = tsi148_bridge;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002523 mutex_init(&dma_ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002524 dma_ctrlr->locked = 0;
2525 dma_ctrlr->number = i;
Martyn Welch4f723df2010-02-18 15:12:58 +00002526 dma_ctrlr->route_attr = VME_DMA_VME_TO_MEM |
2527 VME_DMA_MEM_TO_VME | VME_DMA_VME_TO_VME |
2528 VME_DMA_MEM_TO_MEM | VME_DMA_PATTERN_TO_VME |
2529 VME_DMA_PATTERN_TO_MEM;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002530 INIT_LIST_HEAD(&dma_ctrlr->pending);
2531 INIT_LIST_HEAD(&dma_ctrlr->running);
2532 list_add_tail(&dma_ctrlr->list,
2533 &tsi148_bridge->dma_resources);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002534 }
2535
Martyn Welch42fb5032009-08-11 17:44:56 +01002536 /* Add location monitor to list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00002537 INIT_LIST_HEAD(&tsi148_bridge->lm_resources);
Martyn Welch42fb5032009-08-11 17:44:56 +01002538 lm = kmalloc(sizeof(struct vme_lm_resource), GFP_KERNEL);
2539 if (lm == NULL) {
2540 dev_err(&pdev->dev, "Failed to allocate memory for "
2541 "location monitor resource structure\n");
2542 retval = -ENOMEM;
2543 goto err_lm;
2544 }
2545 lm->parent = tsi148_bridge;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002546 mutex_init(&lm->mtx);
Martyn Welch42fb5032009-08-11 17:44:56 +01002547 lm->locked = 0;
2548 lm->number = 1;
2549 lm->monitors = 4;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002550 list_add_tail(&lm->list, &tsi148_bridge->lm_resources);
Martyn Welch42fb5032009-08-11 17:44:56 +01002551
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002552 tsi148_bridge->slave_get = tsi148_slave_get;
2553 tsi148_bridge->slave_set = tsi148_slave_set;
2554 tsi148_bridge->master_get = tsi148_master_get;
2555 tsi148_bridge->master_set = tsi148_master_set;
2556 tsi148_bridge->master_read = tsi148_master_read;
2557 tsi148_bridge->master_write = tsi148_master_write;
2558 tsi148_bridge->master_rmw = tsi148_master_rmw;
2559 tsi148_bridge->dma_list_add = tsi148_dma_list_add;
2560 tsi148_bridge->dma_list_exec = tsi148_dma_list_exec;
2561 tsi148_bridge->dma_list_empty = tsi148_dma_list_empty;
Martyn Welchc813f592009-10-29 16:34:54 +00002562 tsi148_bridge->irq_set = tsi148_irq_set;
2563 tsi148_bridge->irq_generate = tsi148_irq_generate;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002564 tsi148_bridge->lm_set = tsi148_lm_set;
2565 tsi148_bridge->lm_get = tsi148_lm_get;
2566 tsi148_bridge->lm_attach = tsi148_lm_attach;
2567 tsi148_bridge->lm_detach = tsi148_lm_detach;
2568 tsi148_bridge->slot_get = tsi148_slot_get;
Manohar Vanga7f58f022011-08-10 11:33:46 +02002569 tsi148_bridge->alloc_consistent = tsi148_alloc_consistent;
2570 tsi148_bridge->free_consistent = tsi148_free_consistent;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002571
Martyn Welch29848ac2010-02-18 15:13:05 +00002572 data = ioread32be(tsi148_device->base + TSI148_LCSR_VSTAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002573 dev_info(&pdev->dev, "Board is%s the VME system controller\n",
Martyn Welch79463282010-03-22 14:58:57 +00002574 (data & TSI148_LCSR_VSTAT_SCONS) ? "" : " not");
Martyn Welch29848ac2010-02-18 15:13:05 +00002575 if (!geoid)
Martyn Welch638f1992009-12-15 08:42:49 +00002576 dev_info(&pdev->dev, "VME geographical address is %d\n",
2577 data & TSI148_LCSR_VSTAT_GA_M);
Martyn Welch29848ac2010-02-18 15:13:05 +00002578 else
Martyn Welch638f1992009-12-15 08:42:49 +00002579 dev_info(&pdev->dev, "VME geographical address is set to %d\n",
2580 geoid);
Martyn Welch29848ac2010-02-18 15:13:05 +00002581
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002582 dev_info(&pdev->dev, "VME Write and flush and error check is %s\n",
2583 err_chk ? "enabled" : "disabled");
2584
Martyn Welch48397372010-03-22 14:58:43 +00002585 if (tsi148_crcsr_init(tsi148_bridge, pdev)) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002586 dev_err(&pdev->dev, "CR/CSR configuration failed.\n");
2587 goto err_crcsr;
Martyn Welch48397372010-03-22 14:58:43 +00002588 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002589
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002590 retval = vme_register_bridge(tsi148_bridge);
2591 if (retval != 0) {
2592 dev_err(&pdev->dev, "Chip Registration failed.\n");
2593 goto err_reg;
2594 }
2595
Martyn Welch29848ac2010-02-18 15:13:05 +00002596 pci_set_drvdata(pdev, tsi148_bridge);
2597
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002598 /* Clear VME bus "board fail", and "power-up reset" lines */
Martyn Welch29848ac2010-02-18 15:13:05 +00002599 data = ioread32be(tsi148_device->base + TSI148_LCSR_VSTAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002600 data &= ~TSI148_LCSR_VSTAT_BRDFL;
2601 data |= TSI148_LCSR_VSTAT_CPURST;
Martyn Welch29848ac2010-02-18 15:13:05 +00002602 iowrite32be(data, tsi148_device->base + TSI148_LCSR_VSTAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002603
2604 return 0;
2605
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002606err_reg:
Martyn Welch29848ac2010-02-18 15:13:05 +00002607 tsi148_crcsr_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002608err_crcsr:
Martyn Welch42fb5032009-08-11 17:44:56 +01002609err_lm:
2610 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002611 list_for_each_safe(pos, n, &tsi148_bridge->lm_resources) {
Martyn Welch42fb5032009-08-11 17:44:56 +01002612 lm = list_entry(pos, struct vme_lm_resource, list);
2613 list_del(pos);
2614 kfree(lm);
2615 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002616err_dma:
2617 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002618 list_for_each_safe(pos, n, &tsi148_bridge->dma_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002619 dma_ctrlr = list_entry(pos, struct vme_dma_resource, list);
2620 list_del(pos);
2621 kfree(dma_ctrlr);
2622 }
2623err_slave:
2624 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002625 list_for_each_safe(pos, n, &tsi148_bridge->slave_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002626 slave_image = list_entry(pos, struct vme_slave_resource, list);
2627 list_del(pos);
2628 kfree(slave_image);
2629 }
2630err_master:
2631 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002632 list_for_each_safe(pos, n, &tsi148_bridge->master_resources) {
Martyn Welch79463282010-03-22 14:58:57 +00002633 master_image = list_entry(pos, struct vme_master_resource,
2634 list);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002635 list_del(pos);
2636 kfree(master_image);
2637 }
2638
Emilio G. Cotaa82ad052010-11-12 11:14:47 +00002639 tsi148_irq_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002640err_irq:
2641err_test:
Martyn Welch29848ac2010-02-18 15:13:05 +00002642 iounmap(tsi148_device->base);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002643err_remap:
2644 pci_release_regions(pdev);
2645err_resource:
2646 pci_disable_device(pdev);
2647err_enable:
Martyn Welch29848ac2010-02-18 15:13:05 +00002648 kfree(tsi148_device);
2649err_driver:
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002650 kfree(tsi148_bridge);
2651err_struct:
2652 return retval;
2653
2654}
2655
2656static void tsi148_remove(struct pci_dev *pdev)
2657{
2658 struct list_head *pos = NULL;
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002659 struct list_head *tmplist;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002660 struct vme_master_resource *master_image;
2661 struct vme_slave_resource *slave_image;
2662 struct vme_dma_resource *dma_ctrlr;
2663 int i;
Martyn Welch29848ac2010-02-18 15:13:05 +00002664 struct tsi148_driver *bridge;
2665 struct vme_bridge *tsi148_bridge = pci_get_drvdata(pdev);
2666
2667 bridge = tsi148_bridge->driver_priv;
2668
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002669
2670 dev_dbg(&pdev->dev, "Driver is being unloaded.\n");
2671
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002672 /*
2673 * Shutdown all inbound and outbound windows.
2674 */
2675 for (i = 0; i < 8; i++) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002676 iowrite32be(0, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002677 TSI148_LCSR_OFFSET_ITAT);
Martyn Welch29848ac2010-02-18 15:13:05 +00002678 iowrite32be(0, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002679 TSI148_LCSR_OFFSET_OTAT);
2680 }
2681
2682 /*
2683 * Shutdown Location monitor.
2684 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002685 iowrite32be(0, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002686
2687 /*
2688 * Shutdown CRG map.
2689 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002690 iowrite32be(0, bridge->base + TSI148_LCSR_CSRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002691
2692 /*
2693 * Clear error status.
2694 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002695 iowrite32be(0xFFFFFFFF, bridge->base + TSI148_LCSR_EDPAT);
2696 iowrite32be(0xFFFFFFFF, bridge->base + TSI148_LCSR_VEAT);
2697 iowrite32be(0x07000700, bridge->base + TSI148_LCSR_PSTAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002698
2699 /*
2700 * Remove VIRQ interrupt (if any)
2701 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002702 if (ioread32be(bridge->base + TSI148_LCSR_VICR) & 0x800)
2703 iowrite32be(0x8000, bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002704
2705 /*
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002706 * Map all Interrupts to PCI INTA
2707 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002708 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTM1);
2709 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTM2);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002710
Emilio G. Cotaa82ad052010-11-12 11:14:47 +00002711 tsi148_irq_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002712
2713 vme_unregister_bridge(tsi148_bridge);
2714
Martyn Welch29848ac2010-02-18 15:13:05 +00002715 tsi148_crcsr_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002716
2717 /* resources are stored in link list */
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002718 list_for_each_safe(pos, tmplist, &tsi148_bridge->dma_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002719 dma_ctrlr = list_entry(pos, struct vme_dma_resource, list);
2720 list_del(pos);
2721 kfree(dma_ctrlr);
2722 }
2723
2724 /* resources are stored in link list */
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002725 list_for_each_safe(pos, tmplist, &tsi148_bridge->slave_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002726 slave_image = list_entry(pos, struct vme_slave_resource, list);
2727 list_del(pos);
2728 kfree(slave_image);
2729 }
2730
2731 /* resources are stored in link list */
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002732 list_for_each_safe(pos, tmplist, &tsi148_bridge->master_resources) {
Martyn Welch638f1992009-12-15 08:42:49 +00002733 master_image = list_entry(pos, struct vme_master_resource,
2734 list);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002735 list_del(pos);
2736 kfree(master_image);
2737 }
2738
Martyn Welch29848ac2010-02-18 15:13:05 +00002739 iounmap(bridge->base);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002740
2741 pci_release_regions(pdev);
2742
2743 pci_disable_device(pdev);
2744
Martyn Welch29848ac2010-02-18 15:13:05 +00002745 kfree(tsi148_bridge->driver_priv);
2746
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002747 kfree(tsi148_bridge);
2748}
2749
Wei Yongjun01c07142012-10-18 23:12:50 +08002750module_pci_driver(tsi148_driver);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002751
2752MODULE_PARM_DESC(err_chk, "Check for VME errors on reads and writes");
2753module_param(err_chk, bool, 0);
2754
Martyn Welch638f1992009-12-15 08:42:49 +00002755MODULE_PARM_DESC(geoid, "Override geographical addressing");
2756module_param(geoid, int, 0);
2757
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002758MODULE_DESCRIPTION("VME driver for the Tundra Tempe VME bridge");
2759MODULE_LICENSE("GPL");