1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/sched.h>
18#include <linux/slab.h>
19#include <linux/mutex.h>
20#include "megaraid_mm.h"
21
22
23
24static DEFINE_MUTEX(mraid_mm_mutex);
25static int mraid_mm_open(struct inode *, struct file *);
26static long mraid_mm_unlocked_ioctl(struct file *, uint, unsigned long);
27
28
29
30static int mimd_to_kioc(mimd_t __user *, mraid_mmadp_t *, uioc_t *);
31static int kioc_to_mimd(uioc_t *, mimd_t __user *);
32
33
34
35static int handle_drvrcmd(void __user *, uint8_t, int *);
36static int lld_ioctl(mraid_mmadp_t *, uioc_t *);
37static void ioctl_done(uioc_t *);
38static void lld_timedout(struct timer_list *);
39static void hinfo_to_cinfo(mraid_hba_info_t *, mcontroller_t *);
40static mraid_mmadp_t *mraid_mm_get_adapter(mimd_t __user *, int *);
41static uioc_t *mraid_mm_alloc_kioc(mraid_mmadp_t *);
42static void mraid_mm_dealloc_kioc(mraid_mmadp_t *, uioc_t *);
43static int mraid_mm_attach_buf(mraid_mmadp_t *, uioc_t *, int);
44static int mraid_mm_setup_dma_pools(mraid_mmadp_t *);
45static void mraid_mm_free_adp_resources(mraid_mmadp_t *);
46static void mraid_mm_teardown_dma_pools(mraid_mmadp_t *);
47
48#ifdef CONFIG_COMPAT
49static long mraid_mm_compat_ioctl(struct file *, unsigned int, unsigned long);
50#endif
51
52MODULE_AUTHOR("LSI Logic Corporation");
53MODULE_DESCRIPTION("LSI Logic Management Module");
54MODULE_LICENSE("GPL");
55MODULE_VERSION(LSI_COMMON_MOD_VERSION);
56
57static int dbglevel = CL_ANN;
58module_param_named(dlevel, dbglevel, int, 0);
59MODULE_PARM_DESC(dlevel, "Debug level (default=0)");
60
61EXPORT_SYMBOL(mraid_mm_register_adp);
62EXPORT_SYMBOL(mraid_mm_unregister_adp);
63EXPORT_SYMBOL(mraid_mm_adapter_app_handle);
64
65static uint32_t drvr_ver = 0x02200207;
66
67static int adapters_count_g;
68static struct list_head adapters_list_g;
69
70static wait_queue_head_t wait_q;
71
72static const struct file_operations lsi_fops = {
73 .open = mraid_mm_open,
74 .unlocked_ioctl = mraid_mm_unlocked_ioctl,
75#ifdef CONFIG_COMPAT
76 .compat_ioctl = mraid_mm_compat_ioctl,
77#endif
78 .owner = THIS_MODULE,
79 .llseek = noop_llseek,
80};
81
82static struct miscdevice megaraid_mm_dev = {
83 .minor = MISC_DYNAMIC_MINOR,
84 .name = "megadev0",
85 .fops = &lsi_fops,
86};
87
88
89
90
91
92
93
94
95static int
96mraid_mm_open(struct inode *inode, struct file *filep)
97{
98
99
100
101 if (!capable(CAP_SYS_ADMIN)) return (-EACCES);
102
103 return 0;
104}
105
106
107
108
109
110
111
112
113static int
114mraid_mm_ioctl(struct file *filep, unsigned int cmd, unsigned long arg)
115{
116 uioc_t *kioc;
117 char signature[EXT_IOCTL_SIGN_SZ] = {0};
118 int rval;
119 mraid_mmadp_t *adp;
120 uint8_t old_ioctl;
121 int drvrcmd_rval;
122 void __user *argp = (void __user *)arg;
123
124
125
126
127
128
129 if ((_IOC_TYPE(cmd) != MEGAIOC_MAGIC) && (cmd != USCSICMD)) {
130 return (-EINVAL);
131 }
132
133
134
135
136 if (copy_from_user(signature, argp, EXT_IOCTL_SIGN_SZ)) {
137 con_log(CL_ANN, (KERN_WARNING
138 "megaraid cmm: copy from usr addr failed\n"));
139 return (-EFAULT);
140 }
141
142 if (memcmp(signature, EXT_IOCTL_SIGN, EXT_IOCTL_SIGN_SZ) == 0)
143 old_ioctl = 0;
144 else
145 old_ioctl = 1;
146
147
148
149
150 if (!old_ioctl )
151 return (-EINVAL);
152
153
154
155
156
157 rval = handle_drvrcmd(argp, old_ioctl, &drvrcmd_rval);
158
159 if (rval < 0)
160 return rval;
161 else if (rval == 0)
162 return drvrcmd_rval;
163
164 rval = 0;
165 if ((adp = mraid_mm_get_adapter(argp, &rval)) == NULL) {
166 return rval;
167 }
168
169
170
171
172
173 if (!adp->quiescent) {
174 con_log(CL_ANN, (KERN_WARNING
175 "megaraid cmm: controller cannot accept cmds due to "
176 "earlier errors\n" ));
177 return -EFAULT;
178 }
179
180
181
182
183
184
185 kioc = mraid_mm_alloc_kioc(adp);
186 if (!kioc)
187 return -ENXIO;
188
189
190
191
192 if ((rval = mimd_to_kioc(argp, adp, kioc))) {
193 mraid_mm_dealloc_kioc(adp, kioc);
194 return rval;
195 }
196
197 kioc->done = ioctl_done;
198
199
200
201
202
203
204 if ((rval = lld_ioctl(adp, kioc))) {
205
206 if (!kioc->timedout)
207 mraid_mm_dealloc_kioc(adp, kioc);
208
209 return rval;
210 }
211
212
213
214
215 rval = kioc_to_mimd(kioc, argp);
216
217
218
219
220 mraid_mm_dealloc_kioc(adp, kioc);
221
222 return rval;
223}
224
225static long
226mraid_mm_unlocked_ioctl(struct file *filep, unsigned int cmd,
227 unsigned long arg)
228{
229 int err;
230
231
232 mutex_lock(&mraid_mm_mutex);
233 err = mraid_mm_ioctl(filep, cmd, arg);
234 mutex_unlock(&mraid_mm_mutex);
235
236 return err;
237}
238
239
240
241
242
243
244
245
246static mraid_mmadp_t *
247mraid_mm_get_adapter(mimd_t __user *umimd, int *rval)
248{
249 mraid_mmadp_t *adapter;
250 mimd_t mimd;
251 uint32_t adapno;
252 int iterator;
253
254
255 if (copy_from_user(&mimd, umimd, sizeof(mimd_t))) {
256 *rval = -EFAULT;
257 return NULL;
258 }
259
260 adapno = GETADAP(mimd.ui.fcs.adapno);
261
262 if (adapno >= adapters_count_g) {
263 *rval = -ENODEV;
264 return NULL;
265 }
266
267 adapter = NULL;
268 iterator = 0;
269
270 list_for_each_entry(adapter, &adapters_list_g, list) {
271 if (iterator++ == adapno) break;
272 }
273
274 if (!adapter) {
275 *rval = -ENODEV;
276 return NULL;
277 }
278
279 return adapter;
280}
281
282
283
284
285
286
287
288static int
289handle_drvrcmd(void __user *arg, uint8_t old_ioctl, int *rval)
290{
291 mimd_t __user *umimd;
292 mimd_t kmimd;
293 uint8_t opcode;
294 uint8_t subopcode;
295
296 if (old_ioctl)
297 goto old_packet;
298 else
299 goto new_packet;
300
301new_packet:
302 return (-ENOTSUPP);
303
304old_packet:
305 *rval = 0;
306 umimd = arg;
307
308 if (copy_from_user(&kmimd, umimd, sizeof(mimd_t)))
309 return (-EFAULT);
310
311 opcode = kmimd.ui.fcs.opcode;
312 subopcode = kmimd.ui.fcs.subopcode;
313
314
315
316
317
318
319 if (opcode != 0x82)
320 return 1;
321
322 switch (subopcode) {
323
324 case MEGAIOC_QDRVRVER:
325
326 if (copy_to_user(kmimd.data, &drvr_ver, sizeof(uint32_t)))
327 return (-EFAULT);
328
329 return 0;
330
331 case MEGAIOC_QNADAP:
332
333 *rval = adapters_count_g;
334
335 if (copy_to_user(kmimd.data, &adapters_count_g,
336 sizeof(uint32_t)))
337 return (-EFAULT);
338
339 return 0;
340
341 default:
342
343 return 1;
344 }
345
346 return 0;
347}
348
349
350
351
352
353
354
355
356
357
358
359
360
361static int
362mimd_to_kioc(mimd_t __user *umimd, mraid_mmadp_t *adp, uioc_t *kioc)
363{
364 mbox64_t *mbox64;
365 mbox_t *mbox;
366 mraid_passthru_t *pthru32;
367 uint32_t adapno;
368 uint8_t opcode;
369 uint8_t subopcode;
370 mimd_t mimd;
371
372 if (copy_from_user(&mimd, umimd, sizeof(mimd_t)))
373 return (-EFAULT);
374
375
376
377
378 if ((mimd.mbox[0] == MBOXCMD_PASSTHRU64) ||
379 (mimd.mbox[0] == MBOXCMD_EXTPTHRU))
380 return (-EINVAL);
381
382 opcode = mimd.ui.fcs.opcode;
383 subopcode = mimd.ui.fcs.subopcode;
384 adapno = GETADAP(mimd.ui.fcs.adapno);
385
386 if (adapno >= adapters_count_g)
387 return (-ENODEV);
388
389 kioc->adapno = adapno;
390 kioc->mb_type = MBOX_LEGACY;
391 kioc->app_type = APPTYPE_MIMD;
392
393 switch (opcode) {
394
395 case 0x82:
396
397 if (subopcode == MEGAIOC_QADAPINFO) {
398
399 kioc->opcode = GET_ADAP_INFO;
400 kioc->data_dir = UIOC_RD;
401 kioc->xferlen = sizeof(mraid_hba_info_t);
402
403 if (mraid_mm_attach_buf(adp, kioc, kioc->xferlen))
404 return (-ENOMEM);
405 }
406 else {
407 con_log(CL_ANN, (KERN_WARNING
408 "megaraid cmm: Invalid subop\n"));
409 return (-EINVAL);
410 }
411
412 break;
413
414 case 0x81:
415
416 kioc->opcode = MBOX_CMD;
417 kioc->xferlen = mimd.ui.fcs.length;
418 kioc->user_data_len = kioc->xferlen;
419 kioc->user_data = mimd.ui.fcs.buffer;
420
421 if (mraid_mm_attach_buf(adp, kioc, kioc->xferlen))
422 return (-ENOMEM);
423
424 if (mimd.outlen) kioc->data_dir = UIOC_RD;
425 if (mimd.inlen) kioc->data_dir |= UIOC_WR;
426
427 break;
428
429 case 0x80:
430
431 kioc->opcode = MBOX_CMD;
432 kioc->xferlen = (mimd.outlen > mimd.inlen) ?
433 mimd.outlen : mimd.inlen;
434 kioc->user_data_len = kioc->xferlen;
435 kioc->user_data = mimd.data;
436
437 if (mraid_mm_attach_buf(adp, kioc, kioc->xferlen))
438 return (-ENOMEM);
439
440 if (mimd.outlen) kioc->data_dir = UIOC_RD;
441 if (mimd.inlen) kioc->data_dir |= UIOC_WR;
442
443 break;
444
445 default:
446 return (-EINVAL);
447 }
448
449
450
451
452 if (opcode == 0x82)
453 return 0;
454
455
456
457
458 mbox64 = (mbox64_t *)((unsigned long)kioc->cmdbuf);
459 mbox = &mbox64->mbox32;
460 memcpy(mbox, mimd.mbox, 14);
461
462 if (mbox->cmd != MBOXCMD_PASSTHRU) {
463
464 mbox->xferaddr = (uint32_t)kioc->buf_paddr;
465
466 if (kioc->data_dir & UIOC_WR) {
467 if (copy_from_user(kioc->buf_vaddr, kioc->user_data,
468 kioc->xferlen)) {
469 return (-EFAULT);
470 }
471 }
472
473 return 0;
474 }
475
476
477
478
479
480
481
482 pthru32 = kioc->pthru32;
483 kioc->user_pthru = &umimd->pthru;
484 mbox->xferaddr = (uint32_t)kioc->pthru32_h;
485
486 if (copy_from_user(pthru32, kioc->user_pthru,
487 sizeof(mraid_passthru_t))) {
488 return (-EFAULT);
489 }
490
491 pthru32->dataxferaddr = kioc->buf_paddr;
492 if (kioc->data_dir & UIOC_WR) {
493 if (pthru32->dataxferlen > kioc->xferlen)
494 return -EINVAL;
495 if (copy_from_user(kioc->buf_vaddr, kioc->user_data,
496 pthru32->dataxferlen)) {
497 return (-EFAULT);
498 }
499 }
500
501 return 0;
502}
503
504
505
506
507
508
509
510
511
512
513
514
515static int
516mraid_mm_attach_buf(mraid_mmadp_t *adp, uioc_t *kioc, int xferlen)
517{
518 mm_dmapool_t *pool;
519 int right_pool = -1;
520 unsigned long flags;
521 int i;
522
523 kioc->pool_index = -1;
524 kioc->buf_vaddr = NULL;
525 kioc->buf_paddr = 0;
526 kioc->free_buf = 0;
527
528
529
530
531
532
533 for (i = 0; i < MAX_DMA_POOLS; i++) {
534
535 pool = &adp->dma_pool_list[i];
536
537 if (xferlen > pool->buf_size)
538 continue;
539
540 if (right_pool == -1)
541 right_pool = i;
542
543 spin_lock_irqsave(&pool->lock, flags);
544
545 if (!pool->in_use) {
546
547 pool->in_use = 1;
548 kioc->pool_index = i;
549 kioc->buf_vaddr = pool->vaddr;
550 kioc->buf_paddr = pool->paddr;
551
552 spin_unlock_irqrestore(&pool->lock, flags);
553 return 0;
554 }
555 else {
556 spin_unlock_irqrestore(&pool->lock, flags);
557 continue;
558 }
559 }
560
561
562
563
564 if (right_pool == -1)
565 return -EINVAL;
566
567
568
569
570
571 pool = &adp->dma_pool_list[right_pool];
572
573 spin_lock_irqsave(&pool->lock, flags);
574
575 kioc->pool_index = right_pool;
576 kioc->free_buf = 1;
577 kioc->buf_vaddr = dma_pool_alloc(pool->handle, GFP_ATOMIC,
578 &kioc->buf_paddr);
579 spin_unlock_irqrestore(&pool->lock, flags);
580
581 if (!kioc->buf_vaddr)
582 return -ENOMEM;
583
584 return 0;
585}
586
587
588
589
590
591
592
593
594
595static uioc_t *
596mraid_mm_alloc_kioc(mraid_mmadp_t *adp)
597{
598 uioc_t *kioc;
599 struct list_head* head;
600 unsigned long flags;
601
602 down(&adp->kioc_semaphore);
603
604 spin_lock_irqsave(&adp->kioc_pool_lock, flags);
605
606 head = &adp->kioc_pool;
607
608 if (list_empty(head)) {
609 up(&adp->kioc_semaphore);
610 spin_unlock_irqrestore(&adp->kioc_pool_lock, flags);
611
612 con_log(CL_ANN, ("megaraid cmm: kioc list empty!\n"));
613 return NULL;
614 }
615
616 kioc = list_entry(head->next, uioc_t, list);
617 list_del_init(&kioc->list);
618
619 spin_unlock_irqrestore(&adp->kioc_pool_lock, flags);
620
621 memset((caddr_t)(unsigned long)kioc->cmdbuf, 0, sizeof(mbox64_t));
622 memset((caddr_t) kioc->pthru32, 0, sizeof(mraid_passthru_t));
623
624 kioc->buf_vaddr = NULL;
625 kioc->buf_paddr = 0;
626 kioc->pool_index =-1;
627 kioc->free_buf = 0;
628 kioc->user_data = NULL;
629 kioc->user_data_len = 0;
630 kioc->user_pthru = NULL;
631 kioc->timedout = 0;
632
633 return kioc;
634}
635
636
637
638
639
640
641static void
642mraid_mm_dealloc_kioc(mraid_mmadp_t *adp, uioc_t *kioc)
643{
644 mm_dmapool_t *pool;
645 unsigned long flags;
646
647 if (kioc->pool_index != -1) {
648 pool = &adp->dma_pool_list[kioc->pool_index];
649
650
651 spin_lock_irqsave(&pool->lock, flags);
652
653
654
655
656
657
658
659
660 if (kioc->free_buf == 1)
661 dma_pool_free(pool->handle, kioc->buf_vaddr,
662 kioc->buf_paddr);
663 else
664 pool->in_use = 0;
665
666 spin_unlock_irqrestore(&pool->lock, flags);
667 }
668
669
670 spin_lock_irqsave(&adp->kioc_pool_lock, flags);
671 list_add(&kioc->list, &adp->kioc_pool);
672 spin_unlock_irqrestore(&adp->kioc_pool_lock, flags);
673
674
675 up(&adp->kioc_semaphore);
676
677 return;
678}
679
680
681
682
683
684
685static int
686lld_ioctl(mraid_mmadp_t *adp, uioc_t *kioc)
687{
688 int rval;
689 struct uioc_timeout timeout = { };
690
691 kioc->status = -ENODATA;
692 rval = adp->issue_uioc(adp->drvr_data, kioc, IOCTL_ISSUE);
693
694 if (rval) return rval;
695
696
697
698
699 if (adp->timeout > 0) {
700 timeout.uioc = kioc;
701 timer_setup_on_stack(&timeout.timer, lld_timedout, 0);
702
703 timeout.timer.expires = jiffies + adp->timeout * HZ;
704
705 add_timer(&timeout.timer);
706 }
707
708
709
710
711
712 wait_event(wait_q, (kioc->status != -ENODATA));
713 if (timeout.timer.function) {
714 del_timer_sync(&timeout.timer);
715 destroy_timer_on_stack(&timeout.timer);
716 }
717
718
719
720
721
722 if (kioc->timedout) {
723 adp->quiescent = 0;
724 }
725
726 return kioc->status;
727}
728
729
730
731
732
733
734static void
735ioctl_done(uioc_t *kioc)
736{
737 uint32_t adapno;
738 int iterator;
739 mraid_mmadp_t* adapter;
740
741
742
743
744
745
746 if (kioc->status == -ENODATA) {
747 con_log(CL_ANN, (KERN_WARNING
748 "megaraid cmm: lld didn't change status!\n"));
749
750 kioc->status = -EINVAL;
751 }
752
753
754
755
756
757
758 if (kioc->timedout) {
759 iterator = 0;
760 adapter = NULL;
761 adapno = kioc->adapno;
762
763 con_log(CL_ANN, ( KERN_WARNING "megaraid cmm: completed "
764 "ioctl that was timedout before\n"));
765
766 list_for_each_entry(adapter, &adapters_list_g, list) {
767 if (iterator++ == adapno) break;
768 }
769
770 kioc->timedout = 0;
771
772 if (adapter) {
773 mraid_mm_dealloc_kioc( adapter, kioc );
774 }
775 }
776 else {
777 wake_up(&wait_q);
778 }
779}
780
781
782
783
784
785
786static void
787lld_timedout(struct timer_list *t)
788{
789 struct uioc_timeout *timeout = from_timer(timeout, t, timer);
790 uioc_t *kioc = timeout->uioc;
791
792 kioc->status = -ETIME;
793 kioc->timedout = 1;
794
795 con_log(CL_ANN, (KERN_WARNING "megaraid cmm: ioctl timed out\n"));
796
797 wake_up(&wait_q);
798}
799
800
801
802
803
804
805
806static int
807kioc_to_mimd(uioc_t *kioc, mimd_t __user *mimd)
808{
809 mimd_t kmimd;
810 uint8_t opcode;
811 uint8_t subopcode;
812
813 mbox64_t *mbox64;
814 mraid_passthru_t __user *upthru32;
815 mraid_passthru_t *kpthru32;
816 mcontroller_t cinfo;
817 mraid_hba_info_t *hinfo;
818
819
820 if (copy_from_user(&kmimd, mimd, sizeof(mimd_t)))
821 return (-EFAULT);
822
823 opcode = kmimd.ui.fcs.opcode;
824 subopcode = kmimd.ui.fcs.subopcode;
825
826 if (opcode == 0x82) {
827 switch (subopcode) {
828
829 case MEGAIOC_QADAPINFO:
830
831 hinfo = (mraid_hba_info_t *)(unsigned long)
832 kioc->buf_vaddr;
833
834 hinfo_to_cinfo(hinfo, &cinfo);
835
836 if (copy_to_user(kmimd.data, &cinfo, sizeof(cinfo)))
837 return (-EFAULT);
838
839 return 0;
840
841 default:
842 return (-EINVAL);
843 }
844
845 return 0;
846 }
847
848 mbox64 = (mbox64_t *)(unsigned long)kioc->cmdbuf;
849
850 if (kioc->user_pthru) {
851
852 upthru32 = kioc->user_pthru;
853 kpthru32 = kioc->pthru32;
854
855 if (copy_to_user(&upthru32->scsistatus,
856 &kpthru32->scsistatus,
857 sizeof(uint8_t))) {
858 return (-EFAULT);
859 }
860 }
861
862 if (kioc->user_data) {
863 if (copy_to_user(kioc->user_data, kioc->buf_vaddr,
864 kioc->user_data_len)) {
865 return (-EFAULT);
866 }
867 }
868
869 if (copy_to_user(&mimd->mbox[17],
870 &mbox64->mbox32.status, sizeof(uint8_t))) {
871 return (-EFAULT);
872 }
873
874 return 0;
875}
876
877
878
879
880
881
882
883static void
884hinfo_to_cinfo(mraid_hba_info_t *hinfo, mcontroller_t *cinfo)
885{
886 if (!hinfo || !cinfo)
887 return;
888
889 cinfo->base = hinfo->baseport;
890 cinfo->irq = hinfo->irq;
891 cinfo->numldrv = hinfo->num_ldrv;
892 cinfo->pcibus = hinfo->pci_bus;
893 cinfo->pcidev = hinfo->pci_slot;
894 cinfo->pcifun = PCI_FUNC(hinfo->pci_dev_fn);
895 cinfo->pciid = hinfo->pci_device_id;
896 cinfo->pcivendor = hinfo->pci_vendor_id;
897 cinfo->pcislot = hinfo->pci_slot;
898 cinfo->uid = hinfo->unique_id;
899}
900
901
902
903
904
905
906int
907mraid_mm_register_adp(mraid_mmadp_t *lld_adp)
908{
909 mraid_mmadp_t *adapter;
910 mbox64_t *mbox_list;
911 uioc_t *kioc;
912 uint32_t rval;
913 int i;
914
915
916 if (lld_adp->drvr_type != DRVRTYPE_MBOX)
917 return (-EINVAL);
918
919 adapter = kzalloc(sizeof(mraid_mmadp_t), GFP_KERNEL);
920
921 if (!adapter)
922 return -ENOMEM;
923
924
925 adapter->unique_id = lld_adp->unique_id;
926 adapter->drvr_type = lld_adp->drvr_type;
927 adapter->drvr_data = lld_adp->drvr_data;
928 adapter->pdev = lld_adp->pdev;
929 adapter->issue_uioc = lld_adp->issue_uioc;
930 adapter->timeout = lld_adp->timeout;
931 adapter->max_kioc = lld_adp->max_kioc;
932 adapter->quiescent = 1;
933
934
935
936
937
938 adapter->kioc_list = kmalloc(sizeof(uioc_t) * lld_adp->max_kioc,
939 GFP_KERNEL);
940 adapter->mbox_list = kmalloc(sizeof(mbox64_t) * lld_adp->max_kioc,
941 GFP_KERNEL);
942 adapter->pthru_dma_pool = dma_pool_create("megaraid mm pthru pool",
943 &adapter->pdev->dev,
944 sizeof(mraid_passthru_t),
945 16, 0);
946
947 if (!adapter->kioc_list || !adapter->mbox_list ||
948 !adapter->pthru_dma_pool) {
949
950 con_log(CL_ANN, (KERN_WARNING
951 "megaraid cmm: out of memory, %s %d\n", __func__,
952 __LINE__));
953
954 rval = (-ENOMEM);
955
956 goto memalloc_error;
957 }
958
959
960
961
962 INIT_LIST_HEAD(&adapter->kioc_pool);
963 spin_lock_init(&adapter->kioc_pool_lock);
964 sema_init(&adapter->kioc_semaphore, lld_adp->max_kioc);
965
966 mbox_list = (mbox64_t *)adapter->mbox_list;
967
968 for (i = 0; i < lld_adp->max_kioc; i++) {
969
970 kioc = adapter->kioc_list + i;
971 kioc->cmdbuf = (uint64_t)(unsigned long)(mbox_list + i);
972 kioc->pthru32 = dma_pool_alloc(adapter->pthru_dma_pool,
973 GFP_KERNEL, &kioc->pthru32_h);
974
975 if (!kioc->pthru32) {
976
977 con_log(CL_ANN, (KERN_WARNING
978 "megaraid cmm: out of memory, %s %d\n",
979 __func__, __LINE__));
980
981 rval = (-ENOMEM);
982
983 goto pthru_dma_pool_error;
984 }
985
986 list_add_tail(&kioc->list, &adapter->kioc_pool);
987 }
988
989
990 if ((rval = mraid_mm_setup_dma_pools(adapter)) != 0) {
991 goto dma_pool_error;
992 }
993
994 list_add_tail(&adapter->list, &adapters_list_g);
995
996 adapters_count_g++;
997
998 return 0;
999
1000dma_pool_error:
1001
1002
1003pthru_dma_pool_error:
1004
1005 for (i = 0; i < lld_adp->max_kioc; i++) {
1006 kioc = adapter->kioc_list + i;
1007 if (kioc->pthru32) {
1008 dma_pool_free(adapter->pthru_dma_pool, kioc->pthru32,
1009 kioc->pthru32_h);
1010 }
1011 }
1012
1013memalloc_error:
1014
1015 kfree(adapter->kioc_list);
1016 kfree(adapter->mbox_list);
1017
1018 if (adapter->pthru_dma_pool)
1019 dma_pool_destroy(adapter->pthru_dma_pool);
1020
1021 kfree(adapter);
1022
1023 return rval;
1024}
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038uint32_t
1039mraid_mm_adapter_app_handle(uint32_t unique_id)
1040{
1041 mraid_mmadp_t *adapter;
1042 mraid_mmadp_t *tmp;
1043 int index = 0;
1044
1045 list_for_each_entry_safe(adapter, tmp, &adapters_list_g, list) {
1046
1047 if (adapter->unique_id == unique_id) {
1048
1049 return MKADAP(index);
1050 }
1051
1052 index++;
1053 }
1054
1055 return 0;
1056}
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069static int
1070mraid_mm_setup_dma_pools(mraid_mmadp_t *adp)
1071{
1072 mm_dmapool_t *pool;
1073 int bufsize;
1074 int i;
1075
1076
1077
1078
1079 bufsize = MRAID_MM_INIT_BUFF_SIZE;
1080
1081 for (i = 0; i < MAX_DMA_POOLS; i++){
1082
1083 pool = &adp->dma_pool_list[i];
1084
1085 pool->buf_size = bufsize;
1086 spin_lock_init(&pool->lock);
1087
1088 pool->handle = dma_pool_create("megaraid mm data buffer",
1089 &adp->pdev->dev, bufsize,
1090 16, 0);
1091
1092 if (!pool->handle) {
1093 goto dma_pool_setup_error;
1094 }
1095
1096 pool->vaddr = dma_pool_alloc(pool->handle, GFP_KERNEL,
1097 &pool->paddr);
1098
1099 if (!pool->vaddr)
1100 goto dma_pool_setup_error;
1101
1102 bufsize = bufsize * 2;
1103 }
1104
1105 return 0;
1106
1107dma_pool_setup_error:
1108
1109 mraid_mm_teardown_dma_pools(adp);
1110 return (-ENOMEM);
1111}
1112
1113
1114
1115
1116
1117
1118
1119
1120int
1121mraid_mm_unregister_adp(uint32_t unique_id)
1122{
1123 mraid_mmadp_t *adapter;
1124 mraid_mmadp_t *tmp;
1125
1126 list_for_each_entry_safe(adapter, tmp, &adapters_list_g, list) {
1127
1128
1129 if (adapter->unique_id == unique_id) {
1130
1131 adapters_count_g--;
1132
1133 list_del_init(&adapter->list);
1134
1135 mraid_mm_free_adp_resources(adapter);
1136
1137 kfree(adapter);
1138
1139 con_log(CL_ANN, (
1140 "megaraid cmm: Unregistered one adapter:%#x\n",
1141 unique_id));
1142
1143 return 0;
1144 }
1145 }
1146
1147 return (-ENODEV);
1148}
1149
1150
1151
1152
1153
1154static void
1155mraid_mm_free_adp_resources(mraid_mmadp_t *adp)
1156{
1157 uioc_t *kioc;
1158 int i;
1159
1160 mraid_mm_teardown_dma_pools(adp);
1161
1162 for (i = 0; i < adp->max_kioc; i++) {
1163
1164 kioc = adp->kioc_list + i;
1165
1166 dma_pool_free(adp->pthru_dma_pool, kioc->pthru32,
1167 kioc->pthru32_h);
1168 }
1169
1170 kfree(adp->kioc_list);
1171 kfree(adp->mbox_list);
1172
1173 dma_pool_destroy(adp->pthru_dma_pool);
1174
1175
1176 return;
1177}
1178
1179
1180
1181
1182
1183
1184static void
1185mraid_mm_teardown_dma_pools(mraid_mmadp_t *adp)
1186{
1187 int i;
1188 mm_dmapool_t *pool;
1189
1190 for (i = 0; i < MAX_DMA_POOLS; i++) {
1191
1192 pool = &adp->dma_pool_list[i];
1193
1194 if (pool->handle) {
1195
1196 if (pool->vaddr)
1197 dma_pool_free(pool->handle, pool->vaddr,
1198 pool->paddr);
1199
1200 dma_pool_destroy(pool->handle);
1201 pool->handle = NULL;
1202 }
1203 }
1204
1205 return;
1206}
1207
1208
1209
1210
1211static int __init
1212mraid_mm_init(void)
1213{
1214 int err;
1215
1216
1217 con_log(CL_ANN, (KERN_INFO "megaraid cmm: %s %s\n",
1218 LSI_COMMON_MOD_VERSION, LSI_COMMON_MOD_EXT_VERSION));
1219
1220 err = misc_register(&megaraid_mm_dev);
1221 if (err < 0) {
1222 con_log(CL_ANN, ("megaraid cmm: cannot register misc device\n"));
1223 return err;
1224 }
1225
1226 init_waitqueue_head(&wait_q);
1227
1228 INIT_LIST_HEAD(&adapters_list_g);
1229
1230 return 0;
1231}
1232
1233
1234#ifdef CONFIG_COMPAT
1235
1236
1237
1238
1239
1240
1241static long
1242mraid_mm_compat_ioctl(struct file *filep, unsigned int cmd,
1243 unsigned long arg)
1244{
1245 int err;
1246
1247 err = mraid_mm_ioctl(filep, cmd, arg);
1248
1249 return err;
1250}
1251#endif
1252
1253
1254
1255
1256static void __exit
1257mraid_mm_exit(void)
1258{
1259 con_log(CL_DLEVEL1 , ("exiting common mod\n"));
1260
1261 misc_deregister(&megaraid_mm_dev);
1262}
1263
1264module_init(mraid_mm_init);
1265module_exit(mraid_mm_exit);
1266
1267
1268