?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
ARM: dts: imx6ul-pico-hobbit: Do not hardcode the memory size
[linux/fpc-iii.git] / drivers / scsi / 3w-sas.c
blobcf9f2a09b47d9e327457248e986adacf8e530949
1 /*
2 3w-sas.c -- LSI 3ware SAS/SATA-RAID Controller device driver for Linux.
3
4 Written By: Adam Radford <aradford@gmail.com>
5
6 Copyright (C) 2009 LSI Corporation.
7
8 This program is free software; you can redistribute it and/or modify
9 it under the terms of the GNU General Public License as published by
10 the Free Software Foundation; version 2 of the License.
11
12 This program is distributed in the hope that it will be useful,
13 but WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 GNU General Public License for more details.
16
17 NO WARRANTY
18 THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
19 CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
20 LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
21 MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
22 solely responsible for determining the appropriateness of using and
23 distributing the Program and assumes all risks associated with its
24 exercise of rights under this Agreement, including but not limited to
25 the risks and costs of program errors, damage to or loss of data,
26 programs or equipment, and unavailability or interruption of operations.
27
28 DISCLAIMER OF LIABILITY
29 NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
30 DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
31 DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
32 ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
33 TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
34 USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
35 HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
36
37 You should have received a copy of the GNU General Public License
38 along with this program; if not, write to the Free Software
39 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
40
41 Controllers supported by this driver:
42
43 LSI 3ware 9750 6Gb/s SAS/SATA-RAID
44
45 Bugs/Comments/Suggestions should be mailed to:
46 aradford@gmail.com
47
48 History
49 -------
50 3.26.02.000 - Initial driver release.
51 */
52
53 #include <linux/module.h>
54 #include <linux/reboot.h>
55 #include <linux/spinlock.h>
56 #include <linux/interrupt.h>
57 #include <linux/moduleparam.h>
58 #include <linux/errno.h>
59 #include <linux/types.h>
60 #include <linux/delay.h>
61 #include <linux/pci.h>
62 #include <linux/time.h>
63 #include <linux/mutex.h>
64 #include <linux/slab.h>
65 #include <asm/io.h>
66 #include <asm/irq.h>
67 #include <linux/uaccess.h>
68 #include <scsi/scsi.h>
69 #include <scsi/scsi_host.h>
70 #include <scsi/scsi_tcq.h>
71 #include <scsi/scsi_cmnd.h>
72 #include "3w-sas.h"
73
74 /* Globals */
75 #define TW_DRIVER_VERSION "3.26.02.000"
76 static DEFINE_MUTEX(twl_chrdev_mutex);
77 static TW_Device_Extension *twl_device_extension_list[TW_MAX_SLOT];
78 static unsigned int twl_device_extension_count;
79 static int twl_major = -1;
80 extern struct timezone sys_tz;
81
82 /* Module parameters */
83 MODULE_AUTHOR ("LSI");
84 MODULE_DESCRIPTION ("LSI 3ware SAS/SATA-RAID Linux Driver");
85 MODULE_LICENSE("GPL");
86 MODULE_VERSION(TW_DRIVER_VERSION);
87
88 static int use_msi;
89 module_param(use_msi, int, S_IRUGO);
90 MODULE_PARM_DESC(use_msi, "Use Message Signaled Interrupts. Default: 0");
91
92 /* Function prototypes */
93 static int twl_reset_device_extension(TW_Device_Extension *tw_dev, int ioctl_reset);
94
95 /* Functions */
96
97 /* This function returns AENs through sysfs */
98 static ssize_t twl_sysfs_aen_read(struct file *filp, struct kobject *kobj,
99 struct bin_attribute *bin_attr,
100 char *outbuf, loff_t offset, size_t count)
101 {
102 struct device *dev = container_of(kobj, struct device, kobj);
103 struct Scsi_Host *shost = class_to_shost(dev);
104 TW_Device_Extension *tw_dev = (TW_Device_Extension *)shost->hostdata;
105 unsigned long flags = 0;
106 ssize_t ret;
107
108 if (!capable(CAP_SYS_ADMIN))
109 return -EACCES;
110
111 spin_lock_irqsave(tw_dev->host->host_lock, flags);
112 ret = memory_read_from_buffer(outbuf, count, &offset, tw_dev->event_queue[0], sizeof(TW_Event) * TW_Q_LENGTH);
113 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
114
115 return ret;
116 } /* End twl_sysfs_aen_read() */
117
118 /* aen_read sysfs attribute initializer */
119 static struct bin_attribute twl_sysfs_aen_read_attr = {
120 .attr = {
121 .name = "3ware_aen_read",
122 .mode = S_IRUSR,
123 },
124 .size = 0,
125 .read = twl_sysfs_aen_read
126 };
127
128 /* This function returns driver compatibility info through sysfs */
129 static ssize_t twl_sysfs_compat_info(struct file *filp, struct kobject *kobj,
130 struct bin_attribute *bin_attr,
131 char *outbuf, loff_t offset, size_t count)
132 {
133 struct device *dev = container_of(kobj, struct device, kobj);
134 struct Scsi_Host *shost = class_to_shost(dev);
135 TW_Device_Extension *tw_dev = (TW_Device_Extension *)shost->hostdata;
136 unsigned long flags = 0;
137 ssize_t ret;
138
139 if (!capable(CAP_SYS_ADMIN))
140 return -EACCES;
141
142 spin_lock_irqsave(tw_dev->host->host_lock, flags);
143 ret = memory_read_from_buffer(outbuf, count, &offset, &tw_dev->tw_compat_info, sizeof(TW_Compatibility_Info));
144 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
145
146 return ret;
147 } /* End twl_sysfs_compat_info() */
148
149 /* compat_info sysfs attribute initializer */
150 static struct bin_attribute twl_sysfs_compat_info_attr = {
151 .attr = {
152 .name = "3ware_compat_info",
153 .mode = S_IRUSR,
154 },
155 .size = 0,
156 .read = twl_sysfs_compat_info
157 };
158
159 /* Show some statistics about the card */
160 static ssize_t twl_show_stats(struct device *dev,
161 struct device_attribute *attr, char *buf)
162 {
163 struct Scsi_Host *host = class_to_shost(dev);
164 TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
165 unsigned long flags = 0;
166 ssize_t len;
167
168 spin_lock_irqsave(tw_dev->host->host_lock, flags);
169 len = snprintf(buf, PAGE_SIZE, "3w-sas Driver version: %s\n"
170 "Current commands posted: %4d\n"
171 "Max commands posted: %4d\n"
172 "Last sgl length: %4d\n"
173 "Max sgl length: %4d\n"
174 "Last sector count: %4d\n"
175 "Max sector count: %4d\n"
176 "SCSI Host Resets: %4d\n"
177 "AEN's: %4d\n",
178 TW_DRIVER_VERSION,
179 tw_dev->posted_request_count,
180 tw_dev->max_posted_request_count,
181 tw_dev->sgl_entries,
182 tw_dev->max_sgl_entries,
183 tw_dev->sector_count,
184 tw_dev->max_sector_count,
185 tw_dev->num_resets,
186 tw_dev->aen_count);
187 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
188 return len;
189 } /* End twl_show_stats() */
190
191 /* stats sysfs attribute initializer */
192 static struct device_attribute twl_host_stats_attr = {
193 .attr = {
194 .name = "3ware_stats",
195 .mode = S_IRUGO,
196 },
197 .show = twl_show_stats
198 };
199
200 /* Host attributes initializer */
201 static struct device_attribute *twl_host_attrs[] = {
202 &twl_host_stats_attr,
203 NULL,
204 };
205
206 /* This function will look up an AEN severity string */
207 static char *twl_aen_severity_lookup(unsigned char severity_code)
208 {
209 char *retval = NULL;
210
211 if ((severity_code < (unsigned char) TW_AEN_SEVERITY_ERROR) ||
212 (severity_code > (unsigned char) TW_AEN_SEVERITY_DEBUG))
213 goto out;
214
215 retval = twl_aen_severity_table[severity_code];
216 out:
217 return retval;
218 } /* End twl_aen_severity_lookup() */
219
220 /* This function will queue an event */
221 static void twl_aen_queue_event(TW_Device_Extension *tw_dev, TW_Command_Apache_Header *header)
222 {
223 u32 local_time;
224 TW_Event *event;
225 unsigned short aen;
226 char host[16];
227 char *error_str;
228
229 tw_dev->aen_count++;
230
231 /* Fill out event info */
232 event = tw_dev->event_queue[tw_dev->error_index];
233
234 host[0] = '\0';
235 if (tw_dev->host)
236 sprintf(host, " scsi%d:", tw_dev->host->host_no);
237
238 aen = le16_to_cpu(header->status_block.error);
239 memset(event, 0, sizeof(TW_Event));
240
241 event->severity = TW_SEV_OUT(header->status_block.severity__reserved);
242 /* event->time_stamp_sec overflows in y2106 */
243 local_time = (u32)(ktime_get_real_seconds() - (sys_tz.tz_minuteswest * 60));
244 event->time_stamp_sec = local_time;
245 event->aen_code = aen;
246 event->retrieved = TW_AEN_NOT_RETRIEVED;
247 event->sequence_id = tw_dev->error_sequence_id;
248 tw_dev->error_sequence_id++;
249
250 /* Check for embedded error string */
251 error_str = &(header->err_specific_desc[strlen(header->err_specific_desc)+1]);
252
253 header->err_specific_desc[sizeof(header->err_specific_desc) - 1] = '\0';
254 event->parameter_len = strlen(header->err_specific_desc);
255 memcpy(event->parameter_data, header->err_specific_desc, event->parameter_len + 1 + strlen(error_str));
256 if (event->severity != TW_AEN_SEVERITY_DEBUG)
257 printk(KERN_WARNING "3w-sas:%s AEN: %s (0x%02X:0x%04X): %s:%s.\n",
258 host,
259 twl_aen_severity_lookup(TW_SEV_OUT(header->status_block.severity__reserved)),
260 TW_MESSAGE_SOURCE_CONTROLLER_EVENT, aen, error_str,
261 header->err_specific_desc);
262 else
263 tw_dev->aen_count--;
264
265 tw_dev->error_index = (tw_dev->error_index + 1 ) % TW_Q_LENGTH;
266 } /* End twl_aen_queue_event() */
267
268 /* This function will attempt to post a command packet to the board */
269 static int twl_post_command_packet(TW_Device_Extension *tw_dev, int request_id)
270 {
271 dma_addr_t command_que_value;
272
273 command_que_value = tw_dev->command_packet_phys[request_id];
274 command_que_value += TW_COMMAND_OFFSET;
275
276 /* First write upper 4 bytes */
277 writel((u32)((u64)command_que_value >> 32), TWL_HIBQPH_REG_ADDR(tw_dev));
278 /* Then the lower 4 bytes */
279 writel((u32)(command_que_value | TWL_PULL_MODE), TWL_HIBQPL_REG_ADDR(tw_dev));
280
281 tw_dev->state[request_id] = TW_S_POSTED;
282 tw_dev->posted_request_count++;
283 if (tw_dev->posted_request_count > tw_dev->max_posted_request_count)
284 tw_dev->max_posted_request_count = tw_dev->posted_request_count;
285
286 return 0;
287 } /* End twl_post_command_packet() */
288
289 /* This function hands scsi cdb's to the firmware */
290 static int twl_scsiop_execute_scsi(TW_Device_Extension *tw_dev, int request_id, char *cdb, int use_sg, TW_SG_Entry_ISO *sglistarg)
291 {
292 TW_Command_Full *full_command_packet;
293 TW_Command_Apache *command_packet;
294 int i, sg_count;
295 struct scsi_cmnd *srb = NULL;
296 struct scatterlist *sglist = NULL, *sg;
297 int retval = 1;
298
299 if (tw_dev->srb[request_id]) {
300 srb = tw_dev->srb[request_id];
301 if (scsi_sglist(srb))
302 sglist = scsi_sglist(srb);
303 }
304
305 /* Initialize command packet */
306 full_command_packet = tw_dev->command_packet_virt[request_id];
307 full_command_packet->header.header_desc.size_header = 128;
308 full_command_packet->header.status_block.error = 0;
309 full_command_packet->header.status_block.severity__reserved = 0;
310
311 command_packet = &full_command_packet->command.newcommand;
312 command_packet->status = 0;
313 command_packet->opcode__reserved = TW_OPRES_IN(0, TW_OP_EXECUTE_SCSI);
314
315 /* We forced 16 byte cdb use earlier */
316 if (!cdb)
317 memcpy(command_packet->cdb, srb->cmnd, TW_MAX_CDB_LEN);
318 else
319 memcpy(command_packet->cdb, cdb, TW_MAX_CDB_LEN);
320
321 if (srb) {
322 command_packet->unit = srb->device->id;
323 command_packet->request_id__lunl =
324 cpu_to_le16(TW_REQ_LUN_IN(srb->device->lun, request_id));
325 } else {
326 command_packet->request_id__lunl =
327 cpu_to_le16(TW_REQ_LUN_IN(0, request_id));
328 command_packet->unit = 0;
329 }
330
331 command_packet->sgl_offset = 16;
332
333 if (!sglistarg) {
334 /* Map sglist from scsi layer to cmd packet */
335 if (scsi_sg_count(srb)) {
336 sg_count = scsi_dma_map(srb);
337 if (sg_count <= 0)
338 goto out;
339
340 scsi_for_each_sg(srb, sg, sg_count, i) {
341 command_packet->sg_list[i].address = TW_CPU_TO_SGL(sg_dma_address(sg));
342 command_packet->sg_list[i].length = TW_CPU_TO_SGL(sg_dma_len(sg));
343 }
344 command_packet->sgl_entries__lunh = cpu_to_le16(TW_REQ_LUN_IN((srb->device->lun >> 4), scsi_sg_count(tw_dev->srb[request_id])));
345 }
346 } else {
347 /* Internal cdb post */
348 for (i = 0; i < use_sg; i++) {
349 command_packet->sg_list[i].address = TW_CPU_TO_SGL(sglistarg[i].address);
350 command_packet->sg_list[i].length = TW_CPU_TO_SGL(sglistarg[i].length);
351 }
352 command_packet->sgl_entries__lunh = cpu_to_le16(TW_REQ_LUN_IN(0, use_sg));
353 }
354
355 /* Update some stats */
356 if (srb) {
357 tw_dev->sector_count = scsi_bufflen(srb) / 512;
358 if (tw_dev->sector_count > tw_dev->max_sector_count)
359 tw_dev->max_sector_count = tw_dev->sector_count;
360 tw_dev->sgl_entries = scsi_sg_count(srb);
361 if (tw_dev->sgl_entries > tw_dev->max_sgl_entries)
362 tw_dev->max_sgl_entries = tw_dev->sgl_entries;
363 }
364
365 /* Now post the command to the board */
366 retval = twl_post_command_packet(tw_dev, request_id);
367
368 out:
369 return retval;
370 } /* End twl_scsiop_execute_scsi() */
371
372 /* This function will read the aen queue from the isr */
373 static int twl_aen_read_queue(TW_Device_Extension *tw_dev, int request_id)
374 {
375 char cdb[TW_MAX_CDB_LEN];
376 TW_SG_Entry_ISO sglist[1];
377 TW_Command_Full *full_command_packet;
378 int retval = 1;
379
380 full_command_packet = tw_dev->command_packet_virt[request_id];
381 memset(full_command_packet, 0, sizeof(TW_Command_Full));
382
383 /* Initialize cdb */
384 memset(&cdb, 0, TW_MAX_CDB_LEN);
385 cdb[0] = REQUEST_SENSE; /* opcode */
386 cdb[4] = TW_ALLOCATION_LENGTH; /* allocation length */
387
388 /* Initialize sglist */
389 memset(&sglist, 0, sizeof(TW_SG_Entry_ISO));
390 sglist[0].length = TW_SECTOR_SIZE;
391 sglist[0].address = tw_dev->generic_buffer_phys[request_id];
392
393 /* Mark internal command */
394 tw_dev->srb[request_id] = NULL;
395
396 /* Now post the command packet */
397 if (twl_scsiop_execute_scsi(tw_dev, request_id, cdb, 1, sglist)) {
398 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x2, "Post failed while reading AEN queue");
399 goto out;
400 }
401 retval = 0;
402 out:
403 return retval;
404 } /* End twl_aen_read_queue() */
405
406 /* This function will sync firmware time with the host time */
407 static void twl_aen_sync_time(TW_Device_Extension *tw_dev, int request_id)
408 {
409 u32 schedulertime;
410 TW_Command_Full *full_command_packet;
411 TW_Command *command_packet;
412 TW_Param_Apache *param;
413 time64_t local_time;
414
415 /* Fill out the command packet */
416 full_command_packet = tw_dev->command_packet_virt[request_id];
417 memset(full_command_packet, 0, sizeof(TW_Command_Full));
418 command_packet = &full_command_packet->command.oldcommand;
419 command_packet->opcode__sgloffset = TW_OPSGL_IN(2, TW_OP_SET_PARAM);
420 command_packet->request_id = request_id;
421 command_packet->byte8_offset.param.sgl[0].address = TW_CPU_TO_SGL(tw_dev->generic_buffer_phys[request_id]);
422 command_packet->byte8_offset.param.sgl[0].length = TW_CPU_TO_SGL(TW_SECTOR_SIZE);
423 command_packet->size = TW_COMMAND_SIZE;
424 command_packet->byte6_offset.parameter_count = cpu_to_le16(1);
425
426 /* Setup the param */
427 param = (TW_Param_Apache *)tw_dev->generic_buffer_virt[request_id];
428 memset(param, 0, TW_SECTOR_SIZE);
429 param->table_id = cpu_to_le16(TW_TIMEKEEP_TABLE | 0x8000); /* Controller time keep table */
430 param->parameter_id = cpu_to_le16(0x3); /* SchedulerTime */
431 param->parameter_size_bytes = cpu_to_le16(4);
432
433 /* Convert system time in UTC to local time seconds since last
434 Sunday 12:00AM */
435 local_time = (ktime_get_real_seconds() - (sys_tz.tz_minuteswest * 60));
436 div_u64_rem(local_time - (3 * 86400), 604800, &schedulertime);
437 schedulertime = cpu_to_le32(schedulertime);
438
439 memcpy(param->data, &schedulertime, sizeof(u32));
440
441 /* Mark internal command */
442 tw_dev->srb[request_id] = NULL;
443
444 /* Now post the command */
445 twl_post_command_packet(tw_dev, request_id);
446 } /* End twl_aen_sync_time() */
447
448 /* This function will assign an available request id */
449 static void twl_get_request_id(TW_Device_Extension *tw_dev, int *request_id)
450 {
451 *request_id = tw_dev->free_queue[tw_dev->free_head];
452 tw_dev->free_head = (tw_dev->free_head + 1) % TW_Q_LENGTH;
453 tw_dev->state[*request_id] = TW_S_STARTED;
454 } /* End twl_get_request_id() */
455
456 /* This function will free a request id */
457 static void twl_free_request_id(TW_Device_Extension *tw_dev, int request_id)
458 {
459 tw_dev->free_queue[tw_dev->free_tail] = request_id;
460 tw_dev->state[request_id] = TW_S_FINISHED;
461 tw_dev->free_tail = (tw_dev->free_tail + 1) % TW_Q_LENGTH;
462 } /* End twl_free_request_id() */
463
464 /* This function will complete an aen request from the isr */
465 static int twl_aen_complete(TW_Device_Extension *tw_dev, int request_id)
466 {
467 TW_Command_Full *full_command_packet;
468 TW_Command *command_packet;
469 TW_Command_Apache_Header *header;
470 unsigned short aen;
471 int retval = 1;
472
473 header = (TW_Command_Apache_Header *)tw_dev->generic_buffer_virt[request_id];
474 tw_dev->posted_request_count--;
475 aen = le16_to_cpu(header->status_block.error);
476 full_command_packet = tw_dev->command_packet_virt[request_id];
477 command_packet = &full_command_packet->command.oldcommand;
478
479 /* First check for internal completion of set param for time sync */
480 if (TW_OP_OUT(command_packet->opcode__sgloffset) == TW_OP_SET_PARAM) {
481 /* Keep reading the queue in case there are more aen's */
482 if (twl_aen_read_queue(tw_dev, request_id))
483 goto out2;
484 else {
485 retval = 0;
486 goto out;
487 }
488 }
489
490 switch (aen) {
491 case TW_AEN_QUEUE_EMPTY:
492 /* Quit reading the queue if this is the last one */
493 break;
494 case TW_AEN_SYNC_TIME_WITH_HOST:
495 twl_aen_sync_time(tw_dev, request_id);
496 retval = 0;
497 goto out;
498 default:
499 twl_aen_queue_event(tw_dev, header);
500
501 /* If there are more aen's, keep reading the queue */
502 if (twl_aen_read_queue(tw_dev, request_id))
503 goto out2;
504 else {
505 retval = 0;
506 goto out;
507 }
508 }
509 retval = 0;
510 out2:
511 tw_dev->state[request_id] = TW_S_COMPLETED;
512 twl_free_request_id(tw_dev, request_id);
513 clear_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags);
514 out:
515 return retval;
516 } /* End twl_aen_complete() */
517
518 /* This function will poll for a response */
519 static int twl_poll_response(TW_Device_Extension *tw_dev, int request_id, int seconds)
520 {
521 unsigned long before;
522 dma_addr_t mfa;
523 u32 regh, regl;
524 u32 response;
525 int retval = 1;
526 int found = 0;
527
528 before = jiffies;
529
530 while (!found) {
531 if (sizeof(dma_addr_t) > 4) {
532 regh = readl(TWL_HOBQPH_REG_ADDR(tw_dev));
533 regl = readl(TWL_HOBQPL_REG_ADDR(tw_dev));
534 mfa = ((u64)regh << 32) | regl;
535 } else
536 mfa = readl(TWL_HOBQPL_REG_ADDR(tw_dev));
537
538 response = (u32)mfa;
539
540 if (TW_RESID_OUT(response) == request_id)
541 found = 1;
542
543 if (time_after(jiffies, before + HZ * seconds))
544 goto out;
545
546 msleep(50);
547 }
548 retval = 0;
549 out:
550 return retval;
551 } /* End twl_poll_response() */
552
553 /* This function will drain the aen queue */
554 static int twl_aen_drain_queue(TW_Device_Extension *tw_dev, int no_check_reset)
555 {
556 int request_id = 0;
557 char cdb[TW_MAX_CDB_LEN];
558 TW_SG_Entry_ISO sglist[1];
559 int finished = 0, count = 0;
560 TW_Command_Full *full_command_packet;
561 TW_Command_Apache_Header *header;
562 unsigned short aen;
563 int first_reset = 0, queue = 0, retval = 1;
564
565 if (no_check_reset)
566 first_reset = 0;
567 else
568 first_reset = 1;
569
570 full_command_packet = tw_dev->command_packet_virt[request_id];
571 memset(full_command_packet, 0, sizeof(TW_Command_Full));
572
573 /* Initialize cdb */
574 memset(&cdb, 0, TW_MAX_CDB_LEN);
575 cdb[0] = REQUEST_SENSE; /* opcode */
576 cdb[4] = TW_ALLOCATION_LENGTH; /* allocation length */
577
578 /* Initialize sglist */
579 memset(&sglist, 0, sizeof(TW_SG_Entry_ISO));
580 sglist[0].length = TW_SECTOR_SIZE;
581 sglist[0].address = tw_dev->generic_buffer_phys[request_id];
582
583 /* Mark internal command */
584 tw_dev->srb[request_id] = NULL;
585
586 do {
587 /* Send command to the board */
588 if (twl_scsiop_execute_scsi(tw_dev, request_id, cdb, 1, sglist)) {
589 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x3, "Error posting request sense");
590 goto out;
591 }
592
593 /* Now poll for completion */
594 if (twl_poll_response(tw_dev, request_id, 30)) {
595 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x4, "No valid response while draining AEN queue");
596 tw_dev->posted_request_count--;
597 goto out;
598 }
599
600 tw_dev->posted_request_count--;
601 header = (TW_Command_Apache_Header *)tw_dev->generic_buffer_virt[request_id];
602 aen = le16_to_cpu(header->status_block.error);
603 queue = 0;
604 count++;
605
606 switch (aen) {
607 case TW_AEN_QUEUE_EMPTY:
608 if (first_reset != 1)
609 goto out;
610 else
611 finished = 1;
612 break;
613 case TW_AEN_SOFT_RESET:
614 if (first_reset == 0)
615 first_reset = 1;
616 else
617 queue = 1;
618 break;
619 case TW_AEN_SYNC_TIME_WITH_HOST:
620 break;
621 default:
622 queue = 1;
623 }
624
625 /* Now queue an event info */
626 if (queue)
627 twl_aen_queue_event(tw_dev, header);
628 } while ((finished == 0) && (count < TW_MAX_AEN_DRAIN));
629
630 if (count == TW_MAX_AEN_DRAIN)
631 goto out;
632
633 retval = 0;
634 out:
635 tw_dev->state[request_id] = TW_S_INITIAL;
636 return retval;
637 } /* End twl_aen_drain_queue() */
638
639 /* This function will allocate memory and check if it is correctly aligned */
640 static int twl_allocate_memory(TW_Device_Extension *tw_dev, int size, int which)
641 {
642 int i;
643 dma_addr_t dma_handle;
644 unsigned long *cpu_addr;
645 int retval = 1;
646
647 cpu_addr = pci_zalloc_consistent(tw_dev->tw_pci_dev, size * TW_Q_LENGTH,
648 &dma_handle);
649 if (!cpu_addr) {
650 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x5, "Memory allocation failed");
651 goto out;
652 }
653
654 for (i = 0; i < TW_Q_LENGTH; i++) {
655 switch(which) {
656 case 0:
657 tw_dev->command_packet_phys[i] = dma_handle+(i*size);
658 tw_dev->command_packet_virt[i] = (TW_Command_Full *)((unsigned char *)cpu_addr + (i*size));
659 break;
660 case 1:
661 tw_dev->generic_buffer_phys[i] = dma_handle+(i*size);
662 tw_dev->generic_buffer_virt[i] = (unsigned long *)((unsigned char *)cpu_addr + (i*size));
663 break;
664 case 2:
665 tw_dev->sense_buffer_phys[i] = dma_handle+(i*size);
666 tw_dev->sense_buffer_virt[i] = (TW_Command_Apache_Header *)((unsigned char *)cpu_addr + (i*size));
667 break;
668 }
669 }
670 retval = 0;
671 out:
672 return retval;
673 } /* End twl_allocate_memory() */
674
675 /* This function will load the request id and various sgls for ioctls */
676 static void twl_load_sgl(TW_Device_Extension *tw_dev, TW_Command_Full *full_command_packet, int request_id, dma_addr_t dma_handle, int length)
677 {
678 TW_Command *oldcommand;
679 TW_Command_Apache *newcommand;
680 TW_SG_Entry_ISO *sgl;
681 unsigned int pae = 0;
682
683 if ((sizeof(long) < 8) && (sizeof(dma_addr_t) > 4))
684 pae = 1;
685
686 if (TW_OP_OUT(full_command_packet->command.newcommand.opcode__reserved) == TW_OP_EXECUTE_SCSI) {
687 newcommand = &full_command_packet->command.newcommand;
688 newcommand->request_id__lunl =
689 cpu_to_le16(TW_REQ_LUN_IN(TW_LUN_OUT(newcommand->request_id__lunl), request_id));
690 if (length) {
691 newcommand->sg_list[0].address = TW_CPU_TO_SGL(dma_handle + sizeof(TW_Ioctl_Buf_Apache) - 1);
692 newcommand->sg_list[0].length = TW_CPU_TO_SGL(length);
693 }
694 newcommand->sgl_entries__lunh =
695 cpu_to_le16(TW_REQ_LUN_IN(TW_LUN_OUT(newcommand->sgl_entries__lunh), length ? 1 : 0));
696 } else {
697 oldcommand = &full_command_packet->command.oldcommand;
698 oldcommand->request_id = request_id;
699
700 if (TW_SGL_OUT(oldcommand->opcode__sgloffset)) {
701 /* Load the sg list */
702 sgl = (TW_SG_Entry_ISO *)((u32 *)oldcommand+oldcommand->size - (sizeof(TW_SG_Entry_ISO)/4) + pae + (sizeof(dma_addr_t) > 4 ? 1 : 0));
703 sgl->address = TW_CPU_TO_SGL(dma_handle + sizeof(TW_Ioctl_Buf_Apache) - 1);
704 sgl->length = TW_CPU_TO_SGL(length);
705 oldcommand->size += pae;
706 oldcommand->size += sizeof(dma_addr_t) > 4 ? 1 : 0;
707 }
708 }
709 } /* End twl_load_sgl() */
710
711 /* This function handles ioctl for the character device
712 This interface is used by smartmontools open source software */
713 static long twl_chrdev_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
714 {
715 long timeout;
716 unsigned long *cpu_addr, data_buffer_length_adjusted = 0, flags = 0;
717 dma_addr_t dma_handle;
718 int request_id = 0;
719 TW_Ioctl_Driver_Command driver_command;
720 struct inode *inode = file_inode(file);
721 TW_Ioctl_Buf_Apache *tw_ioctl;
722 TW_Command_Full *full_command_packet;
723 TW_Device_Extension *tw_dev = twl_device_extension_list[iminor(inode)];
724 int retval = -EFAULT;
725 void __user *argp = (void __user *)arg;
726
727 mutex_lock(&twl_chrdev_mutex);
728
729 /* Only let one of these through at a time */
730 if (mutex_lock_interruptible(&tw_dev->ioctl_lock)) {
731 retval = -EINTR;
732 goto out;
733 }
734
735 /* First copy down the driver command */
736 if (copy_from_user(&driver_command, argp, sizeof(TW_Ioctl_Driver_Command)))
737 goto out2;
738
739 /* Check data buffer size */
740 if (driver_command.buffer_length > TW_MAX_SECTORS * 2048) {
741 retval = -EINVAL;
742 goto out2;
743 }
744
745 /* Hardware can only do multiple of 512 byte transfers */
746 data_buffer_length_adjusted = (driver_command.buffer_length + 511) & ~511;
747
748 /* Now allocate ioctl buf memory */
749 cpu_addr = dma_alloc_coherent(&tw_dev->tw_pci_dev->dev, data_buffer_length_adjusted+sizeof(TW_Ioctl_Buf_Apache) - 1, &dma_handle, GFP_KERNEL);
750 if (!cpu_addr) {
751 retval = -ENOMEM;
752 goto out2;
753 }
754
755 tw_ioctl = (TW_Ioctl_Buf_Apache *)cpu_addr;
756
757 /* Now copy down the entire ioctl */
758 if (copy_from_user(tw_ioctl, argp, driver_command.buffer_length + sizeof(TW_Ioctl_Buf_Apache) - 1))
759 goto out3;
760
761 /* See which ioctl we are doing */
762 switch (cmd) {
763 case TW_IOCTL_FIRMWARE_PASS_THROUGH:
764 spin_lock_irqsave(tw_dev->host->host_lock, flags);
765 twl_get_request_id(tw_dev, &request_id);
766
767 /* Flag internal command */
768 tw_dev->srb[request_id] = NULL;
769
770 /* Flag chrdev ioctl */
771 tw_dev->chrdev_request_id = request_id;
772
773 full_command_packet = (TW_Command_Full *)&tw_ioctl->firmware_command;
774
775 /* Load request id and sglist for both command types */
776 twl_load_sgl(tw_dev, full_command_packet, request_id, dma_handle, data_buffer_length_adjusted);
777
778 memcpy(tw_dev->command_packet_virt[request_id], &(tw_ioctl->firmware_command), sizeof(TW_Command_Full));
779
780 /* Now post the command packet to the controller */
781 twl_post_command_packet(tw_dev, request_id);
782 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
783
784 timeout = TW_IOCTL_CHRDEV_TIMEOUT*HZ;
785
786 /* Now wait for command to complete */
787 timeout = wait_event_timeout(tw_dev->ioctl_wqueue, tw_dev->chrdev_request_id == TW_IOCTL_CHRDEV_FREE, timeout);
788
789 /* We timed out, and didn't get an interrupt */
790 if (tw_dev->chrdev_request_id != TW_IOCTL_CHRDEV_FREE) {
791 /* Now we need to reset the board */
792 printk(KERN_WARNING "3w-sas: scsi%d: WARNING: (0x%02X:0x%04X): Character ioctl (0x%x) timed out, resetting card.\n",
793 tw_dev->host->host_no, TW_DRIVER, 0x6,
794 cmd);
795 retval = -EIO;
796 twl_reset_device_extension(tw_dev, 1);
797 goto out3;
798 }
799
800 /* Now copy in the command packet response */
801 memcpy(&(tw_ioctl->firmware_command), tw_dev->command_packet_virt[request_id], sizeof(TW_Command_Full));
802
803 /* Now complete the io */
804 spin_lock_irqsave(tw_dev->host->host_lock, flags);
805 tw_dev->posted_request_count--;
806 tw_dev->state[request_id] = TW_S_COMPLETED;
807 twl_free_request_id(tw_dev, request_id);
808 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
809 break;
810 default:
811 retval = -ENOTTY;
812 goto out3;
813 }
814
815 /* Now copy the entire response to userspace */
816 if (copy_to_user(argp, tw_ioctl, sizeof(TW_Ioctl_Buf_Apache) + driver_command.buffer_length - 1) == 0)
817 retval = 0;
818 out3:
819 /* Now free ioctl buf memory */
820 dma_free_coherent(&tw_dev->tw_pci_dev->dev, data_buffer_length_adjusted+sizeof(TW_Ioctl_Buf_Apache) - 1, cpu_addr, dma_handle);
821 out2:
822 mutex_unlock(&tw_dev->ioctl_lock);
823 out:
824 mutex_unlock(&twl_chrdev_mutex);
825 return retval;
826 } /* End twl_chrdev_ioctl() */
827
828 /* This function handles open for the character device */
829 static int twl_chrdev_open(struct inode *inode, struct file *file)
830 {
831 unsigned int minor_number;
832 int retval = -ENODEV;
833
834 if (!capable(CAP_SYS_ADMIN)) {
835 retval = -EACCES;
836 goto out;
837 }
838
839 minor_number = iminor(inode);
840 if (minor_number >= twl_device_extension_count)
841 goto out;
842 retval = 0;
843 out:
844 return retval;
845 } /* End twl_chrdev_open() */
846
847 /* File operations struct for character device */
848 static const struct file_operations twl_fops = {
849 .owner = THIS_MODULE,
850 .unlocked_ioctl = twl_chrdev_ioctl,
851 .open = twl_chrdev_open,
852 .release = NULL,
853 .llseek = noop_llseek,
854 };
855
856 /* This function passes sense data from firmware to scsi layer */
857 static int twl_fill_sense(TW_Device_Extension *tw_dev, int i, int request_id, int copy_sense, int print_host)
858 {
859 TW_Command_Apache_Header *header;
860 TW_Command_Full *full_command_packet;
861 unsigned short error;
862 char *error_str;
863 int retval = 1;
864
865 header = tw_dev->sense_buffer_virt[i];
866 full_command_packet = tw_dev->command_packet_virt[request_id];
867
868 /* Get embedded firmware error string */
869 error_str = &(header->err_specific_desc[strlen(header->err_specific_desc) + 1]);
870
871 /* Don't print error for Logical unit not supported during rollcall */
872 error = le16_to_cpu(header->status_block.error);
873 if ((error != TW_ERROR_LOGICAL_UNIT_NOT_SUPPORTED) && (error != TW_ERROR_UNIT_OFFLINE) && (error != TW_ERROR_INVALID_FIELD_IN_CDB)) {
874 if (print_host)
875 printk(KERN_WARNING "3w-sas: scsi%d: ERROR: (0x%02X:0x%04X): %s:%s.\n",
876 tw_dev->host->host_no,
877 TW_MESSAGE_SOURCE_CONTROLLER_ERROR,
878 header->status_block.error,
879 error_str,
880 header->err_specific_desc);
881 else
882 printk(KERN_WARNING "3w-sas: ERROR: (0x%02X:0x%04X): %s:%s.\n",
883 TW_MESSAGE_SOURCE_CONTROLLER_ERROR,
884 header->status_block.error,
885 error_str,
886 header->err_specific_desc);
887 }
888
889 if (copy_sense) {
890 memcpy(tw_dev->srb[request_id]->sense_buffer, header->sense_data, TW_SENSE_DATA_LENGTH);
891 tw_dev->srb[request_id]->result = (full_command_packet->command.newcommand.status << 1);
892 goto out;
893 }
894 out:
895 return retval;
896 } /* End twl_fill_sense() */
897
898 /* This function will free up device extension resources */
899 static void twl_free_device_extension(TW_Device_Extension *tw_dev)
900 {
901 if (tw_dev->command_packet_virt[0])
902 pci_free_consistent(tw_dev->tw_pci_dev,
903 sizeof(TW_Command_Full)*TW_Q_LENGTH,
904 tw_dev->command_packet_virt[0],
905 tw_dev->command_packet_phys[0]);
906
907 if (tw_dev->generic_buffer_virt[0])
908 pci_free_consistent(tw_dev->tw_pci_dev,
909 TW_SECTOR_SIZE*TW_Q_LENGTH,
910 tw_dev->generic_buffer_virt[0],
911 tw_dev->generic_buffer_phys[0]);
912
913 if (tw_dev->sense_buffer_virt[0])
914 pci_free_consistent(tw_dev->tw_pci_dev,
915 sizeof(TW_Command_Apache_Header)*
916 TW_Q_LENGTH,
917 tw_dev->sense_buffer_virt[0],
918 tw_dev->sense_buffer_phys[0]);
919
920 kfree(tw_dev->event_queue[0]);
921 } /* End twl_free_device_extension() */
922
923 /* This function will get parameter table entries from the firmware */
924 static void *twl_get_param(TW_Device_Extension *tw_dev, int request_id, int table_id, int parameter_id, int parameter_size_bytes)
925 {
926 TW_Command_Full *full_command_packet;
927 TW_Command *command_packet;
928 TW_Param_Apache *param;
929 void *retval = NULL;
930
931 /* Setup the command packet */
932 full_command_packet = tw_dev->command_packet_virt[request_id];
933 memset(full_command_packet, 0, sizeof(TW_Command_Full));
934 command_packet = &full_command_packet->command.oldcommand;
935
936 command_packet->opcode__sgloffset = TW_OPSGL_IN(2, TW_OP_GET_PARAM);
937 command_packet->size = TW_COMMAND_SIZE;
938 command_packet->request_id = request_id;
939 command_packet->byte6_offset.block_count = cpu_to_le16(1);
940
941 /* Now setup the param */
942 param = (TW_Param_Apache *)tw_dev->generic_buffer_virt[request_id];
943 memset(param, 0, TW_SECTOR_SIZE);
944 param->table_id = cpu_to_le16(table_id | 0x8000);
945 param->parameter_id = cpu_to_le16(parameter_id);
946 param->parameter_size_bytes = cpu_to_le16(parameter_size_bytes);
947
948 command_packet->byte8_offset.param.sgl[0].address = TW_CPU_TO_SGL(tw_dev->generic_buffer_phys[request_id]);
949 command_packet->byte8_offset.param.sgl[0].length = TW_CPU_TO_SGL(TW_SECTOR_SIZE);
950
951 /* Post the command packet to the board */
952 twl_post_command_packet(tw_dev, request_id);
953
954 /* Poll for completion */
955 if (twl_poll_response(tw_dev, request_id, 30))
956 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x7, "No valid response during get param")
957 else
958 retval = (void *)&(param->data[0]);
959
960 tw_dev->posted_request_count--;
961 tw_dev->state[request_id] = TW_S_INITIAL;
962
963 return retval;
964 } /* End twl_get_param() */
965
966 /* This function will send an initconnection command to controller */
967 static int twl_initconnection(TW_Device_Extension *tw_dev, int message_credits,
968 u32 set_features, unsigned short current_fw_srl,
969 unsigned short current_fw_arch_id,
970 unsigned short current_fw_branch,
971 unsigned short current_fw_build,
972 unsigned short *fw_on_ctlr_srl,
973 unsigned short *fw_on_ctlr_arch_id,
974 unsigned short *fw_on_ctlr_branch,
975 unsigned short *fw_on_ctlr_build,
976 u32 *init_connect_result)
977 {
978 TW_Command_Full *full_command_packet;
979 TW_Initconnect *tw_initconnect;
980 int request_id = 0, retval = 1;
981
982 /* Initialize InitConnection command packet */
983 full_command_packet = tw_dev->command_packet_virt[request_id];
984 memset(full_command_packet, 0, sizeof(TW_Command_Full));
985 full_command_packet->header.header_desc.size_header = 128;
986
987 tw_initconnect = (TW_Initconnect *)&full_command_packet->command.oldcommand;
988 tw_initconnect->opcode__reserved = TW_OPRES_IN(0, TW_OP_INIT_CONNECTION);
989 tw_initconnect->request_id = request_id;
990 tw_initconnect->message_credits = cpu_to_le16(message_credits);
991 tw_initconnect->features = set_features;
992
993 /* Turn on 64-bit sgl support if we need to */
994 tw_initconnect->features |= sizeof(dma_addr_t) > 4 ? 1 : 0;
995
996 tw_initconnect->features = cpu_to_le32(tw_initconnect->features);
997
998 if (set_features & TW_EXTENDED_INIT_CONNECT) {
999 tw_initconnect->size = TW_INIT_COMMAND_PACKET_SIZE_EXTENDED;
1000 tw_initconnect->fw_srl = cpu_to_le16(current_fw_srl);
1001 tw_initconnect->fw_arch_id = cpu_to_le16(current_fw_arch_id);
1002 tw_initconnect->fw_branch = cpu_to_le16(current_fw_branch);
1003 tw_initconnect->fw_build = cpu_to_le16(current_fw_build);
1004 } else
1005 tw_initconnect->size = TW_INIT_COMMAND_PACKET_SIZE;
1006
1007 /* Send command packet to the board */
1008 twl_post_command_packet(tw_dev, request_id);
1009
1010 /* Poll for completion */
1011 if (twl_poll_response(tw_dev, request_id, 30)) {
1012 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x8, "No valid response during init connection");
1013 } else {
1014 if (set_features & TW_EXTENDED_INIT_CONNECT) {
1015 *fw_on_ctlr_srl = le16_to_cpu(tw_initconnect->fw_srl);
1016 *fw_on_ctlr_arch_id = le16_to_cpu(tw_initconnect->fw_arch_id);
1017 *fw_on_ctlr_branch = le16_to_cpu(tw_initconnect->fw_branch);
1018 *fw_on_ctlr_build = le16_to_cpu(tw_initconnect->fw_build);
1019 *init_connect_result = le32_to_cpu(tw_initconnect->result);
1020 }
1021 retval = 0;
1022 }
1023
1024 tw_dev->posted_request_count--;
1025 tw_dev->state[request_id] = TW_S_INITIAL;
1026
1027 return retval;
1028 } /* End twl_initconnection() */
1029
1030 /* This function will initialize the fields of a device extension */
1031 static int twl_initialize_device_extension(TW_Device_Extension *tw_dev)
1032 {
1033 int i, retval = 1;
1034
1035 /* Initialize command packet buffers */
1036 if (twl_allocate_memory(tw_dev, sizeof(TW_Command_Full), 0)) {
1037 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x9, "Command packet memory allocation failed");
1038 goto out;
1039 }
1040
1041 /* Initialize generic buffer */
1042 if (twl_allocate_memory(tw_dev, TW_SECTOR_SIZE, 1)) {
1043 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xa, "Generic memory allocation failed");
1044 goto out;
1045 }
1046
1047 /* Allocate sense buffers */
1048 if (twl_allocate_memory(tw_dev, sizeof(TW_Command_Apache_Header), 2)) {
1049 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xb, "Sense buffer allocation failed");
1050 goto out;
1051 }
1052
1053 /* Allocate event info space */
1054 tw_dev->event_queue[0] = kcalloc(TW_Q_LENGTH, sizeof(TW_Event), GFP_KERNEL);
1055 if (!tw_dev->event_queue[0]) {
1056 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xc, "Event info memory allocation failed");
1057 goto out;
1058 }
1059
1060 for (i = 0; i < TW_Q_LENGTH; i++) {
1061 tw_dev->event_queue[i] = (TW_Event *)((unsigned char *)tw_dev->event_queue[0] + (i * sizeof(TW_Event)));
1062 tw_dev->free_queue[i] = i;
1063 tw_dev->state[i] = TW_S_INITIAL;
1064 }
1065
1066 tw_dev->free_head = TW_Q_START;
1067 tw_dev->free_tail = TW_Q_START;
1068 tw_dev->error_sequence_id = 1;
1069 tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;
1070
1071 mutex_init(&tw_dev->ioctl_lock);
1072 init_waitqueue_head(&tw_dev->ioctl_wqueue);
1073
1074 retval = 0;
1075 out:
1076 return retval;
1077 } /* End twl_initialize_device_extension() */
1078
1079 /* This function will handle attention interrupts */
1080 static int twl_handle_attention_interrupt(TW_Device_Extension *tw_dev)
1081 {
1082 int retval = 1;
1083 u32 request_id, doorbell;
1084
1085 /* Read doorbell status */
1086 doorbell = readl(TWL_HOBDB_REG_ADDR(tw_dev));
1087
1088 /* Check for controller errors */
1089 if (doorbell & TWL_DOORBELL_CONTROLLER_ERROR) {
1090 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xd, "Microcontroller Error: clearing");
1091 goto out;
1092 }
1093
1094 /* Check if we need to perform an AEN drain */
1095 if (doorbell & TWL_DOORBELL_ATTENTION_INTERRUPT) {
1096 if (!(test_and_set_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags))) {
1097 twl_get_request_id(tw_dev, &request_id);
1098 if (twl_aen_read_queue(tw_dev, request_id)) {
1099 tw_dev->state[request_id] = TW_S_COMPLETED;
1100 twl_free_request_id(tw_dev, request_id);
1101 clear_bit(TW_IN_ATTENTION_LOOP, &tw_dev->flags);
1102 }
1103 }
1104 }
1105
1106 retval = 0;
1107 out:
1108 /* Clear doorbell interrupt */
1109 TWL_CLEAR_DB_INTERRUPT(tw_dev);
1110
1111 /* Make sure the clear was flushed by reading it back */
1112 readl(TWL_HOBDBC_REG_ADDR(tw_dev));
1113
1114 return retval;
1115 } /* End twl_handle_attention_interrupt() */
1116
1117 /* Interrupt service routine */
1118 static irqreturn_t twl_interrupt(int irq, void *dev_instance)
1119 {
1120 TW_Device_Extension *tw_dev = (TW_Device_Extension *)dev_instance;
1121 int i, handled = 0, error = 0;
1122 dma_addr_t mfa = 0;
1123 u32 reg, regl, regh, response, request_id = 0;
1124 struct scsi_cmnd *cmd;
1125 TW_Command_Full *full_command_packet;
1126
1127 spin_lock(tw_dev->host->host_lock);
1128
1129 /* Read host interrupt status */
1130 reg = readl(TWL_HISTAT_REG_ADDR(tw_dev));
1131
1132 /* Check if this is our interrupt, otherwise bail */
1133 if (!(reg & TWL_HISTATUS_VALID_INTERRUPT))
1134 goto twl_interrupt_bail;
1135
1136 handled = 1;
1137
1138 /* If we are resetting, bail */
1139 if (test_bit(TW_IN_RESET, &tw_dev->flags))
1140 goto twl_interrupt_bail;
1141
1142 /* Attention interrupt */
1143 if (reg & TWL_HISTATUS_ATTENTION_INTERRUPT) {
1144 if (twl_handle_attention_interrupt(tw_dev)) {
1145 TWL_MASK_INTERRUPTS(tw_dev);
1146 goto twl_interrupt_bail;
1147 }
1148 }
1149
1150 /* Response interrupt */
1151 while (reg & TWL_HISTATUS_RESPONSE_INTERRUPT) {
1152 if (sizeof(dma_addr_t) > 4) {
1153 regh = readl(TWL_HOBQPH_REG_ADDR(tw_dev));
1154 regl = readl(TWL_HOBQPL_REG_ADDR(tw_dev));
1155 mfa = ((u64)regh << 32) | regl;
1156 } else
1157 mfa = readl(TWL_HOBQPL_REG_ADDR(tw_dev));
1158
1159 error = 0;
1160 response = (u32)mfa;
1161
1162 /* Check for command packet error */
1163 if (!TW_NOTMFA_OUT(response)) {
1164 for (i=0;i<TW_Q_LENGTH;i++) {
1165 if (tw_dev->sense_buffer_phys[i] == mfa) {
1166 request_id = le16_to_cpu(tw_dev->sense_buffer_virt[i]->header_desc.request_id);
1167 if (tw_dev->srb[request_id] != NULL)
1168 error = twl_fill_sense(tw_dev, i, request_id, 1, 1);
1169 else {
1170 /* Skip ioctl error prints */
1171 if (request_id != tw_dev->chrdev_request_id)
1172 error = twl_fill_sense(tw_dev, i, request_id, 0, 1);
1173 else
1174 memcpy(tw_dev->command_packet_virt[request_id], tw_dev->sense_buffer_virt[i], sizeof(TW_Command_Apache_Header));
1175 }
1176
1177 /* Now re-post the sense buffer */
1178 writel((u32)((u64)tw_dev->sense_buffer_phys[i] >> 32), TWL_HOBQPH_REG_ADDR(tw_dev));
1179 writel((u32)tw_dev->sense_buffer_phys[i], TWL_HOBQPL_REG_ADDR(tw_dev));
1180 break;
1181 }
1182 }
1183 } else
1184 request_id = TW_RESID_OUT(response);
1185
1186 full_command_packet = tw_dev->command_packet_virt[request_id];
1187
1188 /* Check for correct state */
1189 if (tw_dev->state[request_id] != TW_S_POSTED) {
1190 if (tw_dev->srb[request_id] != NULL) {
1191 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xe, "Received a request id that wasn't posted");
1192 TWL_MASK_INTERRUPTS(tw_dev);
1193 goto twl_interrupt_bail;
1194 }
1195 }
1196
1197 /* Check for internal command completion */
1198 if (tw_dev->srb[request_id] == NULL) {
1199 if (request_id != tw_dev->chrdev_request_id) {
1200 if (twl_aen_complete(tw_dev, request_id))
1201 TW_PRINTK(tw_dev->host, TW_DRIVER, 0xf, "Error completing AEN during attention interrupt");
1202 } else {
1203 tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;
1204 wake_up(&tw_dev->ioctl_wqueue);
1205 }
1206 } else {
1207 cmd = tw_dev->srb[request_id];
1208
1209 if (!error)
1210 cmd->result = (DID_OK << 16);
1211
1212 /* Report residual bytes for single sgl */
1213 if ((scsi_sg_count(cmd) <= 1) && (full_command_packet->command.newcommand.status == 0)) {
1214 if (full_command_packet->command.newcommand.sg_list[0].length < scsi_bufflen(tw_dev->srb[request_id]))
1215 scsi_set_resid(cmd, scsi_bufflen(cmd) - full_command_packet->command.newcommand.sg_list[0].length);
1216 }
1217
1218 /* Now complete the io */
1219 scsi_dma_unmap(cmd);
1220 cmd->scsi_done(cmd);
1221 tw_dev->state[request_id] = TW_S_COMPLETED;
1222 twl_free_request_id(tw_dev, request_id);
1223 tw_dev->posted_request_count--;
1224 }
1225
1226 /* Check for another response interrupt */
1227 reg = readl(TWL_HISTAT_REG_ADDR(tw_dev));
1228 }
1229
1230 twl_interrupt_bail:
1231 spin_unlock(tw_dev->host->host_lock);
1232 return IRQ_RETVAL(handled);
1233 } /* End twl_interrupt() */
1234
1235 /* This function will poll for a register change */
1236 static int twl_poll_register(TW_Device_Extension *tw_dev, void *reg, u32 value, u32 result, int seconds)
1237 {
1238 unsigned long before;
1239 int retval = 1;
1240 u32 reg_value;
1241
1242 reg_value = readl(reg);
1243 before = jiffies;
1244
1245 while ((reg_value & value) != result) {
1246 reg_value = readl(reg);
1247 if (time_after(jiffies, before + HZ * seconds))
1248 goto out;
1249 msleep(50);
1250 }
1251 retval = 0;
1252 out:
1253 return retval;
1254 } /* End twl_poll_register() */
1255
1256 /* This function will reset a controller */
1257 static int twl_reset_sequence(TW_Device_Extension *tw_dev, int soft_reset)
1258 {
1259 int retval = 1;
1260 int i = 0;
1261 u32 status = 0;
1262 unsigned short fw_on_ctlr_srl = 0, fw_on_ctlr_arch_id = 0;
1263 unsigned short fw_on_ctlr_branch = 0, fw_on_ctlr_build = 0;
1264 u32 init_connect_result = 0;
1265 int tries = 0;
1266 int do_soft_reset = soft_reset;
1267
1268 while (tries < TW_MAX_RESET_TRIES) {
1269 /* Do a soft reset if one is needed */
1270 if (do_soft_reset) {
1271 TWL_SOFT_RESET(tw_dev);
1272
1273 /* Make sure controller is in a good state */
1274 if (twl_poll_register(tw_dev, TWL_SCRPD3_REG_ADDR(tw_dev), TWL_CONTROLLER_READY, 0x0, 30)) {
1275 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x10, "Controller never went non-ready during reset sequence");
1276 tries++;
1277 continue;
1278 }
1279 if (twl_poll_register(tw_dev, TWL_SCRPD3_REG_ADDR(tw_dev), TWL_CONTROLLER_READY, TWL_CONTROLLER_READY, 60)) {
1280 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x11, "Controller not ready during reset sequence");
1281 tries++;
1282 continue;
1283 }
1284 }
1285
1286 /* Initconnect */
1287 if (twl_initconnection(tw_dev, TW_INIT_MESSAGE_CREDITS,
1288 TW_EXTENDED_INIT_CONNECT, TW_CURRENT_DRIVER_SRL,
1289 TW_9750_ARCH_ID, TW_CURRENT_DRIVER_BRANCH,
1290 TW_CURRENT_DRIVER_BUILD, &fw_on_ctlr_srl,
1291 &fw_on_ctlr_arch_id, &fw_on_ctlr_branch,
1292 &fw_on_ctlr_build, &init_connect_result)) {
1293 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x12, "Initconnection failed while checking SRL");
1294 do_soft_reset = 1;
1295 tries++;
1296 continue;
1297 }
1298
1299 /* Load sense buffers */
1300 while (i < TW_Q_LENGTH) {
1301 writel((u32)((u64)tw_dev->sense_buffer_phys[i] >> 32), TWL_HOBQPH_REG_ADDR(tw_dev));
1302 writel((u32)tw_dev->sense_buffer_phys[i], TWL_HOBQPL_REG_ADDR(tw_dev));
1303
1304 /* Check status for over-run after each write */
1305 status = readl(TWL_STATUS_REG_ADDR(tw_dev));
1306 if (!(status & TWL_STATUS_OVERRUN_SUBMIT))
1307 i++;
1308 }
1309
1310 /* Now check status */
1311 status = readl(TWL_STATUS_REG_ADDR(tw_dev));
1312 if (status) {
1313 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x13, "Bad controller status after loading sense buffers");
1314 do_soft_reset = 1;
1315 tries++;
1316 continue;
1317 }
1318
1319 /* Drain the AEN queue */
1320 if (twl_aen_drain_queue(tw_dev, soft_reset)) {
1321 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x14, "AEN drain failed during reset sequence");
1322 do_soft_reset = 1;
1323 tries++;
1324 continue;
1325 }
1326
1327 /* Load rest of compatibility struct */
1328 strncpy(tw_dev->tw_compat_info.driver_version, TW_DRIVER_VERSION, strlen(TW_DRIVER_VERSION));
1329 tw_dev->tw_compat_info.driver_srl_high = TW_CURRENT_DRIVER_SRL;
1330 tw_dev->tw_compat_info.driver_branch_high = TW_CURRENT_DRIVER_BRANCH;
1331 tw_dev->tw_compat_info.driver_build_high = TW_CURRENT_DRIVER_BUILD;
1332 tw_dev->tw_compat_info.driver_srl_low = TW_BASE_FW_SRL;
1333 tw_dev->tw_compat_info.driver_branch_low = TW_BASE_FW_BRANCH;
1334 tw_dev->tw_compat_info.driver_build_low = TW_BASE_FW_BUILD;
1335 tw_dev->tw_compat_info.fw_on_ctlr_srl = fw_on_ctlr_srl;
1336 tw_dev->tw_compat_info.fw_on_ctlr_branch = fw_on_ctlr_branch;
1337 tw_dev->tw_compat_info.fw_on_ctlr_build = fw_on_ctlr_build;
1338
1339 /* If we got here, controller is in a good state */
1340 retval = 0;
1341 goto out;
1342 }
1343 out:
1344 return retval;
1345 } /* End twl_reset_sequence() */
1346
1347 /* This function will reset a device extension */
1348 static int twl_reset_device_extension(TW_Device_Extension *tw_dev, int ioctl_reset)
1349 {
1350 int i = 0, retval = 1;
1351 unsigned long flags = 0;
1352
1353 /* Block SCSI requests while we are resetting */
1354 if (ioctl_reset)
1355 scsi_block_requests(tw_dev->host);
1356
1357 set_bit(TW_IN_RESET, &tw_dev->flags);
1358 TWL_MASK_INTERRUPTS(tw_dev);
1359 TWL_CLEAR_DB_INTERRUPT(tw_dev);
1360
1361 spin_lock_irqsave(tw_dev->host->host_lock, flags);
1362
1363 /* Abort all requests that are in progress */
1364 for (i = 0; i < TW_Q_LENGTH; i++) {
1365 if ((tw_dev->state[i] != TW_S_FINISHED) &&
1366 (tw_dev->state[i] != TW_S_INITIAL) &&
1367 (tw_dev->state[i] != TW_S_COMPLETED)) {
1368 struct scsi_cmnd *cmd = tw_dev->srb[i];
1369
1370 if (cmd) {
1371 cmd->result = (DID_RESET << 16);
1372 scsi_dma_unmap(cmd);
1373 cmd->scsi_done(cmd);
1374 }
1375 }
1376 }
1377
1378 /* Reset queues and counts */
1379 for (i = 0; i < TW_Q_LENGTH; i++) {
1380 tw_dev->free_queue[i] = i;
1381 tw_dev->state[i] = TW_S_INITIAL;
1382 }
1383 tw_dev->free_head = TW_Q_START;
1384 tw_dev->free_tail = TW_Q_START;
1385 tw_dev->posted_request_count = 0;
1386
1387 spin_unlock_irqrestore(tw_dev->host->host_lock, flags);
1388
1389 if (twl_reset_sequence(tw_dev, 1))
1390 goto out;
1391
1392 TWL_UNMASK_INTERRUPTS(tw_dev);
1393
1394 clear_bit(TW_IN_RESET, &tw_dev->flags);
1395 tw_dev->chrdev_request_id = TW_IOCTL_CHRDEV_FREE;
1396
1397 retval = 0;
1398 out:
1399 if (ioctl_reset)
1400 scsi_unblock_requests(tw_dev->host);
1401 return retval;
1402 } /* End twl_reset_device_extension() */
1403
1404 /* This funciton returns unit geometry in cylinders/heads/sectors */
1405 static int twl_scsi_biosparam(struct scsi_device *sdev, struct block_device *bdev, sector_t capacity, int geom[])
1406 {
1407 int heads, sectors;
1408 TW_Device_Extension *tw_dev;
1409
1410 tw_dev = (TW_Device_Extension *)sdev->host->hostdata;
1411
1412 if (capacity >= 0x200000) {
1413 heads = 255;
1414 sectors = 63;
1415 } else {
1416 heads = 64;
1417 sectors = 32;
1418 }
1419
1420 geom[0] = heads;
1421 geom[1] = sectors;
1422 geom[2] = sector_div(capacity, heads * sectors); /* cylinders */
1423
1424 return 0;
1425 } /* End twl_scsi_biosparam() */
1426
1427 /* This is the new scsi eh reset function */
1428 static int twl_scsi_eh_reset(struct scsi_cmnd *SCpnt)
1429 {
1430 TW_Device_Extension *tw_dev = NULL;
1431 int retval = FAILED;
1432
1433 tw_dev = (TW_Device_Extension *)SCpnt->device->host->hostdata;
1434
1435 tw_dev->num_resets++;
1436
1437 sdev_printk(KERN_WARNING, SCpnt->device,
1438 "WARNING: (0x%02X:0x%04X): Command (0x%x) timed out, resetting card.\n",
1439 TW_DRIVER, 0x2c, SCpnt->cmnd[0]);
1440
1441 /* Make sure we are not issuing an ioctl or resetting from ioctl */
1442 mutex_lock(&tw_dev->ioctl_lock);
1443
1444 /* Now reset the card and some of the device extension data */
1445 if (twl_reset_device_extension(tw_dev, 0)) {
1446 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x15, "Controller reset failed during scsi host reset");
1447 goto out;
1448 }
1449
1450 retval = SUCCESS;
1451 out:
1452 mutex_unlock(&tw_dev->ioctl_lock);
1453 return retval;
1454 } /* End twl_scsi_eh_reset() */
1455
1456 /* This is the main scsi queue function to handle scsi opcodes */
1457 static int twl_scsi_queue_lck(struct scsi_cmnd *SCpnt, void (*done)(struct scsi_cmnd *))
1458 {
1459 int request_id, retval;
1460 TW_Device_Extension *tw_dev = (TW_Device_Extension *)SCpnt->device->host->hostdata;
1461
1462 /* If we are resetting due to timed out ioctl, report as busy */
1463 if (test_bit(TW_IN_RESET, &tw_dev->flags)) {
1464 retval = SCSI_MLQUEUE_HOST_BUSY;
1465 goto out;
1466 }
1467
1468 /* Save done function into scsi_cmnd struct */
1469 SCpnt->scsi_done = done;
1470
1471 /* Get a free request id */
1472 twl_get_request_id(tw_dev, &request_id);
1473
1474 /* Save the scsi command for use by the ISR */
1475 tw_dev->srb[request_id] = SCpnt;
1476
1477 retval = twl_scsiop_execute_scsi(tw_dev, request_id, NULL, 0, NULL);
1478 if (retval) {
1479 tw_dev->state[request_id] = TW_S_COMPLETED;
1480 twl_free_request_id(tw_dev, request_id);
1481 SCpnt->result = (DID_ERROR << 16);
1482 done(SCpnt);
1483 retval = 0;
1484 }
1485 out:
1486 return retval;
1487 } /* End twl_scsi_queue() */
1488
1489 static DEF_SCSI_QCMD(twl_scsi_queue)
1490
1491 /* This function tells the controller to shut down */
1492 static void __twl_shutdown(TW_Device_Extension *tw_dev)
1493 {
1494 /* Disable interrupts */
1495 TWL_MASK_INTERRUPTS(tw_dev);
1496
1497 /* Free up the IRQ */
1498 free_irq(tw_dev->tw_pci_dev->irq, tw_dev);
1499
1500 printk(KERN_WARNING "3w-sas: Shutting down host %d.\n", tw_dev->host->host_no);
1501
1502 /* Tell the card we are shutting down */
1503 if (twl_initconnection(tw_dev, 1, 0, 0, 0, 0, 0, NULL, NULL, NULL, NULL, NULL)) {
1504 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x16, "Connection shutdown failed");
1505 } else {
1506 printk(KERN_WARNING "3w-sas: Shutdown complete.\n");
1507 }
1508
1509 /* Clear doorbell interrupt just before exit */
1510 TWL_CLEAR_DB_INTERRUPT(tw_dev);
1511 } /* End __twl_shutdown() */
1512
1513 /* Wrapper for __twl_shutdown */
1514 static void twl_shutdown(struct pci_dev *pdev)
1515 {
1516 struct Scsi_Host *host = pci_get_drvdata(pdev);
1517 TW_Device_Extension *tw_dev;
1518
1519 if (!host)
1520 return;
1521
1522 tw_dev = (TW_Device_Extension *)host->hostdata;
1523
1524 if (tw_dev->online)
1525 __twl_shutdown(tw_dev);
1526 } /* End twl_shutdown() */
1527
1528 /* This function configures unit settings when a unit is coming on-line */
1529 static int twl_slave_configure(struct scsi_device *sdev)
1530 {
1531 /* Force 60 second timeout */
1532 blk_queue_rq_timeout(sdev->request_queue, 60 * HZ);
1533
1534 return 0;
1535 } /* End twl_slave_configure() */
1536
1537 /* scsi_host_template initializer */
1538 static struct scsi_host_template driver_template = {
1539 .module = THIS_MODULE,
1540 .name = "3w-sas",
1541 .queuecommand = twl_scsi_queue,
1542 .eh_host_reset_handler = twl_scsi_eh_reset,
1543 .bios_param = twl_scsi_biosparam,
1544 .change_queue_depth = scsi_change_queue_depth,
1545 .can_queue = TW_Q_LENGTH-2,
1546 .slave_configure = twl_slave_configure,
1547 .this_id = -1,
1548 .sg_tablesize = TW_LIBERATOR_MAX_SGL_LENGTH,
1549 .max_sectors = TW_MAX_SECTORS,
1550 .cmd_per_lun = TW_MAX_CMDS_PER_LUN,
1551 .use_clustering = ENABLE_CLUSTERING,
1552 .shost_attrs = twl_host_attrs,
1553 .emulated = 1,
1554 .no_write_same = 1,
1555 };
1556
1557 /* This function will probe and initialize a card */
1558 static int twl_probe(struct pci_dev *pdev, const struct pci_device_id *dev_id)
1559 {
1560 struct Scsi_Host *host = NULL;
1561 TW_Device_Extension *tw_dev;
1562 int retval = -ENODEV;
1563 int *ptr_phycount, phycount=0;
1564
1565 retval = pci_enable_device(pdev);
1566 if (retval) {
1567 TW_PRINTK(host, TW_DRIVER, 0x17, "Failed to enable pci device");
1568 goto out_disable_device;
1569 }
1570
1571 pci_set_master(pdev);
1572 pci_try_set_mwi(pdev);
1573
1574 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(64))
1575 || pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
1576 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32))
1577 || pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32))) {
1578 TW_PRINTK(host, TW_DRIVER, 0x18, "Failed to set dma mask");
1579 retval = -ENODEV;
1580 goto out_disable_device;
1581 }
1582
1583 host = scsi_host_alloc(&driver_template, sizeof(TW_Device_Extension));
1584 if (!host) {
1585 TW_PRINTK(host, TW_DRIVER, 0x19, "Failed to allocate memory for device extension");
1586 retval = -ENOMEM;
1587 goto out_disable_device;
1588 }
1589 tw_dev = shost_priv(host);
1590
1591 /* Save values to device extension */
1592 tw_dev->host = host;
1593 tw_dev->tw_pci_dev = pdev;
1594
1595 if (twl_initialize_device_extension(tw_dev)) {
1596 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1a, "Failed to initialize device extension");
1597 goto out_free_device_extension;
1598 }
1599
1600 /* Request IO regions */
1601 retval = pci_request_regions(pdev, "3w-sas");
1602 if (retval) {
1603 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1b, "Failed to get mem region");
1604 goto out_free_device_extension;
1605 }
1606
1607 /* Save base address, use region 1 */
1608 tw_dev->base_addr = pci_iomap(pdev, 1, 0);
1609 if (!tw_dev->base_addr) {
1610 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1c, "Failed to ioremap");
1611 goto out_release_mem_region;
1612 }
1613
1614 /* Disable interrupts on the card */
1615 TWL_MASK_INTERRUPTS(tw_dev);
1616
1617 /* Initialize the card */
1618 if (twl_reset_sequence(tw_dev, 0)) {
1619 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1d, "Controller reset failed during probe");
1620 goto out_iounmap;
1621 }
1622
1623 /* Set host specific parameters */
1624 host->max_id = TW_MAX_UNITS;
1625 host->max_cmd_len = TW_MAX_CDB_LEN;
1626 host->max_lun = TW_MAX_LUNS;
1627 host->max_channel = 0;
1628
1629 /* Register the card with the kernel SCSI layer */
1630 retval = scsi_add_host(host, &pdev->dev);
1631 if (retval) {
1632 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1e, "scsi add host failed");
1633 goto out_iounmap;
1634 }
1635
1636 pci_set_drvdata(pdev, host);
1637
1638 printk(KERN_WARNING "3w-sas: scsi%d: Found an LSI 3ware %s Controller at 0x%llx, IRQ: %d.\n",
1639 host->host_no,
1640 (char *)twl_get_param(tw_dev, 1, TW_VERSION_TABLE,
1641 TW_PARAM_MODEL, TW_PARAM_MODEL_LENGTH),
1642 (u64)pci_resource_start(pdev, 1), pdev->irq);
1643
1644 ptr_phycount = twl_get_param(tw_dev, 2, TW_PARAM_PHY_SUMMARY_TABLE,
1645 TW_PARAM_PHYCOUNT, TW_PARAM_PHYCOUNT_LENGTH);
1646 if (ptr_phycount)
1647 phycount = le32_to_cpu(*(int *)ptr_phycount);
1648
1649 printk(KERN_WARNING "3w-sas: scsi%d: Firmware %s, BIOS %s, Phys: %d.\n",
1650 host->host_no,
1651 (char *)twl_get_param(tw_dev, 1, TW_VERSION_TABLE,
1652 TW_PARAM_FWVER, TW_PARAM_FWVER_LENGTH),
1653 (char *)twl_get_param(tw_dev, 2, TW_VERSION_TABLE,
1654 TW_PARAM_BIOSVER, TW_PARAM_BIOSVER_LENGTH),
1655 phycount);
1656
1657 /* Try to enable MSI */
1658 if (use_msi && !pci_enable_msi(pdev))
1659 set_bit(TW_USING_MSI, &tw_dev->flags);
1660
1661 /* Now setup the interrupt handler */
1662 retval = request_irq(pdev->irq, twl_interrupt, IRQF_SHARED, "3w-sas", tw_dev);
1663 if (retval) {
1664 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x1f, "Error requesting IRQ");
1665 goto out_remove_host;
1666 }
1667
1668 twl_device_extension_list[twl_device_extension_count] = tw_dev;
1669 twl_device_extension_count++;
1670
1671 /* Re-enable interrupts on the card */
1672 TWL_UNMASK_INTERRUPTS(tw_dev);
1673
1674 /* Finally, scan the host */
1675 scsi_scan_host(host);
1676
1677 /* Add sysfs binary files */
1678 if (sysfs_create_bin_file(&host->shost_dev.kobj, &twl_sysfs_aen_read_attr))
1679 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x20, "Failed to create sysfs binary file: 3ware_aen_read");
1680 if (sysfs_create_bin_file(&host->shost_dev.kobj, &twl_sysfs_compat_info_attr))
1681 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x21, "Failed to create sysfs binary file: 3ware_compat_info");
1682
1683 if (twl_major == -1) {
1684 if ((twl_major = register_chrdev (0, "twl", &twl_fops)) < 0)
1685 TW_PRINTK(host, TW_DRIVER, 0x22, "Failed to register character device");
1686 }
1687 tw_dev->online = 1;
1688 return 0;
1689
1690 out_remove_host:
1691 if (test_bit(TW_USING_MSI, &tw_dev->flags))
1692 pci_disable_msi(pdev);
1693 scsi_remove_host(host);
1694 out_iounmap:
1695 iounmap(tw_dev->base_addr);
1696 out_release_mem_region:
1697 pci_release_regions(pdev);
1698 out_free_device_extension:
1699 twl_free_device_extension(tw_dev);
1700 scsi_host_put(host);
1701 out_disable_device:
1702 pci_disable_device(pdev);
1703
1704 return retval;
1705 } /* End twl_probe() */
1706
1707 /* This function is called to remove a device */
1708 static void twl_remove(struct pci_dev *pdev)
1709 {
1710 struct Scsi_Host *host = pci_get_drvdata(pdev);
1711 TW_Device_Extension *tw_dev;
1712
1713 if (!host)
1714 return;
1715
1716 tw_dev = (TW_Device_Extension *)host->hostdata;
1717
1718 if (!tw_dev->online)
1719 return;
1720
1721 /* Remove sysfs binary files */
1722 sysfs_remove_bin_file(&host->shost_dev.kobj, &twl_sysfs_aen_read_attr);
1723 sysfs_remove_bin_file(&host->shost_dev.kobj, &twl_sysfs_compat_info_attr);
1724
1725 scsi_remove_host(tw_dev->host);
1726
1727 /* Unregister character device */
1728 if (twl_major >= 0) {
1729 unregister_chrdev(twl_major, "twl");
1730 twl_major = -1;
1731 }
1732
1733 /* Shutdown the card */
1734 __twl_shutdown(tw_dev);
1735
1736 /* Disable MSI if enabled */
1737 if (test_bit(TW_USING_MSI, &tw_dev->flags))
1738 pci_disable_msi(pdev);
1739
1740 /* Free IO remapping */
1741 iounmap(tw_dev->base_addr);
1742
1743 /* Free up the mem region */
1744 pci_release_regions(pdev);
1745
1746 /* Free up device extension resources */
1747 twl_free_device_extension(tw_dev);
1748
1749 scsi_host_put(tw_dev->host);
1750 pci_disable_device(pdev);
1751 twl_device_extension_count--;
1752 } /* End twl_remove() */
1753
1754 #ifdef CONFIG_PM
1755 /* This function is called on PCI suspend */
1756 static int twl_suspend(struct pci_dev *pdev, pm_message_t state)
1757 {
1758 struct Scsi_Host *host = pci_get_drvdata(pdev);
1759 TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
1760
1761 printk(KERN_WARNING "3w-sas: Suspending host %d.\n", tw_dev->host->host_no);
1762 /* Disable interrupts */
1763 TWL_MASK_INTERRUPTS(tw_dev);
1764
1765 free_irq(tw_dev->tw_pci_dev->irq, tw_dev);
1766
1767 /* Tell the card we are shutting down */
1768 if (twl_initconnection(tw_dev, 1, 0, 0, 0, 0, 0, NULL, NULL, NULL, NULL, NULL)) {
1769 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x23, "Connection shutdown failed during suspend");
1770 } else {
1771 printk(KERN_WARNING "3w-sas: Suspend complete.\n");
1772 }
1773
1774 /* Clear doorbell interrupt */
1775 TWL_CLEAR_DB_INTERRUPT(tw_dev);
1776
1777 pci_save_state(pdev);
1778 pci_disable_device(pdev);
1779 pci_set_power_state(pdev, pci_choose_state(pdev, state));
1780
1781 return 0;
1782 } /* End twl_suspend() */
1783
1784 /* This function is called on PCI resume */
1785 static int twl_resume(struct pci_dev *pdev)
1786 {
1787 int retval = 0;
1788 struct Scsi_Host *host = pci_get_drvdata(pdev);
1789 TW_Device_Extension *tw_dev = (TW_Device_Extension *)host->hostdata;
1790
1791 printk(KERN_WARNING "3w-sas: Resuming host %d.\n", tw_dev->host->host_no);
1792 pci_set_power_state(pdev, PCI_D0);
1793 pci_enable_wake(pdev, PCI_D0, 0);
1794 pci_restore_state(pdev);
1795
1796 retval = pci_enable_device(pdev);
1797 if (retval) {
1798 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x24, "Enable device failed during resume");
1799 return retval;
1800 }
1801
1802 pci_set_master(pdev);
1803 pci_try_set_mwi(pdev);
1804
1805 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(64))
1806 || pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
1807 if (pci_set_dma_mask(pdev, DMA_BIT_MASK(32))
1808 || pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32))) {
1809 TW_PRINTK(host, TW_DRIVER, 0x25, "Failed to set dma mask during resume");
1810 retval = -ENODEV;
1811 goto out_disable_device;
1812 }
1813
1814 /* Initialize the card */
1815 if (twl_reset_sequence(tw_dev, 0)) {
1816 retval = -ENODEV;
1817 goto out_disable_device;
1818 }
1819
1820 /* Now setup the interrupt handler */
1821 retval = request_irq(pdev->irq, twl_interrupt, IRQF_SHARED, "3w-sas", tw_dev);
1822 if (retval) {
1823 TW_PRINTK(tw_dev->host, TW_DRIVER, 0x26, "Error requesting IRQ during resume");
1824 retval = -ENODEV;
1825 goto out_disable_device;
1826 }
1827
1828 /* Now enable MSI if enabled */
1829 if (test_bit(TW_USING_MSI, &tw_dev->flags))
1830 pci_enable_msi(pdev);
1831
1832 /* Re-enable interrupts on the card */
1833 TWL_UNMASK_INTERRUPTS(tw_dev);
1834
1835 printk(KERN_WARNING "3w-sas: Resume complete.\n");
1836 return 0;
1837
1838 out_disable_device:
1839 scsi_remove_host(host);
1840 pci_disable_device(pdev);
1841
1842 return retval;
1843 } /* End twl_resume() */
1844 #endif
1845
1846 /* PCI Devices supported by this driver */
1847 static struct pci_device_id twl_pci_tbl[] = {
1848 { PCI_VDEVICE(3WARE, PCI_DEVICE_ID_3WARE_9750) },
1849 { }
1850 };
1851 MODULE_DEVICE_TABLE(pci, twl_pci_tbl);
1852
1853 /* pci_driver initializer */
1854 static struct pci_driver twl_driver = {
1855 .name = "3w-sas",
1856 .id_table = twl_pci_tbl,
1857 .probe = twl_probe,
1858 .remove = twl_remove,
1859 #ifdef CONFIG_PM
1860 .suspend = twl_suspend,
1861 .resume = twl_resume,
1862 #endif
1863 .shutdown = twl_shutdown
1864 };
1865
1866 /* This function is called on driver initialization */
1867 static int __init twl_init(void)
1868 {
1869 printk(KERN_INFO "LSI 3ware SAS/SATA-RAID Controller device driver for Linux v%s.\n", TW_DRIVER_VERSION);
1870
1871 return pci_register_driver(&twl_driver);
1872 } /* End twl_init() */
1873
1874 /* This function is called on driver exit */
1875 static void __exit twl_exit(void)
1876 {
1877 pci_unregister_driver(&twl_driver);
1878 } /* End twl_exit() */
1879
1880 module_init(twl_init);
1881 module_exit(twl_exit);
1882
Linux with added FPC-III support