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