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