blob: 21ac513486f61e5b1c9bc04ac7012cc1968385d8 [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
Jingoo Hanc3a09c12013-12-03 08:29:48 +090048static const struct pci_device_id 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 Welch48d93562010-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 Welch48d93562010-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 Welch48d93562010-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 Welch48d93562010-03-22 14:58:50 +0000142static u32 tsi148_PERR_irqhandler(struct vme_bridge *tsi148_bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100143{
Martyn Welch48d93562010-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 Welch48d93562010-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 Welch48d93562010-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;
Martyn Welche31c51e2013-06-11 11:20:17 +0100172 struct vme_bus_error *error = NULL;
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 Welch48d93562010-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 Welche31c51e2013-06-11 11:20:17 +0100189 if (err_chk) {
190 error = kmalloc(sizeof(struct vme_bus_error), GFP_ATOMIC);
191 if (error) {
192 error->address = error_addr;
193 error->attributes = error_attrib;
194 list_add_tail(&error->list, &tsi148_bridge->vme_errors);
195 } else {
196 dev_err(tsi148_bridge->parent,
197 "Unable to alloc memory for VMEbus Error reporting\n");
198 }
199 }
200
201 if (!error) {
202 dev_err(tsi148_bridge->parent,
203 "VME Bus Error at address: 0x%llx, attributes: %08x\n",
204 error_addr, error_attrib);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100205 }
206
207 /* Clear Status */
Martyn Welch29848ac2010-02-18 15:13:05 +0000208 iowrite32be(TSI148_LCSR_VEAT_VESCL, bridge->base + TSI148_LCSR_VEAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100209
210 return TSI148_LCSR_INTC_VERRC;
211}
212
213/*
214 * Wake up IACK queue.
215 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000216static u32 tsi148_IACK_irqhandler(struct tsi148_driver *bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100217{
Emilio G. Cota886953e2010-11-12 11:14:07 +0000218 wake_up(&bridge->iack_queue);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100219
220 return TSI148_LCSR_INTC_IACKC;
221}
222
223/*
224 * Calling VME bus interrupt callback if provided.
225 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000226static u32 tsi148_VIRQ_irqhandler(struct vme_bridge *tsi148_bridge,
227 u32 stat)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100228{
229 int vec, i, serviced = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +0000230 struct tsi148_driver *bridge;
231
232 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100233
234 for (i = 7; i > 0; i--) {
235 if (stat & (1 << i)) {
236 /*
Martyn Welch79463282010-03-22 14:58:57 +0000237 * Note: Even though the registers are defined as
238 * 32-bits in the spec, we only want to issue 8-bit
239 * IACK cycles on the bus, read from offset 3.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100240 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000241 vec = ioread8(bridge->base + TSI148_LCSR_VIACK[i] + 3);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100242
Martyn Welchc813f592009-10-29 16:34:54 +0000243 vme_irq_handler(tsi148_bridge, i, vec);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100244
245 serviced |= (1 << i);
246 }
247 }
248
249 return serviced;
250}
251
252/*
253 * Top level interrupt handler. Clears appropriate interrupt status bits and
254 * then calls appropriate sub handler(s).
255 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000256static irqreturn_t tsi148_irqhandler(int irq, void *ptr)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100257{
258 u32 stat, enable, serviced = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +0000259 struct vme_bridge *tsi148_bridge;
260 struct tsi148_driver *bridge;
261
262 tsi148_bridge = ptr;
263
264 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100265
266 /* Determine which interrupts are unmasked and set */
Martyn Welch29848ac2010-02-18 15:13:05 +0000267 enable = ioread32be(bridge->base + TSI148_LCSR_INTEO);
268 stat = ioread32be(bridge->base + TSI148_LCSR_INTS);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100269
270 /* Only look at unmasked interrupts */
271 stat &= enable;
272
Martyn Welch79463282010-03-22 14:58:57 +0000273 if (unlikely(!stat))
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100274 return IRQ_NONE;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100275
276 /* Call subhandlers as appropriate */
277 /* DMA irqs */
278 if (stat & (TSI148_LCSR_INTS_DMA1S | TSI148_LCSR_INTS_DMA0S))
Martyn Welch29848ac2010-02-18 15:13:05 +0000279 serviced |= tsi148_DMA_irqhandler(bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100280
281 /* Location monitor irqs */
282 if (stat & (TSI148_LCSR_INTS_LM3S | TSI148_LCSR_INTS_LM2S |
283 TSI148_LCSR_INTS_LM1S | TSI148_LCSR_INTS_LM0S))
Martyn Welch29848ac2010-02-18 15:13:05 +0000284 serviced |= tsi148_LM_irqhandler(bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100285
286 /* Mail box irqs */
287 if (stat & (TSI148_LCSR_INTS_MB3S | TSI148_LCSR_INTS_MB2S |
288 TSI148_LCSR_INTS_MB1S | TSI148_LCSR_INTS_MB0S))
Martyn Welch48d93562010-03-22 14:58:50 +0000289 serviced |= tsi148_MB_irqhandler(tsi148_bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100290
291 /* PCI bus error */
292 if (stat & TSI148_LCSR_INTS_PERRS)
Martyn Welch48d93562010-03-22 14:58:50 +0000293 serviced |= tsi148_PERR_irqhandler(tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100294
295 /* VME bus error */
296 if (stat & TSI148_LCSR_INTS_VERRS)
Martyn Welch29848ac2010-02-18 15:13:05 +0000297 serviced |= tsi148_VERR_irqhandler(tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100298
299 /* IACK irq */
300 if (stat & TSI148_LCSR_INTS_IACKS)
Martyn Welch29848ac2010-02-18 15:13:05 +0000301 serviced |= tsi148_IACK_irqhandler(bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100302
303 /* VME bus irqs */
304 if (stat & (TSI148_LCSR_INTS_IRQ7S | TSI148_LCSR_INTS_IRQ6S |
305 TSI148_LCSR_INTS_IRQ5S | TSI148_LCSR_INTS_IRQ4S |
306 TSI148_LCSR_INTS_IRQ3S | TSI148_LCSR_INTS_IRQ2S |
307 TSI148_LCSR_INTS_IRQ1S))
Martyn Welch29848ac2010-02-18 15:13:05 +0000308 serviced |= tsi148_VIRQ_irqhandler(tsi148_bridge, stat);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100309
310 /* Clear serviced interrupts */
Martyn Welch29848ac2010-02-18 15:13:05 +0000311 iowrite32be(serviced, bridge->base + TSI148_LCSR_INTC);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100312
313 return IRQ_HANDLED;
314}
315
Martyn Welch29848ac2010-02-18 15:13:05 +0000316static int tsi148_irq_init(struct vme_bridge *tsi148_bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100317{
318 int result;
319 unsigned int tmp;
320 struct pci_dev *pdev;
Martyn Welch29848ac2010-02-18 15:13:05 +0000321 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100322
Martyn Welch29848ac2010-02-18 15:13:05 +0000323 pdev = container_of(tsi148_bridge->parent, struct pci_dev, dev);
324
325 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100326
327 /* Initialise list for VME bus errors */
Emilio G. Cota886953e2010-11-12 11:14:07 +0000328 INIT_LIST_HEAD(&tsi148_bridge->vme_errors);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100329
Emilio G. Cota886953e2010-11-12 11:14:07 +0000330 mutex_init(&tsi148_bridge->irq_mtx);
Martyn Welchc813f592009-10-29 16:34:54 +0000331
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100332 result = request_irq(pdev->irq,
333 tsi148_irqhandler,
334 IRQF_SHARED,
Martyn Welch29848ac2010-02-18 15:13:05 +0000335 driver_name, tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100336 if (result) {
Martyn Welch48d93562010-03-22 14:58:50 +0000337 dev_err(tsi148_bridge->parent, "Can't get assigned pci irq "
338 "vector %02X\n", pdev->irq);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100339 return result;
340 }
341
342 /* Enable and unmask interrupts */
343 tmp = TSI148_LCSR_INTEO_DMA1EO | TSI148_LCSR_INTEO_DMA0EO |
344 TSI148_LCSR_INTEO_MB3EO | TSI148_LCSR_INTEO_MB2EO |
345 TSI148_LCSR_INTEO_MB1EO | TSI148_LCSR_INTEO_MB0EO |
346 TSI148_LCSR_INTEO_PERREO | TSI148_LCSR_INTEO_VERREO |
347 TSI148_LCSR_INTEO_IACKEO;
348
Martyn Welch29848ac2010-02-18 15:13:05 +0000349 /* This leaves the following interrupts masked.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100350 * TSI148_LCSR_INTEO_VIEEO
351 * TSI148_LCSR_INTEO_SYSFLEO
352 * TSI148_LCSR_INTEO_ACFLEO
353 */
354
355 /* Don't enable Location Monitor interrupts here - they will be
356 * enabled when the location monitors are properly configured and
357 * a callback has been attached.
358 * TSI148_LCSR_INTEO_LM0EO
359 * TSI148_LCSR_INTEO_LM1EO
360 * TSI148_LCSR_INTEO_LM2EO
361 * TSI148_LCSR_INTEO_LM3EO
362 */
363
364 /* Don't enable VME interrupts until we add a handler, else the board
365 * will respond to it and we don't want that unless it knows how to
366 * properly deal with it.
367 * TSI148_LCSR_INTEO_IRQ7EO
368 * TSI148_LCSR_INTEO_IRQ6EO
369 * TSI148_LCSR_INTEO_IRQ5EO
370 * TSI148_LCSR_INTEO_IRQ4EO
371 * TSI148_LCSR_INTEO_IRQ3EO
372 * TSI148_LCSR_INTEO_IRQ2EO
373 * TSI148_LCSR_INTEO_IRQ1EO
374 */
375
376 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
377 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
378
379 return 0;
380}
381
Emilio G. Cotaa82ad052010-11-12 11:14:47 +0000382static void tsi148_irq_exit(struct vme_bridge *tsi148_bridge,
383 struct pci_dev *pdev)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100384{
Emilio G. Cotaa82ad052010-11-12 11:14:47 +0000385 struct tsi148_driver *bridge = tsi148_bridge->driver_priv;
386
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100387 /* Turn off interrupts */
Martyn Welch29848ac2010-02-18 15:13:05 +0000388 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTEO);
389 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100390
391 /* Clear all interrupts */
Martyn Welch29848ac2010-02-18 15:13:05 +0000392 iowrite32be(0xFFFFFFFF, bridge->base + TSI148_LCSR_INTC);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100393
394 /* Detach interrupt handler */
Emilio G. Cotaa82ad052010-11-12 11:14:47 +0000395 free_irq(pdev->irq, tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100396}
397
398/*
399 * Check to see if an IACk has been received, return true (1) or false (0).
400 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000401static int tsi148_iack_received(struct tsi148_driver *bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100402{
403 u32 tmp;
404
Martyn Welch29848ac2010-02-18 15:13:05 +0000405 tmp = ioread32be(bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100406
407 if (tmp & TSI148_LCSR_VICR_IRQS)
408 return 0;
409 else
410 return 1;
411}
412
413/*
Martyn Welchc813f592009-10-29 16:34:54 +0000414 * Configure VME interrupt
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100415 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000416static void tsi148_irq_set(struct vme_bridge *tsi148_bridge, int level,
Martyn Welch29848ac2010-02-18 15:13:05 +0000417 int state, int sync)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100418{
Martyn Welch75155022009-08-11 13:50:49 +0100419 struct pci_dev *pdev;
Martyn Welchc813f592009-10-29 16:34:54 +0000420 u32 tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +0000421 struct tsi148_driver *bridge;
422
423 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100424
Martyn Welchc813f592009-10-29 16:34:54 +0000425 /* We need to do the ordering differently for enabling and disabling */
426 if (state == 0) {
Martyn Welch29848ac2010-02-18 15:13:05 +0000427 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100428 tmp &= ~TSI148_LCSR_INTEN_IRQEN[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000429 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchdf455172009-08-05 17:38:31 +0100430
Martyn Welch29848ac2010-02-18 15:13:05 +0000431 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchdf455172009-08-05 17:38:31 +0100432 tmp &= ~TSI148_LCSR_INTEO_IRQEO[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000433 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welch75155022009-08-11 13:50:49 +0100434
Martyn Welchc813f592009-10-29 16:34:54 +0000435 if (sync != 0) {
436 pdev = container_of(tsi148_bridge->parent,
437 struct pci_dev, dev);
Martyn Welch75155022009-08-11 13:50:49 +0100438
Martyn Welchc813f592009-10-29 16:34:54 +0000439 synchronize_irq(pdev->irq);
440 }
441 } else {
Martyn Welch29848ac2010-02-18 15:13:05 +0000442 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchc813f592009-10-29 16:34:54 +0000443 tmp |= TSI148_LCSR_INTEO_IRQEO[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000444 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welchc813f592009-10-29 16:34:54 +0000445
Martyn Welch29848ac2010-02-18 15:13:05 +0000446 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchc813f592009-10-29 16:34:54 +0000447 tmp |= TSI148_LCSR_INTEN_IRQEN[level - 1];
Martyn Welch29848ac2010-02-18 15:13:05 +0000448 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100449 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100450}
451
452/*
453 * Generate a VME bus interrupt at the requested level & vector. Wait for
454 * interrupt to be acked.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100455 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000456static int tsi148_irq_generate(struct vme_bridge *tsi148_bridge, int level,
457 int statid)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100458{
459 u32 tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +0000460 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100461
Martyn Welch29848ac2010-02-18 15:13:05 +0000462 bridge = tsi148_bridge->driver_priv;
463
Emilio G. Cota886953e2010-11-12 11:14:07 +0000464 mutex_lock(&bridge->vme_int);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100465
466 /* Read VICR register */
Martyn Welch29848ac2010-02-18 15:13:05 +0000467 tmp = ioread32be(bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100468
469 /* Set Status/ID */
470 tmp = (tmp & ~TSI148_LCSR_VICR_STID_M) |
471 (statid & TSI148_LCSR_VICR_STID_M);
Martyn Welch29848ac2010-02-18 15:13:05 +0000472 iowrite32be(tmp, bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100473
474 /* Assert VMEbus IRQ */
475 tmp = tmp | TSI148_LCSR_VICR_IRQL[level];
Martyn Welch29848ac2010-02-18 15:13:05 +0000476 iowrite32be(tmp, bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100477
478 /* XXX Consider implementing a timeout? */
Martyn Welch29848ac2010-02-18 15:13:05 +0000479 wait_event_interruptible(bridge->iack_queue,
480 tsi148_iack_received(bridge));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100481
Emilio G. Cota886953e2010-11-12 11:14:07 +0000482 mutex_unlock(&bridge->vme_int);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100483
484 return 0;
485}
486
487/*
488 * Find the first error in this address range
489 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000490static struct vme_bus_error *tsi148_find_error(struct vme_bridge *tsi148_bridge,
Martyn Welch6af04b02011-12-01 17:06:29 +0000491 u32 aspace, unsigned long long address, size_t count)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100492{
493 struct list_head *err_pos;
494 struct vme_bus_error *vme_err, *valid = NULL;
495 unsigned long long bound;
496
497 bound = address + count;
498
499 /*
500 * XXX We are currently not looking at the address space when parsing
501 * for errors. This is because parsing the Address Modifier Codes
502 * is going to be quite resource intensive to do properly. We
503 * should be OK just looking at the addresses and this is certainly
504 * much better than what we had before.
505 */
506 err_pos = NULL;
507 /* Iterate through errors */
Emilio G. Cota886953e2010-11-12 11:14:07 +0000508 list_for_each(err_pos, &tsi148_bridge->vme_errors) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100509 vme_err = list_entry(err_pos, struct vme_bus_error, list);
Martyn Welch79463282010-03-22 14:58:57 +0000510 if ((vme_err->address >= address) &&
511 (vme_err->address < bound)) {
512
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100513 valid = vme_err;
514 break;
515 }
516 }
517
518 return valid;
519}
520
521/*
522 * Clear errors in the provided address range.
523 */
Martyn Welch29848ac2010-02-18 15:13:05 +0000524static void tsi148_clear_errors(struct vme_bridge *tsi148_bridge,
Martyn Welch6af04b02011-12-01 17:06:29 +0000525 u32 aspace, unsigned long long address, size_t count)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100526{
527 struct list_head *err_pos, *temp;
528 struct vme_bus_error *vme_err;
529 unsigned long long bound;
530
531 bound = address + count;
532
533 /*
534 * XXX We are currently not looking at the address space when parsing
535 * for errors. This is because parsing the Address Modifier Codes
536 * is going to be quite resource intensive to do properly. We
537 * should be OK just looking at the addresses and this is certainly
538 * much better than what we had before.
539 */
540 err_pos = NULL;
541 /* Iterate through errors */
Emilio G. Cota886953e2010-11-12 11:14:07 +0000542 list_for_each_safe(err_pos, temp, &tsi148_bridge->vme_errors) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100543 vme_err = list_entry(err_pos, struct vme_bus_error, list);
544
Martyn Welch79463282010-03-22 14:58:57 +0000545 if ((vme_err->address >= address) &&
546 (vme_err->address < bound)) {
547
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100548 list_del(err_pos);
549 kfree(vme_err);
550 }
551 }
552}
553
554/*
555 * Initialize a slave window with the requested attributes.
556 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000557static int tsi148_slave_set(struct vme_slave_resource *image, int enabled,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100558 unsigned long long vme_base, unsigned long long size,
Martyn Welch6af04b02011-12-01 17:06:29 +0000559 dma_addr_t pci_base, u32 aspace, u32 cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100560{
561 unsigned int i, addr = 0, granularity = 0;
562 unsigned int temp_ctl = 0;
563 unsigned int vme_base_low, vme_base_high;
564 unsigned int vme_bound_low, vme_bound_high;
565 unsigned int pci_offset_low, pci_offset_high;
566 unsigned long long vme_bound, pci_offset;
Martyn Welch48d93562010-03-22 14:58:50 +0000567 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +0000568 struct tsi148_driver *bridge;
569
Martyn Welch48d93562010-03-22 14:58:50 +0000570 tsi148_bridge = image->parent;
571 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100572
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100573 i = image->number;
574
575 switch (aspace) {
576 case VME_A16:
577 granularity = 0x10;
578 addr |= TSI148_LCSR_ITAT_AS_A16;
579 break;
580 case VME_A24:
581 granularity = 0x1000;
582 addr |= TSI148_LCSR_ITAT_AS_A24;
583 break;
584 case VME_A32:
585 granularity = 0x10000;
586 addr |= TSI148_LCSR_ITAT_AS_A32;
587 break;
588 case VME_A64:
589 granularity = 0x10000;
590 addr |= TSI148_LCSR_ITAT_AS_A64;
591 break;
592 case VME_CRCSR:
593 case VME_USER1:
594 case VME_USER2:
595 case VME_USER3:
596 case VME_USER4:
597 default:
Martyn Welch48d93562010-03-22 14:58:50 +0000598 dev_err(tsi148_bridge->parent, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100599 return -EINVAL;
600 break;
601 }
602
603 /* Convert 64-bit variables to 2x 32-bit variables */
604 reg_split(vme_base, &vme_base_high, &vme_base_low);
605
606 /*
607 * Bound address is a valid address for the window, adjust
608 * accordingly
609 */
610 vme_bound = vme_base + size - granularity;
611 reg_split(vme_bound, &vme_bound_high, &vme_bound_low);
612 pci_offset = (unsigned long long)pci_base - vme_base;
613 reg_split(pci_offset, &pci_offset_high, &pci_offset_low);
614
615 if (vme_base_low & (granularity - 1)) {
Martyn Welch48d93562010-03-22 14:58:50 +0000616 dev_err(tsi148_bridge->parent, "Invalid VME base alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100617 return -EINVAL;
618 }
619 if (vme_bound_low & (granularity - 1)) {
Martyn Welch48d93562010-03-22 14:58:50 +0000620 dev_err(tsi148_bridge->parent, "Invalid VME bound alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100621 return -EINVAL;
622 }
623 if (pci_offset_low & (granularity - 1)) {
Martyn Welch48d93562010-03-22 14:58:50 +0000624 dev_err(tsi148_bridge->parent, "Invalid PCI Offset "
625 "alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100626 return -EINVAL;
627 }
628
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100629 /* Disable while we are mucking around */
Martyn Welch29848ac2010-02-18 15:13:05 +0000630 temp_ctl = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100631 TSI148_LCSR_OFFSET_ITAT);
632 temp_ctl &= ~TSI148_LCSR_ITAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +0000633 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100634 TSI148_LCSR_OFFSET_ITAT);
635
636 /* Setup mapping */
Martyn Welch29848ac2010-02-18 15:13:05 +0000637 iowrite32be(vme_base_high, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100638 TSI148_LCSR_OFFSET_ITSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000639 iowrite32be(vme_base_low, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100640 TSI148_LCSR_OFFSET_ITSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000641 iowrite32be(vme_bound_high, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100642 TSI148_LCSR_OFFSET_ITEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000643 iowrite32be(vme_bound_low, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100644 TSI148_LCSR_OFFSET_ITEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000645 iowrite32be(pci_offset_high, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100646 TSI148_LCSR_OFFSET_ITOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000647 iowrite32be(pci_offset_low, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100648 TSI148_LCSR_OFFSET_ITOFL);
649
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100650 /* Setup 2eSST speeds */
651 temp_ctl &= ~TSI148_LCSR_ITAT_2eSSTM_M;
652 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
653 case VME_2eSST160:
654 temp_ctl |= TSI148_LCSR_ITAT_2eSSTM_160;
655 break;
656 case VME_2eSST267:
657 temp_ctl |= TSI148_LCSR_ITAT_2eSSTM_267;
658 break;
659 case VME_2eSST320:
660 temp_ctl |= TSI148_LCSR_ITAT_2eSSTM_320;
661 break;
662 }
663
664 /* Setup cycle types */
665 temp_ctl &= ~(0x1F << 7);
666 if (cycle & VME_BLT)
667 temp_ctl |= TSI148_LCSR_ITAT_BLT;
668 if (cycle & VME_MBLT)
669 temp_ctl |= TSI148_LCSR_ITAT_MBLT;
670 if (cycle & VME_2eVME)
671 temp_ctl |= TSI148_LCSR_ITAT_2eVME;
672 if (cycle & VME_2eSST)
673 temp_ctl |= TSI148_LCSR_ITAT_2eSST;
674 if (cycle & VME_2eSSTB)
675 temp_ctl |= TSI148_LCSR_ITAT_2eSSTB;
676
677 /* Setup address space */
678 temp_ctl &= ~TSI148_LCSR_ITAT_AS_M;
679 temp_ctl |= addr;
680
681 temp_ctl &= ~0xF;
682 if (cycle & VME_SUPER)
683 temp_ctl |= TSI148_LCSR_ITAT_SUPR ;
684 if (cycle & VME_USER)
685 temp_ctl |= TSI148_LCSR_ITAT_NPRIV;
686 if (cycle & VME_PROG)
687 temp_ctl |= TSI148_LCSR_ITAT_PGM;
688 if (cycle & VME_DATA)
689 temp_ctl |= TSI148_LCSR_ITAT_DATA;
690
691 /* Write ctl reg without enable */
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 if (enabled)
696 temp_ctl |= TSI148_LCSR_ITAT_EN;
697
Martyn Welch29848ac2010-02-18 15:13:05 +0000698 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100699 TSI148_LCSR_OFFSET_ITAT);
700
701 return 0;
702}
703
704/*
705 * Get slave window configuration.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100706 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000707static int tsi148_slave_get(struct vme_slave_resource *image, int *enabled,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100708 unsigned long long *vme_base, unsigned long long *size,
Martyn Welch6af04b02011-12-01 17:06:29 +0000709 dma_addr_t *pci_base, u32 *aspace, u32 *cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100710{
711 unsigned int i, granularity = 0, ctl = 0;
712 unsigned int vme_base_low, vme_base_high;
713 unsigned int vme_bound_low, vme_bound_high;
714 unsigned int pci_offset_low, pci_offset_high;
715 unsigned long long vme_bound, pci_offset;
Martyn Welch29848ac2010-02-18 15:13:05 +0000716 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100717
Martyn Welch29848ac2010-02-18 15:13:05 +0000718 bridge = image->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100719
720 i = image->number;
721
722 /* Read registers */
Martyn Welch29848ac2010-02-18 15:13:05 +0000723 ctl = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100724 TSI148_LCSR_OFFSET_ITAT);
725
Martyn Welch29848ac2010-02-18 15:13:05 +0000726 vme_base_high = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100727 TSI148_LCSR_OFFSET_ITSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000728 vme_base_low = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100729 TSI148_LCSR_OFFSET_ITSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000730 vme_bound_high = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100731 TSI148_LCSR_OFFSET_ITEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000732 vme_bound_low = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100733 TSI148_LCSR_OFFSET_ITEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +0000734 pci_offset_high = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100735 TSI148_LCSR_OFFSET_ITOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +0000736 pci_offset_low = ioread32be(bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100737 TSI148_LCSR_OFFSET_ITOFL);
738
739 /* Convert 64-bit variables to 2x 32-bit variables */
740 reg_join(vme_base_high, vme_base_low, vme_base);
741 reg_join(vme_bound_high, vme_bound_low, &vme_bound);
742 reg_join(pci_offset_high, pci_offset_low, &pci_offset);
743
744 *pci_base = (dma_addr_t)vme_base + pci_offset;
745
746 *enabled = 0;
747 *aspace = 0;
748 *cycle = 0;
749
750 if (ctl & TSI148_LCSR_ITAT_EN)
751 *enabled = 1;
752
753 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A16) {
754 granularity = 0x10;
755 *aspace |= VME_A16;
756 }
757 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A24) {
758 granularity = 0x1000;
759 *aspace |= VME_A24;
760 }
761 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A32) {
762 granularity = 0x10000;
763 *aspace |= VME_A32;
764 }
765 if ((ctl & TSI148_LCSR_ITAT_AS_M) == TSI148_LCSR_ITAT_AS_A64) {
766 granularity = 0x10000;
767 *aspace |= VME_A64;
768 }
769
770 /* Need granularity before we set the size */
771 *size = (unsigned long long)((vme_bound - *vme_base) + granularity);
772
773
774 if ((ctl & TSI148_LCSR_ITAT_2eSSTM_M) == TSI148_LCSR_ITAT_2eSSTM_160)
775 *cycle |= VME_2eSST160;
776 if ((ctl & TSI148_LCSR_ITAT_2eSSTM_M) == TSI148_LCSR_ITAT_2eSSTM_267)
777 *cycle |= VME_2eSST267;
778 if ((ctl & TSI148_LCSR_ITAT_2eSSTM_M) == TSI148_LCSR_ITAT_2eSSTM_320)
779 *cycle |= VME_2eSST320;
780
781 if (ctl & TSI148_LCSR_ITAT_BLT)
782 *cycle |= VME_BLT;
783 if (ctl & TSI148_LCSR_ITAT_MBLT)
784 *cycle |= VME_MBLT;
785 if (ctl & TSI148_LCSR_ITAT_2eVME)
786 *cycle |= VME_2eVME;
787 if (ctl & TSI148_LCSR_ITAT_2eSST)
788 *cycle |= VME_2eSST;
789 if (ctl & TSI148_LCSR_ITAT_2eSSTB)
790 *cycle |= VME_2eSSTB;
791
792 if (ctl & TSI148_LCSR_ITAT_SUPR)
793 *cycle |= VME_SUPER;
794 if (ctl & TSI148_LCSR_ITAT_NPRIV)
795 *cycle |= VME_USER;
796 if (ctl & TSI148_LCSR_ITAT_PGM)
797 *cycle |= VME_PROG;
798 if (ctl & TSI148_LCSR_ITAT_DATA)
799 *cycle |= VME_DATA;
800
801 return 0;
802}
803
804/*
805 * Allocate and map PCI Resource
806 */
807static int tsi148_alloc_resource(struct vme_master_resource *image,
808 unsigned long long size)
809{
810 unsigned long long existing_size;
811 int retval = 0;
812 struct pci_dev *pdev;
Martyn Welch29848ac2010-02-18 15:13:05 +0000813 struct vme_bridge *tsi148_bridge;
814
815 tsi148_bridge = image->parent;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100816
Martyn Welch48d93562010-03-22 14:58:50 +0000817 pdev = container_of(tsi148_bridge->parent, struct pci_dev, dev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100818
Martyn Welch8fafb472010-02-18 15:13:12 +0000819 existing_size = (unsigned long long)(image->bus_resource.end -
820 image->bus_resource.start);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100821
822 /* If the existing size is OK, return */
Martyn Welch59c22902009-10-29 16:35:01 +0000823 if ((size != 0) && (existing_size == (size - 1)))
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100824 return 0;
825
826 if (existing_size != 0) {
827 iounmap(image->kern_base);
828 image->kern_base = NULL;
Ilia Mirkin794a8942011-03-13 00:29:13 -0500829 kfree(image->bus_resource.name);
Emilio G. Cota886953e2010-11-12 11:14:07 +0000830 release_resource(&image->bus_resource);
831 memset(&image->bus_resource, 0, sizeof(struct resource));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100832 }
833
Martyn Welch59c22902009-10-29 16:35:01 +0000834 /* Exit here if size is zero */
Martyn Welch79463282010-03-22 14:58:57 +0000835 if (size == 0)
Martyn Welch59c22902009-10-29 16:35:01 +0000836 return 0;
Martyn Welch59c22902009-10-29 16:35:01 +0000837
Martyn Welch8fafb472010-02-18 15:13:12 +0000838 if (image->bus_resource.name == NULL) {
Julia Lawall0aa3f132010-05-30 22:27:46 +0200839 image->bus_resource.name = kmalloc(VMENAMSIZ+3, GFP_ATOMIC);
Martyn Welch8fafb472010-02-18 15:13:12 +0000840 if (image->bus_resource.name == NULL) {
Martyn Welch48d93562010-03-22 14:58:50 +0000841 dev_err(tsi148_bridge->parent, "Unable to allocate "
842 "memory for resource name\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100843 retval = -ENOMEM;
844 goto err_name;
845 }
846 }
847
Martyn Welch8fafb472010-02-18 15:13:12 +0000848 sprintf((char *)image->bus_resource.name, "%s.%d", tsi148_bridge->name,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100849 image->number);
850
Martyn Welch8fafb472010-02-18 15:13:12 +0000851 image->bus_resource.start = 0;
852 image->bus_resource.end = (unsigned long)size;
853 image->bus_resource.flags = IORESOURCE_MEM;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100854
855 retval = pci_bus_alloc_resource(pdev->bus,
Emilio G. Cota886953e2010-11-12 11:14:07 +0000856 &image->bus_resource, size, size, PCIBIOS_MIN_MEM,
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100857 0, NULL, NULL);
858 if (retval) {
Martyn Welch48d93562010-03-22 14:58:50 +0000859 dev_err(tsi148_bridge->parent, "Failed to allocate mem "
860 "resource for window %d size 0x%lx start 0x%lx\n",
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100861 image->number, (unsigned long)size,
Martyn Welch8fafb472010-02-18 15:13:12 +0000862 (unsigned long)image->bus_resource.start);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100863 goto err_resource;
864 }
865
866 image->kern_base = ioremap_nocache(
Martyn Welch8fafb472010-02-18 15:13:12 +0000867 image->bus_resource.start, size);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100868 if (image->kern_base == NULL) {
Martyn Welch48d93562010-03-22 14:58:50 +0000869 dev_err(tsi148_bridge->parent, "Failed to remap resource\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100870 retval = -ENOMEM;
871 goto err_remap;
872 }
873
874 return 0;
875
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100876err_remap:
Emilio G. Cota886953e2010-11-12 11:14:07 +0000877 release_resource(&image->bus_resource);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100878err_resource:
Martyn Welch8fafb472010-02-18 15:13:12 +0000879 kfree(image->bus_resource.name);
Emilio G. Cota886953e2010-11-12 11:14:07 +0000880 memset(&image->bus_resource, 0, sizeof(struct resource));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100881err_name:
882 return retval;
883}
884
885/*
886 * Free and unmap PCI Resource
887 */
888static void tsi148_free_resource(struct vme_master_resource *image)
889{
890 iounmap(image->kern_base);
891 image->kern_base = NULL;
Emilio G. Cota886953e2010-11-12 11:14:07 +0000892 release_resource(&image->bus_resource);
Martyn Welch8fafb472010-02-18 15:13:12 +0000893 kfree(image->bus_resource.name);
Emilio G. Cota886953e2010-11-12 11:14:07 +0000894 memset(&image->bus_resource, 0, sizeof(struct resource));
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100895}
896
897/*
898 * Set the attributes of an outbound window.
899 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +0000900static int tsi148_master_set(struct vme_master_resource *image, int enabled,
Martyn Welch6af04b02011-12-01 17:06:29 +0000901 unsigned long long vme_base, unsigned long long size, u32 aspace,
902 u32 cycle, u32 dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100903{
904 int retval = 0;
905 unsigned int i;
906 unsigned int temp_ctl = 0;
907 unsigned int pci_base_low, pci_base_high;
908 unsigned int pci_bound_low, pci_bound_high;
909 unsigned int vme_offset_low, vme_offset_high;
910 unsigned long long pci_bound, vme_offset, pci_base;
Martyn Welch48d93562010-03-22 14:58:50 +0000911 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +0000912 struct tsi148_driver *bridge;
913
Martyn Welch48d93562010-03-22 14:58:50 +0000914 tsi148_bridge = image->parent;
915
916 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100917
918 /* Verify input data */
919 if (vme_base & 0xFFFF) {
Martyn Welch48d93562010-03-22 14:58:50 +0000920 dev_err(tsi148_bridge->parent, "Invalid VME Window "
921 "alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100922 retval = -EINVAL;
923 goto err_window;
924 }
Martyn Welch59c22902009-10-29 16:35:01 +0000925
926 if ((size == 0) && (enabled != 0)) {
Martyn Welch48d93562010-03-22 14:58:50 +0000927 dev_err(tsi148_bridge->parent, "Size must be non-zero for "
928 "enabled windows\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100929 retval = -EINVAL;
930 goto err_window;
931 }
932
Emilio G. Cota886953e2010-11-12 11:14:07 +0000933 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100934
935 /* Let's allocate the resource here rather than further up the stack as
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300936 * it avoids pushing loads of bus dependent stuff up the stack. If size
Martyn Welch59c22902009-10-29 16:35:01 +0000937 * is zero, any existing resource will be freed.
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100938 */
939 retval = tsi148_alloc_resource(image, size);
940 if (retval) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000941 spin_unlock(&image->lock);
Martyn Welch48d93562010-03-22 14:58:50 +0000942 dev_err(tsi148_bridge->parent, "Unable to allocate memory for "
Martyn Welch59c22902009-10-29 16:35:01 +0000943 "resource\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100944 goto err_res;
945 }
946
Martyn Welch59c22902009-10-29 16:35:01 +0000947 if (size == 0) {
948 pci_base = 0;
949 pci_bound = 0;
950 vme_offset = 0;
951 } else {
Martyn Welch8fafb472010-02-18 15:13:12 +0000952 pci_base = (unsigned long long)image->bus_resource.start;
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100953
Martyn Welch59c22902009-10-29 16:35:01 +0000954 /*
955 * Bound address is a valid address for the window, adjust
956 * according to window granularity.
957 */
958 pci_bound = pci_base + (size - 0x10000);
959 vme_offset = vme_base - pci_base;
960 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100961
962 /* Convert 64-bit variables to 2x 32-bit variables */
963 reg_split(pci_base, &pci_base_high, &pci_base_low);
964 reg_split(pci_bound, &pci_bound_high, &pci_bound_low);
965 reg_split(vme_offset, &vme_offset_high, &vme_offset_low);
966
967 if (pci_base_low & 0xFFFF) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000968 spin_unlock(&image->lock);
Martyn Welch48d93562010-03-22 14:58:50 +0000969 dev_err(tsi148_bridge->parent, "Invalid PCI base alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100970 retval = -EINVAL;
971 goto err_gran;
972 }
973 if (pci_bound_low & 0xFFFF) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000974 spin_unlock(&image->lock);
Martyn Welch48d93562010-03-22 14:58:50 +0000975 dev_err(tsi148_bridge->parent, "Invalid PCI bound alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100976 retval = -EINVAL;
977 goto err_gran;
978 }
979 if (vme_offset_low & 0xFFFF) {
Emilio G. Cota886953e2010-11-12 11:14:07 +0000980 spin_unlock(&image->lock);
Martyn Welch48d93562010-03-22 14:58:50 +0000981 dev_err(tsi148_bridge->parent, "Invalid VME Offset "
982 "alignment\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100983 retval = -EINVAL;
984 goto err_gran;
985 }
986
987 i = image->number;
988
989 /* Disable while we are mucking around */
Martyn Welch29848ac2010-02-18 15:13:05 +0000990 temp_ctl = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100991 TSI148_LCSR_OFFSET_OTAT);
992 temp_ctl &= ~TSI148_LCSR_OTAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +0000993 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100994 TSI148_LCSR_OFFSET_OTAT);
995
Martyn Welchd22b8ed2009-07-31 09:28:17 +0100996 /* Setup 2eSST speeds */
997 temp_ctl &= ~TSI148_LCSR_OTAT_2eSSTM_M;
998 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
999 case VME_2eSST160:
1000 temp_ctl |= TSI148_LCSR_OTAT_2eSSTM_160;
1001 break;
1002 case VME_2eSST267:
1003 temp_ctl |= TSI148_LCSR_OTAT_2eSSTM_267;
1004 break;
1005 case VME_2eSST320:
1006 temp_ctl |= TSI148_LCSR_OTAT_2eSSTM_320;
1007 break;
1008 }
1009
1010 /* Setup cycle types */
1011 if (cycle & VME_BLT) {
1012 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1013 temp_ctl |= TSI148_LCSR_OTAT_TM_BLT;
1014 }
1015 if (cycle & VME_MBLT) {
1016 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1017 temp_ctl |= TSI148_LCSR_OTAT_TM_MBLT;
1018 }
1019 if (cycle & VME_2eVME) {
1020 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1021 temp_ctl |= TSI148_LCSR_OTAT_TM_2eVME;
1022 }
1023 if (cycle & VME_2eSST) {
1024 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1025 temp_ctl |= TSI148_LCSR_OTAT_TM_2eSST;
1026 }
1027 if (cycle & VME_2eSSTB) {
Martyn Welch48d93562010-03-22 14:58:50 +00001028 dev_warn(tsi148_bridge->parent, "Currently not setting "
1029 "Broadcast Select Registers\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001030 temp_ctl &= ~TSI148_LCSR_OTAT_TM_M;
1031 temp_ctl |= TSI148_LCSR_OTAT_TM_2eSSTB;
1032 }
1033
1034 /* Setup data width */
1035 temp_ctl &= ~TSI148_LCSR_OTAT_DBW_M;
1036 switch (dwidth) {
1037 case VME_D16:
1038 temp_ctl |= TSI148_LCSR_OTAT_DBW_16;
1039 break;
1040 case VME_D32:
1041 temp_ctl |= TSI148_LCSR_OTAT_DBW_32;
1042 break;
1043 default:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001044 spin_unlock(&image->lock);
Martyn Welch48d93562010-03-22 14:58:50 +00001045 dev_err(tsi148_bridge->parent, "Invalid data width\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001046 retval = -EINVAL;
1047 goto err_dwidth;
1048 }
1049
1050 /* Setup address space */
1051 temp_ctl &= ~TSI148_LCSR_OTAT_AMODE_M;
1052 switch (aspace) {
1053 case VME_A16:
1054 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A16;
1055 break;
1056 case VME_A24:
1057 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A24;
1058 break;
1059 case VME_A32:
1060 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A32;
1061 break;
1062 case VME_A64:
1063 temp_ctl |= TSI148_LCSR_OTAT_AMODE_A64;
1064 break;
1065 case VME_CRCSR:
1066 temp_ctl |= TSI148_LCSR_OTAT_AMODE_CRCSR;
1067 break;
1068 case VME_USER1:
1069 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER1;
1070 break;
1071 case VME_USER2:
1072 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER2;
1073 break;
1074 case VME_USER3:
1075 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER3;
1076 break;
1077 case VME_USER4:
1078 temp_ctl |= TSI148_LCSR_OTAT_AMODE_USER4;
1079 break;
1080 default:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001081 spin_unlock(&image->lock);
Martyn Welch48d93562010-03-22 14:58:50 +00001082 dev_err(tsi148_bridge->parent, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001083 retval = -EINVAL;
1084 goto err_aspace;
1085 break;
1086 }
1087
1088 temp_ctl &= ~(3<<4);
1089 if (cycle & VME_SUPER)
1090 temp_ctl |= TSI148_LCSR_OTAT_SUP;
1091 if (cycle & VME_PROG)
1092 temp_ctl |= TSI148_LCSR_OTAT_PGM;
1093
1094 /* Setup mapping */
Martyn Welch29848ac2010-02-18 15:13:05 +00001095 iowrite32be(pci_base_high, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001096 TSI148_LCSR_OFFSET_OTSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001097 iowrite32be(pci_base_low, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001098 TSI148_LCSR_OFFSET_OTSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001099 iowrite32be(pci_bound_high, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001100 TSI148_LCSR_OFFSET_OTEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001101 iowrite32be(pci_bound_low, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001102 TSI148_LCSR_OFFSET_OTEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001103 iowrite32be(vme_offset_high, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001104 TSI148_LCSR_OFFSET_OTOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001105 iowrite32be(vme_offset_low, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001106 TSI148_LCSR_OFFSET_OTOFL);
1107
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001108 /* Write ctl reg without enable */
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
1112 if (enabled)
1113 temp_ctl |= TSI148_LCSR_OTAT_EN;
1114
Martyn Welch29848ac2010-02-18 15:13:05 +00001115 iowrite32be(temp_ctl, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001116 TSI148_LCSR_OFFSET_OTAT);
1117
Emilio G. Cota886953e2010-11-12 11:14:07 +00001118 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001119 return 0;
1120
1121err_aspace:
1122err_dwidth:
1123err_gran:
1124 tsi148_free_resource(image);
1125err_res:
1126err_window:
1127 return retval;
1128
1129}
1130
1131/*
1132 * Set the attributes of an outbound window.
1133 *
1134 * XXX Not parsing prefetch information.
1135 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001136static int __tsi148_master_get(struct vme_master_resource *image, int *enabled,
Martyn Welch6af04b02011-12-01 17:06:29 +00001137 unsigned long long *vme_base, unsigned long long *size, u32 *aspace,
1138 u32 *cycle, u32 *dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001139{
1140 unsigned int i, ctl;
1141 unsigned int pci_base_low, pci_base_high;
1142 unsigned int pci_bound_low, pci_bound_high;
1143 unsigned int vme_offset_low, vme_offset_high;
1144
1145 unsigned long long pci_base, pci_bound, vme_offset;
Martyn Welch29848ac2010-02-18 15:13:05 +00001146 struct tsi148_driver *bridge;
1147
1148 bridge = image->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001149
1150 i = image->number;
1151
Martyn Welch29848ac2010-02-18 15:13:05 +00001152 ctl = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001153 TSI148_LCSR_OFFSET_OTAT);
1154
Martyn Welch29848ac2010-02-18 15:13:05 +00001155 pci_base_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001156 TSI148_LCSR_OFFSET_OTSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001157 pci_base_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001158 TSI148_LCSR_OFFSET_OTSAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001159 pci_bound_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001160 TSI148_LCSR_OFFSET_OTEAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001161 pci_bound_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001162 TSI148_LCSR_OFFSET_OTEAL);
Martyn Welch29848ac2010-02-18 15:13:05 +00001163 vme_offset_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001164 TSI148_LCSR_OFFSET_OTOFU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001165 vme_offset_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001166 TSI148_LCSR_OFFSET_OTOFL);
1167
1168 /* Convert 64-bit variables to 2x 32-bit variables */
1169 reg_join(pci_base_high, pci_base_low, &pci_base);
1170 reg_join(pci_bound_high, pci_bound_low, &pci_bound);
1171 reg_join(vme_offset_high, vme_offset_low, &vme_offset);
1172
1173 *vme_base = pci_base + vme_offset;
1174 *size = (unsigned long long)(pci_bound - pci_base) + 0x10000;
1175
1176 *enabled = 0;
1177 *aspace = 0;
1178 *cycle = 0;
1179 *dwidth = 0;
1180
1181 if (ctl & TSI148_LCSR_OTAT_EN)
1182 *enabled = 1;
1183
1184 /* Setup address space */
1185 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A16)
1186 *aspace |= VME_A16;
1187 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A24)
1188 *aspace |= VME_A24;
1189 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A32)
1190 *aspace |= VME_A32;
1191 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_A64)
1192 *aspace |= VME_A64;
1193 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_CRCSR)
1194 *aspace |= VME_CRCSR;
1195 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER1)
1196 *aspace |= VME_USER1;
1197 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER2)
1198 *aspace |= VME_USER2;
1199 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER3)
1200 *aspace |= VME_USER3;
1201 if ((ctl & TSI148_LCSR_OTAT_AMODE_M) == TSI148_LCSR_OTAT_AMODE_USER4)
1202 *aspace |= VME_USER4;
1203
1204 /* Setup 2eSST speeds */
1205 if ((ctl & TSI148_LCSR_OTAT_2eSSTM_M) == TSI148_LCSR_OTAT_2eSSTM_160)
1206 *cycle |= VME_2eSST160;
1207 if ((ctl & TSI148_LCSR_OTAT_2eSSTM_M) == TSI148_LCSR_OTAT_2eSSTM_267)
1208 *cycle |= VME_2eSST267;
1209 if ((ctl & TSI148_LCSR_OTAT_2eSSTM_M) == TSI148_LCSR_OTAT_2eSSTM_320)
1210 *cycle |= VME_2eSST320;
1211
1212 /* Setup cycle types */
Martyn Welch79463282010-03-22 14:58:57 +00001213 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_SCT)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001214 *cycle |= VME_SCT;
Martyn Welch79463282010-03-22 14:58:57 +00001215 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_BLT)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001216 *cycle |= VME_BLT;
Martyn Welch79463282010-03-22 14:58:57 +00001217 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_MBLT)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001218 *cycle |= VME_MBLT;
Martyn Welch79463282010-03-22 14:58:57 +00001219 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_2eVME)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001220 *cycle |= VME_2eVME;
Martyn Welch79463282010-03-22 14:58:57 +00001221 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_2eSST)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001222 *cycle |= VME_2eSST;
Martyn Welch79463282010-03-22 14:58:57 +00001223 if ((ctl & TSI148_LCSR_OTAT_TM_M) == TSI148_LCSR_OTAT_TM_2eSSTB)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001224 *cycle |= VME_2eSSTB;
1225
1226 if (ctl & TSI148_LCSR_OTAT_SUP)
1227 *cycle |= VME_SUPER;
1228 else
1229 *cycle |= VME_USER;
1230
1231 if (ctl & TSI148_LCSR_OTAT_PGM)
1232 *cycle |= VME_PROG;
1233 else
1234 *cycle |= VME_DATA;
1235
1236 /* Setup data width */
1237 if ((ctl & TSI148_LCSR_OTAT_DBW_M) == TSI148_LCSR_OTAT_DBW_16)
1238 *dwidth = VME_D16;
1239 if ((ctl & TSI148_LCSR_OTAT_DBW_M) == TSI148_LCSR_OTAT_DBW_32)
1240 *dwidth = VME_D32;
1241
1242 return 0;
1243}
1244
1245
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001246static int tsi148_master_get(struct vme_master_resource *image, int *enabled,
Martyn Welch6af04b02011-12-01 17:06:29 +00001247 unsigned long long *vme_base, unsigned long long *size, u32 *aspace,
1248 u32 *cycle, u32 *dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001249{
1250 int retval;
1251
Emilio G. Cota886953e2010-11-12 11:14:07 +00001252 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001253
1254 retval = __tsi148_master_get(image, enabled, vme_base, size, aspace,
1255 cycle, dwidth);
1256
Emilio G. Cota886953e2010-11-12 11:14:07 +00001257 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001258
1259 return retval;
1260}
1261
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001262static ssize_t tsi148_master_read(struct vme_master_resource *image, void *buf,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001263 size_t count, loff_t offset)
1264{
1265 int retval, enabled;
1266 unsigned long long vme_base, size;
Martyn Welch6af04b02011-12-01 17:06:29 +00001267 u32 aspace, cycle, dwidth;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001268 struct vme_bus_error *vme_err = NULL;
Martyn Welch29848ac2010-02-18 15:13:05 +00001269 struct vme_bridge *tsi148_bridge;
Jingoo Han4e8764d2013-08-19 16:40:15 +09001270 void __iomem *addr = image->kern_base + offset;
Martyn Welch363e2e62012-07-19 17:48:46 +01001271 unsigned int done = 0;
1272 unsigned int count32;
Martyn Welch29848ac2010-02-18 15:13:05 +00001273
1274 tsi148_bridge = image->parent;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001275
Emilio G. Cota886953e2010-11-12 11:14:07 +00001276 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001277
Martyn Welch363e2e62012-07-19 17:48:46 +01001278 /* The following code handles VME address alignment. We cannot use
Martyn Welcha2a720e2014-02-06 13:35:36 +00001279 * memcpy_xxx here because it may cut data transfers in to 8-bit
1280 * cycles when D16 or D32 cycles are required on the VME bus.
Martyn Welch363e2e62012-07-19 17:48:46 +01001281 * On the other hand, the bridge itself assures that the maximum data
1282 * cycle configured for the transfer is used and splits it
1283 * automatically for non-aligned addresses, so we don't want the
1284 * overhead of needlessly forcing small transfers for the entire cycle.
1285 */
1286 if ((uintptr_t)addr & 0x1) {
1287 *(u8 *)buf = ioread8(addr);
1288 done += 1;
1289 if (done == count)
1290 goto out;
1291 }
1292 if ((uintptr_t)addr & 0x2) {
1293 if ((count - done) < 2) {
1294 *(u8 *)(buf + done) = ioread8(addr + done);
1295 done += 1;
1296 goto out;
1297 } else {
1298 *(u16 *)(buf + done) = ioread16(addr + done);
1299 done += 2;
1300 }
1301 }
1302
1303 count32 = (count - done) & ~0x3;
Martyn Welcha2a720e2014-02-06 13:35:36 +00001304 while (done < count32) {
1305 *(u32 *)(buf + done) = ioread32(addr + done);
1306 done += 4;
Martyn Welch363e2e62012-07-19 17:48:46 +01001307 }
1308
1309 if ((count - done) & 0x2) {
1310 *(u16 *)(buf + done) = ioread16(addr + done);
1311 done += 2;
1312 }
1313 if ((count - done) & 0x1) {
1314 *(u8 *)(buf + done) = ioread8(addr + done);
1315 done += 1;
1316 }
1317
1318out:
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001319 retval = count;
1320
1321 if (!err_chk)
1322 goto skip_chk;
1323
1324 __tsi148_master_get(image, &enabled, &vme_base, &size, &aspace, &cycle,
1325 &dwidth);
1326
Martyn Welch29848ac2010-02-18 15:13:05 +00001327 vme_err = tsi148_find_error(tsi148_bridge, aspace, vme_base + offset,
1328 count);
Martyn Welch79463282010-03-22 14:58:57 +00001329 if (vme_err != NULL) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001330 dev_err(image->parent->parent, "First VME read error detected "
1331 "an at address 0x%llx\n", vme_err->address);
1332 retval = vme_err->address - (vme_base + offset);
1333 /* Clear down save errors in this address range */
Martyn Welch29848ac2010-02-18 15:13:05 +00001334 tsi148_clear_errors(tsi148_bridge, aspace, vme_base + offset,
1335 count);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001336 }
1337
1338skip_chk:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001339 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001340
1341 return retval;
1342}
1343
1344
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001345static ssize_t tsi148_master_write(struct vme_master_resource *image, void *buf,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001346 size_t count, loff_t offset)
1347{
1348 int retval = 0, enabled;
1349 unsigned long long vme_base, size;
Martyn Welch6af04b02011-12-01 17:06:29 +00001350 u32 aspace, cycle, dwidth;
Jingoo Han4e8764d2013-08-19 16:40:15 +09001351 void __iomem *addr = image->kern_base + offset;
Martyn Welch363e2e62012-07-19 17:48:46 +01001352 unsigned int done = 0;
1353 unsigned int count32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001354
1355 struct vme_bus_error *vme_err = NULL;
Martyn Welch29848ac2010-02-18 15:13:05 +00001356 struct vme_bridge *tsi148_bridge;
1357 struct tsi148_driver *bridge;
1358
1359 tsi148_bridge = image->parent;
1360
1361 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001362
Emilio G. Cota886953e2010-11-12 11:14:07 +00001363 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001364
Martyn Welch363e2e62012-07-19 17:48:46 +01001365 /* Here we apply for the same strategy we do in master_read
Martyn Welcha2a720e2014-02-06 13:35:36 +00001366 * function in order to assure the correct cycles.
Martyn Welch363e2e62012-07-19 17:48:46 +01001367 */
1368 if ((uintptr_t)addr & 0x1) {
1369 iowrite8(*(u8 *)buf, addr);
1370 done += 1;
1371 if (done == count)
1372 goto out;
1373 }
1374 if ((uintptr_t)addr & 0x2) {
1375 if ((count - done) < 2) {
1376 iowrite8(*(u8 *)(buf + done), addr + done);
1377 done += 1;
1378 goto out;
1379 } else {
1380 iowrite16(*(u16 *)(buf + done), addr + done);
1381 done += 2;
1382 }
1383 }
1384
1385 count32 = (count - done) & ~0x3;
Martyn Welcha2a720e2014-02-06 13:35:36 +00001386 while (done < count32) {
1387 iowrite32(*(u32 *)(buf + done), addr + done);
1388 done += 4;
Martyn Welch363e2e62012-07-19 17:48:46 +01001389 }
1390
1391 if ((count - done) & 0x2) {
1392 iowrite16(*(u16 *)(buf + done), addr + done);
1393 done += 2;
1394 }
1395 if ((count - done) & 0x1) {
1396 iowrite8(*(u8 *)(buf + done), addr + done);
1397 done += 1;
1398 }
1399
1400out:
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001401 retval = count;
1402
1403 /*
1404 * Writes are posted. We need to do a read on the VME bus to flush out
Lucas De Marchi25985ed2011-03-30 22:57:33 -03001405 * all of the writes before we check for errors. We can't guarantee
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001406 * that reading the data we have just written is safe. It is believed
1407 * that there isn't any read, write re-ordering, so we can read any
1408 * location in VME space, so lets read the Device ID from the tsi148's
1409 * own registers as mapped into CR/CSR space.
1410 *
1411 * We check for saved errors in the written address range/space.
1412 */
1413
1414 if (!err_chk)
1415 goto skip_chk;
1416
1417 /*
1418 * Get window info first, to maximise the time that the buffers may
1419 * fluch on their own
1420 */
1421 __tsi148_master_get(image, &enabled, &vme_base, &size, &aspace, &cycle,
1422 &dwidth);
1423
Martyn Welch29848ac2010-02-18 15:13:05 +00001424 ioread16(bridge->flush_image->kern_base + 0x7F000);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001425
Martyn Welch29848ac2010-02-18 15:13:05 +00001426 vme_err = tsi148_find_error(tsi148_bridge, aspace, vme_base + offset,
1427 count);
Martyn Welch79463282010-03-22 14:58:57 +00001428 if (vme_err != NULL) {
Martyn Welch48d93562010-03-22 14:58:50 +00001429 dev_warn(tsi148_bridge->parent, "First VME write error detected"
1430 " an at address 0x%llx\n", vme_err->address);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001431 retval = vme_err->address - (vme_base + offset);
1432 /* Clear down save errors in this address range */
Martyn Welch29848ac2010-02-18 15:13:05 +00001433 tsi148_clear_errors(tsi148_bridge, aspace, vme_base + offset,
1434 count);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001435 }
1436
1437skip_chk:
Emilio G. Cota886953e2010-11-12 11:14:07 +00001438 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001439
1440 return retval;
1441}
1442
1443/*
1444 * Perform an RMW cycle on the VME bus.
1445 *
1446 * Requires a previously configured master window, returns final value.
1447 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001448static unsigned int tsi148_master_rmw(struct vme_master_resource *image,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001449 unsigned int mask, unsigned int compare, unsigned int swap,
1450 loff_t offset)
1451{
1452 unsigned long long pci_addr;
1453 unsigned int pci_addr_high, pci_addr_low;
1454 u32 tmp, result;
1455 int i;
Martyn Welch29848ac2010-02-18 15:13:05 +00001456 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001457
Martyn Welch29848ac2010-02-18 15:13:05 +00001458 bridge = image->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001459
1460 /* Find the PCI address that maps to the desired VME address */
1461 i = image->number;
1462
1463 /* Locking as we can only do one of these at a time */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001464 mutex_lock(&bridge->vme_rmw);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001465
1466 /* Lock image */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001467 spin_lock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001468
Martyn Welch29848ac2010-02-18 15:13:05 +00001469 pci_addr_high = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001470 TSI148_LCSR_OFFSET_OTSAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001471 pci_addr_low = ioread32be(bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001472 TSI148_LCSR_OFFSET_OTSAL);
1473
1474 reg_join(pci_addr_high, pci_addr_low, &pci_addr);
1475 reg_split(pci_addr + offset, &pci_addr_high, &pci_addr_low);
1476
1477 /* Configure registers */
Martyn Welch29848ac2010-02-18 15:13:05 +00001478 iowrite32be(mask, bridge->base + TSI148_LCSR_RMWEN);
1479 iowrite32be(compare, bridge->base + TSI148_LCSR_RMWC);
1480 iowrite32be(swap, bridge->base + TSI148_LCSR_RMWS);
1481 iowrite32be(pci_addr_high, bridge->base + TSI148_LCSR_RMWAU);
1482 iowrite32be(pci_addr_low, bridge->base + TSI148_LCSR_RMWAL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001483
1484 /* Enable RMW */
Martyn Welch29848ac2010-02-18 15:13:05 +00001485 tmp = ioread32be(bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001486 tmp |= TSI148_LCSR_VMCTRL_RMWEN;
Martyn Welch29848ac2010-02-18 15:13:05 +00001487 iowrite32be(tmp, bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001488
1489 /* Kick process off with a read to the required address. */
1490 result = ioread32be(image->kern_base + offset);
1491
1492 /* Disable RMW */
Martyn Welch29848ac2010-02-18 15:13:05 +00001493 tmp = ioread32be(bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001494 tmp &= ~TSI148_LCSR_VMCTRL_RMWEN;
Martyn Welch29848ac2010-02-18 15:13:05 +00001495 iowrite32be(tmp, bridge->base + TSI148_LCSR_VMCTRL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001496
Emilio G. Cota886953e2010-11-12 11:14:07 +00001497 spin_unlock(&image->lock);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001498
Emilio G. Cota886953e2010-11-12 11:14:07 +00001499 mutex_unlock(&bridge->vme_rmw);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001500
1501 return result;
1502}
1503
Martyn Welchac1a4f22012-03-22 13:27:30 +00001504static int tsi148_dma_set_vme_src_attributes(struct device *dev, __be32 *attr,
Martyn Welch6af04b02011-12-01 17:06:29 +00001505 u32 aspace, u32 cycle, u32 dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001506{
Martyn Welchac1a4f22012-03-22 13:27:30 +00001507 u32 val;
1508
1509 val = be32_to_cpu(*attr);
1510
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001511 /* Setup 2eSST speeds */
1512 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
1513 case VME_2eSST160:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001514 val |= TSI148_LCSR_DSAT_2eSSTM_160;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001515 break;
1516 case VME_2eSST267:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001517 val |= TSI148_LCSR_DSAT_2eSSTM_267;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001518 break;
1519 case VME_2eSST320:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001520 val |= TSI148_LCSR_DSAT_2eSSTM_320;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001521 break;
1522 }
1523
1524 /* Setup cycle types */
Martyn Welch79463282010-03-22 14:58:57 +00001525 if (cycle & VME_SCT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001526 val |= TSI148_LCSR_DSAT_TM_SCT;
Martyn Welch79463282010-03-22 14:58:57 +00001527
1528 if (cycle & VME_BLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001529 val |= TSI148_LCSR_DSAT_TM_BLT;
Martyn Welch79463282010-03-22 14:58:57 +00001530
1531 if (cycle & VME_MBLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001532 val |= TSI148_LCSR_DSAT_TM_MBLT;
Martyn Welch79463282010-03-22 14:58:57 +00001533
1534 if (cycle & VME_2eVME)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001535 val |= TSI148_LCSR_DSAT_TM_2eVME;
Martyn Welch79463282010-03-22 14:58:57 +00001536
1537 if (cycle & VME_2eSST)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001538 val |= TSI148_LCSR_DSAT_TM_2eSST;
Martyn Welch79463282010-03-22 14:58:57 +00001539
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001540 if (cycle & VME_2eSSTB) {
Martyn Welch48d93562010-03-22 14:58:50 +00001541 dev_err(dev, "Currently not setting Broadcast Select "
1542 "Registers\n");
Martyn Welchac1a4f22012-03-22 13:27:30 +00001543 val |= TSI148_LCSR_DSAT_TM_2eSSTB;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001544 }
1545
1546 /* Setup data width */
1547 switch (dwidth) {
1548 case VME_D16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001549 val |= TSI148_LCSR_DSAT_DBW_16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001550 break;
1551 case VME_D32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001552 val |= TSI148_LCSR_DSAT_DBW_32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001553 break;
1554 default:
Martyn Welch48d93562010-03-22 14:58:50 +00001555 dev_err(dev, "Invalid data width\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001556 return -EINVAL;
1557 }
1558
1559 /* Setup address space */
1560 switch (aspace) {
1561 case VME_A16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001562 val |= TSI148_LCSR_DSAT_AMODE_A16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001563 break;
1564 case VME_A24:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001565 val |= TSI148_LCSR_DSAT_AMODE_A24;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001566 break;
1567 case VME_A32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001568 val |= TSI148_LCSR_DSAT_AMODE_A32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001569 break;
1570 case VME_A64:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001571 val |= TSI148_LCSR_DSAT_AMODE_A64;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001572 break;
1573 case VME_CRCSR:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001574 val |= TSI148_LCSR_DSAT_AMODE_CRCSR;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001575 break;
1576 case VME_USER1:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001577 val |= TSI148_LCSR_DSAT_AMODE_USER1;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001578 break;
1579 case VME_USER2:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001580 val |= TSI148_LCSR_DSAT_AMODE_USER2;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001581 break;
1582 case VME_USER3:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001583 val |= TSI148_LCSR_DSAT_AMODE_USER3;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001584 break;
1585 case VME_USER4:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001586 val |= TSI148_LCSR_DSAT_AMODE_USER4;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001587 break;
1588 default:
Martyn Welch48d93562010-03-22 14:58:50 +00001589 dev_err(dev, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001590 return -EINVAL;
1591 break;
1592 }
1593
1594 if (cycle & VME_SUPER)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001595 val |= TSI148_LCSR_DSAT_SUP;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001596 if (cycle & VME_PROG)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001597 val |= TSI148_LCSR_DSAT_PGM;
1598
1599 *attr = cpu_to_be32(val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001600
1601 return 0;
1602}
1603
Martyn Welchac1a4f22012-03-22 13:27:30 +00001604static int tsi148_dma_set_vme_dest_attributes(struct device *dev, __be32 *attr,
Martyn Welch6af04b02011-12-01 17:06:29 +00001605 u32 aspace, u32 cycle, u32 dwidth)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001606{
Martyn Welchac1a4f22012-03-22 13:27:30 +00001607 u32 val;
1608
1609 val = be32_to_cpu(*attr);
1610
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001611 /* Setup 2eSST speeds */
1612 switch (cycle & (VME_2eSST160 | VME_2eSST267 | VME_2eSST320)) {
1613 case VME_2eSST160:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001614 val |= TSI148_LCSR_DDAT_2eSSTM_160;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001615 break;
1616 case VME_2eSST267:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001617 val |= TSI148_LCSR_DDAT_2eSSTM_267;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001618 break;
1619 case VME_2eSST320:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001620 val |= TSI148_LCSR_DDAT_2eSSTM_320;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001621 break;
1622 }
1623
1624 /* Setup cycle types */
Martyn Welch79463282010-03-22 14:58:57 +00001625 if (cycle & VME_SCT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001626 val |= TSI148_LCSR_DDAT_TM_SCT;
Martyn Welch79463282010-03-22 14:58:57 +00001627
1628 if (cycle & VME_BLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001629 val |= TSI148_LCSR_DDAT_TM_BLT;
Martyn Welch79463282010-03-22 14:58:57 +00001630
1631 if (cycle & VME_MBLT)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001632 val |= TSI148_LCSR_DDAT_TM_MBLT;
Martyn Welch79463282010-03-22 14:58:57 +00001633
1634 if (cycle & VME_2eVME)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001635 val |= TSI148_LCSR_DDAT_TM_2eVME;
Martyn Welch79463282010-03-22 14:58:57 +00001636
1637 if (cycle & VME_2eSST)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001638 val |= TSI148_LCSR_DDAT_TM_2eSST;
Martyn Welch79463282010-03-22 14:58:57 +00001639
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001640 if (cycle & VME_2eSSTB) {
Martyn Welch48d93562010-03-22 14:58:50 +00001641 dev_err(dev, "Currently not setting Broadcast Select "
1642 "Registers\n");
Martyn Welchac1a4f22012-03-22 13:27:30 +00001643 val |= TSI148_LCSR_DDAT_TM_2eSSTB;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001644 }
1645
1646 /* Setup data width */
1647 switch (dwidth) {
1648 case VME_D16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001649 val |= TSI148_LCSR_DDAT_DBW_16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001650 break;
1651 case VME_D32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001652 val |= TSI148_LCSR_DDAT_DBW_32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001653 break;
1654 default:
Martyn Welch48d93562010-03-22 14:58:50 +00001655 dev_err(dev, "Invalid data width\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001656 return -EINVAL;
1657 }
1658
1659 /* Setup address space */
1660 switch (aspace) {
1661 case VME_A16:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001662 val |= TSI148_LCSR_DDAT_AMODE_A16;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001663 break;
1664 case VME_A24:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001665 val |= TSI148_LCSR_DDAT_AMODE_A24;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001666 break;
1667 case VME_A32:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001668 val |= TSI148_LCSR_DDAT_AMODE_A32;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001669 break;
1670 case VME_A64:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001671 val |= TSI148_LCSR_DDAT_AMODE_A64;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001672 break;
1673 case VME_CRCSR:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001674 val |= TSI148_LCSR_DDAT_AMODE_CRCSR;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001675 break;
1676 case VME_USER1:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001677 val |= TSI148_LCSR_DDAT_AMODE_USER1;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001678 break;
1679 case VME_USER2:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001680 val |= TSI148_LCSR_DDAT_AMODE_USER2;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001681 break;
1682 case VME_USER3:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001683 val |= TSI148_LCSR_DDAT_AMODE_USER3;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001684 break;
1685 case VME_USER4:
Martyn Welchac1a4f22012-03-22 13:27:30 +00001686 val |= TSI148_LCSR_DDAT_AMODE_USER4;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001687 break;
1688 default:
Martyn Welch48d93562010-03-22 14:58:50 +00001689 dev_err(dev, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001690 return -EINVAL;
1691 break;
1692 }
1693
1694 if (cycle & VME_SUPER)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001695 val |= TSI148_LCSR_DDAT_SUP;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001696 if (cycle & VME_PROG)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001697 val |= TSI148_LCSR_DDAT_PGM;
1698
1699 *attr = cpu_to_be32(val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001700
1701 return 0;
1702}
1703
1704/*
1705 * Add a link list descriptor to the list
Martyn Welchac1a4f22012-03-22 13:27:30 +00001706 *
1707 * Note: DMA engine expects the DMA descriptor to be big endian.
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001708 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001709static int tsi148_dma_list_add(struct vme_dma_list *list,
1710 struct vme_dma_attr *src, struct vme_dma_attr *dest, size_t count)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001711{
1712 struct tsi148_dma_entry *entry, *prev;
Martyn Welchac1a4f22012-03-22 13:27:30 +00001713 u32 address_high, address_low, val;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001714 struct vme_dma_pattern *pattern_attr;
1715 struct vme_dma_pci *pci_attr;
1716 struct vme_dma_vme *vme_attr;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001717 int retval = 0;
Martyn Welch48d93562010-03-22 14:58:50 +00001718 struct vme_bridge *tsi148_bridge;
1719
1720 tsi148_bridge = list->parent->parent;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001721
Martyn Welchbb9ea892010-02-18 16:22:13 +00001722 /* Descriptor must be aligned on 64-bit boundaries */
Martyn Welch79463282010-03-22 14:58:57 +00001723 entry = kmalloc(sizeof(struct tsi148_dma_entry), GFP_KERNEL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001724 if (entry == NULL) {
Martyn Welch48d93562010-03-22 14:58:50 +00001725 dev_err(tsi148_bridge->parent, "Failed to allocate memory for "
1726 "dma resource structure\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001727 retval = -ENOMEM;
1728 goto err_mem;
1729 }
1730
1731 /* Test descriptor alignment */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001732 if ((unsigned long)&entry->descriptor & 0x7) {
Martyn Welch48d93562010-03-22 14:58:50 +00001733 dev_err(tsi148_bridge->parent, "Descriptor not aligned to 8 "
1734 "byte boundary as required: %p\n",
Emilio G. Cota886953e2010-11-12 11:14:07 +00001735 &entry->descriptor);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001736 retval = -EINVAL;
1737 goto err_align;
1738 }
1739
1740 /* Given we are going to fill out the structure, we probably don't
1741 * need to zero it, but better safe than sorry for now.
1742 */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001743 memset(&entry->descriptor, 0, sizeof(struct tsi148_dma_descriptor));
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001744
1745 /* Fill out source part */
1746 switch (src->type) {
1747 case VME_DMA_PATTERN:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001748 pattern_attr = src->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001749
Martyn Welchac1a4f22012-03-22 13:27:30 +00001750 entry->descriptor.dsal = cpu_to_be32(pattern_attr->pattern);
1751
1752 val = TSI148_LCSR_DSAT_TYP_PAT;
1753
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001754 /* Default behaviour is 32 bit pattern */
Martyn Welch79463282010-03-22 14:58:57 +00001755 if (pattern_attr->type & VME_DMA_PATTERN_BYTE)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001756 val |= TSI148_LCSR_DSAT_PSZ;
Martyn Welch79463282010-03-22 14:58:57 +00001757
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001758 /* It seems that the default behaviour is to increment */
Martyn Welch79463282010-03-22 14:58:57 +00001759 if ((pattern_attr->type & VME_DMA_PATTERN_INCREMENT) == 0)
Martyn Welchac1a4f22012-03-22 13:27:30 +00001760 val |= TSI148_LCSR_DSAT_NIN;
1761 entry->descriptor.dsat = cpu_to_be32(val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001762 break;
1763 case VME_DMA_PCI:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001764 pci_attr = src->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001765
1766 reg_split((unsigned long long)pci_attr->address, &address_high,
1767 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001768 entry->descriptor.dsau = cpu_to_be32(address_high);
1769 entry->descriptor.dsal = cpu_to_be32(address_low);
1770 entry->descriptor.dsat = cpu_to_be32(TSI148_LCSR_DSAT_TYP_PCI);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001771 break;
1772 case VME_DMA_VME:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001773 vme_attr = src->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001774
1775 reg_split((unsigned long long)vme_attr->address, &address_high,
1776 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001777 entry->descriptor.dsau = cpu_to_be32(address_high);
1778 entry->descriptor.dsal = cpu_to_be32(address_low);
1779 entry->descriptor.dsat = cpu_to_be32(TSI148_LCSR_DSAT_TYP_VME);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001780
1781 retval = tsi148_dma_set_vme_src_attributes(
Emilio G. Cota886953e2010-11-12 11:14:07 +00001782 tsi148_bridge->parent, &entry->descriptor.dsat,
Martyn Welch48d93562010-03-22 14:58:50 +00001783 vme_attr->aspace, vme_attr->cycle, vme_attr->dwidth);
Martyn Welch79463282010-03-22 14:58:57 +00001784 if (retval < 0)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001785 goto err_source;
1786 break;
1787 default:
Martyn Welch48d93562010-03-22 14:58:50 +00001788 dev_err(tsi148_bridge->parent, "Invalid source type\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001789 retval = -EINVAL;
1790 goto err_source;
1791 break;
1792 }
1793
1794 /* Assume last link - this will be over-written by adding another */
Martyn Welchac1a4f22012-03-22 13:27:30 +00001795 entry->descriptor.dnlau = cpu_to_be32(0);
1796 entry->descriptor.dnlal = cpu_to_be32(TSI148_LCSR_DNLAL_LLA);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001797
1798 /* Fill out destination part */
1799 switch (dest->type) {
1800 case VME_DMA_PCI:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001801 pci_attr = dest->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001802
1803 reg_split((unsigned long long)pci_attr->address, &address_high,
1804 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001805 entry->descriptor.ddau = cpu_to_be32(address_high);
1806 entry->descriptor.ddal = cpu_to_be32(address_low);
1807 entry->descriptor.ddat = cpu_to_be32(TSI148_LCSR_DDAT_TYP_PCI);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001808 break;
1809 case VME_DMA_VME:
Kulikov Vasiliyc4d82fb2010-06-29 14:16:20 +04001810 vme_attr = dest->private;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001811
1812 reg_split((unsigned long long)vme_attr->address, &address_high,
1813 &address_low);
Martyn Welchac1a4f22012-03-22 13:27:30 +00001814 entry->descriptor.ddau = cpu_to_be32(address_high);
1815 entry->descriptor.ddal = cpu_to_be32(address_low);
1816 entry->descriptor.ddat = cpu_to_be32(TSI148_LCSR_DDAT_TYP_VME);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001817
1818 retval = tsi148_dma_set_vme_dest_attributes(
Emilio G. Cota886953e2010-11-12 11:14:07 +00001819 tsi148_bridge->parent, &entry->descriptor.ddat,
Martyn Welch48d93562010-03-22 14:58:50 +00001820 vme_attr->aspace, vme_attr->cycle, vme_attr->dwidth);
Martyn Welch79463282010-03-22 14:58:57 +00001821 if (retval < 0)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001822 goto err_dest;
1823 break;
1824 default:
Martyn Welch48d93562010-03-22 14:58:50 +00001825 dev_err(tsi148_bridge->parent, "Invalid destination type\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001826 retval = -EINVAL;
1827 goto err_dest;
1828 break;
1829 }
1830
1831 /* Fill out count */
Martyn Welchac1a4f22012-03-22 13:27:30 +00001832 entry->descriptor.dcnt = cpu_to_be32((u32)count);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001833
1834 /* Add to list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001835 list_add_tail(&entry->list, &list->entries);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001836
1837 /* Fill out previous descriptors "Next Address" */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001838 if (entry->list.prev != &list->entries) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001839 prev = list_entry(entry->list.prev, struct tsi148_dma_entry,
1840 list);
1841 /* We need the bus address for the pointer */
Martyn Welch3abc48a2012-03-22 13:27:29 +00001842 entry->dma_handle = dma_map_single(tsi148_bridge->parent,
1843 &entry->descriptor,
1844 sizeof(struct tsi148_dma_descriptor), DMA_TO_DEVICE);
1845
Martyn Welchac1a4f22012-03-22 13:27:30 +00001846 reg_split((unsigned long long)entry->dma_handle, &address_high,
1847 &address_low);
1848 entry->descriptor.dnlau = cpu_to_be32(address_high);
1849 entry->descriptor.dnlal = cpu_to_be32(address_low);
1850
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001851 }
1852
1853 return 0;
1854
1855err_dest:
1856err_source:
1857err_align:
1858 kfree(entry);
1859err_mem:
1860 return retval;
1861}
1862
1863/*
1864 * Check to see if the provided DMA channel is busy.
1865 */
Martyn Welch29848ac2010-02-18 15:13:05 +00001866static int tsi148_dma_busy(struct vme_bridge *tsi148_bridge, int channel)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001867{
1868 u32 tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +00001869 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001870
Martyn Welch29848ac2010-02-18 15:13:05 +00001871 bridge = tsi148_bridge->driver_priv;
1872
1873 tmp = ioread32be(bridge->base + TSI148_LCSR_DMA[channel] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001874 TSI148_LCSR_OFFSET_DSTA);
1875
1876 if (tmp & TSI148_LCSR_DSTA_BSY)
1877 return 0;
1878 else
1879 return 1;
1880
1881}
1882
1883/*
1884 * Execute a previously generated link list
1885 *
1886 * XXX Need to provide control register configuration.
1887 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001888static int tsi148_dma_list_exec(struct vme_dma_list *list)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001889{
1890 struct vme_dma_resource *ctrlr;
1891 int channel, retval = 0;
1892 struct tsi148_dma_entry *entry;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001893 u32 bus_addr_high, bus_addr_low;
1894 u32 val, dctlreg = 0;
Martyn Welch48d93562010-03-22 14:58:50 +00001895 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +00001896 struct tsi148_driver *bridge;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001897
1898 ctrlr = list->parent;
1899
Martyn Welch48d93562010-03-22 14:58:50 +00001900 tsi148_bridge = ctrlr->parent;
1901
1902 bridge = tsi148_bridge->driver_priv;
Martyn Welch29848ac2010-02-18 15:13:05 +00001903
Emilio G. Cota886953e2010-11-12 11:14:07 +00001904 mutex_lock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001905
1906 channel = ctrlr->number;
1907
Emilio G. Cota886953e2010-11-12 11:14:07 +00001908 if (!list_empty(&ctrlr->running)) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001909 /*
1910 * XXX We have an active DMA transfer and currently haven't
1911 * sorted out the mechanism for "pending" DMA transfers.
1912 * Return busy.
1913 */
1914 /* Need to add to pending here */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001915 mutex_unlock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001916 return -EBUSY;
1917 } else {
Emilio G. Cota886953e2010-11-12 11:14:07 +00001918 list_add(&list->list, &ctrlr->running);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001919 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001920
1921 /* Get first bus address and write into registers */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001922 entry = list_first_entry(&list->entries, struct tsi148_dma_entry,
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001923 list);
1924
Martyn Welch3abc48a2012-03-22 13:27:29 +00001925 entry->dma_handle = dma_map_single(tsi148_bridge->parent,
1926 &entry->descriptor,
1927 sizeof(struct tsi148_dma_descriptor), DMA_TO_DEVICE);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001928
Emilio G. Cota886953e2010-11-12 11:14:07 +00001929 mutex_unlock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001930
Martyn Welch3abc48a2012-03-22 13:27:29 +00001931 reg_split(entry->dma_handle, &bus_addr_high, &bus_addr_low);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001932
Martyn Welch29848ac2010-02-18 15:13:05 +00001933 iowrite32be(bus_addr_high, bridge->base +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001934 TSI148_LCSR_DMA[channel] + TSI148_LCSR_OFFSET_DNLAU);
Martyn Welch29848ac2010-02-18 15:13:05 +00001935 iowrite32be(bus_addr_low, bridge->base +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001936 TSI148_LCSR_DMA[channel] + TSI148_LCSR_OFFSET_DNLAL);
1937
Martyn Welchac1a4f22012-03-22 13:27:30 +00001938 dctlreg = ioread32be(bridge->base + TSI148_LCSR_DMA[channel] +
1939 TSI148_LCSR_OFFSET_DCTL);
1940
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001941 /* Start the operation */
Martyn Welch29848ac2010-02-18 15:13:05 +00001942 iowrite32be(dctlreg | TSI148_LCSR_DCTL_DGO, bridge->base +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001943 TSI148_LCSR_DMA[channel] + TSI148_LCSR_OFFSET_DCTL);
1944
Martyn Welch29848ac2010-02-18 15:13:05 +00001945 wait_event_interruptible(bridge->dma_queue[channel],
1946 tsi148_dma_busy(ctrlr->parent, channel));
Martyn Welchac1a4f22012-03-22 13:27:30 +00001947
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001948 /*
1949 * Read status register, this register is valid until we kick off a
1950 * new transfer.
1951 */
Martyn Welch29848ac2010-02-18 15:13:05 +00001952 val = ioread32be(bridge->base + TSI148_LCSR_DMA[channel] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001953 TSI148_LCSR_OFFSET_DSTA);
1954
1955 if (val & TSI148_LCSR_DSTA_VBE) {
Martyn Welch48d93562010-03-22 14:58:50 +00001956 dev_err(tsi148_bridge->parent, "DMA Error. DSTA=%08X\n", val);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001957 retval = -EIO;
1958 }
1959
1960 /* Remove list from running list */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001961 mutex_lock(&ctrlr->mtx);
1962 list_del(&list->list);
1963 mutex_unlock(&ctrlr->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001964
1965 return retval;
1966}
1967
1968/*
1969 * Clean up a previously generated link list
1970 *
1971 * We have a separate function, don't assume that the chain can't be reused.
1972 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00001973static int tsi148_dma_list_empty(struct vme_dma_list *list)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001974{
1975 struct list_head *pos, *temp;
Martyn Welch79463282010-03-22 14:58:57 +00001976 struct tsi148_dma_entry *entry;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001977
Martyn Welch3abc48a2012-03-22 13:27:29 +00001978 struct vme_bridge *tsi148_bridge = list->parent->parent;
1979
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001980 /* detach and free each entry */
Emilio G. Cota886953e2010-11-12 11:14:07 +00001981 list_for_each_safe(pos, temp, &list->entries) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001982 list_del(pos);
1983 entry = list_entry(pos, struct tsi148_dma_entry, list);
Martyn Welch3abc48a2012-03-22 13:27:29 +00001984
1985 dma_unmap_single(tsi148_bridge->parent, entry->dma_handle,
1986 sizeof(struct tsi148_dma_descriptor), DMA_TO_DEVICE);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001987 kfree(entry);
1988 }
1989
Martyn Welch79463282010-03-22 14:58:57 +00001990 return 0;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01001991}
1992
1993/*
1994 * All 4 location monitors reside at the same base - this is therefore a
1995 * system wide configuration.
1996 *
1997 * This does not enable the LM monitor - that should be done when the first
1998 * callback is attached and disabled when the last callback is removed.
1999 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002000static int tsi148_lm_set(struct vme_lm_resource *lm, unsigned long long lm_base,
Martyn Welch6af04b02011-12-01 17:06:29 +00002001 u32 aspace, u32 cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002002{
2003 u32 lm_base_high, lm_base_low, lm_ctl = 0;
2004 int i;
Martyn Welch48d93562010-03-22 14:58:50 +00002005 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +00002006 struct tsi148_driver *bridge;
2007
Martyn Welch48d93562010-03-22 14:58:50 +00002008 tsi148_bridge = lm->parent;
2009
2010 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002011
Emilio G. Cota886953e2010-11-12 11:14:07 +00002012 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002013
2014 /* If we already have a callback attached, we can't move it! */
Martyn Welch42fb5032009-08-11 17:44:56 +01002015 for (i = 0; i < lm->monitors; i++) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002016 if (bridge->lm_callback[i] != NULL) {
Emilio G. Cota886953e2010-11-12 11:14:07 +00002017 mutex_unlock(&lm->mtx);
Martyn Welch48d93562010-03-22 14:58:50 +00002018 dev_err(tsi148_bridge->parent, "Location monitor "
2019 "callback attached, can't reset\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002020 return -EBUSY;
2021 }
2022 }
2023
2024 switch (aspace) {
2025 case VME_A16:
2026 lm_ctl |= TSI148_LCSR_LMAT_AS_A16;
2027 break;
2028 case VME_A24:
2029 lm_ctl |= TSI148_LCSR_LMAT_AS_A24;
2030 break;
2031 case VME_A32:
2032 lm_ctl |= TSI148_LCSR_LMAT_AS_A32;
2033 break;
2034 case VME_A64:
2035 lm_ctl |= TSI148_LCSR_LMAT_AS_A64;
2036 break;
2037 default:
Emilio G. Cota886953e2010-11-12 11:14:07 +00002038 mutex_unlock(&lm->mtx);
Martyn Welch48d93562010-03-22 14:58:50 +00002039 dev_err(tsi148_bridge->parent, "Invalid address space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002040 return -EINVAL;
2041 break;
2042 }
2043
2044 if (cycle & VME_SUPER)
2045 lm_ctl |= TSI148_LCSR_LMAT_SUPR ;
2046 if (cycle & VME_USER)
2047 lm_ctl |= TSI148_LCSR_LMAT_NPRIV;
2048 if (cycle & VME_PROG)
2049 lm_ctl |= TSI148_LCSR_LMAT_PGM;
2050 if (cycle & VME_DATA)
2051 lm_ctl |= TSI148_LCSR_LMAT_DATA;
2052
2053 reg_split(lm_base, &lm_base_high, &lm_base_low);
2054
Martyn Welch29848ac2010-02-18 15:13:05 +00002055 iowrite32be(lm_base_high, bridge->base + TSI148_LCSR_LMBAU);
2056 iowrite32be(lm_base_low, bridge->base + TSI148_LCSR_LMBAL);
2057 iowrite32be(lm_ctl, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002058
Emilio G. Cota886953e2010-11-12 11:14:07 +00002059 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002060
2061 return 0;
2062}
2063
2064/* Get configuration of the callback monitor and return whether it is enabled
2065 * or disabled.
2066 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002067static int tsi148_lm_get(struct vme_lm_resource *lm,
Martyn Welch6af04b02011-12-01 17:06:29 +00002068 unsigned long long *lm_base, u32 *aspace, u32 *cycle)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002069{
2070 u32 lm_base_high, lm_base_low, lm_ctl, enabled = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +00002071 struct tsi148_driver *bridge;
2072
2073 bridge = lm->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002074
Emilio G. Cota886953e2010-11-12 11:14:07 +00002075 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002076
Martyn Welch29848ac2010-02-18 15:13:05 +00002077 lm_base_high = ioread32be(bridge->base + TSI148_LCSR_LMBAU);
2078 lm_base_low = ioread32be(bridge->base + TSI148_LCSR_LMBAL);
2079 lm_ctl = ioread32be(bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002080
2081 reg_join(lm_base_high, lm_base_low, lm_base);
2082
2083 if (lm_ctl & TSI148_LCSR_LMAT_EN)
2084 enabled = 1;
2085
Martyn Welch79463282010-03-22 14:58:57 +00002086 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A16)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002087 *aspace |= VME_A16;
Martyn Welch79463282010-03-22 14:58:57 +00002088
2089 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A24)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002090 *aspace |= VME_A24;
Martyn Welch79463282010-03-22 14:58:57 +00002091
2092 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A32)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002093 *aspace |= VME_A32;
Martyn Welch79463282010-03-22 14:58:57 +00002094
2095 if ((lm_ctl & TSI148_LCSR_LMAT_AS_M) == TSI148_LCSR_LMAT_AS_A64)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002096 *aspace |= VME_A64;
Martyn Welch79463282010-03-22 14:58:57 +00002097
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002098
2099 if (lm_ctl & TSI148_LCSR_LMAT_SUPR)
2100 *cycle |= VME_SUPER;
2101 if (lm_ctl & TSI148_LCSR_LMAT_NPRIV)
2102 *cycle |= VME_USER;
2103 if (lm_ctl & TSI148_LCSR_LMAT_PGM)
2104 *cycle |= VME_PROG;
2105 if (lm_ctl & TSI148_LCSR_LMAT_DATA)
2106 *cycle |= VME_DATA;
2107
Emilio G. Cota886953e2010-11-12 11:14:07 +00002108 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002109
2110 return enabled;
2111}
2112
2113/*
2114 * Attach a callback to a specific location monitor.
2115 *
2116 * Callback will be passed the monitor triggered.
2117 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002118static int tsi148_lm_attach(struct vme_lm_resource *lm, int monitor,
Martyn Welch42fb5032009-08-11 17:44:56 +01002119 void (*callback)(int))
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002120{
2121 u32 lm_ctl, tmp;
Martyn Welch48d93562010-03-22 14:58:50 +00002122 struct vme_bridge *tsi148_bridge;
Martyn Welch29848ac2010-02-18 15:13:05 +00002123 struct tsi148_driver *bridge;
2124
Martyn Welch48d93562010-03-22 14:58:50 +00002125 tsi148_bridge = lm->parent;
2126
2127 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002128
Emilio G. Cota886953e2010-11-12 11:14:07 +00002129 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002130
2131 /* Ensure that the location monitor is configured - need PGM or DATA */
Martyn Welch29848ac2010-02-18 15:13:05 +00002132 lm_ctl = ioread32be(bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002133 if ((lm_ctl & (TSI148_LCSR_LMAT_PGM | TSI148_LCSR_LMAT_DATA)) == 0) {
Emilio G. Cota886953e2010-11-12 11:14:07 +00002134 mutex_unlock(&lm->mtx);
Martyn Welch48d93562010-03-22 14:58:50 +00002135 dev_err(tsi148_bridge->parent, "Location monitor not properly "
2136 "configured\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002137 return -EINVAL;
2138 }
2139
2140 /* Check that a callback isn't already attached */
Martyn Welch29848ac2010-02-18 15:13:05 +00002141 if (bridge->lm_callback[monitor] != NULL) {
Emilio G. Cota886953e2010-11-12 11:14:07 +00002142 mutex_unlock(&lm->mtx);
Martyn Welch48d93562010-03-22 14:58:50 +00002143 dev_err(tsi148_bridge->parent, "Existing callback attached\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002144 return -EBUSY;
2145 }
2146
2147 /* Attach callback */
Martyn Welch29848ac2010-02-18 15:13:05 +00002148 bridge->lm_callback[monitor] = callback;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002149
2150 /* Enable Location Monitor interrupt */
Martyn Welch29848ac2010-02-18 15:13:05 +00002151 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002152 tmp |= TSI148_LCSR_INTEN_LMEN[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002153 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002154
Martyn Welch29848ac2010-02-18 15:13:05 +00002155 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002156 tmp |= TSI148_LCSR_INTEO_LMEO[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002157 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002158
2159 /* Ensure that global Location Monitor Enable set */
2160 if ((lm_ctl & TSI148_LCSR_LMAT_EN) == 0) {
2161 lm_ctl |= TSI148_LCSR_LMAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +00002162 iowrite32be(lm_ctl, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002163 }
2164
Emilio G. Cota886953e2010-11-12 11:14:07 +00002165 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002166
2167 return 0;
2168}
2169
2170/*
2171 * Detach a callback function forn a specific location monitor.
2172 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002173static int tsi148_lm_detach(struct vme_lm_resource *lm, int monitor)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002174{
2175 u32 lm_en, tmp;
Martyn Welch29848ac2010-02-18 15:13:05 +00002176 struct tsi148_driver *bridge;
2177
2178 bridge = lm->parent->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002179
Emilio G. Cota886953e2010-11-12 11:14:07 +00002180 mutex_lock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002181
2182 /* Disable Location Monitor and ensure previous interrupts are clear */
Martyn Welch29848ac2010-02-18 15:13:05 +00002183 lm_en = ioread32be(bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002184 lm_en &= ~TSI148_LCSR_INTEN_LMEN[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002185 iowrite32be(lm_en, bridge->base + TSI148_LCSR_INTEN);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002186
Martyn Welch29848ac2010-02-18 15:13:05 +00002187 tmp = ioread32be(bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002188 tmp &= ~TSI148_LCSR_INTEO_LMEO[monitor];
Martyn Welch29848ac2010-02-18 15:13:05 +00002189 iowrite32be(tmp, bridge->base + TSI148_LCSR_INTEO);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002190
2191 iowrite32be(TSI148_LCSR_INTC_LMC[monitor],
Martyn Welch29848ac2010-02-18 15:13:05 +00002192 bridge->base + TSI148_LCSR_INTC);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002193
2194 /* Detach callback */
Martyn Welch29848ac2010-02-18 15:13:05 +00002195 bridge->lm_callback[monitor] = NULL;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002196
2197 /* If all location monitors disabled, disable global Location Monitor */
2198 if ((lm_en & (TSI148_LCSR_INTS_LM0S | TSI148_LCSR_INTS_LM1S |
2199 TSI148_LCSR_INTS_LM2S | TSI148_LCSR_INTS_LM3S)) == 0) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002200 tmp = ioread32be(bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002201 tmp &= ~TSI148_LCSR_LMAT_EN;
Martyn Welch29848ac2010-02-18 15:13:05 +00002202 iowrite32be(tmp, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002203 }
2204
Emilio G. Cota886953e2010-11-12 11:14:07 +00002205 mutex_unlock(&lm->mtx);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002206
2207 return 0;
2208}
2209
2210/*
2211 * Determine Geographical Addressing
2212 */
Emilio G. Cota5ade6c42010-11-12 11:15:00 +00002213static int tsi148_slot_get(struct vme_bridge *tsi148_bridge)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002214{
Martyn Welch79463282010-03-22 14:58:57 +00002215 u32 slot = 0;
Martyn Welch29848ac2010-02-18 15:13:05 +00002216 struct tsi148_driver *bridge;
2217
2218 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002219
Martyn Welch638f1992009-12-15 08:42:49 +00002220 if (!geoid) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002221 slot = ioread32be(bridge->base + TSI148_LCSR_VSTAT);
Martyn Welch638f1992009-12-15 08:42:49 +00002222 slot = slot & TSI148_LCSR_VSTAT_GA_M;
2223 } else
2224 slot = geoid;
2225
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002226 return (int)slot;
2227}
2228
H Hartley Sweeten lin8a508ff2012-05-02 17:08:38 -07002229static void *tsi148_alloc_consistent(struct device *parent, size_t size,
Manohar Vanga7f58f022011-08-10 11:33:46 +02002230 dma_addr_t *dma)
2231{
2232 struct pci_dev *pdev;
2233
2234 /* Find pci_dev container of dev */
2235 pdev = container_of(parent, struct pci_dev, dev);
2236
2237 return pci_alloc_consistent(pdev, size, dma);
2238}
2239
H Hartley Sweeten lin8a508ff2012-05-02 17:08:38 -07002240static void tsi148_free_consistent(struct device *parent, size_t size,
2241 void *vaddr, dma_addr_t dma)
Manohar Vanga7f58f022011-08-10 11:33:46 +02002242{
2243 struct pci_dev *pdev;
2244
2245 /* Find pci_dev container of dev */
2246 pdev = container_of(parent, struct pci_dev, dev);
2247
2248 pci_free_consistent(pdev, size, vaddr, dma);
2249}
2250
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002251/*
2252 * Configure CR/CSR space
2253 *
2254 * Access to the CR/CSR can be configured at power-up. The location of the
2255 * CR/CSR registers in the CR/CSR address space is determined by the boards
2256 * Auto-ID or Geographic address. This function ensures that the window is
2257 * enabled at an offset consistent with the boards geopgraphic address.
2258 *
2259 * Each board has a 512kB window, with the highest 4kB being used for the
2260 * boards registers, this means there is a fix length 508kB window which must
2261 * be mapped onto PCI memory.
2262 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002263static int tsi148_crcsr_init(struct vme_bridge *tsi148_bridge,
2264 struct pci_dev *pdev)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002265{
2266 u32 cbar, crat, vstat;
2267 u32 crcsr_bus_high, crcsr_bus_low;
2268 int retval;
Martyn Welch29848ac2010-02-18 15:13:05 +00002269 struct tsi148_driver *bridge;
2270
2271 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002272
2273 /* Allocate mem for CR/CSR image */
Martyn Welch29848ac2010-02-18 15:13:05 +00002274 bridge->crcsr_kernel = pci_alloc_consistent(pdev, VME_CRCSR_BUF_SIZE,
Emilio G. Cota886953e2010-11-12 11:14:07 +00002275 &bridge->crcsr_bus);
Martyn Welch29848ac2010-02-18 15:13:05 +00002276 if (bridge->crcsr_kernel == NULL) {
Martyn Welch48d93562010-03-22 14:58:50 +00002277 dev_err(tsi148_bridge->parent, "Failed to allocate memory for "
2278 "CR/CSR image\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002279 return -ENOMEM;
2280 }
2281
Martyn Welch29848ac2010-02-18 15:13:05 +00002282 memset(bridge->crcsr_kernel, 0, VME_CRCSR_BUF_SIZE);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002283
Martyn Welch29848ac2010-02-18 15:13:05 +00002284 reg_split(bridge->crcsr_bus, &crcsr_bus_high, &crcsr_bus_low);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002285
Martyn Welch29848ac2010-02-18 15:13:05 +00002286 iowrite32be(crcsr_bus_high, bridge->base + TSI148_LCSR_CROU);
2287 iowrite32be(crcsr_bus_low, bridge->base + TSI148_LCSR_CROL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002288
2289 /* Ensure that the CR/CSR is configured at the correct offset */
Martyn Welch29848ac2010-02-18 15:13:05 +00002290 cbar = ioread32be(bridge->base + TSI148_CBAR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002291 cbar = (cbar & TSI148_CRCSR_CBAR_M)>>3;
2292
Martyn Welch29848ac2010-02-18 15:13:05 +00002293 vstat = tsi148_slot_get(tsi148_bridge);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002294
2295 if (cbar != vstat) {
Martyn Welch638f1992009-12-15 08:42:49 +00002296 cbar = vstat;
Martyn Welch48d93562010-03-22 14:58:50 +00002297 dev_info(tsi148_bridge->parent, "Setting CR/CSR offset\n");
Martyn Welch29848ac2010-02-18 15:13:05 +00002298 iowrite32be(cbar<<3, bridge->base + TSI148_CBAR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002299 }
Martyn Welch48d93562010-03-22 14:58:50 +00002300 dev_info(tsi148_bridge->parent, "CR/CSR Offset: %d\n", cbar);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002301
Martyn Welch29848ac2010-02-18 15:13:05 +00002302 crat = ioread32be(bridge->base + TSI148_LCSR_CRAT);
Martyn Welch29817952013-06-11 17:03:14 +01002303 if (crat & TSI148_LCSR_CRAT_EN)
2304 dev_info(tsi148_bridge->parent, "CR/CSR already enabled\n");
2305 else {
Martyn Welch48d93562010-03-22 14:58:50 +00002306 dev_info(tsi148_bridge->parent, "Enabling CR/CSR space\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002307 iowrite32be(crat | TSI148_LCSR_CRAT_EN,
Martyn Welch29848ac2010-02-18 15:13:05 +00002308 bridge->base + TSI148_LCSR_CRAT);
Martyn Welch29817952013-06-11 17:03:14 +01002309 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002310
2311 /* If we want flushed, error-checked writes, set up a window
2312 * over the CR/CSR registers. We read from here to safely flush
2313 * through VME writes.
2314 */
Martyn Welch79463282010-03-22 14:58:57 +00002315 if (err_chk) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002316 retval = tsi148_master_set(bridge->flush_image, 1,
2317 (vstat * 0x80000), 0x80000, VME_CRCSR, VME_SCT,
2318 VME_D16);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002319 if (retval)
Martyn Welch48d93562010-03-22 14:58:50 +00002320 dev_err(tsi148_bridge->parent, "Configuring flush image"
2321 " failed\n");
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002322 }
2323
2324 return 0;
2325
2326}
2327
Martyn Welch29848ac2010-02-18 15:13:05 +00002328static void tsi148_crcsr_exit(struct vme_bridge *tsi148_bridge,
2329 struct pci_dev *pdev)
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002330{
2331 u32 crat;
Martyn Welch29848ac2010-02-18 15:13:05 +00002332 struct tsi148_driver *bridge;
2333
2334 bridge = tsi148_bridge->driver_priv;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002335
2336 /* Turn off CR/CSR space */
Martyn Welch29848ac2010-02-18 15:13:05 +00002337 crat = ioread32be(bridge->base + TSI148_LCSR_CRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002338 iowrite32be(crat & ~TSI148_LCSR_CRAT_EN,
Martyn Welch29848ac2010-02-18 15:13:05 +00002339 bridge->base + TSI148_LCSR_CRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002340
2341 /* Free image */
Martyn Welch29848ac2010-02-18 15:13:05 +00002342 iowrite32be(0, bridge->base + TSI148_LCSR_CROU);
2343 iowrite32be(0, bridge->base + TSI148_LCSR_CROL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002344
Martyn Welch29848ac2010-02-18 15:13:05 +00002345 pci_free_consistent(pdev, VME_CRCSR_BUF_SIZE, bridge->crcsr_kernel,
2346 bridge->crcsr_bus);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002347}
2348
2349static int tsi148_probe(struct pci_dev *pdev, const struct pci_device_id *id)
2350{
2351 int retval, i, master_num;
2352 u32 data;
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002353 struct list_head *pos = NULL, *n;
Martyn Welch29848ac2010-02-18 15:13:05 +00002354 struct vme_bridge *tsi148_bridge;
2355 struct tsi148_driver *tsi148_device;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002356 struct vme_master_resource *master_image;
2357 struct vme_slave_resource *slave_image;
2358 struct vme_dma_resource *dma_ctrlr;
Martyn Welch42fb5032009-08-11 17:44:56 +01002359 struct vme_lm_resource *lm;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002360
2361 /* If we want to support more than one of each bridge, we need to
2362 * dynamically generate this so we get one per device
2363 */
Julia Lawall7a6cb0d2010-05-13 22:00:05 +02002364 tsi148_bridge = kzalloc(sizeof(struct vme_bridge), GFP_KERNEL);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002365 if (tsi148_bridge == NULL) {
2366 dev_err(&pdev->dev, "Failed to allocate memory for device "
2367 "structure\n");
2368 retval = -ENOMEM;
2369 goto err_struct;
2370 }
2371
Julia Lawall7a6cb0d2010-05-13 22:00:05 +02002372 tsi148_device = kzalloc(sizeof(struct tsi148_driver), GFP_KERNEL);
Martyn Welch29848ac2010-02-18 15:13:05 +00002373 if (tsi148_device == NULL) {
2374 dev_err(&pdev->dev, "Failed to allocate memory for device "
2375 "structure\n");
2376 retval = -ENOMEM;
2377 goto err_driver;
2378 }
2379
Martyn Welch29848ac2010-02-18 15:13:05 +00002380 tsi148_bridge->driver_priv = tsi148_device;
2381
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002382 /* Enable the device */
2383 retval = pci_enable_device(pdev);
2384 if (retval) {
2385 dev_err(&pdev->dev, "Unable to enable device\n");
2386 goto err_enable;
2387 }
2388
2389 /* Map Registers */
2390 retval = pci_request_regions(pdev, driver_name);
2391 if (retval) {
2392 dev_err(&pdev->dev, "Unable to reserve resources\n");
2393 goto err_resource;
2394 }
2395
2396 /* map registers in BAR 0 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002397 tsi148_device->base = ioremap_nocache(pci_resource_start(pdev, 0),
2398 4096);
2399 if (!tsi148_device->base) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002400 dev_err(&pdev->dev, "Unable to remap CRG region\n");
2401 retval = -EIO;
2402 goto err_remap;
2403 }
2404
2405 /* Check to see if the mapping worked out */
Martyn Welch29848ac2010-02-18 15:13:05 +00002406 data = ioread32(tsi148_device->base + TSI148_PCFS_ID) & 0x0000FFFF;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002407 if (data != PCI_VENDOR_ID_TUNDRA) {
2408 dev_err(&pdev->dev, "CRG region check failed\n");
2409 retval = -EIO;
2410 goto err_test;
2411 }
2412
2413 /* Initialize wait queues & mutual exclusion flags */
Emilio G. Cota886953e2010-11-12 11:14:07 +00002414 init_waitqueue_head(&tsi148_device->dma_queue[0]);
2415 init_waitqueue_head(&tsi148_device->dma_queue[1]);
2416 init_waitqueue_head(&tsi148_device->iack_queue);
2417 mutex_init(&tsi148_device->vme_int);
2418 mutex_init(&tsi148_device->vme_rmw);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002419
Emilio G. Cota886953e2010-11-12 11:14:07 +00002420 tsi148_bridge->parent = &pdev->dev;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002421 strcpy(tsi148_bridge->name, driver_name);
2422
2423 /* Setup IRQ */
2424 retval = tsi148_irq_init(tsi148_bridge);
2425 if (retval != 0) {
2426 dev_err(&pdev->dev, "Chip Initialization failed.\n");
2427 goto err_irq;
2428 }
2429
2430 /* If we are going to flush writes, we need to read from the VME bus.
2431 * We need to do this safely, thus we read the devices own CR/CSR
2432 * register. To do this we must set up a window in CR/CSR space and
2433 * hence have one less master window resource available.
2434 */
2435 master_num = TSI148_MAX_MASTER;
Martyn Welch79463282010-03-22 14:58:57 +00002436 if (err_chk) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002437 master_num--;
Martyn Welch29848ac2010-02-18 15:13:05 +00002438
Julia Lawall32414872010-05-11 20:26:57 +02002439 tsi148_device->flush_image =
Martyn Welch29848ac2010-02-18 15:13:05 +00002440 kmalloc(sizeof(struct vme_master_resource), GFP_KERNEL);
2441 if (tsi148_device->flush_image == NULL) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002442 dev_err(&pdev->dev, "Failed to allocate memory for "
2443 "flush resource structure\n");
2444 retval = -ENOMEM;
2445 goto err_master;
2446 }
Martyn Welch29848ac2010-02-18 15:13:05 +00002447 tsi148_device->flush_image->parent = tsi148_bridge;
Emilio G. Cota886953e2010-11-12 11:14:07 +00002448 spin_lock_init(&tsi148_device->flush_image->lock);
Martyn Welch29848ac2010-02-18 15:13:05 +00002449 tsi148_device->flush_image->locked = 1;
2450 tsi148_device->flush_image->number = master_num;
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
Wei Yongjun0686ab72013-06-19 10:42:35 +08002585 retval = tsi148_crcsr_init(tsi148_bridge, pdev);
2586 if (retval) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002587 dev_err(&pdev->dev, "CR/CSR configuration failed.\n");
2588 goto err_crcsr;
Martyn Welch48397372010-03-22 14:58:43 +00002589 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002590
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002591 retval = vme_register_bridge(tsi148_bridge);
2592 if (retval != 0) {
2593 dev_err(&pdev->dev, "Chip Registration failed.\n");
2594 goto err_reg;
2595 }
2596
Martyn Welch29848ac2010-02-18 15:13:05 +00002597 pci_set_drvdata(pdev, tsi148_bridge);
2598
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002599 /* Clear VME bus "board fail", and "power-up reset" lines */
Martyn Welch29848ac2010-02-18 15:13:05 +00002600 data = ioread32be(tsi148_device->base + TSI148_LCSR_VSTAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002601 data &= ~TSI148_LCSR_VSTAT_BRDFL;
2602 data |= TSI148_LCSR_VSTAT_CPURST;
Martyn Welch29848ac2010-02-18 15:13:05 +00002603 iowrite32be(data, tsi148_device->base + TSI148_LCSR_VSTAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002604
2605 return 0;
2606
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002607err_reg:
Martyn Welch29848ac2010-02-18 15:13:05 +00002608 tsi148_crcsr_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002609err_crcsr:
Martyn Welch42fb5032009-08-11 17:44:56 +01002610err_lm:
2611 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002612 list_for_each_safe(pos, n, &tsi148_bridge->lm_resources) {
Martyn Welch42fb5032009-08-11 17:44:56 +01002613 lm = list_entry(pos, struct vme_lm_resource, list);
2614 list_del(pos);
2615 kfree(lm);
2616 }
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002617err_dma:
2618 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002619 list_for_each_safe(pos, n, &tsi148_bridge->dma_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002620 dma_ctrlr = list_entry(pos, struct vme_dma_resource, list);
2621 list_del(pos);
2622 kfree(dma_ctrlr);
2623 }
2624err_slave:
2625 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002626 list_for_each_safe(pos, n, &tsi148_bridge->slave_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002627 slave_image = list_entry(pos, struct vme_slave_resource, list);
2628 list_del(pos);
2629 kfree(slave_image);
2630 }
2631err_master:
2632 /* resources are stored in link list */
Wei Yongjunb49c32b2012-08-21 12:19:01 +08002633 list_for_each_safe(pos, n, &tsi148_bridge->master_resources) {
Martyn Welch79463282010-03-22 14:58:57 +00002634 master_image = list_entry(pos, struct vme_master_resource,
2635 list);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002636 list_del(pos);
2637 kfree(master_image);
2638 }
2639
Emilio G. Cotaa82ad052010-11-12 11:14:47 +00002640 tsi148_irq_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002641err_irq:
2642err_test:
Martyn Welch29848ac2010-02-18 15:13:05 +00002643 iounmap(tsi148_device->base);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002644err_remap:
2645 pci_release_regions(pdev);
2646err_resource:
2647 pci_disable_device(pdev);
2648err_enable:
Martyn Welch29848ac2010-02-18 15:13:05 +00002649 kfree(tsi148_device);
2650err_driver:
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002651 kfree(tsi148_bridge);
2652err_struct:
2653 return retval;
2654
2655}
2656
2657static void tsi148_remove(struct pci_dev *pdev)
2658{
2659 struct list_head *pos = NULL;
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002660 struct list_head *tmplist;
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002661 struct vme_master_resource *master_image;
2662 struct vme_slave_resource *slave_image;
2663 struct vme_dma_resource *dma_ctrlr;
2664 int i;
Martyn Welch29848ac2010-02-18 15:13:05 +00002665 struct tsi148_driver *bridge;
2666 struct vme_bridge *tsi148_bridge = pci_get_drvdata(pdev);
2667
2668 bridge = tsi148_bridge->driver_priv;
2669
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002670
2671 dev_dbg(&pdev->dev, "Driver is being unloaded.\n");
2672
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002673 /*
2674 * Shutdown all inbound and outbound windows.
2675 */
2676 for (i = 0; i < 8; i++) {
Martyn Welch29848ac2010-02-18 15:13:05 +00002677 iowrite32be(0, bridge->base + TSI148_LCSR_IT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002678 TSI148_LCSR_OFFSET_ITAT);
Martyn Welch29848ac2010-02-18 15:13:05 +00002679 iowrite32be(0, bridge->base + TSI148_LCSR_OT[i] +
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002680 TSI148_LCSR_OFFSET_OTAT);
2681 }
2682
2683 /*
2684 * Shutdown Location monitor.
2685 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002686 iowrite32be(0, bridge->base + TSI148_LCSR_LMAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002687
2688 /*
2689 * Shutdown CRG map.
2690 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002691 iowrite32be(0, bridge->base + TSI148_LCSR_CSRAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002692
2693 /*
2694 * Clear error status.
2695 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002696 iowrite32be(0xFFFFFFFF, bridge->base + TSI148_LCSR_EDPAT);
2697 iowrite32be(0xFFFFFFFF, bridge->base + TSI148_LCSR_VEAT);
2698 iowrite32be(0x07000700, bridge->base + TSI148_LCSR_PSTAT);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002699
2700 /*
2701 * Remove VIRQ interrupt (if any)
2702 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002703 if (ioread32be(bridge->base + TSI148_LCSR_VICR) & 0x800)
2704 iowrite32be(0x8000, bridge->base + TSI148_LCSR_VICR);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002705
2706 /*
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002707 * Map all Interrupts to PCI INTA
2708 */
Martyn Welch29848ac2010-02-18 15:13:05 +00002709 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTM1);
2710 iowrite32be(0x0, bridge->base + TSI148_LCSR_INTM2);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002711
Emilio G. Cotaa82ad052010-11-12 11:14:47 +00002712 tsi148_irq_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002713
2714 vme_unregister_bridge(tsi148_bridge);
2715
Martyn Welch29848ac2010-02-18 15:13:05 +00002716 tsi148_crcsr_exit(tsi148_bridge, pdev);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002717
2718 /* resources are stored in link list */
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002719 list_for_each_safe(pos, tmplist, &tsi148_bridge->dma_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002720 dma_ctrlr = list_entry(pos, struct vme_dma_resource, list);
2721 list_del(pos);
2722 kfree(dma_ctrlr);
2723 }
2724
2725 /* resources are stored in link list */
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002726 list_for_each_safe(pos, tmplist, &tsi148_bridge->slave_resources) {
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002727 slave_image = list_entry(pos, struct vme_slave_resource, list);
2728 list_del(pos);
2729 kfree(slave_image);
2730 }
2731
2732 /* resources are stored in link list */
Emilio G. Cotab558ba22010-11-12 11:14:34 +00002733 list_for_each_safe(pos, tmplist, &tsi148_bridge->master_resources) {
Martyn Welch638f1992009-12-15 08:42:49 +00002734 master_image = list_entry(pos, struct vme_master_resource,
2735 list);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002736 list_del(pos);
2737 kfree(master_image);
2738 }
2739
Martyn Welch29848ac2010-02-18 15:13:05 +00002740 iounmap(bridge->base);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002741
2742 pci_release_regions(pdev);
2743
2744 pci_disable_device(pdev);
2745
Martyn Welch29848ac2010-02-18 15:13:05 +00002746 kfree(tsi148_bridge->driver_priv);
2747
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002748 kfree(tsi148_bridge);
2749}
2750
Wei Yongjun01c07142012-10-18 23:12:50 +08002751module_pci_driver(tsi148_driver);
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002752
2753MODULE_PARM_DESC(err_chk, "Check for VME errors on reads and writes");
2754module_param(err_chk, bool, 0);
2755
Martyn Welch638f1992009-12-15 08:42:49 +00002756MODULE_PARM_DESC(geoid, "Override geographical addressing");
2757module_param(geoid, int, 0);
2758
Martyn Welchd22b8ed2009-07-31 09:28:17 +01002759MODULE_DESCRIPTION("VME driver for the Tundra Tempe VME bridge");
2760MODULE_LICENSE("GPL");