672c759ac24d7719c3371c191d572e25bd8c4d4f
[linux-2.6.git] / drivers / scsi / megaraid / megaraid_sas.c
1 /*
2  *
3  *              Linux MegaRAID driver for SAS based RAID controllers
4  *
5  * Copyright (c) 2003-2005  LSI Corporation.
6  *
7  *         This program is free software; you can redistribute it and/or
8  *         modify it under the terms of the GNU General Public License
9  *         as published by the Free Software Foundation; either version
10  *         2 of the License, or (at your option) any later version.
11  *
12  * FILE         : megaraid_sas.c
13  * Version      : v00.00.03.16-rc1
14  *
15  * Authors:
16  *      (email-id : megaraidlinux@lsi.com)
17  *      Sreenivas Bagalkote
18  *      Sumant Patro
19  *      Bo Yang
20  *
21  * List of supported controllers
22  *
23  * OEM  Product Name                    VID     DID     SSVID   SSID
24  * ---  ------------                    ---     ---     ----    ----
25  */
26
27 #include <linux/kernel.h>
28 #include <linux/types.h>
29 #include <linux/pci.h>
30 #include <linux/list.h>
31 #include <linux/moduleparam.h>
32 #include <linux/module.h>
33 #include <linux/spinlock.h>
34 #include <linux/mutex.h>
35 #include <linux/interrupt.h>
36 #include <linux/delay.h>
37 #include <linux/uio.h>
38 #include <asm/uaccess.h>
39 #include <linux/fs.h>
40 #include <linux/compat.h>
41 #include <linux/blkdev.h>
42 #include <linux/mutex.h>
43
44 #include <scsi/scsi.h>
45 #include <scsi/scsi_cmnd.h>
46 #include <scsi/scsi_device.h>
47 #include <scsi/scsi_host.h>
48 #include "megaraid_sas.h"
49
50 /*
51  * poll_mode_io:1- schedule complete completion from q cmd
52  */
53 static unsigned int poll_mode_io;
54 module_param_named(poll_mode_io, poll_mode_io, int, 0);
55 MODULE_PARM_DESC(poll_mode_io,
56         "Complete cmds from IO path, (default=0)");
57
58 MODULE_LICENSE("GPL");
59 MODULE_VERSION(MEGASAS_VERSION);
60 MODULE_AUTHOR("megaraidlinux@lsi.com");
61 MODULE_DESCRIPTION("LSI MegaRAID SAS Driver");
62
63 /*
64  * PCI ID table for all supported controllers
65  */
66 static struct pci_device_id megasas_pci_table[] = {
67
68         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1064R)},
69         /* xscale IOP */
70         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_SAS1078R)},
71         /* ppc IOP */
72         {PCI_DEVICE(PCI_VENDOR_ID_LSI_LOGIC, PCI_DEVICE_ID_LSI_VERDE_ZCR)},
73         /* xscale IOP, vega */
74         {PCI_DEVICE(PCI_VENDOR_ID_DELL, PCI_DEVICE_ID_DELL_PERC5)},
75         /* xscale IOP */
76         {}
77 };
78
79 MODULE_DEVICE_TABLE(pci, megasas_pci_table);
80
81 static int megasas_mgmt_majorno;
82 static struct megasas_mgmt_info megasas_mgmt_info;
83 static struct fasync_struct *megasas_async_queue;
84 static DEFINE_MUTEX(megasas_async_queue_mutex);
85
86 static u32 megasas_dbg_lvl;
87
88 static void
89 megasas_complete_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd,
90                      u8 alt_status);
91
92 /**
93  * megasas_get_cmd -    Get a command from the free pool
94  * @instance:           Adapter soft state
95  *
96  * Returns a free command from the pool
97  */
98 static struct megasas_cmd *megasas_get_cmd(struct megasas_instance
99                                                   *instance)
100 {
101         unsigned long flags;
102         struct megasas_cmd *cmd = NULL;
103
104         spin_lock_irqsave(&instance->cmd_pool_lock, flags);
105
106         if (!list_empty(&instance->cmd_pool)) {
107                 cmd = list_entry((&instance->cmd_pool)->next,
108                                  struct megasas_cmd, list);
109                 list_del_init(&cmd->list);
110         } else {
111                 printk(KERN_ERR "megasas: Command pool empty!\n");
112         }
113
114         spin_unlock_irqrestore(&instance->cmd_pool_lock, flags);
115         return cmd;
116 }
117
118 /**
119  * megasas_return_cmd - Return a cmd to free command pool
120  * @instance:           Adapter soft state
121  * @cmd:                Command packet to be returned to free command pool
122  */
123 static inline void
124 megasas_return_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd)
125 {
126         unsigned long flags;
127
128         spin_lock_irqsave(&instance->cmd_pool_lock, flags);
129
130         cmd->scmd = NULL;
131         list_add_tail(&cmd->list, &instance->cmd_pool);
132
133         spin_unlock_irqrestore(&instance->cmd_pool_lock, flags);
134 }
135
136
137 /**
138 *       The following functions are defined for xscale 
139 *       (deviceid : 1064R, PERC5) controllers
140 */
141
142 /**
143  * megasas_enable_intr_xscale - Enables interrupts
144  * @regs:                       MFI register set
145  */
146 static inline void
147 megasas_enable_intr_xscale(struct megasas_register_set __iomem * regs)
148 {
149         writel(1, &(regs)->outbound_intr_mask);
150
151         /* Dummy readl to force pci flush */
152         readl(&regs->outbound_intr_mask);
153 }
154
155 /**
156  * megasas_disable_intr_xscale -Disables interrupt
157  * @regs:                       MFI register set
158  */
159 static inline void
160 megasas_disable_intr_xscale(struct megasas_register_set __iomem * regs)
161 {
162         u32 mask = 0x1f;
163         writel(mask, &regs->outbound_intr_mask);
164         /* Dummy readl to force pci flush */
165         readl(&regs->outbound_intr_mask);
166 }
167
168 /**
169  * megasas_read_fw_status_reg_xscale - returns the current FW status value
170  * @regs:                       MFI register set
171  */
172 static u32
173 megasas_read_fw_status_reg_xscale(struct megasas_register_set __iomem * regs)
174 {
175         return readl(&(regs)->outbound_msg_0);
176 }
177 /**
178  * megasas_clear_interrupt_xscale -     Check & clear interrupt
179  * @regs:                               MFI register set
180  */
181 static int 
182 megasas_clear_intr_xscale(struct megasas_register_set __iomem * regs)
183 {
184         u32 status;
185         /*
186          * Check if it is our interrupt
187          */
188         status = readl(&regs->outbound_intr_status);
189
190         if (!(status & MFI_OB_INTR_STATUS_MASK)) {
191                 return 1;
192         }
193
194         /*
195          * Clear the interrupt by writing back the same value
196          */
197         writel(status, &regs->outbound_intr_status);
198
199         return 0;
200 }
201
202 /**
203  * megasas_fire_cmd_xscale -    Sends command to the FW
204  * @frame_phys_addr :           Physical address of cmd
205  * @frame_count :               Number of frames for the command
206  * @regs :                      MFI register set
207  */
208 static inline void 
209 megasas_fire_cmd_xscale(dma_addr_t frame_phys_addr,u32 frame_count, struct megasas_register_set __iomem *regs)
210 {
211         writel((frame_phys_addr >> 3)|(frame_count),
212                &(regs)->inbound_queue_port);
213 }
214
215 static struct megasas_instance_template megasas_instance_template_xscale = {
216
217         .fire_cmd = megasas_fire_cmd_xscale,
218         .enable_intr = megasas_enable_intr_xscale,
219         .disable_intr = megasas_disable_intr_xscale,
220         .clear_intr = megasas_clear_intr_xscale,
221         .read_fw_status_reg = megasas_read_fw_status_reg_xscale,
222 };
223
224 /**
225 *       This is the end of set of functions & definitions specific 
226 *       to xscale (deviceid : 1064R, PERC5) controllers
227 */
228
229 /**
230 *       The following functions are defined for ppc (deviceid : 0x60) 
231 *       controllers
232 */
233
234 /**
235  * megasas_enable_intr_ppc -    Enables interrupts
236  * @regs:                       MFI register set
237  */
238 static inline void
239 megasas_enable_intr_ppc(struct megasas_register_set __iomem * regs)
240 {
241         writel(0xFFFFFFFF, &(regs)->outbound_doorbell_clear);
242     
243         writel(~0x80000004, &(regs)->outbound_intr_mask);
244
245         /* Dummy readl to force pci flush */
246         readl(&regs->outbound_intr_mask);
247 }
248
249 /**
250  * megasas_disable_intr_ppc -   Disable interrupt
251  * @regs:                       MFI register set
252  */
253 static inline void
254 megasas_disable_intr_ppc(struct megasas_register_set __iomem * regs)
255 {
256         u32 mask = 0xFFFFFFFF;
257         writel(mask, &regs->outbound_intr_mask);
258         /* Dummy readl to force pci flush */
259         readl(&regs->outbound_intr_mask);
260 }
261
262 /**
263  * megasas_read_fw_status_reg_ppc - returns the current FW status value
264  * @regs:                       MFI register set
265  */
266 static u32
267 megasas_read_fw_status_reg_ppc(struct megasas_register_set __iomem * regs)
268 {
269         return readl(&(regs)->outbound_scratch_pad);
270 }
271
272 /**
273  * megasas_clear_interrupt_ppc -        Check & clear interrupt
274  * @regs:                               MFI register set
275  */
276 static int 
277 megasas_clear_intr_ppc(struct megasas_register_set __iomem * regs)
278 {
279         u32 status;
280         /*
281          * Check if it is our interrupt
282          */
283         status = readl(&regs->outbound_intr_status);
284
285         if (!(status & MFI_REPLY_1078_MESSAGE_INTERRUPT)) {
286                 return 1;
287         }
288
289         /*
290          * Clear the interrupt by writing back the same value
291          */
292         writel(status, &regs->outbound_doorbell_clear);
293
294         return 0;
295 }
296 /**
297  * megasas_fire_cmd_ppc -       Sends command to the FW
298  * @frame_phys_addr :           Physical address of cmd
299  * @frame_count :               Number of frames for the command
300  * @regs :                      MFI register set
301  */
302 static inline void 
303 megasas_fire_cmd_ppc(dma_addr_t frame_phys_addr, u32 frame_count, struct megasas_register_set __iomem *regs)
304 {
305         writel((frame_phys_addr | (frame_count<<1))|1, 
306                         &(regs)->inbound_queue_port);
307 }
308
309 static struct megasas_instance_template megasas_instance_template_ppc = {
310         
311         .fire_cmd = megasas_fire_cmd_ppc,
312         .enable_intr = megasas_enable_intr_ppc,
313         .disable_intr = megasas_disable_intr_ppc,
314         .clear_intr = megasas_clear_intr_ppc,
315         .read_fw_status_reg = megasas_read_fw_status_reg_ppc,
316 };
317
318 /**
319 *       This is the end of set of functions & definitions
320 *       specific to ppc (deviceid : 0x60) controllers
321 */
322
323 /**
324  * megasas_issue_polled -       Issues a polling command
325  * @instance:                   Adapter soft state
326  * @cmd:                        Command packet to be issued 
327  *
328  * For polling, MFI requires the cmd_status to be set to 0xFF before posting.
329  */
330 static int
331 megasas_issue_polled(struct megasas_instance *instance, struct megasas_cmd *cmd)
332 {
333         int i;
334         u32 msecs = MFI_POLL_TIMEOUT_SECS * 1000;
335
336         struct megasas_header *frame_hdr = &cmd->frame->hdr;
337
338         frame_hdr->cmd_status = 0xFF;
339         frame_hdr->flags |= MFI_FRAME_DONT_POST_IN_REPLY_QUEUE;
340
341         /*
342          * Issue the frame using inbound queue port
343          */
344         instance->instancet->fire_cmd(cmd->frame_phys_addr ,0,instance->reg_set);
345
346         /*
347          * Wait for cmd_status to change
348          */
349         for (i = 0; (i < msecs) && (frame_hdr->cmd_status == 0xff); i++) {
350                 rmb();
351                 msleep(1);
352         }
353
354         if (frame_hdr->cmd_status == 0xff)
355                 return -ETIME;
356
357         return 0;
358 }
359
360 /**
361  * megasas_issue_blocked_cmd -  Synchronous wrapper around regular FW cmds
362  * @instance:                   Adapter soft state
363  * @cmd:                        Command to be issued
364  *
365  * This function waits on an event for the command to be returned from ISR.
366  * Max wait time is MEGASAS_INTERNAL_CMD_WAIT_TIME secs
367  * Used to issue ioctl commands.
368  */
369 static int
370 megasas_issue_blocked_cmd(struct megasas_instance *instance,
371                           struct megasas_cmd *cmd)
372 {
373         cmd->cmd_status = ENODATA;
374
375         instance->instancet->fire_cmd(cmd->frame_phys_addr ,0,instance->reg_set);
376
377         wait_event_timeout(instance->int_cmd_wait_q, (cmd->cmd_status != ENODATA),
378                 MEGASAS_INTERNAL_CMD_WAIT_TIME*HZ);
379
380         return 0;
381 }
382
383 /**
384  * megasas_issue_blocked_abort_cmd -    Aborts previously issued cmd
385  * @instance:                           Adapter soft state
386  * @cmd_to_abort:                       Previously issued cmd to be aborted
387  *
388  * MFI firmware can abort previously issued AEN comamnd (automatic event
389  * notification). The megasas_issue_blocked_abort_cmd() issues such abort
390  * cmd and waits for return status.
391  * Max wait time is MEGASAS_INTERNAL_CMD_WAIT_TIME secs
392  */
393 static int
394 megasas_issue_blocked_abort_cmd(struct megasas_instance *instance,
395                                 struct megasas_cmd *cmd_to_abort)
396 {
397         struct megasas_cmd *cmd;
398         struct megasas_abort_frame *abort_fr;
399
400         cmd = megasas_get_cmd(instance);
401
402         if (!cmd)
403                 return -1;
404
405         abort_fr = &cmd->frame->abort;
406
407         /*
408          * Prepare and issue the abort frame
409          */
410         abort_fr->cmd = MFI_CMD_ABORT;
411         abort_fr->cmd_status = 0xFF;
412         abort_fr->flags = 0;
413         abort_fr->abort_context = cmd_to_abort->index;
414         abort_fr->abort_mfi_phys_addr_lo = cmd_to_abort->frame_phys_addr;
415         abort_fr->abort_mfi_phys_addr_hi = 0;
416
417         cmd->sync_cmd = 1;
418         cmd->cmd_status = 0xFF;
419
420         instance->instancet->fire_cmd(cmd->frame_phys_addr ,0,instance->reg_set);
421
422         /*
423          * Wait for this cmd to complete
424          */
425         wait_event_timeout(instance->abort_cmd_wait_q, (cmd->cmd_status != 0xFF),
426                 MEGASAS_INTERNAL_CMD_WAIT_TIME*HZ);
427
428         megasas_return_cmd(instance, cmd);
429         return 0;
430 }
431
432 /**
433  * megasas_make_sgl32 - Prepares 32-bit SGL
434  * @instance:           Adapter soft state
435  * @scp:                SCSI command from the mid-layer
436  * @mfi_sgl:            SGL to be filled in
437  *
438  * If successful, this function returns the number of SG elements. Otherwise,
439  * it returnes -1.
440  */
441 static int
442 megasas_make_sgl32(struct megasas_instance *instance, struct scsi_cmnd *scp,
443                    union megasas_sgl *mfi_sgl)
444 {
445         int i;
446         int sge_count;
447         struct scatterlist *os_sgl;
448
449         sge_count = scsi_dma_map(scp);
450         BUG_ON(sge_count < 0);
451
452         if (sge_count) {
453                 scsi_for_each_sg(scp, os_sgl, sge_count, i) {
454                         mfi_sgl->sge32[i].length = sg_dma_len(os_sgl);
455                         mfi_sgl->sge32[i].phys_addr = sg_dma_address(os_sgl);
456                 }
457         }
458         return sge_count;
459 }
460
461 /**
462  * megasas_make_sgl64 - Prepares 64-bit SGL
463  * @instance:           Adapter soft state
464  * @scp:                SCSI command from the mid-layer
465  * @mfi_sgl:            SGL to be filled in
466  *
467  * If successful, this function returns the number of SG elements. Otherwise,
468  * it returnes -1.
469  */
470 static int
471 megasas_make_sgl64(struct megasas_instance *instance, struct scsi_cmnd *scp,
472                    union megasas_sgl *mfi_sgl)
473 {
474         int i;
475         int sge_count;
476         struct scatterlist *os_sgl;
477
478         sge_count = scsi_dma_map(scp);
479         BUG_ON(sge_count < 0);
480
481         if (sge_count) {
482                 scsi_for_each_sg(scp, os_sgl, sge_count, i) {
483                         mfi_sgl->sge64[i].length = sg_dma_len(os_sgl);
484                         mfi_sgl->sge64[i].phys_addr = sg_dma_address(os_sgl);
485                 }
486         }
487         return sge_count;
488 }
489
490  /**
491  * megasas_get_frame_count - Computes the number of frames
492  * @sge_count           : number of sg elements
493  *
494  * Returns the number of frames required for numnber of sge's (sge_count)
495  */
496
497 static u32 megasas_get_frame_count(u8 sge_count)
498 {
499         int num_cnt;
500         int sge_bytes;
501         u32 sge_sz;
502         u32 frame_count=0;
503
504         sge_sz = (IS_DMA64) ? sizeof(struct megasas_sge64) :
505             sizeof(struct megasas_sge32);
506
507         /*
508         * Main frame can contain 2 SGEs for 64-bit SGLs and
509         * 3 SGEs for 32-bit SGLs
510         */
511         if (IS_DMA64)
512                 num_cnt = sge_count - 2;
513         else
514                 num_cnt = sge_count - 3;
515
516         if(num_cnt>0){
517                 sge_bytes = sge_sz * num_cnt;
518
519                 frame_count = (sge_bytes / MEGAMFI_FRAME_SIZE) +
520                     ((sge_bytes % MEGAMFI_FRAME_SIZE) ? 1 : 0) ;
521         }
522         /* Main frame */
523         frame_count +=1;
524
525         if (frame_count > 7)
526                 frame_count = 8;
527         return frame_count;
528 }
529
530 /**
531  * megasas_build_dcdb - Prepares a direct cdb (DCDB) command
532  * @instance:           Adapter soft state
533  * @scp:                SCSI command
534  * @cmd:                Command to be prepared in
535  *
536  * This function prepares CDB commands. These are typcially pass-through
537  * commands to the devices.
538  */
539 static int
540 megasas_build_dcdb(struct megasas_instance *instance, struct scsi_cmnd *scp,
541                    struct megasas_cmd *cmd)
542 {
543         u32 is_logical;
544         u32 device_id;
545         u16 flags = 0;
546         struct megasas_pthru_frame *pthru;
547
548         is_logical = MEGASAS_IS_LOGICAL(scp);
549         device_id = MEGASAS_DEV_INDEX(instance, scp);
550         pthru = (struct megasas_pthru_frame *)cmd->frame;
551
552         if (scp->sc_data_direction == PCI_DMA_TODEVICE)
553                 flags = MFI_FRAME_DIR_WRITE;
554         else if (scp->sc_data_direction == PCI_DMA_FROMDEVICE)
555                 flags = MFI_FRAME_DIR_READ;
556         else if (scp->sc_data_direction == PCI_DMA_NONE)
557                 flags = MFI_FRAME_DIR_NONE;
558
559         /*
560          * Prepare the DCDB frame
561          */
562         pthru->cmd = (is_logical) ? MFI_CMD_LD_SCSI_IO : MFI_CMD_PD_SCSI_IO;
563         pthru->cmd_status = 0x0;
564         pthru->scsi_status = 0x0;
565         pthru->target_id = device_id;
566         pthru->lun = scp->device->lun;
567         pthru->cdb_len = scp->cmd_len;
568         pthru->timeout = 0;
569         pthru->flags = flags;
570         pthru->data_xfer_len = scsi_bufflen(scp);
571
572         memcpy(pthru->cdb, scp->cmnd, scp->cmd_len);
573
574         /*
575          * Construct SGL
576          */
577         if (IS_DMA64) {
578                 pthru->flags |= MFI_FRAME_SGL64;
579                 pthru->sge_count = megasas_make_sgl64(instance, scp,
580                                                       &pthru->sgl);
581         } else
582                 pthru->sge_count = megasas_make_sgl32(instance, scp,
583                                                       &pthru->sgl);
584
585         /*
586          * Sense info specific
587          */
588         pthru->sense_len = SCSI_SENSE_BUFFERSIZE;
589         pthru->sense_buf_phys_addr_hi = 0;
590         pthru->sense_buf_phys_addr_lo = cmd->sense_phys_addr;
591
592         /*
593          * Compute the total number of frames this command consumes. FW uses
594          * this number to pull sufficient number of frames from host memory.
595          */
596         cmd->frame_count = megasas_get_frame_count(pthru->sge_count);
597
598         return cmd->frame_count;
599 }
600
601 /**
602  * megasas_build_ldio - Prepares IOs to logical devices
603  * @instance:           Adapter soft state
604  * @scp:                SCSI command
605  * @cmd:                Command to to be prepared
606  *
607  * Frames (and accompanying SGLs) for regular SCSI IOs use this function.
608  */
609 static int
610 megasas_build_ldio(struct megasas_instance *instance, struct scsi_cmnd *scp,
611                    struct megasas_cmd *cmd)
612 {
613         u32 device_id;
614         u8 sc = scp->cmnd[0];
615         u16 flags = 0;
616         struct megasas_io_frame *ldio;
617
618         device_id = MEGASAS_DEV_INDEX(instance, scp);
619         ldio = (struct megasas_io_frame *)cmd->frame;
620
621         if (scp->sc_data_direction == PCI_DMA_TODEVICE)
622                 flags = MFI_FRAME_DIR_WRITE;
623         else if (scp->sc_data_direction == PCI_DMA_FROMDEVICE)
624                 flags = MFI_FRAME_DIR_READ;
625
626         /*
627          * Prepare the Logical IO frame: 2nd bit is zero for all read cmds
628          */
629         ldio->cmd = (sc & 0x02) ? MFI_CMD_LD_WRITE : MFI_CMD_LD_READ;
630         ldio->cmd_status = 0x0;
631         ldio->scsi_status = 0x0;
632         ldio->target_id = device_id;
633         ldio->timeout = 0;
634         ldio->reserved_0 = 0;
635         ldio->pad_0 = 0;
636         ldio->flags = flags;
637         ldio->start_lba_hi = 0;
638         ldio->access_byte = (scp->cmd_len != 6) ? scp->cmnd[1] : 0;
639
640         /*
641          * 6-byte READ(0x08) or WRITE(0x0A) cdb
642          */
643         if (scp->cmd_len == 6) {
644                 ldio->lba_count = (u32) scp->cmnd[4];
645                 ldio->start_lba_lo = ((u32) scp->cmnd[1] << 16) |
646                     ((u32) scp->cmnd[2] << 8) | (u32) scp->cmnd[3];
647
648                 ldio->start_lba_lo &= 0x1FFFFF;
649         }
650
651         /*
652          * 10-byte READ(0x28) or WRITE(0x2A) cdb
653          */
654         else if (scp->cmd_len == 10) {
655                 ldio->lba_count = (u32) scp->cmnd[8] |
656                     ((u32) scp->cmnd[7] << 8);
657                 ldio->start_lba_lo = ((u32) scp->cmnd[2] << 24) |
658                     ((u32) scp->cmnd[3] << 16) |
659                     ((u32) scp->cmnd[4] << 8) | (u32) scp->cmnd[5];
660         }
661
662         /*
663          * 12-byte READ(0xA8) or WRITE(0xAA) cdb
664          */
665         else if (scp->cmd_len == 12) {
666                 ldio->lba_count = ((u32) scp->cmnd[6] << 24) |
667                     ((u32) scp->cmnd[7] << 16) |
668                     ((u32) scp->cmnd[8] << 8) | (u32) scp->cmnd[9];
669
670                 ldio->start_lba_lo = ((u32) scp->cmnd[2] << 24) |
671                     ((u32) scp->cmnd[3] << 16) |
672                     ((u32) scp->cmnd[4] << 8) | (u32) scp->cmnd[5];
673         }
674
675         /*
676          * 16-byte READ(0x88) or WRITE(0x8A) cdb
677          */
678         else if (scp->cmd_len == 16) {
679                 ldio->lba_count = ((u32) scp->cmnd[10] << 24) |
680                     ((u32) scp->cmnd[11] << 16) |
681                     ((u32) scp->cmnd[12] << 8) | (u32) scp->cmnd[13];
682
683                 ldio->start_lba_lo = ((u32) scp->cmnd[6] << 24) |
684                     ((u32) scp->cmnd[7] << 16) |
685                     ((u32) scp->cmnd[8] << 8) | (u32) scp->cmnd[9];
686
687                 ldio->start_lba_hi = ((u32) scp->cmnd[2] << 24) |
688                     ((u32) scp->cmnd[3] << 16) |
689                     ((u32) scp->cmnd[4] << 8) | (u32) scp->cmnd[5];
690
691         }
692
693         /*
694          * Construct SGL
695          */
696         if (IS_DMA64) {
697                 ldio->flags |= MFI_FRAME_SGL64;
698                 ldio->sge_count = megasas_make_sgl64(instance, scp, &ldio->sgl);
699         } else
700                 ldio->sge_count = megasas_make_sgl32(instance, scp, &ldio->sgl);
701
702         /*
703          * Sense info specific
704          */
705         ldio->sense_len = SCSI_SENSE_BUFFERSIZE;
706         ldio->sense_buf_phys_addr_hi = 0;
707         ldio->sense_buf_phys_addr_lo = cmd->sense_phys_addr;
708
709         /*
710          * Compute the total number of frames this command consumes. FW uses
711          * this number to pull sufficient number of frames from host memory.
712          */
713         cmd->frame_count = megasas_get_frame_count(ldio->sge_count);
714
715         return cmd->frame_count;
716 }
717
718 /**
719  * megasas_is_ldio -            Checks if the cmd is for logical drive
720  * @scmd:                       SCSI command
721  *      
722  * Called by megasas_queue_command to find out if the command to be queued
723  * is a logical drive command   
724  */
725 static inline int megasas_is_ldio(struct scsi_cmnd *cmd)
726 {
727         if (!MEGASAS_IS_LOGICAL(cmd))
728                 return 0;
729         switch (cmd->cmnd[0]) {
730         case READ_10:
731         case WRITE_10:
732         case READ_12:
733         case WRITE_12:
734         case READ_6:
735         case WRITE_6:
736         case READ_16:
737         case WRITE_16:
738                 return 1;
739         default:
740                 return 0;
741         }
742 }
743
744  /**
745  * megasas_dump_pending_frames -        Dumps the frame address of all pending cmds
746  *                                      in FW
747  * @instance:                           Adapter soft state
748  */
749 static inline void
750 megasas_dump_pending_frames(struct megasas_instance *instance)
751 {
752         struct megasas_cmd *cmd;
753         int i,n;
754         union megasas_sgl *mfi_sgl;
755         struct megasas_io_frame *ldio;
756         struct megasas_pthru_frame *pthru;
757         u32 sgcount;
758         u32 max_cmd = instance->max_fw_cmds;
759
760         printk(KERN_ERR "\nmegasas[%d]: Dumping Frame Phys Address of all pending cmds in FW\n",instance->host->host_no);
761         printk(KERN_ERR "megasas[%d]: Total OS Pending cmds : %d\n",instance->host->host_no,atomic_read(&instance->fw_outstanding));
762         if (IS_DMA64)
763                 printk(KERN_ERR "\nmegasas[%d]: 64 bit SGLs were sent to FW\n",instance->host->host_no);
764         else
765                 printk(KERN_ERR "\nmegasas[%d]: 32 bit SGLs were sent to FW\n",instance->host->host_no);
766
767         printk(KERN_ERR "megasas[%d]: Pending OS cmds in FW : \n",instance->host->host_no);
768         for (i = 0; i < max_cmd; i++) {
769                 cmd = instance->cmd_list[i];
770                 if(!cmd->scmd)
771                         continue;
772                 printk(KERN_ERR "megasas[%d]: Frame addr :0x%08lx : ",instance->host->host_no,(unsigned long)cmd->frame_phys_addr);
773                 if (megasas_is_ldio(cmd->scmd)){
774                         ldio = (struct megasas_io_frame *)cmd->frame;
775                         mfi_sgl = &ldio->sgl;
776                         sgcount = ldio->sge_count;
777                         printk(KERN_ERR "megasas[%d]: frame count : 0x%x, Cmd : 0x%x, Tgt id : 0x%x, lba lo : 0x%x, lba_hi : 0x%x, sense_buf addr : 0x%x,sge count : 0x%x\n",instance->host->host_no, cmd->frame_count,ldio->cmd,ldio->target_id, ldio->start_lba_lo,ldio->start_lba_hi,ldio->sense_buf_phys_addr_lo,sgcount);
778                 }
779                 else {
780                         pthru = (struct megasas_pthru_frame *) cmd->frame;
781                         mfi_sgl = &pthru->sgl;
782                         sgcount = pthru->sge_count;
783                         printk(KERN_ERR "megasas[%d]: frame count : 0x%x, Cmd : 0x%x, Tgt id : 0x%x, lun : 0x%x, cdb_len : 0x%x, data xfer len : 0x%x, sense_buf addr : 0x%x,sge count : 0x%x\n",instance->host->host_no,cmd->frame_count,pthru->cmd,pthru->target_id,pthru->lun,pthru->cdb_len , pthru->data_xfer_len,pthru->sense_buf_phys_addr_lo,sgcount);
784                 }
785         if(megasas_dbg_lvl & MEGASAS_DBG_LVL){
786                 for (n = 0; n < sgcount; n++){
787                         if (IS_DMA64)
788                                 printk(KERN_ERR "megasas: sgl len : 0x%x, sgl addr : 0x%08lx ",mfi_sgl->sge64[n].length , (unsigned long)mfi_sgl->sge64[n].phys_addr) ;
789                         else
790                                 printk(KERN_ERR "megasas: sgl len : 0x%x, sgl addr : 0x%x ",mfi_sgl->sge32[n].length , mfi_sgl->sge32[n].phys_addr) ;
791                         }
792                 }
793                 printk(KERN_ERR "\n");
794         } /*for max_cmd*/
795         printk(KERN_ERR "\nmegasas[%d]: Pending Internal cmds in FW : \n",instance->host->host_no);
796         for (i = 0; i < max_cmd; i++) {
797
798                 cmd = instance->cmd_list[i];
799
800                 if(cmd->sync_cmd == 1){
801                         printk(KERN_ERR "0x%08lx : ", (unsigned long)cmd->frame_phys_addr);
802                 }
803         }
804         printk(KERN_ERR "megasas[%d]: Dumping Done.\n\n",instance->host->host_no);
805 }
806
807 /**
808  * megasas_queue_command -      Queue entry point
809  * @scmd:                       SCSI command to be queued
810  * @done:                       Callback entry point
811  */
812 static int
813 megasas_queue_command(struct scsi_cmnd *scmd, void (*done) (struct scsi_cmnd *))
814 {
815         u32 frame_count;
816         struct megasas_cmd *cmd;
817         struct megasas_instance *instance;
818
819         instance = (struct megasas_instance *)
820             scmd->device->host->hostdata;
821
822         /* Don't process if we have already declared adapter dead */
823         if (instance->hw_crit_error)
824                 return SCSI_MLQUEUE_HOST_BUSY;
825
826         scmd->scsi_done = done;
827         scmd->result = 0;
828
829         if (MEGASAS_IS_LOGICAL(scmd) &&
830             (scmd->device->id >= MEGASAS_MAX_LD || scmd->device->lun)) {
831                 scmd->result = DID_BAD_TARGET << 16;
832                 goto out_done;
833         }
834
835         switch (scmd->cmnd[0]) {
836         case SYNCHRONIZE_CACHE:
837                 /*
838                  * FW takes care of flush cache on its own
839                  * No need to send it down
840                  */
841                 scmd->result = DID_OK << 16;
842                 goto out_done;
843         default:
844                 break;
845         }
846
847         cmd = megasas_get_cmd(instance);
848         if (!cmd)
849                 return SCSI_MLQUEUE_HOST_BUSY;
850
851         /*
852          * Logical drive command
853          */
854         if (megasas_is_ldio(scmd))
855                 frame_count = megasas_build_ldio(instance, scmd, cmd);
856         else
857                 frame_count = megasas_build_dcdb(instance, scmd, cmd);
858
859         if (!frame_count)
860                 goto out_return_cmd;
861
862         cmd->scmd = scmd;
863         scmd->SCp.ptr = (char *)cmd;
864
865         /*
866          * Issue the command to the FW
867          */
868         atomic_inc(&instance->fw_outstanding);
869
870         instance->instancet->fire_cmd(cmd->frame_phys_addr ,cmd->frame_count-1,instance->reg_set);
871         /*
872          * Check if we have pend cmds to be completed
873          */
874         if (poll_mode_io && atomic_read(&instance->fw_outstanding))
875                 tasklet_schedule(&instance->isr_tasklet);
876
877
878         return 0;
879
880  out_return_cmd:
881         megasas_return_cmd(instance, cmd);
882  out_done:
883         done(scmd);
884         return 0;
885 }
886
887 static int megasas_slave_configure(struct scsi_device *sdev)
888 {
889         /*
890          * Don't export physical disk devices to the disk driver.
891          *
892          * FIXME: Currently we don't export them to the midlayer at all.
893          *        That will be fixed once LSI engineers have audited the
894          *        firmware for possible issues.
895          */
896         if (sdev->channel < MEGASAS_MAX_PD_CHANNELS && sdev->type == TYPE_DISK)
897                 return -ENXIO;
898
899         /*
900          * The RAID firmware may require extended timeouts.
901          */
902         if (sdev->channel >= MEGASAS_MAX_PD_CHANNELS)
903                 sdev->timeout = MEGASAS_DEFAULT_CMD_TIMEOUT * HZ;
904         return 0;
905 }
906
907 /**
908  * megasas_complete_cmd_dpc      -      Returns FW's controller structure
909  * @instance_addr:                      Address of adapter soft state
910  *
911  * Tasklet to complete cmds
912  */
913 static void megasas_complete_cmd_dpc(unsigned long instance_addr)
914 {
915         u32 producer;
916         u32 consumer;
917         u32 context;
918         struct megasas_cmd *cmd;
919         struct megasas_instance *instance =
920                                 (struct megasas_instance *)instance_addr;
921         unsigned long flags;
922
923         /* If we have already declared adapter dead, donot complete cmds */
924         if (instance->hw_crit_error)
925                 return;
926
927         spin_lock_irqsave(&instance->completion_lock, flags);
928
929         producer = *instance->producer;
930         consumer = *instance->consumer;
931
932         while (consumer != producer) {
933                 context = instance->reply_queue[consumer];
934
935                 cmd = instance->cmd_list[context];
936
937                 megasas_complete_cmd(instance, cmd, DID_OK);
938
939                 consumer++;
940                 if (consumer == (instance->max_fw_cmds + 1)) {
941                         consumer = 0;
942                 }
943         }
944
945         *instance->consumer = producer;
946
947         spin_unlock_irqrestore(&instance->completion_lock, flags);
948
949         /*
950          * Check if we can restore can_queue
951          */
952         if (instance->flag & MEGASAS_FW_BUSY
953                 && time_after(jiffies, instance->last_time + 5 * HZ)
954                 && atomic_read(&instance->fw_outstanding) < 17) {
955
956                 spin_lock_irqsave(instance->host->host_lock, flags);
957                 instance->flag &= ~MEGASAS_FW_BUSY;
958                 instance->host->can_queue =
959                                 instance->max_fw_cmds - MEGASAS_INT_CMDS;
960
961                 spin_unlock_irqrestore(instance->host->host_lock, flags);
962         }
963 }
964
965 /**
966  * megasas_wait_for_outstanding -       Wait for all outstanding cmds
967  * @instance:                           Adapter soft state
968  *
969  * This function waits for upto MEGASAS_RESET_WAIT_TIME seconds for FW to
970  * complete all its outstanding commands. Returns error if one or more IOs
971  * are pending after this time period. It also marks the controller dead.
972  */
973 static int megasas_wait_for_outstanding(struct megasas_instance *instance)
974 {
975         int i;
976         u32 wait_time = MEGASAS_RESET_WAIT_TIME;
977
978         for (i = 0; i < wait_time; i++) {
979
980                 int outstanding = atomic_read(&instance->fw_outstanding);
981
982                 if (!outstanding)
983                         break;
984
985                 if (!(i % MEGASAS_RESET_NOTICE_INTERVAL)) {
986                         printk(KERN_NOTICE "megasas: [%2d]waiting for %d "
987                                "commands to complete\n",i,outstanding);
988                         /*
989                          * Call cmd completion routine. Cmd to be
990                          * be completed directly without depending on isr.
991                          */
992                         megasas_complete_cmd_dpc((unsigned long)instance);
993                 }
994
995                 msleep(1000);
996         }
997
998         if (atomic_read(&instance->fw_outstanding)) {
999                 /*
1000                 * Send signal to FW to stop processing any pending cmds.
1001                 * The controller will be taken offline by the OS now.
1002                 */
1003                 writel(MFI_STOP_ADP,
1004                                 &instance->reg_set->inbound_doorbell);
1005                 megasas_dump_pending_frames(instance);
1006                 instance->hw_crit_error = 1;
1007                 return FAILED;
1008         }
1009
1010         return SUCCESS;
1011 }
1012
1013 /**
1014  * megasas_generic_reset -      Generic reset routine
1015  * @scmd:                       Mid-layer SCSI command
1016  *
1017  * This routine implements a generic reset handler for device, bus and host
1018  * reset requests. Device, bus and host specific reset handlers can use this
1019  * function after they do their specific tasks.
1020  */
1021 static int megasas_generic_reset(struct scsi_cmnd *scmd)
1022 {
1023         int ret_val;
1024         struct megasas_instance *instance;
1025
1026         instance = (struct megasas_instance *)scmd->device->host->hostdata;
1027
1028         scmd_printk(KERN_NOTICE, scmd, "megasas: RESET -%ld cmd=%x retries=%x\n",
1029                  scmd->serial_number, scmd->cmnd[0], scmd->retries);
1030
1031         if (instance->hw_crit_error) {
1032                 printk(KERN_ERR "megasas: cannot recover from previous reset "
1033                        "failures\n");
1034                 return FAILED;
1035         }
1036
1037         ret_val = megasas_wait_for_outstanding(instance);
1038         if (ret_val == SUCCESS)
1039                 printk(KERN_NOTICE "megasas: reset successful \n");
1040         else
1041                 printk(KERN_ERR "megasas: failed to do reset\n");
1042
1043         return ret_val;
1044 }
1045
1046 /**
1047  * megasas_reset_timer - quiesce the adapter if required
1048  * @scmd:               scsi cmnd
1049  *
1050  * Sets the FW busy flag and reduces the host->can_queue if the
1051  * cmd has not been completed within the timeout period.
1052  */
1053 static enum
1054 scsi_eh_timer_return megasas_reset_timer(struct scsi_cmnd *scmd)
1055 {
1056         struct megasas_cmd *cmd = (struct megasas_cmd *)scmd->SCp.ptr;
1057         struct megasas_instance *instance;
1058         unsigned long flags;
1059
1060         if (time_after(jiffies, scmd->jiffies_at_alloc +
1061                                 (MEGASAS_DEFAULT_CMD_TIMEOUT * 2) * HZ)) {
1062                 return EH_NOT_HANDLED;
1063         }
1064
1065         instance = cmd->instance;
1066         if (!(instance->flag & MEGASAS_FW_BUSY)) {
1067                 /* FW is busy, throttle IO */
1068                 spin_lock_irqsave(instance->host->host_lock, flags);
1069
1070                 instance->host->can_queue = 16;
1071                 instance->last_time = jiffies;
1072                 instance->flag |= MEGASAS_FW_BUSY;
1073
1074                 spin_unlock_irqrestore(instance->host->host_lock, flags);
1075         }
1076         return EH_RESET_TIMER;
1077 }
1078
1079 /**
1080  * megasas_reset_device -       Device reset handler entry point
1081  */
1082 static int megasas_reset_device(struct scsi_cmnd *scmd)
1083 {
1084         int ret;
1085
1086         /*
1087          * First wait for all commands to complete
1088          */
1089         ret = megasas_generic_reset(scmd);
1090
1091         return ret;
1092 }
1093
1094 /**
1095  * megasas_reset_bus_host -     Bus & host reset handler entry point
1096  */
1097 static int megasas_reset_bus_host(struct scsi_cmnd *scmd)
1098 {
1099         int ret;
1100
1101         /*
1102          * First wait for all commands to complete
1103          */
1104         ret = megasas_generic_reset(scmd);
1105
1106         return ret;
1107 }
1108
1109 /**
1110  * megasas_bios_param - Returns disk geometry for a disk
1111  * @sdev:               device handle
1112  * @bdev:               block device
1113  * @capacity:           drive capacity
1114  * @geom:               geometry parameters
1115  */
1116 static int
1117 megasas_bios_param(struct scsi_device *sdev, struct block_device *bdev,
1118                  sector_t capacity, int geom[])
1119 {
1120         int heads;
1121         int sectors;
1122         sector_t cylinders;
1123         unsigned long tmp;
1124         /* Default heads (64) & sectors (32) */
1125         heads = 64;
1126         sectors = 32;
1127
1128         tmp = heads * sectors;
1129         cylinders = capacity;
1130
1131         sector_div(cylinders, tmp);
1132
1133         /*
1134          * Handle extended translation size for logical drives > 1Gb
1135          */
1136
1137         if (capacity >= 0x200000) {
1138                 heads = 255;
1139                 sectors = 63;
1140                 tmp = heads*sectors;
1141                 cylinders = capacity;
1142                 sector_div(cylinders, tmp);
1143         }
1144
1145         geom[0] = heads;
1146         geom[1] = sectors;
1147         geom[2] = cylinders;
1148
1149         return 0;
1150 }
1151
1152 /**
1153  * megasas_service_aen -        Processes an event notification
1154  * @instance:                   Adapter soft state
1155  * @cmd:                        AEN command completed by the ISR
1156  *
1157  * For AEN, driver sends a command down to FW that is held by the FW till an
1158  * event occurs. When an event of interest occurs, FW completes the command
1159  * that it was previously holding.
1160  *
1161  * This routines sends SIGIO signal to processes that have registered with the
1162  * driver for AEN.
1163  */
1164 static void
1165 megasas_service_aen(struct megasas_instance *instance, struct megasas_cmd *cmd)
1166 {
1167         /*
1168          * Don't signal app if it is just an aborted previously registered aen
1169          */
1170         if (!cmd->abort_aen)
1171                 kill_fasync(&megasas_async_queue, SIGIO, POLL_IN);
1172         else
1173                 cmd->abort_aen = 0;
1174
1175         instance->aen_cmd = NULL;
1176         megasas_return_cmd(instance, cmd);
1177 }
1178
1179 /*
1180  * Scsi host template for megaraid_sas driver
1181  */
1182 static struct scsi_host_template megasas_template = {
1183
1184         .module = THIS_MODULE,
1185         .name = "LSI SAS based MegaRAID driver",
1186         .proc_name = "megaraid_sas",
1187         .slave_configure = megasas_slave_configure,
1188         .queuecommand = megasas_queue_command,
1189         .eh_device_reset_handler = megasas_reset_device,
1190         .eh_bus_reset_handler = megasas_reset_bus_host,
1191         .eh_host_reset_handler = megasas_reset_bus_host,
1192         .eh_timed_out = megasas_reset_timer,
1193         .bios_param = megasas_bios_param,
1194         .use_clustering = ENABLE_CLUSTERING,
1195 };
1196
1197 /**
1198  * megasas_complete_int_cmd -   Completes an internal command
1199  * @instance:                   Adapter soft state
1200  * @cmd:                        Command to be completed
1201  *
1202  * The megasas_issue_blocked_cmd() function waits for a command to complete
1203  * after it issues a command. This function wakes up that waiting routine by
1204  * calling wake_up() on the wait queue.
1205  */
1206 static void
1207 megasas_complete_int_cmd(struct megasas_instance *instance,
1208                          struct megasas_cmd *cmd)
1209 {
1210         cmd->cmd_status = cmd->frame->io.cmd_status;
1211
1212         if (cmd->cmd_status == ENODATA) {
1213                 cmd->cmd_status = 0;
1214         }
1215         wake_up(&instance->int_cmd_wait_q);
1216 }
1217
1218 /**
1219  * megasas_complete_abort -     Completes aborting a command
1220  * @instance:                   Adapter soft state
1221  * @cmd:                        Cmd that was issued to abort another cmd
1222  *
1223  * The megasas_issue_blocked_abort_cmd() function waits on abort_cmd_wait_q 
1224  * after it issues an abort on a previously issued command. This function 
1225  * wakes up all functions waiting on the same wait queue.
1226  */
1227 static void
1228 megasas_complete_abort(struct megasas_instance *instance,
1229                        struct megasas_cmd *cmd)
1230 {
1231         if (cmd->sync_cmd) {
1232                 cmd->sync_cmd = 0;
1233                 cmd->cmd_status = 0;
1234                 wake_up(&instance->abort_cmd_wait_q);
1235         }
1236
1237         return;
1238 }
1239
1240 /**
1241  * megasas_complete_cmd -       Completes a command
1242  * @instance:                   Adapter soft state
1243  * @cmd:                        Command to be completed
1244  * @alt_status:                 If non-zero, use this value as status to 
1245  *                              SCSI mid-layer instead of the value returned
1246  *                              by the FW. This should be used if caller wants
1247  *                              an alternate status (as in the case of aborted
1248  *                              commands)
1249  */
1250 static void
1251 megasas_complete_cmd(struct megasas_instance *instance, struct megasas_cmd *cmd,
1252                      u8 alt_status)
1253 {
1254         int exception = 0;
1255         struct megasas_header *hdr = &cmd->frame->hdr;
1256
1257         if (cmd->scmd)
1258                 cmd->scmd->SCp.ptr = NULL;
1259
1260         switch (hdr->cmd) {
1261
1262         case MFI_CMD_PD_SCSI_IO:
1263         case MFI_CMD_LD_SCSI_IO:
1264
1265                 /*
1266                  * MFI_CMD_PD_SCSI_IO and MFI_CMD_LD_SCSI_IO could have been
1267                  * issued either through an IO path or an IOCTL path. If it
1268                  * was via IOCTL, we will send it to internal completion.
1269                  */
1270                 if (cmd->sync_cmd) {
1271                         cmd->sync_cmd = 0;
1272                         megasas_complete_int_cmd(instance, cmd);
1273                         break;
1274                 }
1275
1276         case MFI_CMD_LD_READ:
1277         case MFI_CMD_LD_WRITE:
1278
1279                 if (alt_status) {
1280                         cmd->scmd->result = alt_status << 16;
1281                         exception = 1;
1282                 }
1283
1284                 if (exception) {
1285
1286                         atomic_dec(&instance->fw_outstanding);
1287
1288                         scsi_dma_unmap(cmd->scmd);
1289                         cmd->scmd->scsi_done(cmd->scmd);
1290                         megasas_return_cmd(instance, cmd);
1291
1292                         break;
1293                 }
1294
1295                 switch (hdr->cmd_status) {
1296
1297                 case MFI_STAT_OK:
1298                         cmd->scmd->result = DID_OK << 16;
1299                         break;
1300
1301                 case MFI_STAT_SCSI_IO_FAILED:
1302                 case MFI_STAT_LD_INIT_IN_PROGRESS:
1303                         cmd->scmd->result =
1304                             (DID_ERROR << 16) | hdr->scsi_status;
1305                         break;
1306
1307                 case MFI_STAT_SCSI_DONE_WITH_ERROR:
1308
1309                         cmd->scmd->result = (DID_OK << 16) | hdr->scsi_status;
1310
1311                         if (hdr->scsi_status == SAM_STAT_CHECK_CONDITION) {
1312                                 memset(cmd->scmd->sense_buffer, 0,
1313                                        SCSI_SENSE_BUFFERSIZE);
1314                                 memcpy(cmd->scmd->sense_buffer, cmd->sense,
1315                                        hdr->sense_len);
1316
1317                                 cmd->scmd->result |= DRIVER_SENSE << 24;
1318                         }
1319
1320                         break;
1321
1322                 case MFI_STAT_LD_OFFLINE:
1323                 case MFI_STAT_DEVICE_NOT_FOUND:
1324                         cmd->scmd->result = DID_BAD_TARGET << 16;
1325                         break;
1326
1327                 default:
1328                         printk(KERN_DEBUG "megasas: MFI FW status %#x\n",
1329                                hdr->cmd_status);
1330                         cmd->scmd->result = DID_ERROR << 16;
1331                         break;
1332                 }
1333
1334                 atomic_dec(&instance->fw_outstanding);
1335
1336                 scsi_dma_unmap(cmd->scmd);
1337                 cmd->scmd->scsi_done(cmd->scmd);
1338                 megasas_return_cmd(instance, cmd);
1339
1340                 break;
1341
1342         case MFI_CMD_SMP:
1343         case MFI_CMD_STP:
1344         case MFI_CMD_DCMD:
1345
1346                 /*
1347                  * See if got an event notification
1348                  */
1349                 if (cmd->frame->dcmd.opcode == MR_DCMD_CTRL_EVENT_WAIT)
1350                         megasas_service_aen(instance, cmd);
1351                 else
1352                         megasas_complete_int_cmd(instance, cmd);
1353
1354                 break;
1355
1356         case MFI_CMD_ABORT:
1357                 /*
1358                  * Cmd issued to abort another cmd returned
1359                  */
1360                 megasas_complete_abort(instance, cmd);
1361                 break;
1362
1363         default:
1364                 printk("megasas: Unknown command completed! [0x%X]\n",
1365                        hdr->cmd);
1366                 break;
1367         }
1368 }
1369
1370 /**
1371  * megasas_deplete_reply_queue -        Processes all completed commands
1372  * @instance:                           Adapter soft state
1373  * @alt_status:                         Alternate status to be returned to
1374  *                                      SCSI mid-layer instead of the status
1375  *                                      returned by the FW
1376  */
1377 static int
1378 megasas_deplete_reply_queue(struct megasas_instance *instance, u8 alt_status)
1379 {
1380         /*
1381          * Check if it is our interrupt
1382          * Clear the interrupt 
1383          */
1384         if(instance->instancet->clear_intr(instance->reg_set))
1385                 return IRQ_NONE;
1386
1387         if (instance->hw_crit_error)
1388                 goto out_done;
1389         /*
1390          * Schedule the tasklet for cmd completion
1391          */
1392         tasklet_schedule(&instance->isr_tasklet);
1393 out_done:
1394         return IRQ_HANDLED;
1395 }
1396
1397 /**
1398  * megasas_isr - isr entry point
1399  */
1400 static irqreturn_t megasas_isr(int irq, void *devp)
1401 {
1402         return megasas_deplete_reply_queue((struct megasas_instance *)devp,
1403                                            DID_OK);
1404 }
1405
1406 /**
1407  * megasas_transition_to_ready -        Move the FW to READY state
1408  * @instance:                           Adapter soft state
1409  *
1410  * During the initialization, FW passes can potentially be in any one of
1411  * several possible states. If the FW in operational, waiting-for-handshake
1412  * states, driver must take steps to bring it to ready state. Otherwise, it
1413  * has to wait for the ready state.
1414  */
1415 static int
1416 megasas_transition_to_ready(struct megasas_instance* instance)
1417 {
1418         int i;
1419         u8 max_wait;
1420         u32 fw_state;
1421         u32 cur_state;
1422
1423         fw_state = instance->instancet->read_fw_status_reg(instance->reg_set) & MFI_STATE_MASK;
1424
1425         if (fw_state != MFI_STATE_READY)
1426                 printk(KERN_INFO "megasas: Waiting for FW to come to ready"
1427                        " state\n");
1428
1429         while (fw_state != MFI_STATE_READY) {
1430
1431                 switch (fw_state) {
1432
1433                 case MFI_STATE_FAULT:
1434
1435                         printk(KERN_DEBUG "megasas: FW in FAULT state!!\n");
1436                         return -ENODEV;
1437
1438                 case MFI_STATE_WAIT_HANDSHAKE:
1439                         /*
1440                          * Set the CLR bit in inbound doorbell
1441                          */
1442                         writel(MFI_INIT_CLEAR_HANDSHAKE|MFI_INIT_HOTPLUG,
1443                                 &instance->reg_set->inbound_doorbell);
1444
1445                         max_wait = 2;
1446                         cur_state = MFI_STATE_WAIT_HANDSHAKE;
1447                         break;
1448
1449                 case MFI_STATE_BOOT_MESSAGE_PENDING:
1450                         writel(MFI_INIT_HOTPLUG,
1451                                 &instance->reg_set->inbound_doorbell);
1452
1453                         max_wait = 10;
1454                         cur_state = MFI_STATE_BOOT_MESSAGE_PENDING;
1455                         break;
1456
1457                 case MFI_STATE_OPERATIONAL:
1458                         /*
1459                          * Bring it to READY state; assuming max wait 10 secs
1460                          */
1461                         instance->instancet->disable_intr(instance->reg_set);
1462                         writel(MFI_RESET_FLAGS, &instance->reg_set->inbound_doorbell);
1463
1464                         max_wait = 10;
1465                         cur_state = MFI_STATE_OPERATIONAL;
1466                         break;
1467
1468                 case MFI_STATE_UNDEFINED:
1469                         /*
1470                          * This state should not last for more than 2 seconds
1471                          */
1472                         max_wait = 2;
1473                         cur_state = MFI_STATE_UNDEFINED;
1474                         break;
1475
1476                 case MFI_STATE_BB_INIT:
1477                         max_wait = 2;
1478                         cur_state = MFI_STATE_BB_INIT;
1479                         break;
1480
1481                 case MFI_STATE_FW_INIT:
1482                         max_wait = 20;
1483                         cur_state = MFI_STATE_FW_INIT;
1484                         break;
1485
1486                 case MFI_STATE_FW_INIT_2:
1487                         max_wait = 20;
1488                         cur_state = MFI_STATE_FW_INIT_2;
1489                         break;
1490
1491                 case MFI_STATE_DEVICE_SCAN:
1492                         max_wait = 20;
1493                         cur_state = MFI_STATE_DEVICE_SCAN;
1494                         break;
1495
1496                 case MFI_STATE_FLUSH_CACHE:
1497                         max_wait = 20;
1498                         cur_state = MFI_STATE_FLUSH_CACHE;
1499                         break;
1500
1501                 default:
1502                         printk(KERN_DEBUG "megasas: Unknown state 0x%x\n",
1503                                fw_state);
1504                         return -ENODEV;
1505                 }
1506
1507                 /*
1508                  * The cur_state should not last for more than max_wait secs
1509                  */
1510                 for (i = 0; i < (max_wait * 1000); i++) {
1511                         fw_state = instance->instancet->read_fw_status_reg(instance->reg_set) &  
1512                                         MFI_STATE_MASK ;
1513
1514                         if (fw_state == cur_state) {
1515                                 msleep(1);
1516                         } else
1517                                 break;
1518                 }
1519
1520                 /*
1521                  * Return error if fw_state hasn't changed after max_wait
1522                  */
1523                 if (fw_state == cur_state) {
1524                         printk(KERN_DEBUG "FW state [%d] hasn't changed "
1525                                "in %d secs\n", fw_state, max_wait);
1526                         return -ENODEV;
1527                 }
1528         };
1529         printk(KERN_INFO "megasas: FW now in Ready state\n");
1530
1531         return 0;
1532 }
1533
1534 /**
1535  * megasas_teardown_frame_pool -        Destroy the cmd frame DMA pool
1536  * @instance:                           Adapter soft state
1537  */
1538 static void megasas_teardown_frame_pool(struct megasas_instance *instance)
1539 {
1540         int i;
1541         u32 max_cmd = instance->max_fw_cmds;
1542         struct megasas_cmd *cmd;
1543
1544         if (!instance->frame_dma_pool)
1545                 return;
1546
1547         /*
1548          * Return all frames to pool
1549          */
1550         for (i = 0; i < max_cmd; i++) {
1551
1552                 cmd = instance->cmd_list[i];
1553
1554                 if (cmd->frame)
1555                         pci_pool_free(instance->frame_dma_pool, cmd->frame,
1556                                       cmd->frame_phys_addr);
1557
1558                 if (cmd->sense)
1559                         pci_pool_free(instance->sense_dma_pool, cmd->sense,
1560                                       cmd->sense_phys_addr);
1561         }
1562
1563         /*
1564          * Now destroy the pool itself
1565          */
1566         pci_pool_destroy(instance->frame_dma_pool);
1567         pci_pool_destroy(instance->sense_dma_pool);
1568
1569         instance->frame_dma_pool = NULL;
1570         instance->sense_dma_pool = NULL;
1571 }
1572
1573 /**
1574  * megasas_create_frame_pool -  Creates DMA pool for cmd frames
1575  * @instance:                   Adapter soft state
1576  *
1577  * Each command packet has an embedded DMA memory buffer that is used for
1578  * filling MFI frame and the SG list that immediately follows the frame. This
1579  * function creates those DMA memory buffers for each command packet by using
1580  * PCI pool facility.
1581  */
1582 static int megasas_create_frame_pool(struct megasas_instance *instance)
1583 {
1584         int i;
1585         u32 max_cmd;
1586         u32 sge_sz;
1587         u32 sgl_sz;
1588         u32 total_sz;
1589         u32 frame_count;
1590         struct megasas_cmd *cmd;
1591
1592         max_cmd = instance->max_fw_cmds;
1593
1594         /*
1595          * Size of our frame is 64 bytes for MFI frame, followed by max SG
1596          * elements and finally SCSI_SENSE_BUFFERSIZE bytes for sense buffer
1597          */
1598         sge_sz = (IS_DMA64) ? sizeof(struct megasas_sge64) :
1599             sizeof(struct megasas_sge32);
1600
1601         /*
1602          * Calculated the number of 64byte frames required for SGL
1603          */
1604         sgl_sz = sge_sz * instance->max_num_sge;
1605         frame_count = (sgl_sz + MEGAMFI_FRAME_SIZE - 1) / MEGAMFI_FRAME_SIZE;
1606
1607         /*
1608          * We need one extra frame for the MFI command
1609          */
1610         frame_count++;
1611
1612         total_sz = MEGAMFI_FRAME_SIZE * frame_count;
1613         /*
1614          * Use DMA pool facility provided by PCI layer
1615          */
1616         instance->frame_dma_pool = pci_pool_create("megasas frame pool",
1617                                                    instance->pdev, total_sz, 64,
1618                                                    0);
1619
1620         if (!instance->frame_dma_pool) {
1621                 printk(KERN_DEBUG "megasas: failed to setup frame pool\n");
1622                 return -ENOMEM;
1623         }
1624
1625         instance->sense_dma_pool = pci_pool_create("megasas sense pool",
1626                                                    instance->pdev, 128, 4, 0);
1627
1628         if (!instance->sense_dma_pool) {
1629                 printk(KERN_DEBUG "megasas: failed to setup sense pool\n");
1630
1631                 pci_pool_destroy(instance->frame_dma_pool);
1632                 instance->frame_dma_pool = NULL;
1633
1634                 return -ENOMEM;
1635         }
1636
1637         /*
1638          * Allocate and attach a frame to each of the commands in cmd_list.
1639          * By making cmd->index as the context instead of the &cmd, we can
1640          * always use 32bit context regardless of the architecture
1641          */
1642         for (i = 0; i < max_cmd; i++) {
1643
1644                 cmd = instance->cmd_list[i];
1645
1646                 cmd->frame = pci_pool_alloc(instance->frame_dma_pool,
1647                                             GFP_KERNEL, &cmd->frame_phys_addr);
1648
1649                 cmd->sense = pci_pool_alloc(instance->sense_dma_pool,
1650                                             GFP_KERNEL, &cmd->sense_phys_addr);
1651
1652                 /*
1653                  * megasas_teardown_frame_pool() takes care of freeing
1654                  * whatever has been allocated
1655                  */
1656                 if (!cmd->frame || !cmd->sense) {
1657                         printk(KERN_DEBUG "megasas: pci_pool_alloc failed \n");
1658                         megasas_teardown_frame_pool(instance);
1659                         return -ENOMEM;
1660                 }
1661
1662                 cmd->frame->io.context = cmd->index;
1663         }
1664
1665         return 0;
1666 }
1667
1668 /**
1669  * megasas_free_cmds -  Free all the cmds in the free cmd pool
1670  * @instance:           Adapter soft state
1671  */
1672 static void megasas_free_cmds(struct megasas_instance *instance)
1673 {
1674         int i;
1675         /* First free the MFI frame pool */
1676         megasas_teardown_frame_pool(instance);
1677
1678         /* Free all the commands in the cmd_list */
1679         for (i = 0; i < instance->max_fw_cmds; i++)
1680                 kfree(instance->cmd_list[i]);
1681
1682         /* Free the cmd_list buffer itself */
1683         kfree(instance->cmd_list);
1684         instance->cmd_list = NULL;
1685
1686         INIT_LIST_HEAD(&instance->cmd_pool);
1687 }
1688
1689 /**
1690  * megasas_alloc_cmds - Allocates the command packets
1691  * @instance:           Adapter soft state
1692  *
1693  * Each command that is issued to the FW, whether IO commands from the OS or
1694  * internal commands like IOCTLs, are wrapped in local data structure called
1695  * megasas_cmd. The frame embedded in this megasas_cmd is actually issued to
1696  * the FW.
1697  *
1698  * Each frame has a 32-bit field called context (tag). This context is used
1699  * to get back the megasas_cmd from the frame when a frame gets completed in
1700  * the ISR. Typically the address of the megasas_cmd itself would be used as
1701  * the context. But we wanted to keep the differences between 32 and 64 bit
1702  * systems to the mininum. We always use 32 bit integers for the context. In
1703  * this driver, the 32 bit values are the indices into an array cmd_list.
1704  * This array is used only to look up the megasas_cmd given the context. The
1705  * free commands themselves are maintained in a linked list called cmd_pool.
1706  */
1707 static int megasas_alloc_cmds(struct megasas_instance *instance)
1708 {
1709         int i;
1710         int j;
1711         u32 max_cmd;
1712         struct megasas_cmd *cmd;
1713
1714         max_cmd = instance->max_fw_cmds;
1715
1716         /*
1717          * instance->cmd_list is an array of struct megasas_cmd pointers.
1718          * Allocate the dynamic array first and then allocate individual
1719          * commands.
1720          */
1721         instance->cmd_list = kcalloc(max_cmd, sizeof(struct megasas_cmd*), GFP_KERNEL);
1722
1723         if (!instance->cmd_list) {
1724                 printk(KERN_DEBUG "megasas: out of memory\n");
1725                 return -ENOMEM;
1726         }
1727
1728
1729         for (i = 0; i < max_cmd; i++) {
1730                 instance->cmd_list[i] = kmalloc(sizeof(struct megasas_cmd),
1731                                                 GFP_KERNEL);
1732
1733                 if (!instance->cmd_list[i]) {
1734
1735                         for (j = 0; j < i; j++)
1736                                 kfree(instance->cmd_list[j]);
1737
1738                         kfree(instance->cmd_list);
1739                         instance->cmd_list = NULL;
1740
1741                         return -ENOMEM;
1742                 }
1743         }
1744
1745         /*
1746          * Add all the commands to command pool (instance->cmd_pool)
1747          */
1748         for (i = 0; i < max_cmd; i++) {
1749                 cmd = instance->cmd_list[i];
1750                 memset(cmd, 0, sizeof(struct megasas_cmd));
1751                 cmd->index = i;
1752                 cmd->instance = instance;
1753
1754                 list_add_tail(&cmd->list, &instance->cmd_pool);
1755         }
1756
1757         /*
1758          * Create a frame pool and assign one frame to each cmd
1759          */
1760         if (megasas_create_frame_pool(instance)) {
1761                 printk(KERN_DEBUG "megasas: Error creating frame DMA pool\n");
1762                 megasas_free_cmds(instance);
1763         }
1764
1765         return 0;
1766 }
1767
1768 /**
1769  * megasas_get_controller_info -        Returns FW's controller structure
1770  * @instance:                           Adapter soft state
1771  * @ctrl_info:                          Controller information structure
1772  *
1773  * Issues an internal command (DCMD) to get the FW's controller structure.
1774  * This information is mainly used to find out the maximum IO transfer per
1775  * command supported by the FW.
1776  */
1777 static int
1778 megasas_get_ctrl_info(struct megasas_instance *instance,
1779                       struct megasas_ctrl_info *ctrl_info)
1780 {
1781         int ret = 0;
1782         struct megasas_cmd *cmd;
1783         struct megasas_dcmd_frame *dcmd;
1784         struct megasas_ctrl_info *ci;
1785         dma_addr_t ci_h = 0;
1786
1787         cmd = megasas_get_cmd(instance);
1788
1789         if (!cmd) {
1790                 printk(KERN_DEBUG "megasas: Failed to get a free cmd\n");
1791                 return -ENOMEM;
1792         }
1793
1794         dcmd = &cmd->frame->dcmd;
1795
1796         ci = pci_alloc_consistent(instance->pdev,
1797                                   sizeof(struct megasas_ctrl_info), &ci_h);
1798
1799         if (!ci) {
1800                 printk(KERN_DEBUG "Failed to alloc mem for ctrl info\n");
1801                 megasas_return_cmd(instance, cmd);
1802                 return -ENOMEM;
1803         }
1804
1805         memset(ci, 0, sizeof(*ci));
1806         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
1807
1808         dcmd->cmd = MFI_CMD_DCMD;
1809         dcmd->cmd_status = 0xFF;
1810         dcmd->sge_count = 1;
1811         dcmd->flags = MFI_FRAME_DIR_READ;
1812         dcmd->timeout = 0;
1813         dcmd->data_xfer_len = sizeof(struct megasas_ctrl_info);
1814         dcmd->opcode = MR_DCMD_CTRL_GET_INFO;
1815         dcmd->sgl.sge32[0].phys_addr = ci_h;
1816         dcmd->sgl.sge32[0].length = sizeof(struct megasas_ctrl_info);
1817
1818         if (!megasas_issue_polled(instance, cmd)) {
1819                 ret = 0;
1820                 memcpy(ctrl_info, ci, sizeof(struct megasas_ctrl_info));
1821         } else {
1822                 ret = -1;
1823         }
1824
1825         pci_free_consistent(instance->pdev, sizeof(struct megasas_ctrl_info),
1826                             ci, ci_h);
1827
1828         megasas_return_cmd(instance, cmd);
1829         return ret;
1830 }
1831
1832 /**
1833  * megasas_issue_init_mfi -     Initializes the FW
1834  * @instance:           Adapter soft state
1835  *
1836  * Issues the INIT MFI cmd
1837  */
1838 static int
1839 megasas_issue_init_mfi(struct megasas_instance *instance)
1840 {
1841         u32 context;
1842
1843         struct megasas_cmd *cmd;
1844
1845         struct megasas_init_frame *init_frame;
1846         struct megasas_init_queue_info *initq_info;
1847         dma_addr_t init_frame_h;
1848         dma_addr_t initq_info_h;
1849
1850         /*
1851          * Prepare a init frame. Note the init frame points to queue info
1852          * structure. Each frame has SGL allocated after first 64 bytes. For
1853          * this frame - since we don't need any SGL - we use SGL's space as
1854          * queue info structure
1855          *
1856          * We will not get a NULL command below. We just created the pool.
1857          */
1858         cmd = megasas_get_cmd(instance);
1859
1860         init_frame = (struct megasas_init_frame *)cmd->frame;
1861         initq_info = (struct megasas_init_queue_info *)
1862                 ((unsigned long)init_frame + 64);
1863
1864         init_frame_h = cmd->frame_phys_addr;
1865         initq_info_h = init_frame_h + 64;
1866
1867         context = init_frame->context;
1868         memset(init_frame, 0, MEGAMFI_FRAME_SIZE);
1869         memset(initq_info, 0, sizeof(struct megasas_init_queue_info));
1870         init_frame->context = context;
1871
1872         initq_info->reply_queue_entries = instance->max_fw_cmds + 1;
1873         initq_info->reply_queue_start_phys_addr_lo = instance->reply_queue_h;
1874
1875         initq_info->producer_index_phys_addr_lo = instance->producer_h;
1876         initq_info->consumer_index_phys_addr_lo = instance->consumer_h;
1877
1878         init_frame->cmd = MFI_CMD_INIT;
1879         init_frame->cmd_status = 0xFF;
1880         init_frame->queue_info_new_phys_addr_lo = initq_info_h;
1881
1882         init_frame->data_xfer_len = sizeof(struct megasas_init_queue_info);
1883
1884         /*
1885          * disable the intr before firing the init frame to FW
1886          */
1887         instance->instancet->disable_intr(instance->reg_set);
1888
1889         /*
1890          * Issue the init frame in polled mode
1891          */
1892
1893         if (megasas_issue_polled(instance, cmd)) {
1894                 printk(KERN_ERR "megasas: Failed to init firmware\n");
1895                 megasas_return_cmd(instance, cmd);
1896                 goto fail_fw_init;
1897         }
1898
1899         megasas_return_cmd(instance, cmd);
1900
1901         return 0;
1902
1903 fail_fw_init:
1904         return -EINVAL;
1905 }
1906
1907 /**
1908  * megasas_start_timer - Initializes a timer object
1909  * @instance:           Adapter soft state
1910  * @timer:              timer object to be initialized
1911  * @fn:                 timer function
1912  * @interval:           time interval between timer function call
1913  */
1914 static inline void
1915 megasas_start_timer(struct megasas_instance *instance,
1916                         struct timer_list *timer,
1917                         void *fn, unsigned long interval)
1918 {
1919         init_timer(timer);
1920         timer->expires = jiffies + interval;
1921         timer->data = (unsigned long)instance;
1922         timer->function = fn;
1923         add_timer(timer);
1924 }
1925
1926 /**
1927  * megasas_io_completion_timer - Timer fn
1928  * @instance_addr:      Address of adapter soft state
1929  *
1930  * Schedules tasklet for cmd completion
1931  * if poll_mode_io is set
1932  */
1933 static void
1934 megasas_io_completion_timer(unsigned long instance_addr)
1935 {
1936         struct megasas_instance *instance =
1937                         (struct megasas_instance *)instance_addr;
1938
1939         if (atomic_read(&instance->fw_outstanding))
1940                 tasklet_schedule(&instance->isr_tasklet);
1941
1942         /* Restart timer */
1943         if (poll_mode_io)
1944                 mod_timer(&instance->io_completion_timer,
1945                         jiffies + MEGASAS_COMPLETION_TIMER_INTERVAL);
1946 }
1947
1948 /**
1949  * megasas_init_mfi -   Initializes the FW
1950  * @instance:           Adapter soft state
1951  *
1952  * This is the main function for initializing MFI firmware.
1953  */
1954 static int megasas_init_mfi(struct megasas_instance *instance)
1955 {
1956         u32 context_sz;
1957         u32 reply_q_sz;
1958         u32 max_sectors_1;
1959         u32 max_sectors_2;
1960         u32 tmp_sectors;
1961         struct megasas_register_set __iomem *reg_set;
1962         struct megasas_ctrl_info *ctrl_info;
1963         /*
1964          * Map the message registers
1965          */
1966         instance->base_addr = pci_resource_start(instance->pdev, 0);
1967
1968         if (pci_request_regions(instance->pdev, "megasas: LSI")) {
1969                 printk(KERN_DEBUG "megasas: IO memory region busy!\n");
1970                 return -EBUSY;
1971         }
1972
1973         instance->reg_set = ioremap_nocache(instance->base_addr, 8192);
1974
1975         if (!instance->reg_set) {
1976                 printk(KERN_DEBUG "megasas: Failed to map IO mem\n");
1977                 goto fail_ioremap;
1978         }
1979
1980         reg_set = instance->reg_set;
1981
1982         switch(instance->pdev->device)
1983         {
1984                 case PCI_DEVICE_ID_LSI_SAS1078R:        
1985                         instance->instancet = &megasas_instance_template_ppc;
1986                         break;
1987                 case PCI_DEVICE_ID_LSI_SAS1064R:
1988                 case PCI_DEVICE_ID_DELL_PERC5:
1989                 default:
1990                         instance->instancet = &megasas_instance_template_xscale;
1991                         break;
1992         }
1993
1994         /*
1995          * We expect the FW state to be READY
1996          */
1997         if (megasas_transition_to_ready(instance))
1998                 goto fail_ready_state;
1999
2000         /*
2001          * Get various operational parameters from status register
2002          */
2003         instance->max_fw_cmds = instance->instancet->read_fw_status_reg(reg_set) & 0x00FFFF;
2004         /*
2005          * Reduce the max supported cmds by 1. This is to ensure that the
2006          * reply_q_sz (1 more than the max cmd that driver may send)
2007          * does not exceed max cmds that the FW can support
2008          */
2009         instance->max_fw_cmds = instance->max_fw_cmds-1;
2010         instance->max_num_sge = (instance->instancet->read_fw_status_reg(reg_set) & 0xFF0000) >> 
2011                                         0x10;
2012         /*
2013          * Create a pool of commands
2014          */
2015         if (megasas_alloc_cmds(instance))
2016                 goto fail_alloc_cmds;
2017
2018         /*
2019          * Allocate memory for reply queue. Length of reply queue should
2020          * be _one_ more than the maximum commands handled by the firmware.
2021          *
2022          * Note: When FW completes commands, it places corresponding contex
2023          * values in this circular reply queue. This circular queue is a fairly
2024          * typical producer-consumer queue. FW is the producer (of completed
2025          * commands) and the driver is the consumer.
2026          */
2027         context_sz = sizeof(u32);
2028         reply_q_sz = context_sz * (instance->max_fw_cmds + 1);
2029
2030         instance->reply_queue = pci_alloc_consistent(instance->pdev,
2031                                                      reply_q_sz,
2032                                                      &instance->reply_queue_h);
2033
2034         if (!instance->reply_queue) {
2035                 printk(KERN_DEBUG "megasas: Out of DMA mem for reply queue\n");
2036                 goto fail_reply_queue;
2037         }
2038
2039         if (megasas_issue_init_mfi(instance))
2040                 goto fail_fw_init;
2041
2042         ctrl_info = kmalloc(sizeof(struct megasas_ctrl_info), GFP_KERNEL);
2043
2044         /*
2045          * Compute the max allowed sectors per IO: The controller info has two
2046          * limits on max sectors. Driver should use the minimum of these two.
2047          *
2048          * 1 << stripe_sz_ops.min = max sectors per strip
2049          *
2050          * Note that older firmwares ( < FW ver 30) didn't report information
2051          * to calculate max_sectors_1. So the number ended up as zero always.
2052          */
2053         tmp_sectors = 0;
2054         if (ctrl_info && !megasas_get_ctrl_info(instance, ctrl_info)) {
2055
2056                 max_sectors_1 = (1 << ctrl_info->stripe_sz_ops.min) *
2057                     ctrl_info->max_strips_per_io;
2058                 max_sectors_2 = ctrl_info->max_request_size;
2059
2060                 tmp_sectors = min_t(u32, max_sectors_1 , max_sectors_2);
2061         }
2062
2063         instance->max_sectors_per_req = instance->max_num_sge *
2064                                                 PAGE_SIZE / 512;
2065         if (tmp_sectors && (instance->max_sectors_per_req > tmp_sectors))
2066                 instance->max_sectors_per_req = tmp_sectors;
2067
2068         kfree(ctrl_info);
2069
2070         /*
2071         * Setup tasklet for cmd completion
2072         */
2073
2074         tasklet_init(&instance->isr_tasklet, megasas_complete_cmd_dpc,
2075                 (unsigned long)instance);
2076
2077         /* Initialize the cmd completion timer */
2078         if (poll_mode_io)
2079                 megasas_start_timer(instance, &instance->io_completion_timer,
2080                                 megasas_io_completion_timer,
2081                                 MEGASAS_COMPLETION_TIMER_INTERVAL);
2082         return 0;
2083
2084       fail_fw_init:
2085
2086         pci_free_consistent(instance->pdev, reply_q_sz,
2087                             instance->reply_queue, instance->reply_queue_h);
2088       fail_reply_queue:
2089         megasas_free_cmds(instance);
2090
2091       fail_alloc_cmds:
2092       fail_ready_state:
2093         iounmap(instance->reg_set);
2094
2095       fail_ioremap:
2096         pci_release_regions(instance->pdev);
2097
2098         return -EINVAL;
2099 }
2100
2101 /**
2102  * megasas_release_mfi -        Reverses the FW initialization
2103  * @intance:                    Adapter soft state
2104  */
2105 static void megasas_release_mfi(struct megasas_instance *instance)
2106 {
2107         u32 reply_q_sz = sizeof(u32) * (instance->max_fw_cmds + 1);
2108
2109         pci_free_consistent(instance->pdev, reply_q_sz,
2110                             instance->reply_queue, instance->reply_queue_h);
2111
2112         megasas_free_cmds(instance);
2113
2114         iounmap(instance->reg_set);
2115
2116         pci_release_regions(instance->pdev);
2117 }
2118
2119 /**
2120  * megasas_get_seq_num -        Gets latest event sequence numbers
2121  * @instance:                   Adapter soft state
2122  * @eli:                        FW event log sequence numbers information
2123  *
2124  * FW maintains a log of all events in a non-volatile area. Upper layers would
2125  * usually find out the latest sequence number of the events, the seq number at
2126  * the boot etc. They would "read" all the events below the latest seq number
2127  * by issuing a direct fw cmd (DCMD). For the future events (beyond latest seq
2128  * number), they would subsribe to AEN (asynchronous event notification) and
2129  * wait for the events to happen.
2130  */
2131 static int
2132 megasas_get_seq_num(struct megasas_instance *instance,
2133                     struct megasas_evt_log_info *eli)
2134 {
2135         struct megasas_cmd *cmd;
2136         struct megasas_dcmd_frame *dcmd;
2137         struct megasas_evt_log_info *el_info;
2138         dma_addr_t el_info_h = 0;
2139
2140         cmd = megasas_get_cmd(instance);
2141
2142         if (!cmd) {
2143                 return -ENOMEM;
2144         }
2145
2146         dcmd = &cmd->frame->dcmd;
2147         el_info = pci_alloc_consistent(instance->pdev,
2148                                        sizeof(struct megasas_evt_log_info),
2149                                        &el_info_h);
2150
2151         if (!el_info) {
2152                 megasas_return_cmd(instance, cmd);
2153                 return -ENOMEM;
2154         }
2155
2156         memset(el_info, 0, sizeof(*el_info));
2157         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2158
2159         dcmd->cmd = MFI_CMD_DCMD;
2160         dcmd->cmd_status = 0x0;
2161         dcmd->sge_count = 1;
2162         dcmd->flags = MFI_FRAME_DIR_READ;
2163         dcmd->timeout = 0;
2164         dcmd->data_xfer_len = sizeof(struct megasas_evt_log_info);
2165         dcmd->opcode = MR_DCMD_CTRL_EVENT_GET_INFO;
2166         dcmd->sgl.sge32[0].phys_addr = el_info_h;
2167         dcmd->sgl.sge32[0].length = sizeof(struct megasas_evt_log_info);
2168
2169         megasas_issue_blocked_cmd(instance, cmd);
2170
2171         /*
2172          * Copy the data back into callers buffer
2173          */
2174         memcpy(eli, el_info, sizeof(struct megasas_evt_log_info));
2175
2176         pci_free_consistent(instance->pdev, sizeof(struct megasas_evt_log_info),
2177                             el_info, el_info_h);
2178
2179         megasas_return_cmd(instance, cmd);
2180
2181         return 0;
2182 }
2183
2184 /**
2185  * megasas_register_aen -       Registers for asynchronous event notification
2186  * @instance:                   Adapter soft state
2187  * @seq_num:                    The starting sequence number
2188  * @class_locale:               Class of the event
2189  *
2190  * This function subscribes for AEN for events beyond the @seq_num. It requests
2191  * to be notified if and only if the event is of type @class_locale
2192  */
2193 static int
2194 megasas_register_aen(struct megasas_instance *instance, u32 seq_num,
2195                      u32 class_locale_word)
2196 {
2197         int ret_val;
2198         struct megasas_cmd *cmd;
2199         struct megasas_dcmd_frame *dcmd;
2200         union megasas_evt_class_locale curr_aen;
2201         union megasas_evt_class_locale prev_aen;
2202
2203         /*
2204          * If there an AEN pending already (aen_cmd), check if the
2205          * class_locale of that pending AEN is inclusive of the new
2206          * AEN request we currently have. If it is, then we don't have
2207          * to do anything. In other words, whichever events the current
2208          * AEN request is subscribing to, have already been subscribed
2209          * to.
2210          *
2211          * If the old_cmd is _not_ inclusive, then we have to abort
2212          * that command, form a class_locale that is superset of both
2213          * old and current and re-issue to the FW
2214          */
2215
2216         curr_aen.word = class_locale_word;
2217
2218         if (instance->aen_cmd) {
2219
2220                 prev_aen.word = instance->aen_cmd->frame->dcmd.mbox.w[1];
2221
2222                 /*
2223                  * A class whose enum value is smaller is inclusive of all
2224                  * higher values. If a PROGRESS (= -1) was previously
2225                  * registered, then a new registration requests for higher
2226                  * classes need not be sent to FW. They are automatically
2227                  * included.
2228                  *
2229                  * Locale numbers don't have such hierarchy. They are bitmap
2230                  * values
2231                  */
2232                 if ((prev_aen.members.class <= curr_aen.members.class) &&
2233                     !((prev_aen.members.locale & curr_aen.members.locale) ^
2234                       curr_aen.members.locale)) {
2235                         /*
2236                          * Previously issued event registration includes
2237                          * current request. Nothing to do.
2238                          */
2239                         return 0;
2240                 } else {
2241                         curr_aen.members.locale |= prev_aen.members.locale;
2242
2243                         if (prev_aen.members.class < curr_aen.members.class)
2244                                 curr_aen.members.class = prev_aen.members.class;
2245
2246                         instance->aen_cmd->abort_aen = 1;
2247                         ret_val = megasas_issue_blocked_abort_cmd(instance,
2248                                                                   instance->
2249                                                                   aen_cmd);
2250
2251                         if (ret_val) {
2252                                 printk(KERN_DEBUG "megasas: Failed to abort "
2253                                        "previous AEN command\n");
2254                                 return ret_val;
2255                         }
2256                 }
2257         }
2258
2259         cmd = megasas_get_cmd(instance);
2260
2261         if (!cmd)
2262                 return -ENOMEM;
2263
2264         dcmd = &cmd->frame->dcmd;
2265
2266         memset(instance->evt_detail, 0, sizeof(struct megasas_evt_detail));
2267
2268         /*
2269          * Prepare DCMD for aen registration
2270          */
2271         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2272
2273         dcmd->cmd = MFI_CMD_DCMD;
2274         dcmd->cmd_status = 0x0;
2275         dcmd->sge_count = 1;
2276         dcmd->flags = MFI_FRAME_DIR_READ;
2277         dcmd->timeout = 0;
2278         dcmd->data_xfer_len = sizeof(struct megasas_evt_detail);
2279         dcmd->opcode = MR_DCMD_CTRL_EVENT_WAIT;
2280         dcmd->mbox.w[0] = seq_num;
2281         dcmd->mbox.w[1] = curr_aen.word;
2282         dcmd->sgl.sge32[0].phys_addr = (u32) instance->evt_detail_h;
2283         dcmd->sgl.sge32[0].length = sizeof(struct megasas_evt_detail);
2284
2285         /*
2286          * Store reference to the cmd used to register for AEN. When an
2287          * application wants us to register for AEN, we have to abort this
2288          * cmd and re-register with a new EVENT LOCALE supplied by that app
2289          */
2290         instance->aen_cmd = cmd;
2291
2292         /*
2293          * Issue the aen registration frame
2294          */
2295         instance->instancet->fire_cmd(cmd->frame_phys_addr ,0,instance->reg_set);
2296
2297         return 0;
2298 }
2299
2300 /**
2301  * megasas_start_aen -  Subscribes to AEN during driver load time
2302  * @instance:           Adapter soft state
2303  */
2304 static int megasas_start_aen(struct megasas_instance *instance)
2305 {
2306         struct megasas_evt_log_info eli;
2307         union megasas_evt_class_locale class_locale;
2308
2309         /*
2310          * Get the latest sequence number from FW
2311          */
2312         memset(&eli, 0, sizeof(eli));
2313
2314         if (megasas_get_seq_num(instance, &eli))
2315                 return -1;
2316
2317         /*
2318          * Register AEN with FW for latest sequence number plus 1
2319          */
2320         class_locale.members.reserved = 0;
2321         class_locale.members.locale = MR_EVT_LOCALE_ALL;
2322         class_locale.members.class = MR_EVT_CLASS_DEBUG;
2323
2324         return megasas_register_aen(instance, eli.newest_seq_num + 1,
2325                                     class_locale.word);
2326 }
2327
2328 /**
2329  * megasas_io_attach -  Attaches this driver to SCSI mid-layer
2330  * @instance:           Adapter soft state
2331  */
2332 static int megasas_io_attach(struct megasas_instance *instance)
2333 {
2334         struct Scsi_Host *host = instance->host;
2335
2336         /*
2337          * Export parameters required by SCSI mid-layer
2338          */
2339         host->irq = instance->pdev->irq;
2340         host->unique_id = instance->unique_id;
2341         host->can_queue = instance->max_fw_cmds - MEGASAS_INT_CMDS;
2342         host->this_id = instance->init_id;
2343         host->sg_tablesize = instance->max_num_sge;
2344         host->max_sectors = instance->max_sectors_per_req;
2345         host->cmd_per_lun = 128;
2346         host->max_channel = MEGASAS_MAX_CHANNELS - 1;
2347         host->max_id = MEGASAS_MAX_DEV_PER_CHANNEL;
2348         host->max_lun = MEGASAS_MAX_LUN;
2349         host->max_cmd_len = 16;
2350
2351         /*
2352          * Notify the mid-layer about the new controller
2353          */
2354         if (scsi_add_host(host, &instance->pdev->dev)) {
2355                 printk(KERN_DEBUG "megasas: scsi_add_host failed\n");
2356                 return -ENODEV;
2357         }
2358
2359         /*
2360          * Trigger SCSI to scan our drives
2361          */
2362         scsi_scan_host(host);
2363         return 0;
2364 }
2365
2366 static int
2367 megasas_set_dma_mask(struct pci_dev *pdev)
2368 {
2369         /*
2370          * All our contollers are capable of performing 64-bit DMA
2371          */
2372         if (IS_DMA64) {
2373                 if (pci_set_dma_mask(pdev, DMA_64BIT_MASK) != 0) {
2374
2375                         if (pci_set_dma_mask(pdev, DMA_32BIT_MASK) != 0)
2376                                 goto fail_set_dma_mask;
2377                 }
2378         } else {
2379                 if (pci_set_dma_mask(pdev, DMA_32BIT_MASK) != 0)
2380                         goto fail_set_dma_mask;
2381         }
2382         return 0;
2383
2384 fail_set_dma_mask:
2385         return 1;
2386 }
2387
2388 /**
2389  * megasas_probe_one -  PCI hotplug entry point
2390  * @pdev:               PCI device structure
2391  * @id:                 PCI ids of supported hotplugged adapter 
2392  */
2393 static int __devinit
2394 megasas_probe_one(struct pci_dev *pdev, const struct pci_device_id *id)
2395 {
2396         int rval;
2397         struct Scsi_Host *host;
2398         struct megasas_instance *instance;
2399
2400         /*
2401          * Announce PCI information
2402          */
2403         printk(KERN_INFO "megasas: %#4.04x:%#4.04x:%#4.04x:%#4.04x: ",
2404                pdev->vendor, pdev->device, pdev->subsystem_vendor,
2405                pdev->subsystem_device);
2406
2407         printk("bus %d:slot %d:func %d\n",
2408                pdev->bus->number, PCI_SLOT(pdev->devfn), PCI_FUNC(pdev->devfn));
2409
2410         /*
2411          * PCI prepping: enable device set bus mastering and dma mask
2412          */
2413         rval = pci_enable_device(pdev);
2414
2415         if (rval) {
2416                 return rval;
2417         }
2418
2419         pci_set_master(pdev);
2420
2421         if (megasas_set_dma_mask(pdev))
2422                 goto fail_set_dma_mask;
2423
2424         host = scsi_host_alloc(&megasas_template,
2425                                sizeof(struct megasas_instance));
2426
2427         if (!host) {
2428                 printk(KERN_DEBUG "megasas: scsi_host_alloc failed\n");
2429                 goto fail_alloc_instance;
2430         }
2431
2432         instance = (struct megasas_instance *)host->hostdata;
2433         memset(instance, 0, sizeof(*instance));
2434
2435         instance->producer = pci_alloc_consistent(pdev, sizeof(u32),
2436                                                   &instance->producer_h);
2437         instance->consumer = pci_alloc_consistent(pdev, sizeof(u32),
2438                                                   &instance->consumer_h);
2439
2440         if (!instance->producer || !instance->consumer) {
2441                 printk(KERN_DEBUG "megasas: Failed to allocate memory for "
2442                        "producer, consumer\n");
2443                 goto fail_alloc_dma_buf;
2444         }
2445
2446         *instance->producer = 0;
2447         *instance->consumer = 0;
2448
2449         instance->evt_detail = pci_alloc_consistent(pdev,
2450                                                     sizeof(struct
2451                                                            megasas_evt_detail),
2452                                                     &instance->evt_detail_h);
2453
2454         if (!instance->evt_detail) {
2455                 printk(KERN_DEBUG "megasas: Failed to allocate memory for "
2456                        "event detail structure\n");
2457                 goto fail_alloc_dma_buf;
2458         }
2459
2460         /*
2461          * Initialize locks and queues
2462          */
2463         INIT_LIST_HEAD(&instance->cmd_pool);
2464
2465         atomic_set(&instance->fw_outstanding,0);
2466
2467         init_waitqueue_head(&instance->int_cmd_wait_q);
2468         init_waitqueue_head(&instance->abort_cmd_wait_q);
2469
2470         spin_lock_init(&instance->cmd_pool_lock);
2471         spin_lock_init(&instance->completion_lock);
2472
2473         mutex_init(&instance->aen_mutex);
2474         sema_init(&instance->ioctl_sem, MEGASAS_INT_CMDS);
2475
2476         /*
2477          * Initialize PCI related and misc parameters
2478          */
2479         instance->pdev = pdev;
2480         instance->host = host;
2481         instance->unique_id = pdev->bus->number << 8 | pdev->devfn;
2482         instance->init_id = MEGASAS_DEFAULT_INIT_ID;
2483
2484         megasas_dbg_lvl = 0;
2485         instance->flag = 0;
2486         instance->last_time = 0;
2487
2488         /*
2489          * Initialize MFI Firmware
2490          */
2491         if (megasas_init_mfi(instance))
2492                 goto fail_init_mfi;
2493
2494         /*
2495          * Register IRQ
2496          */
2497         if (request_irq(pdev->irq, megasas_isr, IRQF_SHARED, "megasas", instance)) {
2498                 printk(KERN_DEBUG "megasas: Failed to register IRQ\n");
2499                 goto fail_irq;
2500         }
2501
2502         instance->instancet->enable_intr(instance->reg_set);
2503
2504         /*
2505          * Store instance in PCI softstate
2506          */
2507         pci_set_drvdata(pdev, instance);
2508
2509         /*
2510          * Add this controller to megasas_mgmt_info structure so that it
2511          * can be exported to management applications
2512          */
2513         megasas_mgmt_info.count++;
2514         megasas_mgmt_info.instance[megasas_mgmt_info.max_index] = instance;
2515         megasas_mgmt_info.max_index++;
2516
2517         /*
2518          * Initiate AEN (Asynchronous Event Notification)
2519          */
2520         if (megasas_start_aen(instance)) {
2521                 printk(KERN_DEBUG "megasas: start aen failed\n");
2522                 goto fail_start_aen;
2523         }
2524
2525         /*
2526          * Register with SCSI mid-layer
2527          */
2528         if (megasas_io_attach(instance))
2529                 goto fail_io_attach;
2530
2531         return 0;
2532
2533       fail_start_aen:
2534       fail_io_attach:
2535         megasas_mgmt_info.count--;
2536         megasas_mgmt_info.instance[megasas_mgmt_info.max_index] = NULL;
2537         megasas_mgmt_info.max_index--;
2538
2539         pci_set_drvdata(pdev, NULL);
2540         instance->instancet->disable_intr(instance->reg_set);
2541         free_irq(instance->pdev->irq, instance);
2542
2543         megasas_release_mfi(instance);
2544
2545       fail_irq:
2546       fail_init_mfi:
2547       fail_alloc_dma_buf:
2548         if (instance->evt_detail)
2549                 pci_free_consistent(pdev, sizeof(struct megasas_evt_detail),
2550                                     instance->evt_detail,
2551                                     instance->evt_detail_h);
2552
2553         if (instance->producer)
2554                 pci_free_consistent(pdev, sizeof(u32), instance->producer,
2555                                     instance->producer_h);
2556         if (instance->consumer)
2557                 pci_free_consistent(pdev, sizeof(u32), instance->consumer,
2558                                     instance->consumer_h);
2559         scsi_host_put(host);
2560
2561       fail_alloc_instance:
2562       fail_set_dma_mask:
2563         pci_disable_device(pdev);
2564
2565         return -ENODEV;
2566 }
2567
2568 /**
2569  * megasas_flush_cache -        Requests FW to flush all its caches
2570  * @instance:                   Adapter soft state
2571  */
2572 static void megasas_flush_cache(struct megasas_instance *instance)
2573 {
2574         struct megasas_cmd *cmd;
2575         struct megasas_dcmd_frame *dcmd;
2576
2577         cmd = megasas_get_cmd(instance);
2578
2579         if (!cmd)
2580                 return;
2581
2582         dcmd = &cmd->frame->dcmd;
2583
2584         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2585
2586         dcmd->cmd = MFI_CMD_DCMD;
2587         dcmd->cmd_status = 0x0;
2588         dcmd->sge_count = 0;
2589         dcmd->flags = MFI_FRAME_DIR_NONE;
2590         dcmd->timeout = 0;
2591         dcmd->data_xfer_len = 0;
2592         dcmd->opcode = MR_DCMD_CTRL_CACHE_FLUSH;
2593         dcmd->mbox.b[0] = MR_FLUSH_CTRL_CACHE | MR_FLUSH_DISK_CACHE;
2594
2595         megasas_issue_blocked_cmd(instance, cmd);
2596
2597         megasas_return_cmd(instance, cmd);
2598
2599         return;
2600 }
2601
2602 /**
2603  * megasas_shutdown_controller -        Instructs FW to shutdown the controller
2604  * @instance:                           Adapter soft state
2605  * @opcode:                             Shutdown/Hibernate
2606  */
2607 static void megasas_shutdown_controller(struct megasas_instance *instance,
2608                                         u32 opcode)
2609 {
2610         struct megasas_cmd *cmd;
2611         struct megasas_dcmd_frame *dcmd;
2612
2613         cmd = megasas_get_cmd(instance);
2614
2615         if (!cmd)
2616                 return;
2617
2618         if (instance->aen_cmd)
2619                 megasas_issue_blocked_abort_cmd(instance, instance->aen_cmd);
2620
2621         dcmd = &cmd->frame->dcmd;
2622
2623         memset(dcmd->mbox.b, 0, MFI_MBOX_SIZE);
2624
2625         dcmd->cmd = MFI_CMD_DCMD;
2626         dcmd->cmd_status = 0x0;
2627         dcmd->sge_count = 0;
2628         dcmd->flags = MFI_FRAME_DIR_NONE;
2629         dcmd->timeout = 0;
2630         dcmd->data_xfer_len = 0;
2631         dcmd->opcode = opcode;
2632
2633         megasas_issue_blocked_cmd(instance, cmd);
2634
2635         megasas_return_cmd(instance, cmd);
2636
2637         return;
2638 }
2639
2640 /**
2641  * megasas_suspend -    driver suspend entry point
2642  * @pdev:               PCI device structure
2643  * @state:              PCI power state to suspend routine
2644  */
2645 static int __devinit
2646 megasas_suspend(struct pci_dev *pdev, pm_message_t state)
2647 {
2648         struct Scsi_Host *host;
2649         struct megasas_instance *instance;
2650
2651         instance = pci_get_drvdata(pdev);
2652         host = instance->host;
2653
2654         if (poll_mode_io)
2655                 del_timer_sync(&instance->io_completion_timer);
2656
2657         megasas_flush_cache(instance);
2658         megasas_shutdown_controller(instance, MR_DCMD_HIBERNATE_SHUTDOWN);
2659         tasklet_kill(&instance->isr_tasklet);
2660
2661         pci_set_drvdata(instance->pdev, instance);
2662         instance->instancet->disable_intr(instance->reg_set);
2663         free_irq(instance->pdev->irq, instance);
2664
2665         pci_save_state(pdev);
2666         pci_disable_device(pdev);
2667
2668         pci_set_power_state(pdev, pci_choose_state(pdev, state));
2669
2670         return 0;
2671 }
2672
2673 /**
2674  * megasas_resume-      driver resume entry point
2675  * @pdev:               PCI device structure
2676  */
2677 static int __devinit
2678 megasas_resume(struct pci_dev *pdev)
2679 {
2680         int rval;
2681         struct Scsi_Host *host;
2682         struct megasas_instance *instance;
2683
2684         instance = pci_get_drvdata(pdev);
2685         host = instance->host;
2686         pci_set_power_state(pdev, PCI_D0);
2687         pci_enable_wake(pdev, PCI_D0, 0);
2688         pci_restore_state(pdev);
2689
2690         /*
2691          * PCI prepping: enable device set bus mastering and dma mask
2692          */
2693         rval = pci_enable_device(pdev);
2694
2695         if (rval) {
2696                 printk(KERN_ERR "megasas: Enable device failed\n");
2697                 return rval;
2698         }
2699
2700         pci_set_master(pdev);
2701
2702         if (megasas_set_dma_mask(pdev))
2703                 goto fail_set_dma_mask;
2704
2705         /*
2706          * Initialize MFI Firmware
2707          */
2708
2709         *instance->producer = 0;
2710         *instance->consumer = 0;
2711
2712         atomic_set(&instance->fw_outstanding, 0);
2713
2714         /*
2715          * We expect the FW state to be READY
2716          */
2717         if (megasas_transition_to_ready(instance))
2718                 goto fail_ready_state;
2719
2720         if (megasas_issue_init_mfi(instance))
2721                 goto fail_init_mfi;
2722
2723         tasklet_init(&instance->isr_tasklet, megasas_complete_cmd_dpc,
2724                         (unsigned long)instance);
2725
2726         /*
2727          * Register IRQ
2728          */
2729         if (request_irq(pdev->irq, megasas_isr, IRQF_SHARED,
2730                 "megasas", instance)) {
2731                 printk(KERN_ERR "megasas: Failed to register IRQ\n");
2732                 goto fail_irq;
2733         }
2734
2735         instance->instancet->enable_intr(instance->reg_set);
2736
2737         /*
2738          * Initiate AEN (Asynchronous Event Notification)
2739          */
2740         if (megasas_start_aen(instance))
2741                 printk(KERN_ERR "megasas: Start AEN failed\n");
2742
2743         /* Initialize the cmd completion timer */
2744         if (poll_mode_io)
2745                 megasas_start_timer(instance, &instance->io_completion_timer,
2746                                 megasas_io_completion_timer,
2747                                 MEGASAS_COMPLETION_TIMER_INTERVAL);
2748         return 0;
2749
2750 fail_irq:
2751 fail_init_mfi:
2752         if (instance->evt_detail)
2753                 pci_free_consistent(pdev, sizeof(struct megasas_evt_detail),
2754                                 instance->evt_detail,
2755                                 instance->evt_detail_h);
2756
2757         if (instance->producer)
2758                 pci_free_consistent(pdev, sizeof(u32), instance->producer,
2759                                 instance->producer_h);
2760         if (instance->consumer)
2761                 pci_free_consistent(pdev, sizeof(u32), instance->consumer,
2762                                 instance->consumer_h);
2763         scsi_host_put(host);
2764
2765 fail_set_dma_mask:
2766 fail_ready_state:
2767
2768         pci_disable_device(pdev);
2769
2770         return -ENODEV;
2771 }
2772
2773 /**
2774  * megasas_detach_one - PCI hot"un"plug entry point
2775  * @pdev:               PCI device structure
2776  */
2777 static void megasas_detach_one(struct pci_dev *pdev)
2778 {
2779         int i;
2780         struct Scsi_Host *host;
2781         struct megasas_instance *instance;
2782
2783         instance = pci_get_drvdata(pdev);
2784         host = instance->host;
2785
2786         if (poll_mode_io)
2787                 del_timer_sync(&instance->io_completion_timer);
2788
2789         scsi_remove_host(instance->host);
2790         megasas_flush_cache(instance);
2791         megasas_shutdown_controller(instance, MR_DCMD_CTRL_SHUTDOWN);
2792         tasklet_kill(&instance->isr_tasklet);
2793
2794         /*
2795          * Take the instance off the instance array. Note that we will not
2796          * decrement the max_index. We let this array be sparse array
2797          */
2798         for (i = 0; i < megasas_mgmt_info.max_index; i++) {
2799                 if (megasas_mgmt_info.instance[i] == instance) {
2800                         megasas_mgmt_info.count--;
2801                         megasas_mgmt_info.instance[i] = NULL;
2802
2803                         break;
2804                 }
2805         }
2806
2807         pci_set_drvdata(instance->pdev, NULL);
2808
2809         instance->instancet->disable_intr(instance->reg_set);
2810
2811         free_irq(instance->pdev->irq, instance);
2812
2813         megasas_release_mfi(instance);
2814
2815         pci_free_consistent(pdev, sizeof(struct megasas_evt_detail),
2816                             instance->evt_detail, instance->evt_detail_h);
2817
2818         pci_free_consistent(pdev, sizeof(u32), instance->producer,
2819                             instance->producer_h);
2820
2821         pci_free_consistent(pdev, sizeof(u32), instance->consumer,
2822                             instance->consumer_h);
2823
2824         scsi_host_put(host);
2825
2826         pci_set_drvdata(pdev, NULL);
2827
2828         pci_disable_device(pdev);
2829
2830         return;
2831 }
2832
2833 /**
2834  * megasas_shutdown -   Shutdown entry point
2835  * @device:             Generic device structure
2836  */
2837 static void megasas_shutdown(struct pci_dev *pdev)
2838 {
2839         struct megasas_instance *instance = pci_get_drvdata(pdev);
2840         megasas_flush_cache(instance);
2841 }
2842
2843 /**
2844  * megasas_mgmt_open -  char node "open" entry point
2845  */
2846 static int megasas_mgmt_open(struct inode *inode, struct file *filep)
2847 {
2848         /*
2849          * Allow only those users with admin rights
2850          */
2851         if (!capable(CAP_SYS_ADMIN))
2852                 return -EACCES;
2853
2854         return 0;
2855 }
2856
2857 /**
2858  * megasas_mgmt_release - char node "release" entry point
2859  */
2860 static int megasas_mgmt_release(struct inode *inode, struct file *filep)
2861 {
2862         filep->private_data = NULL;
2863         fasync_helper(-1, filep, 0, &megasas_async_queue);
2864
2865         return 0;
2866 }
2867
2868 /**
2869  * megasas_mgmt_fasync -        Async notifier registration from applications
2870  *
2871  * This function adds the calling process to a driver global queue. When an
2872  * event occurs, SIGIO will be sent to all processes in this queue.
2873  */
2874 static int megasas_mgmt_fasync(int fd, struct file *filep, int mode)
2875 {
2876         int rc;
2877
2878         mutex_lock(&megasas_async_queue_mutex);
2879
2880         rc = fasync_helper(fd, filep, mode, &megasas_async_queue);
2881
2882         mutex_unlock(&megasas_async_queue_mutex);
2883
2884         if (rc >= 0) {
2885                 /* For sanity check when we get ioctl */
2886                 filep->private_data = filep;
2887                 return 0;
2888         }
2889
2890         printk(KERN_DEBUG "megasas: fasync_helper failed [%d]\n", rc);
2891
2892         return rc;
2893 }
2894
2895 /**
2896  * megasas_mgmt_fw_ioctl -      Issues management ioctls to FW
2897  * @instance:                   Adapter soft state
2898  * @argp:                       User's ioctl packet
2899  */
2900 static int
2901 megasas_mgmt_fw_ioctl(struct megasas_instance *instance,
2902                       struct megasas_iocpacket __user * user_ioc,
2903                       struct megasas_iocpacket *ioc)
2904 {
2905         struct megasas_sge32 *kern_sge32;
2906         struct megasas_cmd *cmd;
2907         void *kbuff_arr[MAX_IOCTL_SGE];
2908         dma_addr_t buf_handle = 0;
2909         int error = 0, i;
2910         void *sense = NULL;
2911         dma_addr_t sense_handle;
2912         u32 *sense_ptr;
2913         unsigned long *sense_buff;
2914
2915         memset(kbuff_arr, 0, sizeof(kbuff_arr));
2916
2917         if (ioc->sge_count > MAX_IOCTL_SGE) {
2918                 printk(KERN_DEBUG "megasas: SGE count [%d] >  max limit [%d]\n",
2919                        ioc->sge_count, MAX_IOCTL_SGE);
2920                 return -EINVAL;
2921         }
2922
2923         cmd = megasas_get_cmd(instance);
2924         if (!cmd) {
2925                 printk(KERN_DEBUG "megasas: Failed to get a cmd packet\n");
2926                 return -ENOMEM;
2927         }
2928
2929         /*
2930          * User's IOCTL packet has 2 frames (maximum). Copy those two
2931          * frames into our cmd's frames. cmd->frame's context will get
2932          * overwritten when we copy from user's frames. So set that value
2933          * alone separately
2934          */
2935         memcpy(cmd->frame, ioc->frame.raw, 2 * MEGAMFI_FRAME_SIZE);
2936         cmd->frame->hdr.context = cmd->index;
2937
2938         /*
2939          * The management interface between applications and the fw uses
2940          * MFI frames. E.g, RAID configuration changes, LD property changes
2941          * etc are accomplishes through different kinds of MFI frames. The
2942          * driver needs to care only about substituting user buffers with
2943          * kernel buffers in SGLs. The location of SGL is embedded in the
2944          * struct iocpacket itself.
2945          */
2946         kern_sge32 = (struct megasas_sge32 *)
2947             ((unsigned long)cmd->frame + ioc->sgl_off);
2948
2949         /*
2950          * For each user buffer, create a mirror buffer and copy in
2951          */
2952         for (i = 0; i < ioc->sge_count; i++) {
2953                 kbuff_arr[i] = dma_alloc_coherent(&instance->pdev->dev,
2954                                                     ioc->sgl[i].iov_len,
2955                                                     &buf_handle, GFP_KERNEL);
2956                 if (!kbuff_arr[i]) {
2957                         printk(KERN_DEBUG "megasas: Failed to alloc "
2958                                "kernel SGL buffer for IOCTL \n");
2959                         error = -ENOMEM;
2960                         goto out;
2961                 }
2962
2963                 /*
2964                  * We don't change the dma_coherent_mask, so
2965                  * pci_alloc_consistent only returns 32bit addresses
2966                  */
2967                 kern_sge32[i].phys_addr = (u32) buf_handle;
2968                 kern_sge32[i].length = ioc->sgl[i].iov_len;
2969
2970                 /*
2971                  * We created a kernel buffer corresponding to the
2972                  * user buffer. Now copy in from the user buffer
2973                  */
2974                 if (copy_from_user(kbuff_arr[i], ioc->sgl[i].iov_base,
2975                                    (u32) (ioc->sgl[i].iov_len))) {
2976                         error = -EFAULT;
2977                         goto out;
2978                 }
2979         }
2980
2981         if (ioc->sense_len) {
2982                 sense = dma_alloc_coherent(&instance->pdev->dev, ioc->sense_len,
2983                                              &sense_handle, GFP_KERNEL);
2984                 if (!sense) {
2985                         error = -ENOMEM;
2986                         goto out;
2987                 }
2988
2989                 sense_ptr =
2990                     (u32 *) ((unsigned long)cmd->frame + ioc->sense_off);
2991                 *sense_ptr = sense_handle;
2992         }
2993
2994         /*
2995          * Set the sync_cmd flag so that the ISR knows not to complete this
2996          * cmd to the SCSI mid-layer
2997          */
2998         cmd->sync_cmd = 1;
2999         megasas_issue_blocked_cmd(instance, cmd);
3000         cmd->sync_cmd = 0;
3001
3002         /*
3003          * copy out the kernel buffers to user buffers
3004          */
3005         for (i = 0; i < ioc->sge_count; i++) {
3006                 if (copy_to_user(ioc->sgl[i].iov_base, kbuff_arr[i],
3007                                  ioc->sgl[i].iov_len)) {
3008                         error = -EFAULT;
3009                         goto out;
3010                 }
3011         }
3012
3013         /*
3014          * copy out the sense
3015          */
3016         if (ioc->sense_len) {
3017                 /*
3018                  * sense_buff points to the location that has the user
3019                  * sense buffer address
3020                  */
3021                 sense_buff = (unsigned long *) ((unsigned long)ioc->frame.raw +
3022                                                                 ioc->sense_off);
3023
3024                 if (copy_to_user((void __user *)(unsigned long)(*sense_buff),
3025                                 sense, ioc->sense_len)) {
3026                         printk(KERN_ERR "megasas: Failed to copy out to user "
3027                                         "sense data\n");
3028                         error = -EFAULT;
3029                         goto out;
3030                 }
3031         }
3032
3033         /*
3034          * copy the status codes returned by the fw
3035          */
3036         if (copy_to_user(&user_ioc->frame.hdr.cmd_status,
3037                          &cmd->frame->hdr.cmd_status, sizeof(u8))) {
3038                 printk(KERN_DEBUG "megasas: Error copying out cmd_status\n");
3039                 error = -EFAULT;
3040         }
3041
3042       out:
3043         if (sense) {
3044                 dma_free_coherent(&instance->pdev->dev, ioc->sense_len,
3045                                     sense, sense_handle);
3046         }
3047
3048         for (i = 0; i < ioc->sge_count && kbuff_arr[i]; i++) {
3049                 dma_free_coherent(&instance->pdev->dev,
3050                                     kern_sge32[i].length,
3051                                     kbuff_arr[i], kern_sge32[i].phys_addr);
3052         }
3053
3054         megasas_return_cmd(instance, cmd);
3055         return error;
3056 }
3057
3058 static struct megasas_instance *megasas_lookup_instance(u16 host_no)
3059 {
3060         int i;
3061
3062         for (i = 0; i < megasas_mgmt_info.max_index; i++) {
3063
3064                 if ((megasas_mgmt_info.instance[i]) &&
3065                     (megasas_mgmt_info.instance[i]->host->host_no == host_no))
3066                         return megasas_mgmt_info.instance[i];
3067         }
3068
3069         return NULL;
3070 }
3071
3072 static int megasas_mgmt_ioctl_fw(struct file *file, unsigned long arg)
3073 {
3074         struct megasas_iocpacket __user *user_ioc =
3075             (struct megasas_iocpacket __user *)arg;
3076         struct megasas_iocpacket *ioc;
3077         struct megasas_instance *instance;
3078         int error;
3079
3080         ioc = kmalloc(sizeof(*ioc), GFP_KERNEL);
3081         if (!ioc)
3082                 return -ENOMEM;
3083
3084         if (copy_from_user(ioc, user_ioc, sizeof(*ioc))) {
3085                 error = -EFAULT;
3086                 goto out_kfree_ioc;
3087         }
3088
3089         instance = megasas_lookup_instance(ioc->host_no);
3090         if (!instance) {
3091                 error = -ENODEV;
3092                 goto out_kfree_ioc;
3093         }
3094
3095         /*
3096          * We will allow only MEGASAS_INT_CMDS number of parallel ioctl cmds
3097          */
3098         if (down_interruptible(&instance->ioctl_sem)) {
3099                 error = -ERESTARTSYS;
3100                 goto out_kfree_ioc;
3101         }
3102         error = megasas_mgmt_fw_ioctl(instance, user_ioc, ioc);
3103         up(&instance->ioctl_sem);
3104
3105       out_kfree_ioc:
3106         kfree(ioc);
3107         return error;
3108 }
3109
3110 static int megasas_mgmt_ioctl_aen(struct file *file, unsigned long arg)
3111 {
3112         struct megasas_instance *instance;
3113         struct megasas_aen aen;
3114         int error;
3115
3116         if (file->private_data != file) {
3117                 printk(KERN_DEBUG "megasas: fasync_helper was not "
3118                        "called first\n");
3119                 return -EINVAL;
3120         }
3121
3122         if (copy_from_user(&aen, (void __user *)arg, sizeof(aen)))
3123                 return -EFAULT;
3124
3125         instance = megasas_lookup_instance(aen.host_no);
3126
3127         if (!instance)
3128                 return -ENODEV;
3129
3130         mutex_lock(&instance->aen_mutex);
3131         error = megasas_register_aen(instance, aen.seq_num,
3132                                      aen.class_locale_word);
3133         mutex_unlock(&instance->aen_mutex);
3134         return error;
3135 }
3136
3137 /**
3138  * megasas_mgmt_ioctl - char node ioctl entry point
3139  */
3140 static long
3141 megasas_mgmt_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
3142 {
3143         switch (cmd) {
3144         case MEGASAS_IOC_FIRMWARE:
3145                 return megasas_mgmt_ioctl_fw(file, arg);
3146
3147         case MEGASAS_IOC_GET_AEN:
3148                 return megasas_mgmt_ioctl_aen(file, arg);
3149         }
3150
3151         return -ENOTTY;
3152 }
3153
3154 #ifdef CONFIG_COMPAT
3155 static int megasas_mgmt_compat_ioctl_fw(struct file *file, unsigned long arg)
3156 {
3157         struct compat_megasas_iocpacket __user *cioc =
3158             (struct compat_megasas_iocpacket __user *)arg;
3159         struct megasas_iocpacket __user *ioc =
3160             compat_alloc_user_space(sizeof(struct megasas_iocpacket));
3161         int i;
3162         int error = 0;
3163
3164         if (clear_user(ioc, sizeof(*ioc)))
3165                 return -EFAULT;
3166
3167         if (copy_in_user(&ioc->host_no, &cioc->host_no, sizeof(u16)) ||
3168             copy_in_user(&ioc->sgl_off, &cioc->sgl_off, sizeof(u32)) ||
3169             copy_in_user(&ioc->sense_off, &cioc->sense_off, sizeof(u32)) ||
3170             copy_in_user(&ioc->sense_len, &cioc->sense_len, sizeof(u32)) ||
3171             copy_in_user(ioc->frame.raw, cioc->frame.raw, 128) ||
3172             copy_in_user(&ioc->sge_count, &cioc->sge_count, sizeof(u32)))
3173                 return -EFAULT;
3174
3175         for (i = 0; i < MAX_IOCTL_SGE; i++) {
3176                 compat_uptr_t ptr;
3177
3178                 if (get_user(ptr, &cioc->sgl[i].iov_base) ||
3179                     put_user(compat_ptr(ptr), &ioc->sgl[i].iov_base) ||
3180                     copy_in_user(&ioc->sgl[i].iov_len,
3181                                  &cioc->sgl[i].iov_len, sizeof(compat_size_t)))
3182                         return -EFAULT;
3183         }
3184
3185         error = megasas_mgmt_ioctl_fw(file, (unsigned long)ioc);
3186
3187         if (copy_in_user(&cioc->frame.hdr.cmd_status,
3188                          &ioc->frame.hdr.cmd_status, sizeof(u8))) {
3189                 printk(KERN_DEBUG "megasas: error copy_in_user cmd_status\n");
3190                 return -EFAULT;
3191         }
3192         return error;
3193 }
3194
3195 static long
3196 megasas_mgmt_compat_ioctl(struct file *file, unsigned int cmd,
3197                           unsigned long arg)
3198 {
3199         switch (cmd) {
3200         case MEGASAS_IOC_FIRMWARE32:
3201                 return megasas_mgmt_compat_ioctl_fw(file, arg);
3202         case MEGASAS_IOC_GET_AEN:
3203                 return megasas_mgmt_ioctl_aen(file, arg);
3204         }
3205
3206         return -ENOTTY;
3207 }
3208 #endif
3209
3210 /*
3211  * File operations structure for management interface
3212  */
3213 static const struct file_operations megasas_mgmt_fops = {
3214         .owner = THIS_MODULE,
3215         .open = megasas_mgmt_open,
3216         .release = megasas_mgmt_release,
3217         .fasync = megasas_mgmt_fasync,
3218         .unlocked_ioctl = megasas_mgmt_ioctl,
3219 #ifdef CONFIG_COMPAT
3220         .compat_ioctl = megasas_mgmt_compat_ioctl,
3221 #endif
3222 };
3223
3224 /*
3225  * PCI hotplug support registration structure
3226  */
3227 static struct pci_driver megasas_pci_driver = {
3228
3229         .name = "megaraid_sas",
3230         .id_table = megasas_pci_table,
3231         .probe = megasas_probe_one,
3232         .remove = __devexit_p(megasas_detach_one),
3233         .suspend = megasas_suspend,
3234         .resume = megasas_resume,
3235         .shutdown = megasas_shutdown,
3236 };
3237
3238 /*
3239  * Sysfs driver attributes
3240  */
3241 static ssize_t megasas_sysfs_show_version(struct device_driver *dd, char *buf)
3242 {
3243         return snprintf(buf, strlen(MEGASAS_VERSION) + 2, "%s\n",
3244                         MEGASAS_VERSION);
3245 }
3246
3247 static DRIVER_ATTR(version, S_IRUGO, megasas_sysfs_show_version, NULL);
3248
3249 static ssize_t
3250 megasas_sysfs_show_release_date(struct device_driver *dd, char *buf)
3251 {
3252         return snprintf(buf, strlen(MEGASAS_RELDATE) + 2, "%s\n",
3253                         MEGASAS_RELDATE);
3254 }
3255
3256 static DRIVER_ATTR(release_date, S_IRUGO, megasas_sysfs_show_release_date,
3257                    NULL);
3258
3259 static ssize_t
3260 megasas_sysfs_show_dbg_lvl(struct device_driver *dd, char *buf)
3261 {
3262         return sprintf(buf, "%u\n", megasas_dbg_lvl);
3263 }
3264
3265 static ssize_t
3266 megasas_sysfs_set_dbg_lvl(struct device_driver *dd, const char *buf, size_t count)
3267 {
3268         int retval = count;
3269         if(sscanf(buf,"%u",&megasas_dbg_lvl)<1){
3270                 printk(KERN_ERR "megasas: could not set dbg_lvl\n");
3271                 retval = -EINVAL;
3272         }
3273         return retval;
3274 }
3275
3276 static DRIVER_ATTR(dbg_lvl, S_IRUGO|S_IWUGO, megasas_sysfs_show_dbg_lvl,
3277                 megasas_sysfs_set_dbg_lvl);
3278
3279 static ssize_t
3280 megasas_sysfs_show_poll_mode_io(struct device_driver *dd, char *buf)
3281 {
3282         return sprintf(buf, "%u\n", poll_mode_io);
3283 }
3284
3285 static ssize_t
3286 megasas_sysfs_set_poll_mode_io(struct device_driver *dd,
3287                                 const char *buf, size_t count)
3288 {
3289         int retval = count;
3290         int tmp = poll_mode_io;
3291         int i;
3292         struct megasas_instance *instance;
3293
3294         if (sscanf(buf, "%u", &poll_mode_io) < 1) {
3295                 printk(KERN_ERR "megasas: could not set poll_mode_io\n");
3296                 retval = -EINVAL;
3297         }
3298
3299         /*
3300          * Check if poll_mode_io is already set or is same as previous value
3301          */
3302         if ((tmp && poll_mode_io) || (tmp == poll_mode_io))
3303                 goto out;
3304
3305         if (poll_mode_io) {
3306                 /*
3307                  * Start timers for all adapters
3308                  */
3309                 for (i = 0; i < megasas_mgmt_info.max_index; i++) {
3310                         instance = megasas_mgmt_info.instance[i];
3311                         if (instance) {
3312                                 megasas_start_timer(instance,
3313                                         &instance->io_completion_timer,
3314                                         megasas_io_completion_timer,
3315                                         MEGASAS_COMPLETION_TIMER_INTERVAL);
3316                         }
3317                 }
3318         } else {
3319                 /*
3320                  * Delete timers for all adapters
3321                  */
3322                 for (i = 0; i < megasas_mgmt_info.max_index; i++) {
3323                         instance = megasas_mgmt_info.instance[i];
3324                         if (instance)
3325                                 del_timer_sync(&instance->io_completion_timer);
3326                 }
3327         }
3328
3329 out:
3330         return retval;
3331 }
3332
3333 static DRIVER_ATTR(poll_mode_io, S_IRUGO|S_IWUGO,
3334                 megasas_sysfs_show_poll_mode_io,
3335                 megasas_sysfs_set_poll_mode_io);
3336
3337 /**
3338  * megasas_init - Driver load entry point
3339  */
3340 static int __init megasas_init(void)
3341 {
3342         int rval;
3343
3344         /*
3345          * Announce driver version and other information
3346          */
3347         printk(KERN_INFO "megasas: %s %s\n", MEGASAS_VERSION,
3348                MEGASAS_EXT_VERSION);
3349
3350         memset(&megasas_mgmt_info, 0, sizeof(megasas_mgmt_info));
3351
3352         /*
3353          * Register character device node
3354          */
3355         rval = register_chrdev(0, "megaraid_sas_ioctl", &megasas_mgmt_fops);
3356
3357         if (rval < 0) {
3358                 printk(KERN_DEBUG "megasas: failed to open device node\n");
3359                 return rval;
3360         }
3361
3362         megasas_mgmt_majorno = rval;
3363
3364         /*
3365          * Register ourselves as PCI hotplug module
3366          */
3367         rval = pci_register_driver(&megasas_pci_driver);
3368
3369         if (rval) {
3370                 printk(KERN_DEBUG "megasas: PCI hotplug regisration failed \n");
3371                 goto err_pcidrv;
3372         }
3373
3374         rval = driver_create_file(&megasas_pci_driver.driver,
3375                                   &driver_attr_version);
3376         if (rval)
3377                 goto err_dcf_attr_ver;
3378         rval = driver_create_file(&megasas_pci_driver.driver,
3379                                   &driver_attr_release_date);
3380         if (rval)
3381                 goto err_dcf_rel_date;
3382         rval = driver_create_file(&megasas_pci_driver.driver,
3383                                   &driver_attr_dbg_lvl);
3384         if (rval)
3385                 goto err_dcf_dbg_lvl;
3386         rval = driver_create_file(&megasas_pci_driver.driver,
3387                                   &driver_attr_poll_mode_io);
3388         if (rval)
3389                 goto err_dcf_poll_mode_io;
3390
3391         return rval;
3392
3393 err_dcf_poll_mode_io:
3394         driver_remove_file(&megasas_pci_driver.driver,
3395                            &driver_attr_dbg_lvl);
3396 err_dcf_dbg_lvl:
3397         driver_remove_file(&megasas_pci_driver.driver,
3398                            &driver_attr_release_date);
3399 err_dcf_rel_date:
3400         driver_remove_file(&megasas_pci_driver.driver, &driver_attr_version);
3401 err_dcf_attr_ver:
3402         pci_unregister_driver(&megasas_pci_driver);
3403 err_pcidrv:
3404         unregister_chrdev(megasas_mgmt_majorno, "megaraid_sas_ioctl");
3405         return rval;
3406 }
3407
3408 /**
3409  * megasas_exit - Driver unload entry point
3410  */
3411 static void __exit megasas_exit(void)
3412 {
3413         driver_remove_file(&megasas_pci_driver.driver,
3414                            &driver_attr_poll_mode_io);
3415         driver_remove_file(&megasas_pci_driver.driver,
3416                            &driver_attr_dbg_lvl);
3417         driver_remove_file(&megasas_pci_driver.driver,
3418                            &driver_attr_release_date);
3419         driver_remove_file(&megasas_pci_driver.driver, &driver_attr_version);
3420
3421         pci_unregister_driver(&megasas_pci_driver);
3422         unregister_chrdev(megasas_mgmt_majorno, "megaraid_sas_ioctl");
3423 }
3424
3425 module_init(megasas_init);
3426 module_exit(megasas_exit);