blob: f4716ad7348ae7185bdba2a35379b9a68fd37a63 [file] [log] [blame]
Bruce Losuree1e19742005-04-25 13:09:41 -07001/*
2 * This file is subject to the terms and conditions of the GNU General Public
3 * License. See the file "COPYING" in the main directory of this archive
4 * for more details.
5 *
6 * Copyright (c) 2005 Silicon Graphics, Inc. All rights reserved.
7 */
8
9/*
10 * MOATB Core Services driver.
11 */
12
Bruce Losuree1e19742005-04-25 13:09:41 -070013#include <linux/interrupt.h>
14#include <linux/module.h>
15#include <linux/moduleparam.h>
16#include <linux/types.h>
17#include <linux/ioport.h>
18#include <linux/notifier.h>
19#include <linux/reboot.h>
20#include <linux/init.h>
21#include <linux/fs.h>
22#include <linux/delay.h>
23#include <linux/device.h>
24#include <linux/mm.h>
25#include <linux/uio.h>
Matthias Kaehlckea40ba842008-02-07 00:15:24 -080026#include <linux/mutex.h>
Bruce Losuree1e19742005-04-25 13:09:41 -070027#include <asm/io.h>
28#include <asm/uaccess.h>
29#include <asm/system.h>
30#include <asm/pgtable.h>
31#include <asm/sn/addrs.h>
32#include <asm/sn/intr.h>
33#include <asm/sn/tiocx.h>
34#include "mbcs.h"
35
36#define MBCS_DEBUG 0
37#if MBCS_DEBUG
38#define DBG(fmt...) printk(KERN_ALERT fmt)
39#else
40#define DBG(fmt...)
41#endif
Alan Cox39ef01e2007-07-19 01:47:53 -070042static int mbcs_major;
Bruce Losuree1e19742005-04-25 13:09:41 -070043
Alan Cox39ef01e2007-07-19 01:47:53 -070044static LIST_HEAD(soft_list);
Bruce Losuree1e19742005-04-25 13:09:41 -070045
46/*
47 * file operations
48 */
Alan Cox39ef01e2007-07-19 01:47:53 -070049static const struct file_operations mbcs_ops = {
Bruce Losuree1e19742005-04-25 13:09:41 -070050 .open = mbcs_open,
51 .llseek = mbcs_sram_llseek,
52 .read = mbcs_sram_read,
53 .write = mbcs_sram_write,
54 .mmap = mbcs_gscr_mmap,
55};
56
57struct mbcs_callback_arg {
58 int minor;
59 struct cx_dev *cx_dev;
60};
61
62static inline void mbcs_getdma_init(struct getdma *gdma)
63{
64 memset(gdma, 0, sizeof(struct getdma));
65 gdma->DoneIntEnable = 1;
66}
67
68static inline void mbcs_putdma_init(struct putdma *pdma)
69{
70 memset(pdma, 0, sizeof(struct putdma));
71 pdma->DoneIntEnable = 1;
72}
73
74static inline void mbcs_algo_init(struct algoblock *algo_soft)
75{
76 memset(algo_soft, 0, sizeof(struct algoblock));
77}
78
79static inline void mbcs_getdma_set(void *mmr,
80 uint64_t hostAddr,
81 uint64_t localAddr,
82 uint64_t localRamSel,
83 uint64_t numPkts,
84 uint64_t amoEnable,
85 uint64_t intrEnable,
86 uint64_t peerIO,
87 uint64_t amoHostDest,
88 uint64_t amoModType, uint64_t intrHostDest,
89 uint64_t intrVector)
90{
91 union dma_control rdma_control;
92 union dma_amo_dest amo_dest;
93 union intr_dest intr_dest;
94 union dma_localaddr local_addr;
95 union dma_hostaddr host_addr;
96
97 rdma_control.dma_control_reg = 0;
98 amo_dest.dma_amo_dest_reg = 0;
99 intr_dest.intr_dest_reg = 0;
100 local_addr.dma_localaddr_reg = 0;
101 host_addr.dma_hostaddr_reg = 0;
102
103 host_addr.dma_sys_addr = hostAddr;
104 MBCS_MMR_SET(mmr, MBCS_RD_DMA_SYS_ADDR, host_addr.dma_hostaddr_reg);
105
106 local_addr.dma_ram_addr = localAddr;
107 local_addr.dma_ram_sel = localRamSel;
108 MBCS_MMR_SET(mmr, MBCS_RD_DMA_LOC_ADDR, local_addr.dma_localaddr_reg);
109
110 rdma_control.dma_op_length = numPkts;
111 rdma_control.done_amo_en = amoEnable;
112 rdma_control.done_int_en = intrEnable;
113 rdma_control.pio_mem_n = peerIO;
114 MBCS_MMR_SET(mmr, MBCS_RD_DMA_CTRL, rdma_control.dma_control_reg);
115
116 amo_dest.dma_amo_sys_addr = amoHostDest;
117 amo_dest.dma_amo_mod_type = amoModType;
118 MBCS_MMR_SET(mmr, MBCS_RD_DMA_AMO_DEST, amo_dest.dma_amo_dest_reg);
119
120 intr_dest.address = intrHostDest;
121 intr_dest.int_vector = intrVector;
122 MBCS_MMR_SET(mmr, MBCS_RD_DMA_INT_DEST, intr_dest.intr_dest_reg);
123
124}
125
126static inline void mbcs_putdma_set(void *mmr,
127 uint64_t hostAddr,
128 uint64_t localAddr,
129 uint64_t localRamSel,
130 uint64_t numPkts,
131 uint64_t amoEnable,
132 uint64_t intrEnable,
133 uint64_t peerIO,
134 uint64_t amoHostDest,
135 uint64_t amoModType,
136 uint64_t intrHostDest, uint64_t intrVector)
137{
138 union dma_control wdma_control;
139 union dma_amo_dest amo_dest;
140 union intr_dest intr_dest;
141 union dma_localaddr local_addr;
142 union dma_hostaddr host_addr;
143
144 wdma_control.dma_control_reg = 0;
145 amo_dest.dma_amo_dest_reg = 0;
146 intr_dest.intr_dest_reg = 0;
147 local_addr.dma_localaddr_reg = 0;
148 host_addr.dma_hostaddr_reg = 0;
149
150 host_addr.dma_sys_addr = hostAddr;
151 MBCS_MMR_SET(mmr, MBCS_WR_DMA_SYS_ADDR, host_addr.dma_hostaddr_reg);
152
153 local_addr.dma_ram_addr = localAddr;
154 local_addr.dma_ram_sel = localRamSel;
155 MBCS_MMR_SET(mmr, MBCS_WR_DMA_LOC_ADDR, local_addr.dma_localaddr_reg);
156
157 wdma_control.dma_op_length = numPkts;
158 wdma_control.done_amo_en = amoEnable;
159 wdma_control.done_int_en = intrEnable;
160 wdma_control.pio_mem_n = peerIO;
161 MBCS_MMR_SET(mmr, MBCS_WR_DMA_CTRL, wdma_control.dma_control_reg);
162
163 amo_dest.dma_amo_sys_addr = amoHostDest;
164 amo_dest.dma_amo_mod_type = amoModType;
165 MBCS_MMR_SET(mmr, MBCS_WR_DMA_AMO_DEST, amo_dest.dma_amo_dest_reg);
166
167 intr_dest.address = intrHostDest;
168 intr_dest.int_vector = intrVector;
169 MBCS_MMR_SET(mmr, MBCS_WR_DMA_INT_DEST, intr_dest.intr_dest_reg);
170
171}
172
173static inline void mbcs_algo_set(void *mmr,
174 uint64_t amoHostDest,
175 uint64_t amoModType,
176 uint64_t intrHostDest,
177 uint64_t intrVector, uint64_t algoStepCount)
178{
179 union dma_amo_dest amo_dest;
180 union intr_dest intr_dest;
181 union algo_step step;
182
183 step.algo_step_reg = 0;
184 intr_dest.intr_dest_reg = 0;
185 amo_dest.dma_amo_dest_reg = 0;
186
187 amo_dest.dma_amo_sys_addr = amoHostDest;
188 amo_dest.dma_amo_mod_type = amoModType;
189 MBCS_MMR_SET(mmr, MBCS_ALG_AMO_DEST, amo_dest.dma_amo_dest_reg);
190
191 intr_dest.address = intrHostDest;
192 intr_dest.int_vector = intrVector;
193 MBCS_MMR_SET(mmr, MBCS_ALG_INT_DEST, intr_dest.intr_dest_reg);
194
195 step.alg_step_cnt = algoStepCount;
196 MBCS_MMR_SET(mmr, MBCS_ALG_STEP, step.algo_step_reg);
197}
198
199static inline int mbcs_getdma_start(struct mbcs_soft *soft)
200{
201 void *mmr_base;
202 struct getdma *gdma;
203 uint64_t numPkts;
204 union cm_control cm_control;
205
206 mmr_base = soft->mmr_base;
207 gdma = &soft->getdma;
208
209 /* check that host address got setup */
210 if (!gdma->hostAddr)
211 return -1;
212
213 numPkts =
214 (gdma->bytes + (MBCS_CACHELINE_SIZE - 1)) / MBCS_CACHELINE_SIZE;
215
216 /* program engine */
217 mbcs_getdma_set(mmr_base, tiocx_dma_addr(gdma->hostAddr),
218 gdma->localAddr,
219 (gdma->localAddr < MB2) ? 0 :
220 (gdma->localAddr < MB4) ? 1 :
221 (gdma->localAddr < MB6) ? 2 : 3,
222 numPkts,
223 gdma->DoneAmoEnable,
224 gdma->DoneIntEnable,
225 gdma->peerIO,
226 gdma->amoHostDest,
227 gdma->amoModType,
228 gdma->intrHostDest, gdma->intrVector);
229
230 /* start engine */
231 cm_control.cm_control_reg = MBCS_MMR_GET(mmr_base, MBCS_CM_CONTROL);
232 cm_control.rd_dma_go = 1;
233 MBCS_MMR_SET(mmr_base, MBCS_CM_CONTROL, cm_control.cm_control_reg);
234
235 return 0;
236
237}
238
239static inline int mbcs_putdma_start(struct mbcs_soft *soft)
240{
241 void *mmr_base;
242 struct putdma *pdma;
243 uint64_t numPkts;
244 union cm_control cm_control;
245
246 mmr_base = soft->mmr_base;
247 pdma = &soft->putdma;
248
249 /* check that host address got setup */
250 if (!pdma->hostAddr)
251 return -1;
252
253 numPkts =
254 (pdma->bytes + (MBCS_CACHELINE_SIZE - 1)) / MBCS_CACHELINE_SIZE;
255
256 /* program engine */
257 mbcs_putdma_set(mmr_base, tiocx_dma_addr(pdma->hostAddr),
258 pdma->localAddr,
259 (pdma->localAddr < MB2) ? 0 :
260 (pdma->localAddr < MB4) ? 1 :
261 (pdma->localAddr < MB6) ? 2 : 3,
262 numPkts,
263 pdma->DoneAmoEnable,
264 pdma->DoneIntEnable,
265 pdma->peerIO,
266 pdma->amoHostDest,
267 pdma->amoModType,
268 pdma->intrHostDest, pdma->intrVector);
269
270 /* start engine */
271 cm_control.cm_control_reg = MBCS_MMR_GET(mmr_base, MBCS_CM_CONTROL);
272 cm_control.wr_dma_go = 1;
273 MBCS_MMR_SET(mmr_base, MBCS_CM_CONTROL, cm_control.cm_control_reg);
274
275 return 0;
276
277}
278
279static inline int mbcs_algo_start(struct mbcs_soft *soft)
280{
281 struct algoblock *algo_soft = &soft->algo;
282 void *mmr_base = soft->mmr_base;
283 union cm_control cm_control;
284
Matthias Kaehlckea40ba842008-02-07 00:15:24 -0800285 if (mutex_lock_interruptible(&soft->algolock))
Bruce Losuree1e19742005-04-25 13:09:41 -0700286 return -ERESTARTSYS;
287
288 atomic_set(&soft->algo_done, 0);
289
290 mbcs_algo_set(mmr_base,
291 algo_soft->amoHostDest,
292 algo_soft->amoModType,
293 algo_soft->intrHostDest,
294 algo_soft->intrVector, algo_soft->algoStepCount);
295
296 /* start algorithm */
297 cm_control.cm_control_reg = MBCS_MMR_GET(mmr_base, MBCS_CM_CONTROL);
298 cm_control.alg_done_int_en = 1;
299 cm_control.alg_go = 1;
300 MBCS_MMR_SET(mmr_base, MBCS_CM_CONTROL, cm_control.cm_control_reg);
301
Matthias Kaehlckea40ba842008-02-07 00:15:24 -0800302 mutex_unlock(&soft->algolock);
Bruce Losuree1e19742005-04-25 13:09:41 -0700303
304 return 0;
305}
306
307static inline ssize_t
308do_mbcs_sram_dmawrite(struct mbcs_soft *soft, uint64_t hostAddr,
309 size_t len, loff_t * off)
310{
311 int rv = 0;
312
Matthias Kaehlcke46bca692008-02-07 00:15:24 -0800313 if (mutex_lock_interruptible(&soft->dmawritelock))
Bruce Losuree1e19742005-04-25 13:09:41 -0700314 return -ERESTARTSYS;
315
316 atomic_set(&soft->dmawrite_done, 0);
317
318 soft->putdma.hostAddr = hostAddr;
319 soft->putdma.localAddr = *off;
320 soft->putdma.bytes = len;
321
322 if (mbcs_putdma_start(soft) < 0) {
323 DBG(KERN_ALERT "do_mbcs_sram_dmawrite: "
324 "mbcs_putdma_start failed\n");
325 rv = -EAGAIN;
326 goto dmawrite_exit;
327 }
328
329 if (wait_event_interruptible(soft->dmawrite_queue,
330 atomic_read(&soft->dmawrite_done))) {
331 rv = -ERESTARTSYS;
332 goto dmawrite_exit;
333 }
334
335 rv = len;
336 *off += len;
337
338dmawrite_exit:
Matthias Kaehlcke46bca692008-02-07 00:15:24 -0800339 mutex_unlock(&soft->dmawritelock);
Bruce Losuree1e19742005-04-25 13:09:41 -0700340
341 return rv;
342}
343
344static inline ssize_t
345do_mbcs_sram_dmaread(struct mbcs_soft *soft, uint64_t hostAddr,
346 size_t len, loff_t * off)
347{
348 int rv = 0;
349
Matthias Kaehlckeae5e2972008-02-07 00:15:25 -0800350 if (mutex_lock_interruptible(&soft->dmareadlock))
Bruce Losuree1e19742005-04-25 13:09:41 -0700351 return -ERESTARTSYS;
352
353 atomic_set(&soft->dmawrite_done, 0);
354
355 soft->getdma.hostAddr = hostAddr;
356 soft->getdma.localAddr = *off;
357 soft->getdma.bytes = len;
358
359 if (mbcs_getdma_start(soft) < 0) {
360 DBG(KERN_ALERT "mbcs_strategy: mbcs_getdma_start failed\n");
361 rv = -EAGAIN;
362 goto dmaread_exit;
363 }
364
365 if (wait_event_interruptible(soft->dmaread_queue,
366 atomic_read(&soft->dmaread_done))) {
367 rv = -ERESTARTSYS;
368 goto dmaread_exit;
369 }
370
371 rv = len;
372 *off += len;
373
374dmaread_exit:
Matthias Kaehlckeae5e2972008-02-07 00:15:25 -0800375 mutex_unlock(&soft->dmareadlock);
Bruce Losuree1e19742005-04-25 13:09:41 -0700376
377 return rv;
378}
379
Alan Cox39ef01e2007-07-19 01:47:53 -0700380static int mbcs_open(struct inode *ip, struct file *fp)
Bruce Losuree1e19742005-04-25 13:09:41 -0700381{
382 struct mbcs_soft *soft;
383 int minor;
384
385 minor = iminor(ip);
386
387 list_for_each_entry(soft, &soft_list, list) {
388 if (soft->nasid == minor) {
389 fp->private_data = soft->cxdev;
390 return 0;
391 }
392 }
393
394 return -ENODEV;
395}
396
Alan Cox39ef01e2007-07-19 01:47:53 -0700397static ssize_t mbcs_sram_read(struct file * fp, char __user *buf, size_t len, loff_t * off)
Bruce Losuree1e19742005-04-25 13:09:41 -0700398{
399 struct cx_dev *cx_dev = fp->private_data;
400 struct mbcs_soft *soft = cx_dev->soft;
401 uint64_t hostAddr;
402 int rv = 0;
403
404 hostAddr = __get_dma_pages(GFP_KERNEL, get_order(len));
405 if (hostAddr == 0)
406 return -ENOMEM;
407
408 rv = do_mbcs_sram_dmawrite(soft, hostAddr, len, off);
409 if (rv < 0)
410 goto exit;
411
412 if (copy_to_user(buf, (void *)hostAddr, len))
413 rv = -EFAULT;
414
415 exit:
416 free_pages(hostAddr, get_order(len));
417
418 return rv;
419}
420
Alan Cox39ef01e2007-07-19 01:47:53 -0700421static ssize_t
Al Viro9b525232005-05-04 05:39:01 +0100422mbcs_sram_write(struct file * fp, const char __user *buf, size_t len, loff_t * off)
Bruce Losuree1e19742005-04-25 13:09:41 -0700423{
424 struct cx_dev *cx_dev = fp->private_data;
425 struct mbcs_soft *soft = cx_dev->soft;
426 uint64_t hostAddr;
427 int rv = 0;
428
429 hostAddr = __get_dma_pages(GFP_KERNEL, get_order(len));
430 if (hostAddr == 0)
431 return -ENOMEM;
432
433 if (copy_from_user((void *)hostAddr, buf, len)) {
434 rv = -EFAULT;
435 goto exit;
436 }
437
438 rv = do_mbcs_sram_dmaread(soft, hostAddr, len, off);
439
440 exit:
441 free_pages(hostAddr, get_order(len));
442
443 return rv;
444}
445
Alan Cox39ef01e2007-07-19 01:47:53 -0700446static loff_t mbcs_sram_llseek(struct file * filp, loff_t off, int whence)
Bruce Losuree1e19742005-04-25 13:09:41 -0700447{
448 loff_t newpos;
449
450 switch (whence) {
Josef 'Jeff' Sipek930ff812006-09-30 23:27:33 -0700451 case SEEK_SET:
Bruce Losuree1e19742005-04-25 13:09:41 -0700452 newpos = off;
453 break;
454
Josef 'Jeff' Sipek930ff812006-09-30 23:27:33 -0700455 case SEEK_CUR:
Bruce Losuree1e19742005-04-25 13:09:41 -0700456 newpos = filp->f_pos + off;
457 break;
458
Josef 'Jeff' Sipek930ff812006-09-30 23:27:33 -0700459 case SEEK_END:
Bruce Losuree1e19742005-04-25 13:09:41 -0700460 newpos = MBCS_SRAM_SIZE + off;
461 break;
462
463 default: /* can't happen */
464 return -EINVAL;
465 }
466
467 if (newpos < 0)
468 return -EINVAL;
469
470 filp->f_pos = newpos;
471
472 return newpos;
473}
474
475static uint64_t mbcs_pioaddr(struct mbcs_soft *soft, uint64_t offset)
476{
477 uint64_t mmr_base;
478
479 mmr_base = (uint64_t) (soft->mmr_base + offset);
480
481 return mmr_base;
482}
483
484static void mbcs_debug_pioaddr_set(struct mbcs_soft *soft)
485{
486 soft->debug_addr = mbcs_pioaddr(soft, MBCS_DEBUG_START);
487}
488
489static void mbcs_gscr_pioaddr_set(struct mbcs_soft *soft)
490{
491 soft->gscr_addr = mbcs_pioaddr(soft, MBCS_GSCR_START);
492}
493
Alan Cox39ef01e2007-07-19 01:47:53 -0700494static int mbcs_gscr_mmap(struct file *fp, struct vm_area_struct *vma)
Bruce Losuree1e19742005-04-25 13:09:41 -0700495{
496 struct cx_dev *cx_dev = fp->private_data;
497 struct mbcs_soft *soft = cx_dev->soft;
498
499 if (vma->vm_pgoff != 0)
500 return -EINVAL;
501
502 vma->vm_page_prot = pgprot_noncached(vma->vm_page_prot);
503
504 /* Remap-pfn-range will mark the range VM_IO and VM_RESERVED */
505 if (remap_pfn_range(vma,
506 vma->vm_start,
507 __pa(soft->gscr_addr) >> PAGE_SHIFT,
508 PAGE_SIZE,
509 vma->vm_page_prot))
510 return -EAGAIN;
511
512 return 0;
513}
514
515/**
516 * mbcs_completion_intr_handler - Primary completion handler.
517 * @irq: irq
518 * @arg: soft struct for device
Bruce Losuree1e19742005-04-25 13:09:41 -0700519 *
520 */
521static irqreturn_t
David Howells7d12e782006-10-05 14:55:46 +0100522mbcs_completion_intr_handler(int irq, void *arg)
Bruce Losuree1e19742005-04-25 13:09:41 -0700523{
524 struct mbcs_soft *soft = (struct mbcs_soft *)arg;
525 void *mmr_base;
526 union cm_status cm_status;
527 union cm_control cm_control;
528
529 mmr_base = soft->mmr_base;
530 cm_status.cm_status_reg = MBCS_MMR_GET(mmr_base, MBCS_CM_STATUS);
531
532 if (cm_status.rd_dma_done) {
533 /* stop dma-read engine, clear status */
534 cm_control.cm_control_reg =
535 MBCS_MMR_GET(mmr_base, MBCS_CM_CONTROL);
536 cm_control.rd_dma_clr = 1;
537 MBCS_MMR_SET(mmr_base, MBCS_CM_CONTROL,
538 cm_control.cm_control_reg);
539 atomic_set(&soft->dmaread_done, 1);
540 wake_up(&soft->dmaread_queue);
541 }
542 if (cm_status.wr_dma_done) {
543 /* stop dma-write engine, clear status */
544 cm_control.cm_control_reg =
545 MBCS_MMR_GET(mmr_base, MBCS_CM_CONTROL);
546 cm_control.wr_dma_clr = 1;
547 MBCS_MMR_SET(mmr_base, MBCS_CM_CONTROL,
548 cm_control.cm_control_reg);
549 atomic_set(&soft->dmawrite_done, 1);
550 wake_up(&soft->dmawrite_queue);
551 }
552 if (cm_status.alg_done) {
553 /* clear status */
554 cm_control.cm_control_reg =
555 MBCS_MMR_GET(mmr_base, MBCS_CM_CONTROL);
556 cm_control.alg_done_clr = 1;
557 MBCS_MMR_SET(mmr_base, MBCS_CM_CONTROL,
558 cm_control.cm_control_reg);
559 atomic_set(&soft->algo_done, 1);
560 wake_up(&soft->algo_queue);
561 }
562
563 return IRQ_HANDLED;
564}
565
566/**
567 * mbcs_intr_alloc - Allocate interrupts.
568 * @dev: device pointer
569 *
570 */
571static int mbcs_intr_alloc(struct cx_dev *dev)
572{
573 struct sn_irq_info *sn_irq;
574 struct mbcs_soft *soft;
575 struct getdma *getdma;
576 struct putdma *putdma;
577 struct algoblock *algo;
578
579 soft = dev->soft;
580 getdma = &soft->getdma;
581 putdma = &soft->putdma;
582 algo = &soft->algo;
583
584 soft->get_sn_irq = NULL;
585 soft->put_sn_irq = NULL;
586 soft->algo_sn_irq = NULL;
587
588 sn_irq = tiocx_irq_alloc(dev->cx_id.nasid, TIOCX_CORELET, -1, -1, -1);
589 if (sn_irq == NULL)
590 return -EAGAIN;
591 soft->get_sn_irq = sn_irq;
592 getdma->intrHostDest = sn_irq->irq_xtalkaddr;
593 getdma->intrVector = sn_irq->irq_irq;
594 if (request_irq(sn_irq->irq_irq,
Thomas Gleixner0f2ed4c2006-07-01 19:29:33 -0700595 (void *)mbcs_completion_intr_handler, IRQF_SHARED,
Bruce Losuree1e19742005-04-25 13:09:41 -0700596 "MBCS get intr", (void *)soft)) {
597 tiocx_irq_free(soft->get_sn_irq);
598 return -EAGAIN;
599 }
600
601 sn_irq = tiocx_irq_alloc(dev->cx_id.nasid, TIOCX_CORELET, -1, -1, -1);
602 if (sn_irq == NULL) {
603 free_irq(soft->get_sn_irq->irq_irq, soft);
604 tiocx_irq_free(soft->get_sn_irq);
605 return -EAGAIN;
606 }
607 soft->put_sn_irq = sn_irq;
608 putdma->intrHostDest = sn_irq->irq_xtalkaddr;
609 putdma->intrVector = sn_irq->irq_irq;
610 if (request_irq(sn_irq->irq_irq,
Thomas Gleixner0f2ed4c2006-07-01 19:29:33 -0700611 (void *)mbcs_completion_intr_handler, IRQF_SHARED,
Bruce Losuree1e19742005-04-25 13:09:41 -0700612 "MBCS put intr", (void *)soft)) {
613 tiocx_irq_free(soft->put_sn_irq);
614 free_irq(soft->get_sn_irq->irq_irq, soft);
615 tiocx_irq_free(soft->get_sn_irq);
616 return -EAGAIN;
617 }
618
619 sn_irq = tiocx_irq_alloc(dev->cx_id.nasid, TIOCX_CORELET, -1, -1, -1);
620 if (sn_irq == NULL) {
621 free_irq(soft->put_sn_irq->irq_irq, soft);
622 tiocx_irq_free(soft->put_sn_irq);
623 free_irq(soft->get_sn_irq->irq_irq, soft);
624 tiocx_irq_free(soft->get_sn_irq);
625 return -EAGAIN;
626 }
627 soft->algo_sn_irq = sn_irq;
628 algo->intrHostDest = sn_irq->irq_xtalkaddr;
629 algo->intrVector = sn_irq->irq_irq;
630 if (request_irq(sn_irq->irq_irq,
Thomas Gleixner0f2ed4c2006-07-01 19:29:33 -0700631 (void *)mbcs_completion_intr_handler, IRQF_SHARED,
Bruce Losuree1e19742005-04-25 13:09:41 -0700632 "MBCS algo intr", (void *)soft)) {
633 tiocx_irq_free(soft->algo_sn_irq);
634 free_irq(soft->put_sn_irq->irq_irq, soft);
635 tiocx_irq_free(soft->put_sn_irq);
636 free_irq(soft->get_sn_irq->irq_irq, soft);
637 tiocx_irq_free(soft->get_sn_irq);
638 return -EAGAIN;
639 }
640
641 return 0;
642}
643
644/**
645 * mbcs_intr_dealloc - Remove interrupts.
646 * @dev: device pointer
647 *
648 */
649static void mbcs_intr_dealloc(struct cx_dev *dev)
650{
651 struct mbcs_soft *soft;
652
653 soft = dev->soft;
654
655 free_irq(soft->get_sn_irq->irq_irq, soft);
656 tiocx_irq_free(soft->get_sn_irq);
657 free_irq(soft->put_sn_irq->irq_irq, soft);
658 tiocx_irq_free(soft->put_sn_irq);
659 free_irq(soft->algo_sn_irq->irq_irq, soft);
660 tiocx_irq_free(soft->algo_sn_irq);
661}
662
663static inline int mbcs_hw_init(struct mbcs_soft *soft)
664{
665 void *mmr_base = soft->mmr_base;
666 union cm_control cm_control;
667 union cm_req_timeout cm_req_timeout;
668 uint64_t err_stat;
669
670 cm_req_timeout.cm_req_timeout_reg =
671 MBCS_MMR_GET(mmr_base, MBCS_CM_REQ_TOUT);
672
673 cm_req_timeout.time_out = MBCS_CM_CONTROL_REQ_TOUT_MASK;
674 MBCS_MMR_SET(mmr_base, MBCS_CM_REQ_TOUT,
675 cm_req_timeout.cm_req_timeout_reg);
676
677 mbcs_gscr_pioaddr_set(soft);
678 mbcs_debug_pioaddr_set(soft);
679
680 /* clear errors */
681 err_stat = MBCS_MMR_GET(mmr_base, MBCS_CM_ERR_STAT);
682 MBCS_MMR_SET(mmr_base, MBCS_CM_CLR_ERR_STAT, err_stat);
683 MBCS_MMR_ZERO(mmr_base, MBCS_CM_ERROR_DETAIL1);
684
685 /* enable interrupts */
686 /* turn off 2^23 (INT_EN_PIO_REQ_ADDR_INV) */
687 MBCS_MMR_SET(mmr_base, MBCS_CM_ERR_INT_EN, 0x3ffffff7e00ffUL);
688
689 /* arm status regs and clear engines */
690 cm_control.cm_control_reg = MBCS_MMR_GET(mmr_base, MBCS_CM_CONTROL);
691 cm_control.rearm_stat_regs = 1;
692 cm_control.alg_clr = 1;
693 cm_control.wr_dma_clr = 1;
694 cm_control.rd_dma_clr = 1;
695
696 MBCS_MMR_SET(mmr_base, MBCS_CM_CONTROL, cm_control.cm_control_reg);
697
698 return 0;
699}
700
Yani Ioannou74880c02005-05-17 06:41:12 -0400701static ssize_t show_algo(struct device *dev, struct device_attribute *attr, char *buf)
Bruce Losuree1e19742005-04-25 13:09:41 -0700702{
703 struct cx_dev *cx_dev = to_cx_dev(dev);
704 struct mbcs_soft *soft = cx_dev->soft;
705 uint64_t debug0;
706
707 /*
708 * By convention, the first debug register contains the
709 * algorithm number and revision.
710 */
711 debug0 = *(uint64_t *) soft->debug_addr;
712
713 return sprintf(buf, "0x%lx 0x%lx\n",
714 (debug0 >> 32), (debug0 & 0xffffffff));
715}
716
Yani Ioannou74880c02005-05-17 06:41:12 -0400717static ssize_t store_algo(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
Bruce Losuree1e19742005-04-25 13:09:41 -0700718{
719 int n;
720 struct cx_dev *cx_dev = to_cx_dev(dev);
721 struct mbcs_soft *soft = cx_dev->soft;
722
723 if (count <= 0)
724 return 0;
725
726 n = simple_strtoul(buf, NULL, 0);
727
728 if (n == 1) {
729 mbcs_algo_start(soft);
730 if (wait_event_interruptible(soft->algo_queue,
731 atomic_read(&soft->algo_done)))
732 return -ERESTARTSYS;
733 }
734
735 return count;
736}
737
738DEVICE_ATTR(algo, 0644, show_algo, store_algo);
739
740/**
741 * mbcs_probe - Initialize for device
742 * @dev: device pointer
743 * @device_id: id table pointer
744 *
745 */
746static int mbcs_probe(struct cx_dev *dev, const struct cx_device_id *id)
747{
748 struct mbcs_soft *soft;
749
750 dev->soft = NULL;
751
Pekka Enberg82ca76b2005-09-06 15:18:35 -0700752 soft = kzalloc(sizeof(struct mbcs_soft), GFP_KERNEL);
Bruce Losuree1e19742005-04-25 13:09:41 -0700753 if (soft == NULL)
754 return -ENOMEM;
755
756 soft->nasid = dev->cx_id.nasid;
757 list_add(&soft->list, &soft_list);
758 soft->mmr_base = (void *)tiocx_swin_base(dev->cx_id.nasid);
759 dev->soft = soft;
760 soft->cxdev = dev;
761
762 init_waitqueue_head(&soft->dmawrite_queue);
763 init_waitqueue_head(&soft->dmaread_queue);
764 init_waitqueue_head(&soft->algo_queue);
765
Matthias Kaehlcke46bca692008-02-07 00:15:24 -0800766 mutex_init(&soft->dmawritelock);
Matthias Kaehlckeae5e2972008-02-07 00:15:25 -0800767 mutex_init(&soft->dmareadlock);
Matthias Kaehlckea40ba842008-02-07 00:15:24 -0800768 mutex_init(&soft->algolock);
Bruce Losuree1e19742005-04-25 13:09:41 -0700769
770 mbcs_getdma_init(&soft->getdma);
771 mbcs_putdma_init(&soft->putdma);
772 mbcs_algo_init(&soft->algo);
773
774 mbcs_hw_init(soft);
775
776 /* Allocate interrupts */
777 mbcs_intr_alloc(dev);
778
779 device_create_file(&dev->dev, &dev_attr_algo);
780
781 return 0;
782}
783
784static int mbcs_remove(struct cx_dev *dev)
785{
786 if (dev->soft) {
787 mbcs_intr_dealloc(dev);
788 kfree(dev->soft);
789 }
790
791 device_remove_file(&dev->dev, &dev_attr_algo);
792
793 return 0;
794}
795
Alan Cox39ef01e2007-07-19 01:47:53 -0700796static const struct cx_device_id __devinitdata mbcs_id_table[] = {
Bruce Losuree1e19742005-04-25 13:09:41 -0700797 {
798 .part_num = MBCS_PART_NUM,
799 .mfg_num = MBCS_MFG_NUM,
800 },
801 {
802 .part_num = MBCS_PART_NUM_ALG0,
803 .mfg_num = MBCS_MFG_NUM,
804 },
805 {0, 0}
806};
807
808MODULE_DEVICE_TABLE(cx, mbcs_id_table);
809
Alan Cox39ef01e2007-07-19 01:47:53 -0700810static struct cx_drv mbcs_driver = {
Bruce Losuree1e19742005-04-25 13:09:41 -0700811 .name = DEVICE_NAME,
812 .id_table = mbcs_id_table,
813 .probe = mbcs_probe,
814 .remove = mbcs_remove,
815};
816
817static void __exit mbcs_exit(void)
818{
Akinobu Mita68fc4fa2007-07-19 01:47:50 -0700819 unregister_chrdev(mbcs_major, DEVICE_NAME);
Bruce Losuree1e19742005-04-25 13:09:41 -0700820 cx_driver_unregister(&mbcs_driver);
821}
822
823static int __init mbcs_init(void)
824{
825 int rv;
826
Greg Edwards96f339c62005-09-28 17:05:19 -0500827 if (!ia64_platform_is("sn2"))
828 return -ENODEV;
829
Bruce Losuree1e19742005-04-25 13:09:41 -0700830 // Put driver into chrdevs[]. Get major number.
831 rv = register_chrdev(mbcs_major, DEVICE_NAME, &mbcs_ops);
832 if (rv < 0) {
833 DBG(KERN_ALERT "mbcs_init: can't get major number. %d\n", rv);
834 return rv;
835 }
836 mbcs_major = rv;
837
838 return cx_driver_register(&mbcs_driver);
839}
840
841module_init(mbcs_init);
842module_exit(mbcs_exit);
843
844MODULE_AUTHOR("Bruce Losure <blosure@sgi.com>");
845MODULE_DESCRIPTION("Driver for MOATB Core Services");
846MODULE_LICENSE("GPL");