xref: /openbmc/linux/drivers/scsi/hpsa.c (revision 50a0decf75b66480aa5b076d4e1bca11bc202efe)
1edd16368SStephen M. Cameron /*
2edd16368SStephen M. Cameron  *    Disk Array driver for HP Smart Array SAS controllers
351c35139SScott Teel  *    Copyright 2000, 2014 Hewlett-Packard Development Company, L.P.
4edd16368SStephen M. Cameron  *
5edd16368SStephen M. Cameron  *    This program is free software; you can redistribute it and/or modify
6edd16368SStephen M. Cameron  *    it under the terms of the GNU General Public License as published by
7edd16368SStephen M. Cameron  *    the Free Software Foundation; version 2 of the License.
8edd16368SStephen M. Cameron  *
9edd16368SStephen M. Cameron  *    This program is distributed in the hope that it will be useful,
10edd16368SStephen M. Cameron  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
11edd16368SStephen M. Cameron  *    MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
12edd16368SStephen M. Cameron  *    NON INFRINGEMENT.  See the GNU General Public License for more details.
13edd16368SStephen M. Cameron  *
14edd16368SStephen M. Cameron  *    You should have received a copy of the GNU General Public License
15edd16368SStephen M. Cameron  *    along with this program; if not, write to the Free Software
16edd16368SStephen M. Cameron  *    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
17edd16368SStephen M. Cameron  *
18edd16368SStephen M. Cameron  *    Questions/Comments/Bugfixes to iss_storagedev@hp.com
19edd16368SStephen M. Cameron  *
20edd16368SStephen M. Cameron  */
21edd16368SStephen M. Cameron 
22edd16368SStephen M. Cameron #include <linux/module.h>
23edd16368SStephen M. Cameron #include <linux/interrupt.h>
24edd16368SStephen M. Cameron #include <linux/types.h>
25edd16368SStephen M. Cameron #include <linux/pci.h>
26e5a44df8SMatthew Garrett #include <linux/pci-aspm.h>
27edd16368SStephen M. Cameron #include <linux/kernel.h>
28edd16368SStephen M. Cameron #include <linux/slab.h>
29edd16368SStephen M. Cameron #include <linux/delay.h>
30edd16368SStephen M. Cameron #include <linux/fs.h>
31edd16368SStephen M. Cameron #include <linux/timer.h>
32edd16368SStephen M. Cameron #include <linux/init.h>
33edd16368SStephen M. Cameron #include <linux/spinlock.h>
34edd16368SStephen M. Cameron #include <linux/compat.h>
35edd16368SStephen M. Cameron #include <linux/blktrace_api.h>
36edd16368SStephen M. Cameron #include <linux/uaccess.h>
37edd16368SStephen M. Cameron #include <linux/io.h>
38edd16368SStephen M. Cameron #include <linux/dma-mapping.h>
39edd16368SStephen M. Cameron #include <linux/completion.h>
40edd16368SStephen M. Cameron #include <linux/moduleparam.h>
41edd16368SStephen M. Cameron #include <scsi/scsi.h>
42edd16368SStephen M. Cameron #include <scsi/scsi_cmnd.h>
43edd16368SStephen M. Cameron #include <scsi/scsi_device.h>
44edd16368SStephen M. Cameron #include <scsi/scsi_host.h>
45667e23d4SStephen M. Cameron #include <scsi/scsi_tcq.h>
46edd16368SStephen M. Cameron #include <linux/cciss_ioctl.h>
47edd16368SStephen M. Cameron #include <linux/string.h>
48edd16368SStephen M. Cameron #include <linux/bitmap.h>
4960063497SArun Sharma #include <linux/atomic.h>
50a0c12413SStephen M. Cameron #include <linux/jiffies.h>
5142a91641SDon Brace #include <linux/percpu-defs.h>
52094963daSStephen M. Cameron #include <linux/percpu.h>
53283b4a9bSStephen M. Cameron #include <asm/div64.h>
54edd16368SStephen M. Cameron #include "hpsa_cmd.h"
55edd16368SStephen M. Cameron #include "hpsa.h"
56edd16368SStephen M. Cameron 
57edd16368SStephen M. Cameron /* HPSA_DRIVER_VERSION must be 3 byte values (0-255) separated by '.' */
589a993302SStephen M. Cameron #define HPSA_DRIVER_VERSION "3.4.4-1"
59edd16368SStephen M. Cameron #define DRIVER_NAME "HP HPSA Driver (v " HPSA_DRIVER_VERSION ")"
60f79cfec6SStephen M. Cameron #define HPSA "hpsa"
61edd16368SStephen M. Cameron 
62edd16368SStephen M. Cameron /* How long to wait (in milliseconds) for board to go into simple mode */
63edd16368SStephen M. Cameron #define MAX_CONFIG_WAIT 30000
64edd16368SStephen M. Cameron #define MAX_IOCTL_CONFIG_WAIT 1000
65edd16368SStephen M. Cameron 
66edd16368SStephen M. Cameron /*define how many times we will try a command because of bus resets */
67edd16368SStephen M. Cameron #define MAX_CMD_RETRIES 3
68edd16368SStephen M. Cameron 
69edd16368SStephen M. Cameron /* Embedded module documentation macros - see modules.h */
70edd16368SStephen M. Cameron MODULE_AUTHOR("Hewlett-Packard Company");
71edd16368SStephen M. Cameron MODULE_DESCRIPTION("Driver for HP Smart Array Controller version " \
72edd16368SStephen M. Cameron 	HPSA_DRIVER_VERSION);
73edd16368SStephen M. Cameron MODULE_SUPPORTED_DEVICE("HP Smart Array Controllers");
74edd16368SStephen M. Cameron MODULE_VERSION(HPSA_DRIVER_VERSION);
75edd16368SStephen M. Cameron MODULE_LICENSE("GPL");
76edd16368SStephen M. Cameron 
77edd16368SStephen M. Cameron static int hpsa_allow_any;
78edd16368SStephen M. Cameron module_param(hpsa_allow_any, int, S_IRUGO|S_IWUSR);
79edd16368SStephen M. Cameron MODULE_PARM_DESC(hpsa_allow_any,
80edd16368SStephen M. Cameron 		"Allow hpsa driver to access unknown HP Smart Array hardware");
8102ec19c8SStephen M. Cameron static int hpsa_simple_mode;
8202ec19c8SStephen M. Cameron module_param(hpsa_simple_mode, int, S_IRUGO|S_IWUSR);
8302ec19c8SStephen M. Cameron MODULE_PARM_DESC(hpsa_simple_mode,
8402ec19c8SStephen M. Cameron 	"Use 'simple mode' rather than 'performant mode'");
85edd16368SStephen M. Cameron 
86edd16368SStephen M. Cameron /* define the PCI info for the cards we can control */
87edd16368SStephen M. Cameron static const struct pci_device_id hpsa_pci_device_id[] = {
88edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3241},
89edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3243},
90edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3245},
91edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3247},
92edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3249},
93163dbcd8SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x324A},
94163dbcd8SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x324B},
95f8b01eb9SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3233},
969143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3350},
979143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3351},
989143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3352},
999143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3353},
1009143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3354},
1019143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3355},
1029143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3356},
103fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1921},
104fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1922},
105fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1923},
106fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1924},
107fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1926},
108fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1928},
10997b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1929},
11097b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21BD},
11197b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21BE},
11297b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21BF},
11397b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C0},
11497b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C1},
11597b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C2},
11697b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C3},
11797b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C4},
11897b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C5},
1193b7a45e5SJoe Handzik 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C6},
12097b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C7},
12197b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C8},
12297b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C9},
1233b7a45e5SJoe Handzik 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21CA},
1243b7a45e5SJoe Handzik 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21CB},
1253b7a45e5SJoe Handzik 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21CC},
1263b7a45e5SJoe Handzik 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21CD},
1273b7a45e5SJoe Handzik 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21CE},
1288e616a5eSStephen M. Cameron 	{PCI_VENDOR_ID_HP_3PAR, 0x0075, 0x1590, 0x0076},
1298e616a5eSStephen M. Cameron 	{PCI_VENDOR_ID_HP_3PAR, 0x0075, 0x1590, 0x0087},
1308e616a5eSStephen M. Cameron 	{PCI_VENDOR_ID_HP_3PAR, 0x0075, 0x1590, 0x007D},
1318e616a5eSStephen M. Cameron 	{PCI_VENDOR_ID_HP_3PAR, 0x0075, 0x1590, 0x0088},
1328e616a5eSStephen M. Cameron 	{PCI_VENDOR_ID_HP, 0x333f, 0x103c, 0x333f},
133edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_ANY_ID,	PCI_ANY_ID, PCI_ANY_ID,
134edd16368SStephen M. Cameron 		PCI_CLASS_STORAGE_RAID << 8, 0xffff << 8, 0},
135edd16368SStephen M. Cameron 	{0,}
136edd16368SStephen M. Cameron };
137edd16368SStephen M. Cameron 
138edd16368SStephen M. Cameron MODULE_DEVICE_TABLE(pci, hpsa_pci_device_id);
139edd16368SStephen M. Cameron 
140edd16368SStephen M. Cameron /*  board_id = Subsystem Device ID & Vendor ID
141edd16368SStephen M. Cameron  *  product = Marketing Name for the board
142edd16368SStephen M. Cameron  *  access = Address of the struct of function pointers
143edd16368SStephen M. Cameron  */
144edd16368SStephen M. Cameron static struct board_type products[] = {
145edd16368SStephen M. Cameron 	{0x3241103C, "Smart Array P212", &SA5_access},
146edd16368SStephen M. Cameron 	{0x3243103C, "Smart Array P410", &SA5_access},
147edd16368SStephen M. Cameron 	{0x3245103C, "Smart Array P410i", &SA5_access},
148edd16368SStephen M. Cameron 	{0x3247103C, "Smart Array P411", &SA5_access},
149edd16368SStephen M. Cameron 	{0x3249103C, "Smart Array P812", &SA5_access},
150163dbcd8SMike Miller 	{0x324A103C, "Smart Array P712m", &SA5_access},
151163dbcd8SMike Miller 	{0x324B103C, "Smart Array P711m", &SA5_access},
1527d2cce58SStephen M. Cameron 	{0x3233103C, "HP StorageWorks 1210m", &SA5_access}, /* alias of 333f */
153fe0c9610SMike Miller 	{0x3350103C, "Smart Array P222", &SA5_access},
154fe0c9610SMike Miller 	{0x3351103C, "Smart Array P420", &SA5_access},
155fe0c9610SMike Miller 	{0x3352103C, "Smart Array P421", &SA5_access},
156fe0c9610SMike Miller 	{0x3353103C, "Smart Array P822", &SA5_access},
157fe0c9610SMike Miller 	{0x3354103C, "Smart Array P420i", &SA5_access},
158fe0c9610SMike Miller 	{0x3355103C, "Smart Array P220i", &SA5_access},
159fe0c9610SMike Miller 	{0x3356103C, "Smart Array P721m", &SA5_access},
1601fd6c8e3SMike Miller 	{0x1921103C, "Smart Array P830i", &SA5_access},
1611fd6c8e3SMike Miller 	{0x1922103C, "Smart Array P430", &SA5_access},
1621fd6c8e3SMike Miller 	{0x1923103C, "Smart Array P431", &SA5_access},
1631fd6c8e3SMike Miller 	{0x1924103C, "Smart Array P830", &SA5_access},
1641fd6c8e3SMike Miller 	{0x1926103C, "Smart Array P731m", &SA5_access},
1651fd6c8e3SMike Miller 	{0x1928103C, "Smart Array P230i", &SA5_access},
1661fd6c8e3SMike Miller 	{0x1929103C, "Smart Array P530", &SA5_access},
16797b9f53dSMike Miller 	{0x21BD103C, "Smart Array", &SA5_access},
16897b9f53dSMike Miller 	{0x21BE103C, "Smart Array", &SA5_access},
16997b9f53dSMike Miller 	{0x21BF103C, "Smart Array", &SA5_access},
17097b9f53dSMike Miller 	{0x21C0103C, "Smart Array", &SA5_access},
17197b9f53dSMike Miller 	{0x21C1103C, "Smart Array", &SA5_access},
17297b9f53dSMike Miller 	{0x21C2103C, "Smart Array", &SA5_access},
17397b9f53dSMike Miller 	{0x21C3103C, "Smart Array", &SA5_access},
17497b9f53dSMike Miller 	{0x21C4103C, "Smart Array", &SA5_access},
17597b9f53dSMike Miller 	{0x21C5103C, "Smart Array", &SA5_access},
1763b7a45e5SJoe Handzik 	{0x21C6103C, "Smart Array", &SA5_access},
17797b9f53dSMike Miller 	{0x21C7103C, "Smart Array", &SA5_access},
17897b9f53dSMike Miller 	{0x21C8103C, "Smart Array", &SA5_access},
17997b9f53dSMike Miller 	{0x21C9103C, "Smart Array", &SA5_access},
1803b7a45e5SJoe Handzik 	{0x21CA103C, "Smart Array", &SA5_access},
1813b7a45e5SJoe Handzik 	{0x21CB103C, "Smart Array", &SA5_access},
1823b7a45e5SJoe Handzik 	{0x21CC103C, "Smart Array", &SA5_access},
1833b7a45e5SJoe Handzik 	{0x21CD103C, "Smart Array", &SA5_access},
1843b7a45e5SJoe Handzik 	{0x21CE103C, "Smart Array", &SA5_access},
1858e616a5eSStephen M. Cameron 	{0x00761590, "HP Storage P1224 Array Controller", &SA5_access},
1868e616a5eSStephen M. Cameron 	{0x00871590, "HP Storage P1224e Array Controller", &SA5_access},
1878e616a5eSStephen M. Cameron 	{0x007D1590, "HP Storage P1228 Array Controller", &SA5_access},
1888e616a5eSStephen M. Cameron 	{0x00881590, "HP Storage P1228e Array Controller", &SA5_access},
1898e616a5eSStephen M. Cameron 	{0x333f103c, "HP StorageWorks 1210m Array Controller", &SA5_access},
190edd16368SStephen M. Cameron 	{0xFFFF103C, "Unknown Smart Array", &SA5_access},
191edd16368SStephen M. Cameron };
192edd16368SStephen M. Cameron 
193edd16368SStephen M. Cameron static int number_of_controllers;
194edd16368SStephen M. Cameron 
19510f66018SStephen M. Cameron static irqreturn_t do_hpsa_intr_intx(int irq, void *dev_id);
19610f66018SStephen M. Cameron static irqreturn_t do_hpsa_intr_msi(int irq, void *dev_id);
19742a91641SDon Brace static int hpsa_ioctl(struct scsi_device *dev, int cmd, void __user *arg);
1980b57075dSStephen M. Cameron static void lock_and_start_io(struct ctlr_info *h);
1990b57075dSStephen M. Cameron static void start_io(struct ctlr_info *h, unsigned long *flags);
200edd16368SStephen M. Cameron 
201edd16368SStephen M. Cameron #ifdef CONFIG_COMPAT
20242a91641SDon Brace static int hpsa_compat_ioctl(struct scsi_device *dev, int cmd,
20342a91641SDon Brace 	void __user *arg);
204edd16368SStephen M. Cameron #endif
205edd16368SStephen M. Cameron 
206edd16368SStephen M. Cameron static void cmd_free(struct ctlr_info *h, struct CommandList *c);
207edd16368SStephen M. Cameron static void cmd_special_free(struct ctlr_info *h, struct CommandList *c);
208edd16368SStephen M. Cameron static struct CommandList *cmd_alloc(struct ctlr_info *h);
209edd16368SStephen M. Cameron static struct CommandList *cmd_special_alloc(struct ctlr_info *h);
210a2dac136SStephen M. Cameron static int fill_cmd(struct CommandList *c, u8 cmd, struct ctlr_info *h,
211b7bb24ebSStephen M. Cameron 	void *buff, size_t size, u16 page_code, unsigned char *scsi3addr,
212edd16368SStephen M. Cameron 	int cmd_type);
213b7bb24ebSStephen M. Cameron #define VPD_PAGE (1 << 8)
214edd16368SStephen M. Cameron 
215f281233dSJeff Garzik static int hpsa_scsi_queue_command(struct Scsi_Host *h, struct scsi_cmnd *cmd);
216a08a8471SStephen M. Cameron static void hpsa_scan_start(struct Scsi_Host *);
217a08a8471SStephen M. Cameron static int hpsa_scan_finished(struct Scsi_Host *sh,
218a08a8471SStephen M. Cameron 	unsigned long elapsed_time);
219667e23d4SStephen M. Cameron static int hpsa_change_queue_depth(struct scsi_device *sdev,
220667e23d4SStephen M. Cameron 	int qdepth, int reason);
221edd16368SStephen M. Cameron 
222edd16368SStephen M. Cameron static int hpsa_eh_device_reset_handler(struct scsi_cmnd *scsicmd);
22375167d2cSStephen M. Cameron static int hpsa_eh_abort_handler(struct scsi_cmnd *scsicmd);
224edd16368SStephen M. Cameron static int hpsa_slave_alloc(struct scsi_device *sdev);
225edd16368SStephen M. Cameron static void hpsa_slave_destroy(struct scsi_device *sdev);
226edd16368SStephen M. Cameron 
227edd16368SStephen M. Cameron static void hpsa_update_scsi_devices(struct ctlr_info *h, int hostno);
228edd16368SStephen M. Cameron static int check_for_unit_attention(struct ctlr_info *h,
229edd16368SStephen M. Cameron 	struct CommandList *c);
230edd16368SStephen M. Cameron static void check_ioctl_unit_attention(struct ctlr_info *h,
231edd16368SStephen M. Cameron 	struct CommandList *c);
232303932fdSDon Brace /* performant mode helper functions */
233303932fdSDon Brace static void calc_bucket_map(int *bucket, int num_buckets,
234e1f7de0cSMatt Gates 	int nsgs, int min_blocks, int *bucket_map);
2356f039790SGreg Kroah-Hartman static void hpsa_put_ctlr_into_performant_mode(struct ctlr_info *h);
236254f796bSMatt Gates static inline u32 next_command(struct ctlr_info *h, u8 q);
2376f039790SGreg Kroah-Hartman static int hpsa_find_cfg_addrs(struct pci_dev *pdev, void __iomem *vaddr,
2386f039790SGreg Kroah-Hartman 			       u32 *cfg_base_addr, u64 *cfg_base_addr_index,
2391df8552aSStephen M. Cameron 			       u64 *cfg_offset);
2406f039790SGreg Kroah-Hartman static int hpsa_pci_find_memory_BAR(struct pci_dev *pdev,
2411df8552aSStephen M. Cameron 				    unsigned long *memory_bar);
2426f039790SGreg Kroah-Hartman static int hpsa_lookup_board_id(struct pci_dev *pdev, u32 *board_id);
2436f039790SGreg Kroah-Hartman static int hpsa_wait_for_board_state(struct pci_dev *pdev, void __iomem *vaddr,
2446f039790SGreg Kroah-Hartman 				     int wait_for_ready);
24575167d2cSStephen M. Cameron static inline void finish_cmd(struct CommandList *c);
246283b4a9bSStephen M. Cameron static void hpsa_wait_for_mode_change_ack(struct ctlr_info *h);
247fe5389c8SStephen M. Cameron #define BOARD_NOT_READY 0
248fe5389c8SStephen M. Cameron #define BOARD_READY 1
24923100dd9SStephen M. Cameron static void hpsa_drain_accel_commands(struct ctlr_info *h);
25076438d08SStephen M. Cameron static void hpsa_flush_cache(struct ctlr_info *h);
251c349775eSScott Teel static int hpsa_scsi_ioaccel_queue_command(struct ctlr_info *h,
252c349775eSScott Teel 	struct CommandList *c, u32 ioaccel_handle, u8 *cdb, int cdb_len,
253c349775eSScott Teel 	u8 *scsi3addr);
254edd16368SStephen M. Cameron 
255edd16368SStephen M. Cameron static inline struct ctlr_info *sdev_to_hba(struct scsi_device *sdev)
256edd16368SStephen M. Cameron {
257edd16368SStephen M. Cameron 	unsigned long *priv = shost_priv(sdev->host);
258edd16368SStephen M. Cameron 	return (struct ctlr_info *) *priv;
259edd16368SStephen M. Cameron }
260edd16368SStephen M. Cameron 
261a23513e8SStephen M. Cameron static inline struct ctlr_info *shost_to_hba(struct Scsi_Host *sh)
262a23513e8SStephen M. Cameron {
263a23513e8SStephen M. Cameron 	unsigned long *priv = shost_priv(sh);
264a23513e8SStephen M. Cameron 	return (struct ctlr_info *) *priv;
265a23513e8SStephen M. Cameron }
266a23513e8SStephen M. Cameron 
267edd16368SStephen M. Cameron static int check_for_unit_attention(struct ctlr_info *h,
268edd16368SStephen M. Cameron 	struct CommandList *c)
269edd16368SStephen M. Cameron {
270edd16368SStephen M. Cameron 	if (c->err_info->SenseInfo[2] != UNIT_ATTENTION)
271edd16368SStephen M. Cameron 		return 0;
272edd16368SStephen M. Cameron 
273edd16368SStephen M. Cameron 	switch (c->err_info->SenseInfo[12]) {
274edd16368SStephen M. Cameron 	case STATE_CHANGED:
275f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: a state change "
276edd16368SStephen M. Cameron 			"detected, command retried\n", h->ctlr);
277edd16368SStephen M. Cameron 		break;
278edd16368SStephen M. Cameron 	case LUN_FAILED:
2797f73695aSStephen M. Cameron 		dev_warn(&h->pdev->dev,
2807f73695aSStephen M. Cameron 			HPSA "%d: LUN failure detected\n", h->ctlr);
281edd16368SStephen M. Cameron 		break;
282edd16368SStephen M. Cameron 	case REPORT_LUNS_CHANGED:
2837f73695aSStephen M. Cameron 		dev_warn(&h->pdev->dev,
2847f73695aSStephen M. Cameron 			HPSA "%d: report LUN data changed\n", h->ctlr);
285edd16368SStephen M. Cameron 	/*
2864f4eb9f1SScott Teel 	 * Note: this REPORT_LUNS_CHANGED condition only occurs on the external
2874f4eb9f1SScott Teel 	 * target (array) devices.
288edd16368SStephen M. Cameron 	 */
289edd16368SStephen M. Cameron 		break;
290edd16368SStephen M. Cameron 	case POWER_OR_RESET:
291f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: a power on "
292edd16368SStephen M. Cameron 			"or device reset detected\n", h->ctlr);
293edd16368SStephen M. Cameron 		break;
294edd16368SStephen M. Cameron 	case UNIT_ATTENTION_CLEARED:
295f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: unit attention "
296edd16368SStephen M. Cameron 		    "cleared by another initiator\n", h->ctlr);
297edd16368SStephen M. Cameron 		break;
298edd16368SStephen M. Cameron 	default:
299f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: unknown "
300edd16368SStephen M. Cameron 			"unit attention detected\n", h->ctlr);
301edd16368SStephen M. Cameron 		break;
302edd16368SStephen M. Cameron 	}
303edd16368SStephen M. Cameron 	return 1;
304edd16368SStephen M. Cameron }
305edd16368SStephen M. Cameron 
306852af20aSMatt Bondurant static int check_for_busy(struct ctlr_info *h, struct CommandList *c)
307852af20aSMatt Bondurant {
308852af20aSMatt Bondurant 	if (c->err_info->CommandStatus != CMD_TARGET_STATUS ||
309852af20aSMatt Bondurant 		(c->err_info->ScsiStatus != SAM_STAT_BUSY &&
310852af20aSMatt Bondurant 		 c->err_info->ScsiStatus != SAM_STAT_TASK_SET_FULL))
311852af20aSMatt Bondurant 		return 0;
312852af20aSMatt Bondurant 	dev_warn(&h->pdev->dev, HPSA "device busy");
313852af20aSMatt Bondurant 	return 1;
314852af20aSMatt Bondurant }
315852af20aSMatt Bondurant 
316da0697bdSScott Teel static ssize_t host_store_hp_ssd_smart_path_status(struct device *dev,
317da0697bdSScott Teel 					 struct device_attribute *attr,
318da0697bdSScott Teel 					 const char *buf, size_t count)
319da0697bdSScott Teel {
320da0697bdSScott Teel 	int status, len;
321da0697bdSScott Teel 	struct ctlr_info *h;
322da0697bdSScott Teel 	struct Scsi_Host *shost = class_to_shost(dev);
323da0697bdSScott Teel 	char tmpbuf[10];
324da0697bdSScott Teel 
325da0697bdSScott Teel 	if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
326da0697bdSScott Teel 		return -EACCES;
327da0697bdSScott Teel 	len = count > sizeof(tmpbuf) - 1 ? sizeof(tmpbuf) - 1 : count;
328da0697bdSScott Teel 	strncpy(tmpbuf, buf, len);
329da0697bdSScott Teel 	tmpbuf[len] = '\0';
330da0697bdSScott Teel 	if (sscanf(tmpbuf, "%d", &status) != 1)
331da0697bdSScott Teel 		return -EINVAL;
332da0697bdSScott Teel 	h = shost_to_hba(shost);
333da0697bdSScott Teel 	h->acciopath_status = !!status;
334da0697bdSScott Teel 	dev_warn(&h->pdev->dev,
335da0697bdSScott Teel 		"hpsa: HP SSD Smart Path %s via sysfs update.\n",
336da0697bdSScott Teel 		h->acciopath_status ? "enabled" : "disabled");
337da0697bdSScott Teel 	return count;
338da0697bdSScott Teel }
339da0697bdSScott Teel 
3402ba8bfc8SStephen M. Cameron static ssize_t host_store_raid_offload_debug(struct device *dev,
3412ba8bfc8SStephen M. Cameron 					 struct device_attribute *attr,
3422ba8bfc8SStephen M. Cameron 					 const char *buf, size_t count)
3432ba8bfc8SStephen M. Cameron {
3442ba8bfc8SStephen M. Cameron 	int debug_level, len;
3452ba8bfc8SStephen M. Cameron 	struct ctlr_info *h;
3462ba8bfc8SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
3472ba8bfc8SStephen M. Cameron 	char tmpbuf[10];
3482ba8bfc8SStephen M. Cameron 
3492ba8bfc8SStephen M. Cameron 	if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO))
3502ba8bfc8SStephen M. Cameron 		return -EACCES;
3512ba8bfc8SStephen M. Cameron 	len = count > sizeof(tmpbuf) - 1 ? sizeof(tmpbuf) - 1 : count;
3522ba8bfc8SStephen M. Cameron 	strncpy(tmpbuf, buf, len);
3532ba8bfc8SStephen M. Cameron 	tmpbuf[len] = '\0';
3542ba8bfc8SStephen M. Cameron 	if (sscanf(tmpbuf, "%d", &debug_level) != 1)
3552ba8bfc8SStephen M. Cameron 		return -EINVAL;
3562ba8bfc8SStephen M. Cameron 	if (debug_level < 0)
3572ba8bfc8SStephen M. Cameron 		debug_level = 0;
3582ba8bfc8SStephen M. Cameron 	h = shost_to_hba(shost);
3592ba8bfc8SStephen M. Cameron 	h->raid_offload_debug = debug_level;
3602ba8bfc8SStephen M. Cameron 	dev_warn(&h->pdev->dev, "hpsa: Set raid_offload_debug level = %d\n",
3612ba8bfc8SStephen M. Cameron 		h->raid_offload_debug);
3622ba8bfc8SStephen M. Cameron 	return count;
3632ba8bfc8SStephen M. Cameron }
3642ba8bfc8SStephen M. Cameron 
365edd16368SStephen M. Cameron static ssize_t host_store_rescan(struct device *dev,
366edd16368SStephen M. Cameron 				 struct device_attribute *attr,
367edd16368SStephen M. Cameron 				 const char *buf, size_t count)
368edd16368SStephen M. Cameron {
369edd16368SStephen M. Cameron 	struct ctlr_info *h;
370edd16368SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
371a23513e8SStephen M. Cameron 	h = shost_to_hba(shost);
37231468401SMike Miller 	hpsa_scan_start(h->scsi_host);
373edd16368SStephen M. Cameron 	return count;
374edd16368SStephen M. Cameron }
375edd16368SStephen M. Cameron 
376d28ce020SStephen M. Cameron static ssize_t host_show_firmware_revision(struct device *dev,
377d28ce020SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
378d28ce020SStephen M. Cameron {
379d28ce020SStephen M. Cameron 	struct ctlr_info *h;
380d28ce020SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
381d28ce020SStephen M. Cameron 	unsigned char *fwrev;
382d28ce020SStephen M. Cameron 
383d28ce020SStephen M. Cameron 	h = shost_to_hba(shost);
384d28ce020SStephen M. Cameron 	if (!h->hba_inquiry_data)
385d28ce020SStephen M. Cameron 		return 0;
386d28ce020SStephen M. Cameron 	fwrev = &h->hba_inquiry_data[32];
387d28ce020SStephen M. Cameron 	return snprintf(buf, 20, "%c%c%c%c\n",
388d28ce020SStephen M. Cameron 		fwrev[0], fwrev[1], fwrev[2], fwrev[3]);
389d28ce020SStephen M. Cameron }
390d28ce020SStephen M. Cameron 
39194a13649SStephen M. Cameron static ssize_t host_show_commands_outstanding(struct device *dev,
39294a13649SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
39394a13649SStephen M. Cameron {
39494a13649SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
39594a13649SStephen M. Cameron 	struct ctlr_info *h = shost_to_hba(shost);
39694a13649SStephen M. Cameron 
39794a13649SStephen M. Cameron 	return snprintf(buf, 20, "%d\n", h->commands_outstanding);
39894a13649SStephen M. Cameron }
39994a13649SStephen M. Cameron 
400745a7a25SStephen M. Cameron static ssize_t host_show_transport_mode(struct device *dev,
401745a7a25SStephen M. Cameron 	struct device_attribute *attr, char *buf)
402745a7a25SStephen M. Cameron {
403745a7a25SStephen M. Cameron 	struct ctlr_info *h;
404745a7a25SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
405745a7a25SStephen M. Cameron 
406745a7a25SStephen M. Cameron 	h = shost_to_hba(shost);
407745a7a25SStephen M. Cameron 	return snprintf(buf, 20, "%s\n",
408960a30e7SStephen M. Cameron 		h->transMethod & CFGTBL_Trans_Performant ?
409745a7a25SStephen M. Cameron 			"performant" : "simple");
410745a7a25SStephen M. Cameron }
411745a7a25SStephen M. Cameron 
412da0697bdSScott Teel static ssize_t host_show_hp_ssd_smart_path_status(struct device *dev,
413da0697bdSScott Teel 	struct device_attribute *attr, char *buf)
414da0697bdSScott Teel {
415da0697bdSScott Teel 	struct ctlr_info *h;
416da0697bdSScott Teel 	struct Scsi_Host *shost = class_to_shost(dev);
417da0697bdSScott Teel 
418da0697bdSScott Teel 	h = shost_to_hba(shost);
419da0697bdSScott Teel 	return snprintf(buf, 30, "HP SSD Smart Path %s\n",
420da0697bdSScott Teel 		(h->acciopath_status == 1) ?  "enabled" : "disabled");
421da0697bdSScott Teel }
422da0697bdSScott Teel 
42346380786SStephen M. Cameron /* List of controllers which cannot be hard reset on kexec with reset_devices */
424941b1cdaSStephen M. Cameron static u32 unresettable_controller[] = {
425941b1cdaSStephen M. Cameron 	0x324a103C, /* Smart Array P712m */
426941b1cdaSStephen M. Cameron 	0x324b103C, /* SmartArray P711m */
427941b1cdaSStephen M. Cameron 	0x3223103C, /* Smart Array P800 */
428941b1cdaSStephen M. Cameron 	0x3234103C, /* Smart Array P400 */
429941b1cdaSStephen M. Cameron 	0x3235103C, /* Smart Array P400i */
430941b1cdaSStephen M. Cameron 	0x3211103C, /* Smart Array E200i */
431941b1cdaSStephen M. Cameron 	0x3212103C, /* Smart Array E200 */
432941b1cdaSStephen M. Cameron 	0x3213103C, /* Smart Array E200i */
433941b1cdaSStephen M. Cameron 	0x3214103C, /* Smart Array E200i */
434941b1cdaSStephen M. Cameron 	0x3215103C, /* Smart Array E200i */
435941b1cdaSStephen M. Cameron 	0x3237103C, /* Smart Array E500 */
436941b1cdaSStephen M. Cameron 	0x323D103C, /* Smart Array P700m */
4377af0abbcSTomas Henzl 	0x40800E11, /* Smart Array 5i */
438941b1cdaSStephen M. Cameron 	0x409C0E11, /* Smart Array 6400 */
439941b1cdaSStephen M. Cameron 	0x409D0E11, /* Smart Array 6400 EM */
4405a4f934eSTomas Henzl 	0x40700E11, /* Smart Array 5300 */
4415a4f934eSTomas Henzl 	0x40820E11, /* Smart Array 532 */
4425a4f934eSTomas Henzl 	0x40830E11, /* Smart Array 5312 */
4435a4f934eSTomas Henzl 	0x409A0E11, /* Smart Array 641 */
4445a4f934eSTomas Henzl 	0x409B0E11, /* Smart Array 642 */
4455a4f934eSTomas Henzl 	0x40910E11, /* Smart Array 6i */
446941b1cdaSStephen M. Cameron };
447941b1cdaSStephen M. Cameron 
44846380786SStephen M. Cameron /* List of controllers which cannot even be soft reset */
44946380786SStephen M. Cameron static u32 soft_unresettable_controller[] = {
4507af0abbcSTomas Henzl 	0x40800E11, /* Smart Array 5i */
4515a4f934eSTomas Henzl 	0x40700E11, /* Smart Array 5300 */
4525a4f934eSTomas Henzl 	0x40820E11, /* Smart Array 532 */
4535a4f934eSTomas Henzl 	0x40830E11, /* Smart Array 5312 */
4545a4f934eSTomas Henzl 	0x409A0E11, /* Smart Array 641 */
4555a4f934eSTomas Henzl 	0x409B0E11, /* Smart Array 642 */
4565a4f934eSTomas Henzl 	0x40910E11, /* Smart Array 6i */
45746380786SStephen M. Cameron 	/* Exclude 640x boards.  These are two pci devices in one slot
45846380786SStephen M. Cameron 	 * which share a battery backed cache module.  One controls the
45946380786SStephen M. Cameron 	 * cache, the other accesses the cache through the one that controls
46046380786SStephen M. Cameron 	 * it.  If we reset the one controlling the cache, the other will
46146380786SStephen M. Cameron 	 * likely not be happy.  Just forbid resetting this conjoined mess.
46246380786SStephen M. Cameron 	 * The 640x isn't really supported by hpsa anyway.
46346380786SStephen M. Cameron 	 */
46446380786SStephen M. Cameron 	0x409C0E11, /* Smart Array 6400 */
46546380786SStephen M. Cameron 	0x409D0E11, /* Smart Array 6400 EM */
46646380786SStephen M. Cameron };
46746380786SStephen M. Cameron 
46846380786SStephen M. Cameron static int ctlr_is_hard_resettable(u32 board_id)
469941b1cdaSStephen M. Cameron {
470941b1cdaSStephen M. Cameron 	int i;
471941b1cdaSStephen M. Cameron 
472941b1cdaSStephen M. Cameron 	for (i = 0; i < ARRAY_SIZE(unresettable_controller); i++)
47346380786SStephen M. Cameron 		if (unresettable_controller[i] == board_id)
474941b1cdaSStephen M. Cameron 			return 0;
475941b1cdaSStephen M. Cameron 	return 1;
476941b1cdaSStephen M. Cameron }
477941b1cdaSStephen M. Cameron 
47846380786SStephen M. Cameron static int ctlr_is_soft_resettable(u32 board_id)
47946380786SStephen M. Cameron {
48046380786SStephen M. Cameron 	int i;
48146380786SStephen M. Cameron 
48246380786SStephen M. Cameron 	for (i = 0; i < ARRAY_SIZE(soft_unresettable_controller); i++)
48346380786SStephen M. Cameron 		if (soft_unresettable_controller[i] == board_id)
48446380786SStephen M. Cameron 			return 0;
48546380786SStephen M. Cameron 	return 1;
48646380786SStephen M. Cameron }
48746380786SStephen M. Cameron 
48846380786SStephen M. Cameron static int ctlr_is_resettable(u32 board_id)
48946380786SStephen M. Cameron {
49046380786SStephen M. Cameron 	return ctlr_is_hard_resettable(board_id) ||
49146380786SStephen M. Cameron 		ctlr_is_soft_resettable(board_id);
49246380786SStephen M. Cameron }
49346380786SStephen M. Cameron 
494941b1cdaSStephen M. Cameron static ssize_t host_show_resettable(struct device *dev,
495941b1cdaSStephen M. Cameron 	struct device_attribute *attr, char *buf)
496941b1cdaSStephen M. Cameron {
497941b1cdaSStephen M. Cameron 	struct ctlr_info *h;
498941b1cdaSStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
499941b1cdaSStephen M. Cameron 
500941b1cdaSStephen M. Cameron 	h = shost_to_hba(shost);
50146380786SStephen M. Cameron 	return snprintf(buf, 20, "%d\n", ctlr_is_resettable(h->board_id));
502941b1cdaSStephen M. Cameron }
503941b1cdaSStephen M. Cameron 
504edd16368SStephen M. Cameron static inline int is_logical_dev_addr_mode(unsigned char scsi3addr[])
505edd16368SStephen M. Cameron {
506edd16368SStephen M. Cameron 	return (scsi3addr[3] & 0xC0) == 0x40;
507edd16368SStephen M. Cameron }
508edd16368SStephen M. Cameron 
509edd16368SStephen M. Cameron static const char *raid_label[] = { "0", "4", "1(1+0)", "5", "5+1", "ADG",
510d82357eaSMike Miller 	"1(ADM)", "UNKNOWN"
511edd16368SStephen M. Cameron };
5126b80b18fSScott Teel #define HPSA_RAID_0	0
5136b80b18fSScott Teel #define HPSA_RAID_4	1
5146b80b18fSScott Teel #define HPSA_RAID_1	2	/* also used for RAID 10 */
5156b80b18fSScott Teel #define HPSA_RAID_5	3	/* also used for RAID 50 */
5166b80b18fSScott Teel #define HPSA_RAID_51	4
5176b80b18fSScott Teel #define HPSA_RAID_6	5	/* also used for RAID 60 */
5186b80b18fSScott Teel #define HPSA_RAID_ADM	6	/* also used for RAID 1+0 ADM */
519edd16368SStephen M. Cameron #define RAID_UNKNOWN (ARRAY_SIZE(raid_label) - 1)
520edd16368SStephen M. Cameron 
521edd16368SStephen M. Cameron static ssize_t raid_level_show(struct device *dev,
522edd16368SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
523edd16368SStephen M. Cameron {
524edd16368SStephen M. Cameron 	ssize_t l = 0;
52582a72c0aSStephen M. Cameron 	unsigned char rlevel;
526edd16368SStephen M. Cameron 	struct ctlr_info *h;
527edd16368SStephen M. Cameron 	struct scsi_device *sdev;
528edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *hdev;
529edd16368SStephen M. Cameron 	unsigned long flags;
530edd16368SStephen M. Cameron 
531edd16368SStephen M. Cameron 	sdev = to_scsi_device(dev);
532edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
533edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
534edd16368SStephen M. Cameron 	hdev = sdev->hostdata;
535edd16368SStephen M. Cameron 	if (!hdev) {
536edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
537edd16368SStephen M. Cameron 		return -ENODEV;
538edd16368SStephen M. Cameron 	}
539edd16368SStephen M. Cameron 
540edd16368SStephen M. Cameron 	/* Is this even a logical drive? */
541edd16368SStephen M. Cameron 	if (!is_logical_dev_addr_mode(hdev->scsi3addr)) {
542edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
543edd16368SStephen M. Cameron 		l = snprintf(buf, PAGE_SIZE, "N/A\n");
544edd16368SStephen M. Cameron 		return l;
545edd16368SStephen M. Cameron 	}
546edd16368SStephen M. Cameron 
547edd16368SStephen M. Cameron 	rlevel = hdev->raid_level;
548edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
54982a72c0aSStephen M. Cameron 	if (rlevel > RAID_UNKNOWN)
550edd16368SStephen M. Cameron 		rlevel = RAID_UNKNOWN;
551edd16368SStephen M. Cameron 	l = snprintf(buf, PAGE_SIZE, "RAID %s\n", raid_label[rlevel]);
552edd16368SStephen M. Cameron 	return l;
553edd16368SStephen M. Cameron }
554edd16368SStephen M. Cameron 
555edd16368SStephen M. Cameron static ssize_t lunid_show(struct device *dev,
556edd16368SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
557edd16368SStephen M. Cameron {
558edd16368SStephen M. Cameron 	struct ctlr_info *h;
559edd16368SStephen M. Cameron 	struct scsi_device *sdev;
560edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *hdev;
561edd16368SStephen M. Cameron 	unsigned long flags;
562edd16368SStephen M. Cameron 	unsigned char lunid[8];
563edd16368SStephen M. Cameron 
564edd16368SStephen M. Cameron 	sdev = to_scsi_device(dev);
565edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
566edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
567edd16368SStephen M. Cameron 	hdev = sdev->hostdata;
568edd16368SStephen M. Cameron 	if (!hdev) {
569edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
570edd16368SStephen M. Cameron 		return -ENODEV;
571edd16368SStephen M. Cameron 	}
572edd16368SStephen M. Cameron 	memcpy(lunid, hdev->scsi3addr, sizeof(lunid));
573edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
574edd16368SStephen M. Cameron 	return snprintf(buf, 20, "0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
575edd16368SStephen M. Cameron 		lunid[0], lunid[1], lunid[2], lunid[3],
576edd16368SStephen M. Cameron 		lunid[4], lunid[5], lunid[6], lunid[7]);
577edd16368SStephen M. Cameron }
578edd16368SStephen M. Cameron 
579edd16368SStephen M. Cameron static ssize_t unique_id_show(struct device *dev,
580edd16368SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
581edd16368SStephen M. Cameron {
582edd16368SStephen M. Cameron 	struct ctlr_info *h;
583edd16368SStephen M. Cameron 	struct scsi_device *sdev;
584edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *hdev;
585edd16368SStephen M. Cameron 	unsigned long flags;
586edd16368SStephen M. Cameron 	unsigned char sn[16];
587edd16368SStephen M. Cameron 
588edd16368SStephen M. Cameron 	sdev = to_scsi_device(dev);
589edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
590edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
591edd16368SStephen M. Cameron 	hdev = sdev->hostdata;
592edd16368SStephen M. Cameron 	if (!hdev) {
593edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
594edd16368SStephen M. Cameron 		return -ENODEV;
595edd16368SStephen M. Cameron 	}
596edd16368SStephen M. Cameron 	memcpy(sn, hdev->device_id, sizeof(sn));
597edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
598edd16368SStephen M. Cameron 	return snprintf(buf, 16 * 2 + 2,
599edd16368SStephen M. Cameron 			"%02X%02X%02X%02X%02X%02X%02X%02X"
600edd16368SStephen M. Cameron 			"%02X%02X%02X%02X%02X%02X%02X%02X\n",
601edd16368SStephen M. Cameron 			sn[0], sn[1], sn[2], sn[3],
602edd16368SStephen M. Cameron 			sn[4], sn[5], sn[6], sn[7],
603edd16368SStephen M. Cameron 			sn[8], sn[9], sn[10], sn[11],
604edd16368SStephen M. Cameron 			sn[12], sn[13], sn[14], sn[15]);
605edd16368SStephen M. Cameron }
606edd16368SStephen M. Cameron 
607c1988684SScott Teel static ssize_t host_show_hp_ssd_smart_path_enabled(struct device *dev,
608c1988684SScott Teel 	     struct device_attribute *attr, char *buf)
609c1988684SScott Teel {
610c1988684SScott Teel 	struct ctlr_info *h;
611c1988684SScott Teel 	struct scsi_device *sdev;
612c1988684SScott Teel 	struct hpsa_scsi_dev_t *hdev;
613c1988684SScott Teel 	unsigned long flags;
614c1988684SScott Teel 	int offload_enabled;
615c1988684SScott Teel 
616c1988684SScott Teel 	sdev = to_scsi_device(dev);
617c1988684SScott Teel 	h = sdev_to_hba(sdev);
618c1988684SScott Teel 	spin_lock_irqsave(&h->lock, flags);
619c1988684SScott Teel 	hdev = sdev->hostdata;
620c1988684SScott Teel 	if (!hdev) {
621c1988684SScott Teel 		spin_unlock_irqrestore(&h->lock, flags);
622c1988684SScott Teel 		return -ENODEV;
623c1988684SScott Teel 	}
624c1988684SScott Teel 	offload_enabled = hdev->offload_enabled;
625c1988684SScott Teel 	spin_unlock_irqrestore(&h->lock, flags);
626c1988684SScott Teel 	return snprintf(buf, 20, "%d\n", offload_enabled);
627c1988684SScott Teel }
628c1988684SScott Teel 
6293f5eac3aSStephen M. Cameron static DEVICE_ATTR(raid_level, S_IRUGO, raid_level_show, NULL);
6303f5eac3aSStephen M. Cameron static DEVICE_ATTR(lunid, S_IRUGO, lunid_show, NULL);
6313f5eac3aSStephen M. Cameron static DEVICE_ATTR(unique_id, S_IRUGO, unique_id_show, NULL);
6323f5eac3aSStephen M. Cameron static DEVICE_ATTR(rescan, S_IWUSR, NULL, host_store_rescan);
633c1988684SScott Teel static DEVICE_ATTR(hp_ssd_smart_path_enabled, S_IRUGO,
634c1988684SScott Teel 			host_show_hp_ssd_smart_path_enabled, NULL);
635da0697bdSScott Teel static DEVICE_ATTR(hp_ssd_smart_path_status, S_IWUSR|S_IRUGO|S_IROTH,
636da0697bdSScott Teel 		host_show_hp_ssd_smart_path_status,
637da0697bdSScott Teel 		host_store_hp_ssd_smart_path_status);
6382ba8bfc8SStephen M. Cameron static DEVICE_ATTR(raid_offload_debug, S_IWUSR, NULL,
6392ba8bfc8SStephen M. Cameron 			host_store_raid_offload_debug);
6403f5eac3aSStephen M. Cameron static DEVICE_ATTR(firmware_revision, S_IRUGO,
6413f5eac3aSStephen M. Cameron 	host_show_firmware_revision, NULL);
6423f5eac3aSStephen M. Cameron static DEVICE_ATTR(commands_outstanding, S_IRUGO,
6433f5eac3aSStephen M. Cameron 	host_show_commands_outstanding, NULL);
6443f5eac3aSStephen M. Cameron static DEVICE_ATTR(transport_mode, S_IRUGO,
6453f5eac3aSStephen M. Cameron 	host_show_transport_mode, NULL);
646941b1cdaSStephen M. Cameron static DEVICE_ATTR(resettable, S_IRUGO,
647941b1cdaSStephen M. Cameron 	host_show_resettable, NULL);
6483f5eac3aSStephen M. Cameron 
6493f5eac3aSStephen M. Cameron static struct device_attribute *hpsa_sdev_attrs[] = {
6503f5eac3aSStephen M. Cameron 	&dev_attr_raid_level,
6513f5eac3aSStephen M. Cameron 	&dev_attr_lunid,
6523f5eac3aSStephen M. Cameron 	&dev_attr_unique_id,
653c1988684SScott Teel 	&dev_attr_hp_ssd_smart_path_enabled,
6543f5eac3aSStephen M. Cameron 	NULL,
6553f5eac3aSStephen M. Cameron };
6563f5eac3aSStephen M. Cameron 
6573f5eac3aSStephen M. Cameron static struct device_attribute *hpsa_shost_attrs[] = {
6583f5eac3aSStephen M. Cameron 	&dev_attr_rescan,
6593f5eac3aSStephen M. Cameron 	&dev_attr_firmware_revision,
6603f5eac3aSStephen M. Cameron 	&dev_attr_commands_outstanding,
6613f5eac3aSStephen M. Cameron 	&dev_attr_transport_mode,
662941b1cdaSStephen M. Cameron 	&dev_attr_resettable,
663da0697bdSScott Teel 	&dev_attr_hp_ssd_smart_path_status,
6642ba8bfc8SStephen M. Cameron 	&dev_attr_raid_offload_debug,
6653f5eac3aSStephen M. Cameron 	NULL,
6663f5eac3aSStephen M. Cameron };
6673f5eac3aSStephen M. Cameron 
6683f5eac3aSStephen M. Cameron static struct scsi_host_template hpsa_driver_template = {
6693f5eac3aSStephen M. Cameron 	.module			= THIS_MODULE,
670f79cfec6SStephen M. Cameron 	.name			= HPSA,
671f79cfec6SStephen M. Cameron 	.proc_name		= HPSA,
6723f5eac3aSStephen M. Cameron 	.queuecommand		= hpsa_scsi_queue_command,
6733f5eac3aSStephen M. Cameron 	.scan_start		= hpsa_scan_start,
6743f5eac3aSStephen M. Cameron 	.scan_finished		= hpsa_scan_finished,
6753f5eac3aSStephen M. Cameron 	.change_queue_depth	= hpsa_change_queue_depth,
6763f5eac3aSStephen M. Cameron 	.this_id		= -1,
6773f5eac3aSStephen M. Cameron 	.use_clustering		= ENABLE_CLUSTERING,
67875167d2cSStephen M. Cameron 	.eh_abort_handler	= hpsa_eh_abort_handler,
6793f5eac3aSStephen M. Cameron 	.eh_device_reset_handler = hpsa_eh_device_reset_handler,
6803f5eac3aSStephen M. Cameron 	.ioctl			= hpsa_ioctl,
6813f5eac3aSStephen M. Cameron 	.slave_alloc		= hpsa_slave_alloc,
6823f5eac3aSStephen M. Cameron 	.slave_destroy		= hpsa_slave_destroy,
6833f5eac3aSStephen M. Cameron #ifdef CONFIG_COMPAT
6843f5eac3aSStephen M. Cameron 	.compat_ioctl		= hpsa_compat_ioctl,
6853f5eac3aSStephen M. Cameron #endif
6863f5eac3aSStephen M. Cameron 	.sdev_attrs = hpsa_sdev_attrs,
6873f5eac3aSStephen M. Cameron 	.shost_attrs = hpsa_shost_attrs,
688c0d6a4d1SStephen M. Cameron 	.max_sectors = 8192,
68954b2b50cSMartin K. Petersen 	.no_write_same = 1,
6903f5eac3aSStephen M. Cameron };
6913f5eac3aSStephen M. Cameron 
6923f5eac3aSStephen M. Cameron 
6933f5eac3aSStephen M. Cameron /* Enqueuing and dequeuing functions for cmdlists. */
6943f5eac3aSStephen M. Cameron static inline void addQ(struct list_head *list, struct CommandList *c)
6953f5eac3aSStephen M. Cameron {
6963f5eac3aSStephen M. Cameron 	list_add_tail(&c->list, list);
6973f5eac3aSStephen M. Cameron }
6983f5eac3aSStephen M. Cameron 
699254f796bSMatt Gates static inline u32 next_command(struct ctlr_info *h, u8 q)
7003f5eac3aSStephen M. Cameron {
7013f5eac3aSStephen M. Cameron 	u32 a;
702072b0518SStephen M. Cameron 	struct reply_queue_buffer *rq = &h->reply_queue[q];
703e16a33adSMatt Gates 	unsigned long flags;
7043f5eac3aSStephen M. Cameron 
705e1f7de0cSMatt Gates 	if (h->transMethod & CFGTBL_Trans_io_accel1)
706e1f7de0cSMatt Gates 		return h->access.command_completed(h, q);
707e1f7de0cSMatt Gates 
7083f5eac3aSStephen M. Cameron 	if (unlikely(!(h->transMethod & CFGTBL_Trans_Performant)))
709254f796bSMatt Gates 		return h->access.command_completed(h, q);
7103f5eac3aSStephen M. Cameron 
711254f796bSMatt Gates 	if ((rq->head[rq->current_entry] & 1) == rq->wraparound) {
712254f796bSMatt Gates 		a = rq->head[rq->current_entry];
713254f796bSMatt Gates 		rq->current_entry++;
714e16a33adSMatt Gates 		spin_lock_irqsave(&h->lock, flags);
7153f5eac3aSStephen M. Cameron 		h->commands_outstanding--;
716e16a33adSMatt Gates 		spin_unlock_irqrestore(&h->lock, flags);
7173f5eac3aSStephen M. Cameron 	} else {
7183f5eac3aSStephen M. Cameron 		a = FIFO_EMPTY;
7193f5eac3aSStephen M. Cameron 	}
7203f5eac3aSStephen M. Cameron 	/* Check for wraparound */
721254f796bSMatt Gates 	if (rq->current_entry == h->max_commands) {
722254f796bSMatt Gates 		rq->current_entry = 0;
723254f796bSMatt Gates 		rq->wraparound ^= 1;
7243f5eac3aSStephen M. Cameron 	}
7253f5eac3aSStephen M. Cameron 	return a;
7263f5eac3aSStephen M. Cameron }
7273f5eac3aSStephen M. Cameron 
728c349775eSScott Teel /*
729c349775eSScott Teel  * There are some special bits in the bus address of the
730c349775eSScott Teel  * command that we have to set for the controller to know
731c349775eSScott Teel  * how to process the command:
732c349775eSScott Teel  *
733c349775eSScott Teel  * Normal performant mode:
734c349775eSScott Teel  * bit 0: 1 means performant mode, 0 means simple mode.
735c349775eSScott Teel  * bits 1-3 = block fetch table entry
736c349775eSScott Teel  * bits 4-6 = command type (== 0)
737c349775eSScott Teel  *
738c349775eSScott Teel  * ioaccel1 mode:
739c349775eSScott Teel  * bit 0 = "performant mode" bit.
740c349775eSScott Teel  * bits 1-3 = block fetch table entry
741c349775eSScott Teel  * bits 4-6 = command type (== 110)
742c349775eSScott Teel  * (command type is needed because ioaccel1 mode
743c349775eSScott Teel  * commands are submitted through the same register as normal
744c349775eSScott Teel  * mode commands, so this is how the controller knows whether
745c349775eSScott Teel  * the command is normal mode or ioaccel1 mode.)
746c349775eSScott Teel  *
747c349775eSScott Teel  * ioaccel2 mode:
748c349775eSScott Teel  * bit 0 = "performant mode" bit.
749c349775eSScott Teel  * bits 1-4 = block fetch table entry (note extra bit)
750c349775eSScott Teel  * bits 4-6 = not needed, because ioaccel2 mode has
751c349775eSScott Teel  * a separate special register for submitting commands.
752c349775eSScott Teel  */
753c349775eSScott Teel 
7543f5eac3aSStephen M. Cameron /* set_performant_mode: Modify the tag for cciss performant
7553f5eac3aSStephen M. Cameron  * set bit 0 for pull model, bits 3-1 for block fetch
7563f5eac3aSStephen M. Cameron  * register number
7573f5eac3aSStephen M. Cameron  */
7583f5eac3aSStephen M. Cameron static void set_performant_mode(struct ctlr_info *h, struct CommandList *c)
7593f5eac3aSStephen M. Cameron {
760254f796bSMatt Gates 	if (likely(h->transMethod & CFGTBL_Trans_Performant)) {
7613f5eac3aSStephen M. Cameron 		c->busaddr |= 1 | (h->blockFetchTable[c->Header.SGList] << 1);
762eee0f03aSHannes Reinecke 		if (likely(h->msix_vector > 0))
763254f796bSMatt Gates 			c->Header.ReplyQueue =
764804a5cb5SJohn Kacur 				raw_smp_processor_id() % h->nreply_queues;
765254f796bSMatt Gates 	}
7663f5eac3aSStephen M. Cameron }
7673f5eac3aSStephen M. Cameron 
768c349775eSScott Teel static void set_ioaccel1_performant_mode(struct ctlr_info *h,
769c349775eSScott Teel 						struct CommandList *c)
770c349775eSScott Teel {
771c349775eSScott Teel 	struct io_accel1_cmd *cp = &h->ioaccel_cmd_pool[c->cmdindex];
772c349775eSScott Teel 
773c349775eSScott Teel 	/* Tell the controller to post the reply to the queue for this
774c349775eSScott Teel 	 * processor.  This seems to give the best I/O throughput.
775c349775eSScott Teel 	 */
776c349775eSScott Teel 	cp->ReplyQueue = smp_processor_id() % h->nreply_queues;
777c349775eSScott Teel 	/* Set the bits in the address sent down to include:
778c349775eSScott Teel 	 *  - performant mode bit (bit 0)
779c349775eSScott Teel 	 *  - pull count (bits 1-3)
780c349775eSScott Teel 	 *  - command type (bits 4-6)
781c349775eSScott Teel 	 */
782c349775eSScott Teel 	c->busaddr |= 1 | (h->ioaccel1_blockFetchTable[c->Header.SGList] << 1) |
783c349775eSScott Teel 					IOACCEL1_BUSADDR_CMDTYPE;
784c349775eSScott Teel }
785c349775eSScott Teel 
786c349775eSScott Teel static void set_ioaccel2_performant_mode(struct ctlr_info *h,
787c349775eSScott Teel 						struct CommandList *c)
788c349775eSScott Teel {
789c349775eSScott Teel 	struct io_accel2_cmd *cp = &h->ioaccel2_cmd_pool[c->cmdindex];
790c349775eSScott Teel 
791c349775eSScott Teel 	/* Tell the controller to post the reply to the queue for this
792c349775eSScott Teel 	 * processor.  This seems to give the best I/O throughput.
793c349775eSScott Teel 	 */
794c349775eSScott Teel 	cp->reply_queue = smp_processor_id() % h->nreply_queues;
795c349775eSScott Teel 	/* Set the bits in the address sent down to include:
796c349775eSScott Teel 	 *  - performant mode bit not used in ioaccel mode 2
797c349775eSScott Teel 	 *  - pull count (bits 0-3)
798c349775eSScott Teel 	 *  - command type isn't needed for ioaccel2
799c349775eSScott Teel 	 */
800c349775eSScott Teel 	c->busaddr |= (h->ioaccel2_blockFetchTable[cp->sg_count]);
801c349775eSScott Teel }
802c349775eSScott Teel 
803e85c5974SStephen M. Cameron static int is_firmware_flash_cmd(u8 *cdb)
804e85c5974SStephen M. Cameron {
805e85c5974SStephen M. Cameron 	return cdb[0] == BMIC_WRITE && cdb[6] == BMIC_FLASH_FIRMWARE;
806e85c5974SStephen M. Cameron }
807e85c5974SStephen M. Cameron 
808e85c5974SStephen M. Cameron /*
809e85c5974SStephen M. Cameron  * During firmware flash, the heartbeat register may not update as frequently
810e85c5974SStephen M. Cameron  * as it should.  So we dial down lockup detection during firmware flash. and
811e85c5974SStephen M. Cameron  * dial it back up when firmware flash completes.
812e85c5974SStephen M. Cameron  */
813e85c5974SStephen M. Cameron #define HEARTBEAT_SAMPLE_INTERVAL_DURING_FLASH (240 * HZ)
814e85c5974SStephen M. Cameron #define HEARTBEAT_SAMPLE_INTERVAL (30 * HZ)
815e85c5974SStephen M. Cameron static void dial_down_lockup_detection_during_fw_flash(struct ctlr_info *h,
816e85c5974SStephen M. Cameron 		struct CommandList *c)
817e85c5974SStephen M. Cameron {
818e85c5974SStephen M. Cameron 	if (!is_firmware_flash_cmd(c->Request.CDB))
819e85c5974SStephen M. Cameron 		return;
820e85c5974SStephen M. Cameron 	atomic_inc(&h->firmware_flash_in_progress);
821e85c5974SStephen M. Cameron 	h->heartbeat_sample_interval = HEARTBEAT_SAMPLE_INTERVAL_DURING_FLASH;
822e85c5974SStephen M. Cameron }
823e85c5974SStephen M. Cameron 
824e85c5974SStephen M. Cameron static void dial_up_lockup_detection_on_fw_flash_complete(struct ctlr_info *h,
825e85c5974SStephen M. Cameron 		struct CommandList *c)
826e85c5974SStephen M. Cameron {
827e85c5974SStephen M. Cameron 	if (is_firmware_flash_cmd(c->Request.CDB) &&
828e85c5974SStephen M. Cameron 		atomic_dec_and_test(&h->firmware_flash_in_progress))
829e85c5974SStephen M. Cameron 		h->heartbeat_sample_interval = HEARTBEAT_SAMPLE_INTERVAL;
830e85c5974SStephen M. Cameron }
831e85c5974SStephen M. Cameron 
8323f5eac3aSStephen M. Cameron static void enqueue_cmd_and_start_io(struct ctlr_info *h,
8333f5eac3aSStephen M. Cameron 	struct CommandList *c)
8343f5eac3aSStephen M. Cameron {
8353f5eac3aSStephen M. Cameron 	unsigned long flags;
8363f5eac3aSStephen M. Cameron 
837c349775eSScott Teel 	switch (c->cmd_type) {
838c349775eSScott Teel 	case CMD_IOACCEL1:
839c349775eSScott Teel 		set_ioaccel1_performant_mode(h, c);
840c349775eSScott Teel 		break;
841c349775eSScott Teel 	case CMD_IOACCEL2:
842c349775eSScott Teel 		set_ioaccel2_performant_mode(h, c);
843c349775eSScott Teel 		break;
844c349775eSScott Teel 	default:
8453f5eac3aSStephen M. Cameron 		set_performant_mode(h, c);
846c349775eSScott Teel 	}
847e85c5974SStephen M. Cameron 	dial_down_lockup_detection_during_fw_flash(h, c);
8483f5eac3aSStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
8493f5eac3aSStephen M. Cameron 	addQ(&h->reqQ, c);
8503f5eac3aSStephen M. Cameron 	h->Qdepth++;
8510b57075dSStephen M. Cameron 	start_io(h, &flags);
8523f5eac3aSStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
8533f5eac3aSStephen M. Cameron }
8543f5eac3aSStephen M. Cameron 
8553f5eac3aSStephen M. Cameron static inline void removeQ(struct CommandList *c)
8563f5eac3aSStephen M. Cameron {
8573f5eac3aSStephen M. Cameron 	if (WARN_ON(list_empty(&c->list)))
8583f5eac3aSStephen M. Cameron 		return;
8593f5eac3aSStephen M. Cameron 	list_del_init(&c->list);
8603f5eac3aSStephen M. Cameron }
8613f5eac3aSStephen M. Cameron 
8623f5eac3aSStephen M. Cameron static inline int is_hba_lunid(unsigned char scsi3addr[])
8633f5eac3aSStephen M. Cameron {
8643f5eac3aSStephen M. Cameron 	return memcmp(scsi3addr, RAID_CTLR_LUNID, 8) == 0;
8653f5eac3aSStephen M. Cameron }
8663f5eac3aSStephen M. Cameron 
8673f5eac3aSStephen M. Cameron static inline int is_scsi_rev_5(struct ctlr_info *h)
8683f5eac3aSStephen M. Cameron {
8693f5eac3aSStephen M. Cameron 	if (!h->hba_inquiry_data)
8703f5eac3aSStephen M. Cameron 		return 0;
8713f5eac3aSStephen M. Cameron 	if ((h->hba_inquiry_data[2] & 0x07) == 5)
8723f5eac3aSStephen M. Cameron 		return 1;
8733f5eac3aSStephen M. Cameron 	return 0;
8743f5eac3aSStephen M. Cameron }
8753f5eac3aSStephen M. Cameron 
876edd16368SStephen M. Cameron static int hpsa_find_target_lun(struct ctlr_info *h,
877edd16368SStephen M. Cameron 	unsigned char scsi3addr[], int bus, int *target, int *lun)
878edd16368SStephen M. Cameron {
879edd16368SStephen M. Cameron 	/* finds an unused bus, target, lun for a new physical device
880edd16368SStephen M. Cameron 	 * assumes h->devlock is held
881edd16368SStephen M. Cameron 	 */
882edd16368SStephen M. Cameron 	int i, found = 0;
883cfe5badcSScott Teel 	DECLARE_BITMAP(lun_taken, HPSA_MAX_DEVICES);
884edd16368SStephen M. Cameron 
885263d9401SAkinobu Mita 	bitmap_zero(lun_taken, HPSA_MAX_DEVICES);
886edd16368SStephen M. Cameron 
887edd16368SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++) {
888edd16368SStephen M. Cameron 		if (h->dev[i]->bus == bus && h->dev[i]->target != -1)
889263d9401SAkinobu Mita 			__set_bit(h->dev[i]->target, lun_taken);
890edd16368SStephen M. Cameron 	}
891edd16368SStephen M. Cameron 
892263d9401SAkinobu Mita 	i = find_first_zero_bit(lun_taken, HPSA_MAX_DEVICES);
893263d9401SAkinobu Mita 	if (i < HPSA_MAX_DEVICES) {
894edd16368SStephen M. Cameron 		/* *bus = 1; */
895edd16368SStephen M. Cameron 		*target = i;
896edd16368SStephen M. Cameron 		*lun = 0;
897edd16368SStephen M. Cameron 		found = 1;
898edd16368SStephen M. Cameron 	}
899edd16368SStephen M. Cameron 	return !found;
900edd16368SStephen M. Cameron }
901edd16368SStephen M. Cameron 
902edd16368SStephen M. Cameron /* Add an entry into h->dev[] array. */
903edd16368SStephen M. Cameron static int hpsa_scsi_add_entry(struct ctlr_info *h, int hostno,
904edd16368SStephen M. Cameron 		struct hpsa_scsi_dev_t *device,
905edd16368SStephen M. Cameron 		struct hpsa_scsi_dev_t *added[], int *nadded)
906edd16368SStephen M. Cameron {
907edd16368SStephen M. Cameron 	/* assumes h->devlock is held */
908edd16368SStephen M. Cameron 	int n = h->ndevices;
909edd16368SStephen M. Cameron 	int i;
910edd16368SStephen M. Cameron 	unsigned char addr1[8], addr2[8];
911edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
912edd16368SStephen M. Cameron 
913cfe5badcSScott Teel 	if (n >= HPSA_MAX_DEVICES) {
914edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "too many devices, some will be "
915edd16368SStephen M. Cameron 			"inaccessible.\n");
916edd16368SStephen M. Cameron 		return -1;
917edd16368SStephen M. Cameron 	}
918edd16368SStephen M. Cameron 
919edd16368SStephen M. Cameron 	/* physical devices do not have lun or target assigned until now. */
920edd16368SStephen M. Cameron 	if (device->lun != -1)
921edd16368SStephen M. Cameron 		/* Logical device, lun is already assigned. */
922edd16368SStephen M. Cameron 		goto lun_assigned;
923edd16368SStephen M. Cameron 
924edd16368SStephen M. Cameron 	/* If this device a non-zero lun of a multi-lun device
925edd16368SStephen M. Cameron 	 * byte 4 of the 8-byte LUN addr will contain the logical
926edd16368SStephen M. Cameron 	 * unit no, zero otherise.
927edd16368SStephen M. Cameron 	 */
928edd16368SStephen M. Cameron 	if (device->scsi3addr[4] == 0) {
929edd16368SStephen M. Cameron 		/* This is not a non-zero lun of a multi-lun device */
930edd16368SStephen M. Cameron 		if (hpsa_find_target_lun(h, device->scsi3addr,
931edd16368SStephen M. Cameron 			device->bus, &device->target, &device->lun) != 0)
932edd16368SStephen M. Cameron 			return -1;
933edd16368SStephen M. Cameron 		goto lun_assigned;
934edd16368SStephen M. Cameron 	}
935edd16368SStephen M. Cameron 
936edd16368SStephen M. Cameron 	/* This is a non-zero lun of a multi-lun device.
937edd16368SStephen M. Cameron 	 * Search through our list and find the device which
938edd16368SStephen M. Cameron 	 * has the same 8 byte LUN address, excepting byte 4.
939edd16368SStephen M. Cameron 	 * Assign the same bus and target for this new LUN.
940edd16368SStephen M. Cameron 	 * Use the logical unit number from the firmware.
941edd16368SStephen M. Cameron 	 */
942edd16368SStephen M. Cameron 	memcpy(addr1, device->scsi3addr, 8);
943edd16368SStephen M. Cameron 	addr1[4] = 0;
944edd16368SStephen M. Cameron 	for (i = 0; i < n; i++) {
945edd16368SStephen M. Cameron 		sd = h->dev[i];
946edd16368SStephen M. Cameron 		memcpy(addr2, sd->scsi3addr, 8);
947edd16368SStephen M. Cameron 		addr2[4] = 0;
948edd16368SStephen M. Cameron 		/* differ only in byte 4? */
949edd16368SStephen M. Cameron 		if (memcmp(addr1, addr2, 8) == 0) {
950edd16368SStephen M. Cameron 			device->bus = sd->bus;
951edd16368SStephen M. Cameron 			device->target = sd->target;
952edd16368SStephen M. Cameron 			device->lun = device->scsi3addr[4];
953edd16368SStephen M. Cameron 			break;
954edd16368SStephen M. Cameron 		}
955edd16368SStephen M. Cameron 	}
956edd16368SStephen M. Cameron 	if (device->lun == -1) {
957edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "physical device with no LUN=0,"
958edd16368SStephen M. Cameron 			" suspect firmware bug or unsupported hardware "
959edd16368SStephen M. Cameron 			"configuration.\n");
960edd16368SStephen M. Cameron 			return -1;
961edd16368SStephen M. Cameron 	}
962edd16368SStephen M. Cameron 
963edd16368SStephen M. Cameron lun_assigned:
964edd16368SStephen M. Cameron 
965edd16368SStephen M. Cameron 	h->dev[n] = device;
966edd16368SStephen M. Cameron 	h->ndevices++;
967edd16368SStephen M. Cameron 	added[*nadded] = device;
968edd16368SStephen M. Cameron 	(*nadded)++;
969edd16368SStephen M. Cameron 
970edd16368SStephen M. Cameron 	/* initially, (before registering with scsi layer) we don't
971edd16368SStephen M. Cameron 	 * know our hostno and we don't want to print anything first
972edd16368SStephen M. Cameron 	 * time anyway (the scsi layer's inquiries will show that info)
973edd16368SStephen M. Cameron 	 */
974edd16368SStephen M. Cameron 	/* if (hostno != -1) */
975edd16368SStephen M. Cameron 		dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d added.\n",
976edd16368SStephen M. Cameron 			scsi_device_type(device->devtype), hostno,
977edd16368SStephen M. Cameron 			device->bus, device->target, device->lun);
978edd16368SStephen M. Cameron 	return 0;
979edd16368SStephen M. Cameron }
980edd16368SStephen M. Cameron 
981bd9244f7SScott Teel /* Update an entry in h->dev[] array. */
982bd9244f7SScott Teel static void hpsa_scsi_update_entry(struct ctlr_info *h, int hostno,
983bd9244f7SScott Teel 	int entry, struct hpsa_scsi_dev_t *new_entry)
984bd9244f7SScott Teel {
985bd9244f7SScott Teel 	/* assumes h->devlock is held */
986bd9244f7SScott Teel 	BUG_ON(entry < 0 || entry >= HPSA_MAX_DEVICES);
987bd9244f7SScott Teel 
988bd9244f7SScott Teel 	/* Raid level changed. */
989bd9244f7SScott Teel 	h->dev[entry]->raid_level = new_entry->raid_level;
990250fb125SStephen M. Cameron 
991250fb125SStephen M. Cameron 	/* Raid offload parameters changed. */
992250fb125SStephen M. Cameron 	h->dev[entry]->offload_config = new_entry->offload_config;
993250fb125SStephen M. Cameron 	h->dev[entry]->offload_enabled = new_entry->offload_enabled;
9949fb0de2dSStephen M. Cameron 	h->dev[entry]->ioaccel_handle = new_entry->ioaccel_handle;
9959fb0de2dSStephen M. Cameron 	h->dev[entry]->offload_to_mirror = new_entry->offload_to_mirror;
9969fb0de2dSStephen M. Cameron 	h->dev[entry]->raid_map = new_entry->raid_map;
997250fb125SStephen M. Cameron 
998bd9244f7SScott Teel 	dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d updated.\n",
999bd9244f7SScott Teel 		scsi_device_type(new_entry->devtype), hostno, new_entry->bus,
1000bd9244f7SScott Teel 		new_entry->target, new_entry->lun);
1001bd9244f7SScott Teel }
1002bd9244f7SScott Teel 
10032a8ccf31SStephen M. Cameron /* Replace an entry from h->dev[] array. */
10042a8ccf31SStephen M. Cameron static void hpsa_scsi_replace_entry(struct ctlr_info *h, int hostno,
10052a8ccf31SStephen M. Cameron 	int entry, struct hpsa_scsi_dev_t *new_entry,
10062a8ccf31SStephen M. Cameron 	struct hpsa_scsi_dev_t *added[], int *nadded,
10072a8ccf31SStephen M. Cameron 	struct hpsa_scsi_dev_t *removed[], int *nremoved)
10082a8ccf31SStephen M. Cameron {
10092a8ccf31SStephen M. Cameron 	/* assumes h->devlock is held */
1010cfe5badcSScott Teel 	BUG_ON(entry < 0 || entry >= HPSA_MAX_DEVICES);
10112a8ccf31SStephen M. Cameron 	removed[*nremoved] = h->dev[entry];
10122a8ccf31SStephen M. Cameron 	(*nremoved)++;
101301350d05SStephen M. Cameron 
101401350d05SStephen M. Cameron 	/*
101501350d05SStephen M. Cameron 	 * New physical devices won't have target/lun assigned yet
101601350d05SStephen M. Cameron 	 * so we need to preserve the values in the slot we are replacing.
101701350d05SStephen M. Cameron 	 */
101801350d05SStephen M. Cameron 	if (new_entry->target == -1) {
101901350d05SStephen M. Cameron 		new_entry->target = h->dev[entry]->target;
102001350d05SStephen M. Cameron 		new_entry->lun = h->dev[entry]->lun;
102101350d05SStephen M. Cameron 	}
102201350d05SStephen M. Cameron 
10232a8ccf31SStephen M. Cameron 	h->dev[entry] = new_entry;
10242a8ccf31SStephen M. Cameron 	added[*nadded] = new_entry;
10252a8ccf31SStephen M. Cameron 	(*nadded)++;
10262a8ccf31SStephen M. Cameron 	dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d changed.\n",
10272a8ccf31SStephen M. Cameron 		scsi_device_type(new_entry->devtype), hostno, new_entry->bus,
10282a8ccf31SStephen M. Cameron 			new_entry->target, new_entry->lun);
10292a8ccf31SStephen M. Cameron }
10302a8ccf31SStephen M. Cameron 
1031edd16368SStephen M. Cameron /* Remove an entry from h->dev[] array. */
1032edd16368SStephen M. Cameron static void hpsa_scsi_remove_entry(struct ctlr_info *h, int hostno, int entry,
1033edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *removed[], int *nremoved)
1034edd16368SStephen M. Cameron {
1035edd16368SStephen M. Cameron 	/* assumes h->devlock is held */
1036edd16368SStephen M. Cameron 	int i;
1037edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
1038edd16368SStephen M. Cameron 
1039cfe5badcSScott Teel 	BUG_ON(entry < 0 || entry >= HPSA_MAX_DEVICES);
1040edd16368SStephen M. Cameron 
1041edd16368SStephen M. Cameron 	sd = h->dev[entry];
1042edd16368SStephen M. Cameron 	removed[*nremoved] = h->dev[entry];
1043edd16368SStephen M. Cameron 	(*nremoved)++;
1044edd16368SStephen M. Cameron 
1045edd16368SStephen M. Cameron 	for (i = entry; i < h->ndevices-1; i++)
1046edd16368SStephen M. Cameron 		h->dev[i] = h->dev[i+1];
1047edd16368SStephen M. Cameron 	h->ndevices--;
1048edd16368SStephen M. Cameron 	dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d removed.\n",
1049edd16368SStephen M. Cameron 		scsi_device_type(sd->devtype), hostno, sd->bus, sd->target,
1050edd16368SStephen M. Cameron 		sd->lun);
1051edd16368SStephen M. Cameron }
1052edd16368SStephen M. Cameron 
1053edd16368SStephen M. Cameron #define SCSI3ADDR_EQ(a, b) ( \
1054edd16368SStephen M. Cameron 	(a)[7] == (b)[7] && \
1055edd16368SStephen M. Cameron 	(a)[6] == (b)[6] && \
1056edd16368SStephen M. Cameron 	(a)[5] == (b)[5] && \
1057edd16368SStephen M. Cameron 	(a)[4] == (b)[4] && \
1058edd16368SStephen M. Cameron 	(a)[3] == (b)[3] && \
1059edd16368SStephen M. Cameron 	(a)[2] == (b)[2] && \
1060edd16368SStephen M. Cameron 	(a)[1] == (b)[1] && \
1061edd16368SStephen M. Cameron 	(a)[0] == (b)[0])
1062edd16368SStephen M. Cameron 
1063edd16368SStephen M. Cameron static void fixup_botched_add(struct ctlr_info *h,
1064edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *added)
1065edd16368SStephen M. Cameron {
1066edd16368SStephen M. Cameron 	/* called when scsi_add_device fails in order to re-adjust
1067edd16368SStephen M. Cameron 	 * h->dev[] to match the mid layer's view.
1068edd16368SStephen M. Cameron 	 */
1069edd16368SStephen M. Cameron 	unsigned long flags;
1070edd16368SStephen M. Cameron 	int i, j;
1071edd16368SStephen M. Cameron 
1072edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
1073edd16368SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++) {
1074edd16368SStephen M. Cameron 		if (h->dev[i] == added) {
1075edd16368SStephen M. Cameron 			for (j = i; j < h->ndevices-1; j++)
1076edd16368SStephen M. Cameron 				h->dev[j] = h->dev[j+1];
1077edd16368SStephen M. Cameron 			h->ndevices--;
1078edd16368SStephen M. Cameron 			break;
1079edd16368SStephen M. Cameron 		}
1080edd16368SStephen M. Cameron 	}
1081edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
1082edd16368SStephen M. Cameron 	kfree(added);
1083edd16368SStephen M. Cameron }
1084edd16368SStephen M. Cameron 
1085edd16368SStephen M. Cameron static inline int device_is_the_same(struct hpsa_scsi_dev_t *dev1,
1086edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *dev2)
1087edd16368SStephen M. Cameron {
1088edd16368SStephen M. Cameron 	/* we compare everything except lun and target as these
1089edd16368SStephen M. Cameron 	 * are not yet assigned.  Compare parts likely
1090edd16368SStephen M. Cameron 	 * to differ first
1091edd16368SStephen M. Cameron 	 */
1092edd16368SStephen M. Cameron 	if (memcmp(dev1->scsi3addr, dev2->scsi3addr,
1093edd16368SStephen M. Cameron 		sizeof(dev1->scsi3addr)) != 0)
1094edd16368SStephen M. Cameron 		return 0;
1095edd16368SStephen M. Cameron 	if (memcmp(dev1->device_id, dev2->device_id,
1096edd16368SStephen M. Cameron 		sizeof(dev1->device_id)) != 0)
1097edd16368SStephen M. Cameron 		return 0;
1098edd16368SStephen M. Cameron 	if (memcmp(dev1->model, dev2->model, sizeof(dev1->model)) != 0)
1099edd16368SStephen M. Cameron 		return 0;
1100edd16368SStephen M. Cameron 	if (memcmp(dev1->vendor, dev2->vendor, sizeof(dev1->vendor)) != 0)
1101edd16368SStephen M. Cameron 		return 0;
1102edd16368SStephen M. Cameron 	if (dev1->devtype != dev2->devtype)
1103edd16368SStephen M. Cameron 		return 0;
1104edd16368SStephen M. Cameron 	if (dev1->bus != dev2->bus)
1105edd16368SStephen M. Cameron 		return 0;
1106edd16368SStephen M. Cameron 	return 1;
1107edd16368SStephen M. Cameron }
1108edd16368SStephen M. Cameron 
1109bd9244f7SScott Teel static inline int device_updated(struct hpsa_scsi_dev_t *dev1,
1110bd9244f7SScott Teel 	struct hpsa_scsi_dev_t *dev2)
1111bd9244f7SScott Teel {
1112bd9244f7SScott Teel 	/* Device attributes that can change, but don't mean
1113bd9244f7SScott Teel 	 * that the device is a different device, nor that the OS
1114bd9244f7SScott Teel 	 * needs to be told anything about the change.
1115bd9244f7SScott Teel 	 */
1116bd9244f7SScott Teel 	if (dev1->raid_level != dev2->raid_level)
1117bd9244f7SScott Teel 		return 1;
1118250fb125SStephen M. Cameron 	if (dev1->offload_config != dev2->offload_config)
1119250fb125SStephen M. Cameron 		return 1;
1120250fb125SStephen M. Cameron 	if (dev1->offload_enabled != dev2->offload_enabled)
1121250fb125SStephen M. Cameron 		return 1;
1122bd9244f7SScott Teel 	return 0;
1123bd9244f7SScott Teel }
1124bd9244f7SScott Teel 
1125edd16368SStephen M. Cameron /* Find needle in haystack.  If exact match found, return DEVICE_SAME,
1126edd16368SStephen M. Cameron  * and return needle location in *index.  If scsi3addr matches, but not
1127edd16368SStephen M. Cameron  * vendor, model, serial num, etc. return DEVICE_CHANGED, and return needle
1128bd9244f7SScott Teel  * location in *index.
1129bd9244f7SScott Teel  * In the case of a minor device attribute change, such as RAID level, just
1130bd9244f7SScott Teel  * return DEVICE_UPDATED, along with the updated device's location in index.
1131bd9244f7SScott Teel  * If needle not found, return DEVICE_NOT_FOUND.
1132edd16368SStephen M. Cameron  */
1133edd16368SStephen M. Cameron static int hpsa_scsi_find_entry(struct hpsa_scsi_dev_t *needle,
1134edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *haystack[], int haystack_size,
1135edd16368SStephen M. Cameron 	int *index)
1136edd16368SStephen M. Cameron {
1137edd16368SStephen M. Cameron 	int i;
1138edd16368SStephen M. Cameron #define DEVICE_NOT_FOUND 0
1139edd16368SStephen M. Cameron #define DEVICE_CHANGED 1
1140edd16368SStephen M. Cameron #define DEVICE_SAME 2
1141bd9244f7SScott Teel #define DEVICE_UPDATED 3
1142edd16368SStephen M. Cameron 	for (i = 0; i < haystack_size; i++) {
114323231048SStephen M. Cameron 		if (haystack[i] == NULL) /* previously removed. */
114423231048SStephen M. Cameron 			continue;
1145edd16368SStephen M. Cameron 		if (SCSI3ADDR_EQ(needle->scsi3addr, haystack[i]->scsi3addr)) {
1146edd16368SStephen M. Cameron 			*index = i;
1147bd9244f7SScott Teel 			if (device_is_the_same(needle, haystack[i])) {
1148bd9244f7SScott Teel 				if (device_updated(needle, haystack[i]))
1149bd9244f7SScott Teel 					return DEVICE_UPDATED;
1150edd16368SStephen M. Cameron 				return DEVICE_SAME;
1151bd9244f7SScott Teel 			} else {
11529846590eSStephen M. Cameron 				/* Keep offline devices offline */
11539846590eSStephen M. Cameron 				if (needle->volume_offline)
11549846590eSStephen M. Cameron 					return DEVICE_NOT_FOUND;
1155edd16368SStephen M. Cameron 				return DEVICE_CHANGED;
1156edd16368SStephen M. Cameron 			}
1157edd16368SStephen M. Cameron 		}
1158bd9244f7SScott Teel 	}
1159edd16368SStephen M. Cameron 	*index = -1;
1160edd16368SStephen M. Cameron 	return DEVICE_NOT_FOUND;
1161edd16368SStephen M. Cameron }
1162edd16368SStephen M. Cameron 
11639846590eSStephen M. Cameron static void hpsa_monitor_offline_device(struct ctlr_info *h,
11649846590eSStephen M. Cameron 					unsigned char scsi3addr[])
11659846590eSStephen M. Cameron {
11669846590eSStephen M. Cameron 	struct offline_device_entry *device;
11679846590eSStephen M. Cameron 	unsigned long flags;
11689846590eSStephen M. Cameron 
11699846590eSStephen M. Cameron 	/* Check to see if device is already on the list */
11709846590eSStephen M. Cameron 	spin_lock_irqsave(&h->offline_device_lock, flags);
11719846590eSStephen M. Cameron 	list_for_each_entry(device, &h->offline_device_list, offline_list) {
11729846590eSStephen M. Cameron 		if (memcmp(device->scsi3addr, scsi3addr,
11739846590eSStephen M. Cameron 			sizeof(device->scsi3addr)) == 0) {
11749846590eSStephen M. Cameron 			spin_unlock_irqrestore(&h->offline_device_lock, flags);
11759846590eSStephen M. Cameron 			return;
11769846590eSStephen M. Cameron 		}
11779846590eSStephen M. Cameron 	}
11789846590eSStephen M. Cameron 	spin_unlock_irqrestore(&h->offline_device_lock, flags);
11799846590eSStephen M. Cameron 
11809846590eSStephen M. Cameron 	/* Device is not on the list, add it. */
11819846590eSStephen M. Cameron 	device = kmalloc(sizeof(*device), GFP_KERNEL);
11829846590eSStephen M. Cameron 	if (!device) {
11839846590eSStephen M. Cameron 		dev_warn(&h->pdev->dev, "out of memory in %s\n", __func__);
11849846590eSStephen M. Cameron 		return;
11859846590eSStephen M. Cameron 	}
11869846590eSStephen M. Cameron 	memcpy(device->scsi3addr, scsi3addr, sizeof(device->scsi3addr));
11879846590eSStephen M. Cameron 	spin_lock_irqsave(&h->offline_device_lock, flags);
11889846590eSStephen M. Cameron 	list_add_tail(&device->offline_list, &h->offline_device_list);
11899846590eSStephen M. Cameron 	spin_unlock_irqrestore(&h->offline_device_lock, flags);
11909846590eSStephen M. Cameron }
11919846590eSStephen M. Cameron 
11929846590eSStephen M. Cameron /* Print a message explaining various offline volume states */
11939846590eSStephen M. Cameron static void hpsa_show_volume_status(struct ctlr_info *h,
11949846590eSStephen M. Cameron 	struct hpsa_scsi_dev_t *sd)
11959846590eSStephen M. Cameron {
11969846590eSStephen M. Cameron 	if (sd->volume_offline == HPSA_VPD_LV_STATUS_UNSUPPORTED)
11979846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
11989846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume status is not available through vital product data pages.\n",
11999846590eSStephen M. Cameron 			h->scsi_host->host_no,
12009846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12019846590eSStephen M. Cameron 	switch (sd->volume_offline) {
12029846590eSStephen M. Cameron 	case HPSA_LV_OK:
12039846590eSStephen M. Cameron 		break;
12049846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_ERASE:
12059846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12069846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is undergoing background erase process.\n",
12079846590eSStephen M. Cameron 			h->scsi_host->host_no,
12089846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12099846590eSStephen M. Cameron 		break;
12109846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_RPI:
12119846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12129846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is undergoing rapid parity initialization process.\n",
12139846590eSStephen M. Cameron 			h->scsi_host->host_no,
12149846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12159846590eSStephen M. Cameron 		break;
12169846590eSStephen M. Cameron 	case HPSA_LV_PENDING_RPI:
12179846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12189846590eSStephen M. Cameron 				"C%d:B%d:T%d:L%d Volume is queued for rapid parity initialization process.\n",
12199846590eSStephen M. Cameron 				h->scsi_host->host_no,
12209846590eSStephen M. Cameron 				sd->bus, sd->target, sd->lun);
12219846590eSStephen M. Cameron 		break;
12229846590eSStephen M. Cameron 	case HPSA_LV_ENCRYPTED_NO_KEY:
12239846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12249846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is encrypted and cannot be accessed because key is not present.\n",
12259846590eSStephen M. Cameron 			h->scsi_host->host_no,
12269846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12279846590eSStephen M. Cameron 		break;
12289846590eSStephen M. Cameron 	case HPSA_LV_PLAINTEXT_IN_ENCRYPT_ONLY_CONTROLLER:
12299846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12309846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is not encrypted and cannot be accessed because controller is in encryption-only mode.\n",
12319846590eSStephen M. Cameron 			h->scsi_host->host_no,
12329846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12339846590eSStephen M. Cameron 		break;
12349846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_ENCRYPTION:
12359846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12369846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is undergoing encryption process.\n",
12379846590eSStephen M. Cameron 			h->scsi_host->host_no,
12389846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12399846590eSStephen M. Cameron 		break;
12409846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_ENCRYPTION_REKEYING:
12419846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12429846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is undergoing encryption re-keying process.\n",
12439846590eSStephen M. Cameron 			h->scsi_host->host_no,
12449846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12459846590eSStephen M. Cameron 		break;
12469846590eSStephen M. Cameron 	case HPSA_LV_ENCRYPTED_IN_NON_ENCRYPTED_CONTROLLER:
12479846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12489846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is encrypted and cannot be accessed because controller does not have encryption enabled.\n",
12499846590eSStephen M. Cameron 			h->scsi_host->host_no,
12509846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12519846590eSStephen M. Cameron 		break;
12529846590eSStephen M. Cameron 	case HPSA_LV_PENDING_ENCRYPTION:
12539846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12549846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is pending migration to encrypted state, but process has not started.\n",
12559846590eSStephen M. Cameron 			h->scsi_host->host_no,
12569846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12579846590eSStephen M. Cameron 		break;
12589846590eSStephen M. Cameron 	case HPSA_LV_PENDING_ENCRYPTION_REKEYING:
12599846590eSStephen M. Cameron 		dev_info(&h->pdev->dev,
12609846590eSStephen M. Cameron 			"C%d:B%d:T%d:L%d Volume is encrypted and is pending encryption rekeying.\n",
12619846590eSStephen M. Cameron 			h->scsi_host->host_no,
12629846590eSStephen M. Cameron 			sd->bus, sd->target, sd->lun);
12639846590eSStephen M. Cameron 		break;
12649846590eSStephen M. Cameron 	}
12659846590eSStephen M. Cameron }
12669846590eSStephen M. Cameron 
12674967bd3eSStephen M. Cameron static void adjust_hpsa_scsi_table(struct ctlr_info *h, int hostno,
1268edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd[], int nsds)
1269edd16368SStephen M. Cameron {
1270edd16368SStephen M. Cameron 	/* sd contains scsi3 addresses and devtypes, and inquiry
1271edd16368SStephen M. Cameron 	 * data.  This function takes what's in sd to be the current
1272edd16368SStephen M. Cameron 	 * reality and updates h->dev[] to reflect that reality.
1273edd16368SStephen M. Cameron 	 */
1274edd16368SStephen M. Cameron 	int i, entry, device_change, changes = 0;
1275edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *csd;
1276edd16368SStephen M. Cameron 	unsigned long flags;
1277edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t **added, **removed;
1278edd16368SStephen M. Cameron 	int nadded, nremoved;
1279edd16368SStephen M. Cameron 	struct Scsi_Host *sh = NULL;
1280edd16368SStephen M. Cameron 
1281cfe5badcSScott Teel 	added = kzalloc(sizeof(*added) * HPSA_MAX_DEVICES, GFP_KERNEL);
1282cfe5badcSScott Teel 	removed = kzalloc(sizeof(*removed) * HPSA_MAX_DEVICES, GFP_KERNEL);
1283edd16368SStephen M. Cameron 
1284edd16368SStephen M. Cameron 	if (!added || !removed) {
1285edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "out of memory in "
1286edd16368SStephen M. Cameron 			"adjust_hpsa_scsi_table\n");
1287edd16368SStephen M. Cameron 		goto free_and_out;
1288edd16368SStephen M. Cameron 	}
1289edd16368SStephen M. Cameron 
1290edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->devlock, flags);
1291edd16368SStephen M. Cameron 
1292edd16368SStephen M. Cameron 	/* find any devices in h->dev[] that are not in
1293edd16368SStephen M. Cameron 	 * sd[] and remove them from h->dev[], and for any
1294edd16368SStephen M. Cameron 	 * devices which have changed, remove the old device
1295edd16368SStephen M. Cameron 	 * info and add the new device info.
1296bd9244f7SScott Teel 	 * If minor device attributes change, just update
1297bd9244f7SScott Teel 	 * the existing device structure.
1298edd16368SStephen M. Cameron 	 */
1299edd16368SStephen M. Cameron 	i = 0;
1300edd16368SStephen M. Cameron 	nremoved = 0;
1301edd16368SStephen M. Cameron 	nadded = 0;
1302edd16368SStephen M. Cameron 	while (i < h->ndevices) {
1303edd16368SStephen M. Cameron 		csd = h->dev[i];
1304edd16368SStephen M. Cameron 		device_change = hpsa_scsi_find_entry(csd, sd, nsds, &entry);
1305edd16368SStephen M. Cameron 		if (device_change == DEVICE_NOT_FOUND) {
1306edd16368SStephen M. Cameron 			changes++;
1307edd16368SStephen M. Cameron 			hpsa_scsi_remove_entry(h, hostno, i,
1308edd16368SStephen M. Cameron 				removed, &nremoved);
1309edd16368SStephen M. Cameron 			continue; /* remove ^^^, hence i not incremented */
1310edd16368SStephen M. Cameron 		} else if (device_change == DEVICE_CHANGED) {
1311edd16368SStephen M. Cameron 			changes++;
13122a8ccf31SStephen M. Cameron 			hpsa_scsi_replace_entry(h, hostno, i, sd[entry],
13132a8ccf31SStephen M. Cameron 				added, &nadded, removed, &nremoved);
1314c7f172dcSStephen M. Cameron 			/* Set it to NULL to prevent it from being freed
1315c7f172dcSStephen M. Cameron 			 * at the bottom of hpsa_update_scsi_devices()
1316c7f172dcSStephen M. Cameron 			 */
1317c7f172dcSStephen M. Cameron 			sd[entry] = NULL;
1318bd9244f7SScott Teel 		} else if (device_change == DEVICE_UPDATED) {
1319bd9244f7SScott Teel 			hpsa_scsi_update_entry(h, hostno, i, sd[entry]);
1320edd16368SStephen M. Cameron 		}
1321edd16368SStephen M. Cameron 		i++;
1322edd16368SStephen M. Cameron 	}
1323edd16368SStephen M. Cameron 
1324edd16368SStephen M. Cameron 	/* Now, make sure every device listed in sd[] is also
1325edd16368SStephen M. Cameron 	 * listed in h->dev[], adding them if they aren't found
1326edd16368SStephen M. Cameron 	 */
1327edd16368SStephen M. Cameron 
1328edd16368SStephen M. Cameron 	for (i = 0; i < nsds; i++) {
1329edd16368SStephen M. Cameron 		if (!sd[i]) /* if already added above. */
1330edd16368SStephen M. Cameron 			continue;
13319846590eSStephen M. Cameron 
13329846590eSStephen M. Cameron 		/* Don't add devices which are NOT READY, FORMAT IN PROGRESS
13339846590eSStephen M. Cameron 		 * as the SCSI mid-layer does not handle such devices well.
13349846590eSStephen M. Cameron 		 * It relentlessly loops sending TUR at 3Hz, then READ(10)
13359846590eSStephen M. Cameron 		 * at 160Hz, and prevents the system from coming up.
13369846590eSStephen M. Cameron 		 */
13379846590eSStephen M. Cameron 		if (sd[i]->volume_offline) {
13389846590eSStephen M. Cameron 			hpsa_show_volume_status(h, sd[i]);
13399846590eSStephen M. Cameron 			dev_info(&h->pdev->dev, "c%db%dt%dl%d: temporarily offline\n",
13409846590eSStephen M. Cameron 				h->scsi_host->host_no,
13419846590eSStephen M. Cameron 				sd[i]->bus, sd[i]->target, sd[i]->lun);
13429846590eSStephen M. Cameron 			continue;
13439846590eSStephen M. Cameron 		}
13449846590eSStephen M. Cameron 
1345edd16368SStephen M. Cameron 		device_change = hpsa_scsi_find_entry(sd[i], h->dev,
1346edd16368SStephen M. Cameron 					h->ndevices, &entry);
1347edd16368SStephen M. Cameron 		if (device_change == DEVICE_NOT_FOUND) {
1348edd16368SStephen M. Cameron 			changes++;
1349edd16368SStephen M. Cameron 			if (hpsa_scsi_add_entry(h, hostno, sd[i],
1350edd16368SStephen M. Cameron 				added, &nadded) != 0)
1351edd16368SStephen M. Cameron 				break;
1352edd16368SStephen M. Cameron 			sd[i] = NULL; /* prevent from being freed later. */
1353edd16368SStephen M. Cameron 		} else if (device_change == DEVICE_CHANGED) {
1354edd16368SStephen M. Cameron 			/* should never happen... */
1355edd16368SStephen M. Cameron 			changes++;
1356edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev,
1357edd16368SStephen M. Cameron 				"device unexpectedly changed.\n");
1358edd16368SStephen M. Cameron 			/* but if it does happen, we just ignore that device */
1359edd16368SStephen M. Cameron 		}
1360edd16368SStephen M. Cameron 	}
1361edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->devlock, flags);
1362edd16368SStephen M. Cameron 
13639846590eSStephen M. Cameron 	/* Monitor devices which are in one of several NOT READY states to be
13649846590eSStephen M. Cameron 	 * brought online later. This must be done without holding h->devlock,
13659846590eSStephen M. Cameron 	 * so don't touch h->dev[]
13669846590eSStephen M. Cameron 	 */
13679846590eSStephen M. Cameron 	for (i = 0; i < nsds; i++) {
13689846590eSStephen M. Cameron 		if (!sd[i]) /* if already added above. */
13699846590eSStephen M. Cameron 			continue;
13709846590eSStephen M. Cameron 		if (sd[i]->volume_offline)
13719846590eSStephen M. Cameron 			hpsa_monitor_offline_device(h, sd[i]->scsi3addr);
13729846590eSStephen M. Cameron 	}
13739846590eSStephen M. Cameron 
1374edd16368SStephen M. Cameron 	/* Don't notify scsi mid layer of any changes the first time through
1375edd16368SStephen M. Cameron 	 * (or if there are no changes) scsi_scan_host will do it later the
1376edd16368SStephen M. Cameron 	 * first time through.
1377edd16368SStephen M. Cameron 	 */
1378edd16368SStephen M. Cameron 	if (hostno == -1 || !changes)
1379edd16368SStephen M. Cameron 		goto free_and_out;
1380edd16368SStephen M. Cameron 
1381edd16368SStephen M. Cameron 	sh = h->scsi_host;
1382edd16368SStephen M. Cameron 	/* Notify scsi mid layer of any removed devices */
1383edd16368SStephen M. Cameron 	for (i = 0; i < nremoved; i++) {
1384edd16368SStephen M. Cameron 		struct scsi_device *sdev =
1385edd16368SStephen M. Cameron 			scsi_device_lookup(sh, removed[i]->bus,
1386edd16368SStephen M. Cameron 				removed[i]->target, removed[i]->lun);
1387edd16368SStephen M. Cameron 		if (sdev != NULL) {
1388edd16368SStephen M. Cameron 			scsi_remove_device(sdev);
1389edd16368SStephen M. Cameron 			scsi_device_put(sdev);
1390edd16368SStephen M. Cameron 		} else {
1391edd16368SStephen M. Cameron 			/* We don't expect to get here.
1392edd16368SStephen M. Cameron 			 * future cmds to this device will get selection
1393edd16368SStephen M. Cameron 			 * timeout as if the device was gone.
1394edd16368SStephen M. Cameron 			 */
1395edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "didn't find c%db%dt%dl%d "
1396edd16368SStephen M. Cameron 				" for removal.", hostno, removed[i]->bus,
1397edd16368SStephen M. Cameron 				removed[i]->target, removed[i]->lun);
1398edd16368SStephen M. Cameron 		}
1399edd16368SStephen M. Cameron 		kfree(removed[i]);
1400edd16368SStephen M. Cameron 		removed[i] = NULL;
1401edd16368SStephen M. Cameron 	}
1402edd16368SStephen M. Cameron 
1403edd16368SStephen M. Cameron 	/* Notify scsi mid layer of any added devices */
1404edd16368SStephen M. Cameron 	for (i = 0; i < nadded; i++) {
1405edd16368SStephen M. Cameron 		if (scsi_add_device(sh, added[i]->bus,
1406edd16368SStephen M. Cameron 			added[i]->target, added[i]->lun) == 0)
1407edd16368SStephen M. Cameron 			continue;
1408edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "scsi_add_device c%db%dt%dl%d failed, "
1409edd16368SStephen M. Cameron 			"device not added.\n", hostno, added[i]->bus,
1410edd16368SStephen M. Cameron 			added[i]->target, added[i]->lun);
1411edd16368SStephen M. Cameron 		/* now we have to remove it from h->dev,
1412edd16368SStephen M. Cameron 		 * since it didn't get added to scsi mid layer
1413edd16368SStephen M. Cameron 		 */
1414edd16368SStephen M. Cameron 		fixup_botched_add(h, added[i]);
1415edd16368SStephen M. Cameron 	}
1416edd16368SStephen M. Cameron 
1417edd16368SStephen M. Cameron free_and_out:
1418edd16368SStephen M. Cameron 	kfree(added);
1419edd16368SStephen M. Cameron 	kfree(removed);
1420edd16368SStephen M. Cameron }
1421edd16368SStephen M. Cameron 
1422edd16368SStephen M. Cameron /*
14239e03aa2fSJoe Perches  * Lookup bus/target/lun and return corresponding struct hpsa_scsi_dev_t *
1424edd16368SStephen M. Cameron  * Assume's h->devlock is held.
1425edd16368SStephen M. Cameron  */
1426edd16368SStephen M. Cameron static struct hpsa_scsi_dev_t *lookup_hpsa_scsi_dev(struct ctlr_info *h,
1427edd16368SStephen M. Cameron 	int bus, int target, int lun)
1428edd16368SStephen M. Cameron {
1429edd16368SStephen M. Cameron 	int i;
1430edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
1431edd16368SStephen M. Cameron 
1432edd16368SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++) {
1433edd16368SStephen M. Cameron 		sd = h->dev[i];
1434edd16368SStephen M. Cameron 		if (sd->bus == bus && sd->target == target && sd->lun == lun)
1435edd16368SStephen M. Cameron 			return sd;
1436edd16368SStephen M. Cameron 	}
1437edd16368SStephen M. Cameron 	return NULL;
1438edd16368SStephen M. Cameron }
1439edd16368SStephen M. Cameron 
1440edd16368SStephen M. Cameron /* link sdev->hostdata to our per-device structure. */
1441edd16368SStephen M. Cameron static int hpsa_slave_alloc(struct scsi_device *sdev)
1442edd16368SStephen M. Cameron {
1443edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
1444edd16368SStephen M. Cameron 	unsigned long flags;
1445edd16368SStephen M. Cameron 	struct ctlr_info *h;
1446edd16368SStephen M. Cameron 
1447edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
1448edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->devlock, flags);
1449edd16368SStephen M. Cameron 	sd = lookup_hpsa_scsi_dev(h, sdev_channel(sdev),
1450edd16368SStephen M. Cameron 		sdev_id(sdev), sdev->lun);
1451edd16368SStephen M. Cameron 	if (sd != NULL)
1452edd16368SStephen M. Cameron 		sdev->hostdata = sd;
1453edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->devlock, flags);
1454edd16368SStephen M. Cameron 	return 0;
1455edd16368SStephen M. Cameron }
1456edd16368SStephen M. Cameron 
1457edd16368SStephen M. Cameron static void hpsa_slave_destroy(struct scsi_device *sdev)
1458edd16368SStephen M. Cameron {
1459bcc44255SStephen M. Cameron 	/* nothing to do. */
1460edd16368SStephen M. Cameron }
1461edd16368SStephen M. Cameron 
146233a2ffceSStephen M. Cameron static void hpsa_free_sg_chain_blocks(struct ctlr_info *h)
146333a2ffceSStephen M. Cameron {
146433a2ffceSStephen M. Cameron 	int i;
146533a2ffceSStephen M. Cameron 
146633a2ffceSStephen M. Cameron 	if (!h->cmd_sg_list)
146733a2ffceSStephen M. Cameron 		return;
146833a2ffceSStephen M. Cameron 	for (i = 0; i < h->nr_cmds; i++) {
146933a2ffceSStephen M. Cameron 		kfree(h->cmd_sg_list[i]);
147033a2ffceSStephen M. Cameron 		h->cmd_sg_list[i] = NULL;
147133a2ffceSStephen M. Cameron 	}
147233a2ffceSStephen M. Cameron 	kfree(h->cmd_sg_list);
147333a2ffceSStephen M. Cameron 	h->cmd_sg_list = NULL;
147433a2ffceSStephen M. Cameron }
147533a2ffceSStephen M. Cameron 
147633a2ffceSStephen M. Cameron static int hpsa_allocate_sg_chain_blocks(struct ctlr_info *h)
147733a2ffceSStephen M. Cameron {
147833a2ffceSStephen M. Cameron 	int i;
147933a2ffceSStephen M. Cameron 
148033a2ffceSStephen M. Cameron 	if (h->chainsize <= 0)
148133a2ffceSStephen M. Cameron 		return 0;
148233a2ffceSStephen M. Cameron 
148333a2ffceSStephen M. Cameron 	h->cmd_sg_list = kzalloc(sizeof(*h->cmd_sg_list) * h->nr_cmds,
148433a2ffceSStephen M. Cameron 				GFP_KERNEL);
148533a2ffceSStephen M. Cameron 	if (!h->cmd_sg_list)
148633a2ffceSStephen M. Cameron 		return -ENOMEM;
148733a2ffceSStephen M. Cameron 	for (i = 0; i < h->nr_cmds; i++) {
148833a2ffceSStephen M. Cameron 		h->cmd_sg_list[i] = kmalloc(sizeof(*h->cmd_sg_list[i]) *
148933a2ffceSStephen M. Cameron 						h->chainsize, GFP_KERNEL);
149033a2ffceSStephen M. Cameron 		if (!h->cmd_sg_list[i])
149133a2ffceSStephen M. Cameron 			goto clean;
149233a2ffceSStephen M. Cameron 	}
149333a2ffceSStephen M. Cameron 	return 0;
149433a2ffceSStephen M. Cameron 
149533a2ffceSStephen M. Cameron clean:
149633a2ffceSStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
149733a2ffceSStephen M. Cameron 	return -ENOMEM;
149833a2ffceSStephen M. Cameron }
149933a2ffceSStephen M. Cameron 
1500e2bea6dfSStephen M. Cameron static int hpsa_map_sg_chain_block(struct ctlr_info *h,
150133a2ffceSStephen M. Cameron 	struct CommandList *c)
150233a2ffceSStephen M. Cameron {
150333a2ffceSStephen M. Cameron 	struct SGDescriptor *chain_sg, *chain_block;
150433a2ffceSStephen M. Cameron 	u64 temp64;
1505*50a0decfSStephen M. Cameron 	u32 chain_len;
150633a2ffceSStephen M. Cameron 
150733a2ffceSStephen M. Cameron 	chain_sg = &c->SG[h->max_cmd_sg_entries - 1];
150833a2ffceSStephen M. Cameron 	chain_block = h->cmd_sg_list[c->cmdindex];
1509*50a0decfSStephen M. Cameron 	chain_sg->Ext = cpu_to_le32(HPSA_SG_CHAIN);
1510*50a0decfSStephen M. Cameron 	chain_len = sizeof(*chain_sg) *
151133a2ffceSStephen M. Cameron 		(c->Header.SGTotal - h->max_cmd_sg_entries);
1512*50a0decfSStephen M. Cameron 	chain_sg->Len = cpu_to_le32(chain_len);
1513*50a0decfSStephen M. Cameron 	temp64 = pci_map_single(h->pdev, chain_block, chain_len,
151433a2ffceSStephen M. Cameron 				PCI_DMA_TODEVICE);
1515e2bea6dfSStephen M. Cameron 	if (dma_mapping_error(&h->pdev->dev, temp64)) {
1516e2bea6dfSStephen M. Cameron 		/* prevent subsequent unmapping */
1517*50a0decfSStephen M. Cameron 		chain_sg->Addr = cpu_to_le64(0);
1518e2bea6dfSStephen M. Cameron 		return -1;
1519e2bea6dfSStephen M. Cameron 	}
1520*50a0decfSStephen M. Cameron 	chain_sg->Addr = cpu_to_le64(temp64);
1521e2bea6dfSStephen M. Cameron 	return 0;
152233a2ffceSStephen M. Cameron }
152333a2ffceSStephen M. Cameron 
152433a2ffceSStephen M. Cameron static void hpsa_unmap_sg_chain_block(struct ctlr_info *h,
152533a2ffceSStephen M. Cameron 	struct CommandList *c)
152633a2ffceSStephen M. Cameron {
152733a2ffceSStephen M. Cameron 	struct SGDescriptor *chain_sg;
152833a2ffceSStephen M. Cameron 
1529*50a0decfSStephen M. Cameron 	if (le16_to_cpu(c->Header.SGTotal) <= h->max_cmd_sg_entries)
153033a2ffceSStephen M. Cameron 		return;
153133a2ffceSStephen M. Cameron 
153233a2ffceSStephen M. Cameron 	chain_sg = &c->SG[h->max_cmd_sg_entries - 1];
1533*50a0decfSStephen M. Cameron 	pci_unmap_single(h->pdev, le64_to_cpu(chain_sg->Addr),
1534*50a0decfSStephen M. Cameron 			le32_to_cpu(chain_sg->Len), PCI_DMA_TODEVICE);
153533a2ffceSStephen M. Cameron }
153633a2ffceSStephen M. Cameron 
1537a09c1441SScott Teel 
1538a09c1441SScott Teel /* Decode the various types of errors on ioaccel2 path.
1539a09c1441SScott Teel  * Return 1 for any error that should generate a RAID path retry.
1540a09c1441SScott Teel  * Return 0 for errors that don't require a RAID path retry.
1541a09c1441SScott Teel  */
1542a09c1441SScott Teel static int handle_ioaccel_mode2_error(struct ctlr_info *h,
1543c349775eSScott Teel 					struct CommandList *c,
1544c349775eSScott Teel 					struct scsi_cmnd *cmd,
1545c349775eSScott Teel 					struct io_accel2_cmd *c2)
1546c349775eSScott Teel {
1547c349775eSScott Teel 	int data_len;
1548a09c1441SScott Teel 	int retry = 0;
1549c349775eSScott Teel 
1550c349775eSScott Teel 	switch (c2->error_data.serv_response) {
1551c349775eSScott Teel 	case IOACCEL2_SERV_RESPONSE_COMPLETE:
1552c349775eSScott Teel 		switch (c2->error_data.status) {
1553c349775eSScott Teel 		case IOACCEL2_STATUS_SR_TASK_COMP_GOOD:
1554c349775eSScott Teel 			break;
1555c349775eSScott Teel 		case IOACCEL2_STATUS_SR_TASK_COMP_CHK_COND:
1556c349775eSScott Teel 			dev_warn(&h->pdev->dev,
1557c349775eSScott Teel 				"%s: task complete with check condition.\n",
1558c349775eSScott Teel 				"HP SSD Smart Path");
1559ee6b1889SStephen M. Cameron 			cmd->result |= SAM_STAT_CHECK_CONDITION;
1560c349775eSScott Teel 			if (c2->error_data.data_present !=
1561ee6b1889SStephen M. Cameron 					IOACCEL2_SENSE_DATA_PRESENT) {
1562ee6b1889SStephen M. Cameron 				memset(cmd->sense_buffer, 0,
1563ee6b1889SStephen M. Cameron 					SCSI_SENSE_BUFFERSIZE);
1564c349775eSScott Teel 				break;
1565ee6b1889SStephen M. Cameron 			}
1566c349775eSScott Teel 			/* copy the sense data */
1567c349775eSScott Teel 			data_len = c2->error_data.sense_data_len;
1568c349775eSScott Teel 			if (data_len > SCSI_SENSE_BUFFERSIZE)
1569c349775eSScott Teel 				data_len = SCSI_SENSE_BUFFERSIZE;
1570c349775eSScott Teel 			if (data_len > sizeof(c2->error_data.sense_data_buff))
1571c349775eSScott Teel 				data_len =
1572c349775eSScott Teel 					sizeof(c2->error_data.sense_data_buff);
1573c349775eSScott Teel 			memcpy(cmd->sense_buffer,
1574c349775eSScott Teel 				c2->error_data.sense_data_buff, data_len);
1575a09c1441SScott Teel 			retry = 1;
1576c349775eSScott Teel 			break;
1577c349775eSScott Teel 		case IOACCEL2_STATUS_SR_TASK_COMP_BUSY:
1578c349775eSScott Teel 			dev_warn(&h->pdev->dev,
1579c349775eSScott Teel 				"%s: task complete with BUSY status.\n",
1580c349775eSScott Teel 				"HP SSD Smart Path");
1581a09c1441SScott Teel 			retry = 1;
1582c349775eSScott Teel 			break;
1583c349775eSScott Teel 		case IOACCEL2_STATUS_SR_TASK_COMP_RES_CON:
1584c349775eSScott Teel 			dev_warn(&h->pdev->dev,
1585c349775eSScott Teel 				"%s: task complete with reservation conflict.\n",
1586c349775eSScott Teel 				"HP SSD Smart Path");
1587a09c1441SScott Teel 			retry = 1;
1588c349775eSScott Teel 			break;
1589c349775eSScott Teel 		case IOACCEL2_STATUS_SR_TASK_COMP_SET_FULL:
1590c349775eSScott Teel 			/* Make scsi midlayer do unlimited retries */
1591c349775eSScott Teel 			cmd->result = DID_IMM_RETRY << 16;
1592c349775eSScott Teel 			break;
1593c349775eSScott Teel 		case IOACCEL2_STATUS_SR_TASK_COMP_ABORTED:
1594c349775eSScott Teel 			dev_warn(&h->pdev->dev,
1595c349775eSScott Teel 				"%s: task complete with aborted status.\n",
1596c349775eSScott Teel 				"HP SSD Smart Path");
1597a09c1441SScott Teel 			retry = 1;
1598c349775eSScott Teel 			break;
1599c349775eSScott Teel 		default:
1600c349775eSScott Teel 			dev_warn(&h->pdev->dev,
1601c349775eSScott Teel 				"%s: task complete with unrecognized status: 0x%02x\n",
1602c349775eSScott Teel 				"HP SSD Smart Path", c2->error_data.status);
1603a09c1441SScott Teel 			retry = 1;
1604c349775eSScott Teel 			break;
1605c349775eSScott Teel 		}
1606c349775eSScott Teel 		break;
1607c349775eSScott Teel 	case IOACCEL2_SERV_RESPONSE_FAILURE:
1608c349775eSScott Teel 		/* don't expect to get here. */
1609c349775eSScott Teel 		dev_warn(&h->pdev->dev,
1610c349775eSScott Teel 			"unexpected delivery or target failure, status = 0x%02x\n",
1611c349775eSScott Teel 			c2->error_data.status);
1612a09c1441SScott Teel 		retry = 1;
1613c349775eSScott Teel 		break;
1614c349775eSScott Teel 	case IOACCEL2_SERV_RESPONSE_TMF_COMPLETE:
1615c349775eSScott Teel 		break;
1616c349775eSScott Teel 	case IOACCEL2_SERV_RESPONSE_TMF_SUCCESS:
1617c349775eSScott Teel 		break;
1618c349775eSScott Teel 	case IOACCEL2_SERV_RESPONSE_TMF_REJECTED:
1619c349775eSScott Teel 		dev_warn(&h->pdev->dev, "task management function rejected.\n");
1620a09c1441SScott Teel 		retry = 1;
1621c349775eSScott Teel 		break;
1622c349775eSScott Teel 	case IOACCEL2_SERV_RESPONSE_TMF_WRONG_LUN:
1623c349775eSScott Teel 		dev_warn(&h->pdev->dev, "task management function invalid LUN\n");
1624c349775eSScott Teel 		break;
1625c349775eSScott Teel 	default:
1626c349775eSScott Teel 		dev_warn(&h->pdev->dev,
1627c349775eSScott Teel 			"%s: Unrecognized server response: 0x%02x\n",
1628a09c1441SScott Teel 			"HP SSD Smart Path",
1629a09c1441SScott Teel 			c2->error_data.serv_response);
1630a09c1441SScott Teel 		retry = 1;
1631c349775eSScott Teel 		break;
1632c349775eSScott Teel 	}
1633a09c1441SScott Teel 
1634a09c1441SScott Teel 	return retry;	/* retry on raid path? */
1635c349775eSScott Teel }
1636c349775eSScott Teel 
1637c349775eSScott Teel static void process_ioaccel2_completion(struct ctlr_info *h,
1638c349775eSScott Teel 		struct CommandList *c, struct scsi_cmnd *cmd,
1639c349775eSScott Teel 		struct hpsa_scsi_dev_t *dev)
1640c349775eSScott Teel {
1641c349775eSScott Teel 	struct io_accel2_cmd *c2 = &h->ioaccel2_cmd_pool[c->cmdindex];
1642a09c1441SScott Teel 	int raid_retry = 0;
1643c349775eSScott Teel 
1644c349775eSScott Teel 	/* check for good status */
1645c349775eSScott Teel 	if (likely(c2->error_data.serv_response == 0 &&
1646c349775eSScott Teel 			c2->error_data.status == 0)) {
1647c349775eSScott Teel 		cmd_free(h, c);
1648c349775eSScott Teel 		cmd->scsi_done(cmd);
1649c349775eSScott Teel 		return;
1650c349775eSScott Teel 	}
1651c349775eSScott Teel 
1652c349775eSScott Teel 	/* Any RAID offload error results in retry which will use
1653c349775eSScott Teel 	 * the normal I/O path so the controller can handle whatever's
1654c349775eSScott Teel 	 * wrong.
1655c349775eSScott Teel 	 */
1656c349775eSScott Teel 	if (is_logical_dev_addr_mode(dev->scsi3addr) &&
1657c349775eSScott Teel 		c2->error_data.serv_response ==
1658c349775eSScott Teel 			IOACCEL2_SERV_RESPONSE_FAILURE) {
1659c349775eSScott Teel 		dev->offload_enabled = 0;
1660e863d68eSScott Teel 		h->drv_req_rescan = 1;	/* schedule controller for a rescan */
1661c349775eSScott Teel 		cmd->result = DID_SOFT_ERROR << 16;
1662c349775eSScott Teel 		cmd_free(h, c);
1663c349775eSScott Teel 		cmd->scsi_done(cmd);
1664c349775eSScott Teel 		return;
1665c349775eSScott Teel 	}
1666a09c1441SScott Teel 	raid_retry = handle_ioaccel_mode2_error(h, c, cmd, c2);
1667a09c1441SScott Teel 	/* If error found, disable Smart Path, schedule a rescan,
1668a09c1441SScott Teel 	 * and force a retry on the standard path.
1669a09c1441SScott Teel 	 */
1670a09c1441SScott Teel 	if (raid_retry) {
1671a09c1441SScott Teel 		dev_warn(&h->pdev->dev, "%s: Retrying on standard path.\n",
1672a09c1441SScott Teel 			"HP SSD Smart Path");
1673a09c1441SScott Teel 		dev->offload_enabled = 0; /* Disable Smart Path */
1674a09c1441SScott Teel 		h->drv_req_rescan = 1;	  /* schedule controller rescan */
1675a09c1441SScott Teel 		cmd->result = DID_SOFT_ERROR << 16;
1676a09c1441SScott Teel 	}
1677c349775eSScott Teel 	cmd_free(h, c);
1678c349775eSScott Teel 	cmd->scsi_done(cmd);
1679c349775eSScott Teel }
1680c349775eSScott Teel 
16811fb011fbSStephen M. Cameron static void complete_scsi_command(struct CommandList *cp)
1682edd16368SStephen M. Cameron {
1683edd16368SStephen M. Cameron 	struct scsi_cmnd *cmd;
1684edd16368SStephen M. Cameron 	struct ctlr_info *h;
1685edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
1686283b4a9bSStephen M. Cameron 	struct hpsa_scsi_dev_t *dev;
1687edd16368SStephen M. Cameron 
1688edd16368SStephen M. Cameron 	unsigned char sense_key;
1689edd16368SStephen M. Cameron 	unsigned char asc;      /* additional sense code */
1690edd16368SStephen M. Cameron 	unsigned char ascq;     /* additional sense code qualifier */
1691db111e18SStephen M. Cameron 	unsigned long sense_data_size;
1692edd16368SStephen M. Cameron 
1693edd16368SStephen M. Cameron 	ei = cp->err_info;
1694edd16368SStephen M. Cameron 	cmd = (struct scsi_cmnd *) cp->scsi_cmd;
1695edd16368SStephen M. Cameron 	h = cp->h;
1696283b4a9bSStephen M. Cameron 	dev = cmd->device->hostdata;
1697edd16368SStephen M. Cameron 
1698edd16368SStephen M. Cameron 	scsi_dma_unmap(cmd); /* undo the DMA mappings */
1699e1f7de0cSMatt Gates 	if ((cp->cmd_type == CMD_SCSI) &&
1700e1f7de0cSMatt Gates 		(cp->Header.SGTotal > h->max_cmd_sg_entries))
170133a2ffceSStephen M. Cameron 		hpsa_unmap_sg_chain_block(h, cp);
1702edd16368SStephen M. Cameron 
1703edd16368SStephen M. Cameron 	cmd->result = (DID_OK << 16); 		/* host byte */
1704edd16368SStephen M. Cameron 	cmd->result |= (COMMAND_COMPLETE << 8);	/* msg byte */
1705c349775eSScott Teel 
1706c349775eSScott Teel 	if (cp->cmd_type == CMD_IOACCEL2)
1707c349775eSScott Teel 		return process_ioaccel2_completion(h, cp, cmd, dev);
1708c349775eSScott Teel 
17095512672fSStephen M. Cameron 	cmd->result |= ei->ScsiStatus;
1710edd16368SStephen M. Cameron 
17116aa4c361SRobert Elliott 	scsi_set_resid(cmd, ei->ResidualCnt);
17126aa4c361SRobert Elliott 	if (ei->CommandStatus == 0) {
17136aa4c361SRobert Elliott 		cmd_free(h, cp);
17146aa4c361SRobert Elliott 		cmd->scsi_done(cmd);
17156aa4c361SRobert Elliott 		return;
17166aa4c361SRobert Elliott 	}
17176aa4c361SRobert Elliott 
17186aa4c361SRobert Elliott 	/* copy the sense data */
1719db111e18SStephen M. Cameron 	if (SCSI_SENSE_BUFFERSIZE < sizeof(ei->SenseInfo))
1720db111e18SStephen M. Cameron 		sense_data_size = SCSI_SENSE_BUFFERSIZE;
1721db111e18SStephen M. Cameron 	else
1722db111e18SStephen M. Cameron 		sense_data_size = sizeof(ei->SenseInfo);
1723db111e18SStephen M. Cameron 	if (ei->SenseLen < sense_data_size)
1724db111e18SStephen M. Cameron 		sense_data_size = ei->SenseLen;
1725db111e18SStephen M. Cameron 
1726db111e18SStephen M. Cameron 	memcpy(cmd->sense_buffer, ei->SenseInfo, sense_data_size);
1727edd16368SStephen M. Cameron 
1728e1f7de0cSMatt Gates 	/* For I/O accelerator commands, copy over some fields to the normal
1729e1f7de0cSMatt Gates 	 * CISS header used below for error handling.
1730e1f7de0cSMatt Gates 	 */
1731e1f7de0cSMatt Gates 	if (cp->cmd_type == CMD_IOACCEL1) {
1732e1f7de0cSMatt Gates 		struct io_accel1_cmd *c = &h->ioaccel_cmd_pool[cp->cmdindex];
1733e1f7de0cSMatt Gates 		cp->Header.SGList = cp->Header.SGTotal = scsi_sg_count(cmd);
1734e1f7de0cSMatt Gates 		cp->Request.CDBLen = c->io_flags & IOACCEL1_IOFLAGS_CDBLEN_MASK;
1735*50a0decfSStephen M. Cameron 		cp->Header.tag = c->tag;
1736e1f7de0cSMatt Gates 		memcpy(cp->Header.LUN.LunAddrBytes, c->CISS_LUN, 8);
1737e1f7de0cSMatt Gates 		memcpy(cp->Request.CDB, c->CDB, cp->Request.CDBLen);
1738283b4a9bSStephen M. Cameron 
1739283b4a9bSStephen M. Cameron 		/* Any RAID offload error results in retry which will use
1740283b4a9bSStephen M. Cameron 		 * the normal I/O path so the controller can handle whatever's
1741283b4a9bSStephen M. Cameron 		 * wrong.
1742283b4a9bSStephen M. Cameron 		 */
1743283b4a9bSStephen M. Cameron 		if (is_logical_dev_addr_mode(dev->scsi3addr)) {
1744283b4a9bSStephen M. Cameron 			if (ei->CommandStatus == CMD_IOACCEL_DISABLED)
1745283b4a9bSStephen M. Cameron 				dev->offload_enabled = 0;
1746283b4a9bSStephen M. Cameron 			cmd->result = DID_SOFT_ERROR << 16;
1747283b4a9bSStephen M. Cameron 			cmd_free(h, cp);
1748283b4a9bSStephen M. Cameron 			cmd->scsi_done(cmd);
1749283b4a9bSStephen M. Cameron 			return;
1750283b4a9bSStephen M. Cameron 		}
1751e1f7de0cSMatt Gates 	}
1752e1f7de0cSMatt Gates 
1753edd16368SStephen M. Cameron 	/* an error has occurred */
1754edd16368SStephen M. Cameron 	switch (ei->CommandStatus) {
1755edd16368SStephen M. Cameron 
1756edd16368SStephen M. Cameron 	case CMD_TARGET_STATUS:
1757edd16368SStephen M. Cameron 		if (ei->ScsiStatus) {
1758edd16368SStephen M. Cameron 			/* Get sense key */
1759edd16368SStephen M. Cameron 			sense_key = 0xf & ei->SenseInfo[2];
1760edd16368SStephen M. Cameron 			/* Get additional sense code */
1761edd16368SStephen M. Cameron 			asc = ei->SenseInfo[12];
1762edd16368SStephen M. Cameron 			/* Get addition sense code qualifier */
1763edd16368SStephen M. Cameron 			ascq = ei->SenseInfo[13];
1764edd16368SStephen M. Cameron 		}
1765edd16368SStephen M. Cameron 
1766edd16368SStephen M. Cameron 		if (ei->ScsiStatus == SAM_STAT_CHECK_CONDITION) {
17673ce438dfSMatt Gates 			if (check_for_unit_attention(h, cp))
1768edd16368SStephen M. Cameron 				break;
1769edd16368SStephen M. Cameron 			if (sense_key == ILLEGAL_REQUEST) {
1770edd16368SStephen M. Cameron 				/*
1771edd16368SStephen M. Cameron 				 * SCSI REPORT_LUNS is commonly unsupported on
1772edd16368SStephen M. Cameron 				 * Smart Array.  Suppress noisy complaint.
1773edd16368SStephen M. Cameron 				 */
1774edd16368SStephen M. Cameron 				if (cp->Request.CDB[0] == REPORT_LUNS)
1775edd16368SStephen M. Cameron 					break;
1776edd16368SStephen M. Cameron 
1777edd16368SStephen M. Cameron 				/* If ASC/ASCQ indicate Logical Unit
1778edd16368SStephen M. Cameron 				 * Not Supported condition,
1779edd16368SStephen M. Cameron 				 */
1780edd16368SStephen M. Cameron 				if ((asc == 0x25) && (ascq == 0x0)) {
1781edd16368SStephen M. Cameron 					dev_warn(&h->pdev->dev, "cp %p "
1782edd16368SStephen M. Cameron 						"has check condition\n", cp);
1783edd16368SStephen M. Cameron 					break;
1784edd16368SStephen M. Cameron 				}
1785edd16368SStephen M. Cameron 			}
1786edd16368SStephen M. Cameron 
1787edd16368SStephen M. Cameron 			if (sense_key == NOT_READY) {
1788edd16368SStephen M. Cameron 				/* If Sense is Not Ready, Logical Unit
1789edd16368SStephen M. Cameron 				 * Not ready, Manual Intervention
1790edd16368SStephen M. Cameron 				 * required
1791edd16368SStephen M. Cameron 				 */
1792edd16368SStephen M. Cameron 				if ((asc == 0x04) && (ascq == 0x03)) {
1793edd16368SStephen M. Cameron 					dev_warn(&h->pdev->dev, "cp %p "
1794edd16368SStephen M. Cameron 						"has check condition: unit "
1795edd16368SStephen M. Cameron 						"not ready, manual "
1796edd16368SStephen M. Cameron 						"intervention required\n", cp);
1797edd16368SStephen M. Cameron 					break;
1798edd16368SStephen M. Cameron 				}
1799edd16368SStephen M. Cameron 			}
18001d3b3609SMatt Gates 			if (sense_key == ABORTED_COMMAND) {
18011d3b3609SMatt Gates 				/* Aborted command is retryable */
18021d3b3609SMatt Gates 				dev_warn(&h->pdev->dev, "cp %p "
18031d3b3609SMatt Gates 					"has check condition: aborted command: "
18041d3b3609SMatt Gates 					"ASC: 0x%x, ASCQ: 0x%x\n",
18051d3b3609SMatt Gates 					cp, asc, ascq);
18062e311fbaSStephen M. Cameron 				cmd->result |= DID_SOFT_ERROR << 16;
18071d3b3609SMatt Gates 				break;
18081d3b3609SMatt Gates 			}
1809edd16368SStephen M. Cameron 			/* Must be some other type of check condition */
181021b8e4efSStephen M. Cameron 			dev_dbg(&h->pdev->dev, "cp %p has check condition: "
1811edd16368SStephen M. Cameron 					"unknown type: "
1812edd16368SStephen M. Cameron 					"Sense: 0x%x, ASC: 0x%x, ASCQ: 0x%x, "
1813edd16368SStephen M. Cameron 					"Returning result: 0x%x, "
1814edd16368SStephen M. Cameron 					"cmd=[%02x %02x %02x %02x %02x "
1815807be732SMike Miller 					"%02x %02x %02x %02x %02x %02x "
1816edd16368SStephen M. Cameron 					"%02x %02x %02x %02x %02x]\n",
1817edd16368SStephen M. Cameron 					cp, sense_key, asc, ascq,
1818edd16368SStephen M. Cameron 					cmd->result,
1819edd16368SStephen M. Cameron 					cmd->cmnd[0], cmd->cmnd[1],
1820edd16368SStephen M. Cameron 					cmd->cmnd[2], cmd->cmnd[3],
1821edd16368SStephen M. Cameron 					cmd->cmnd[4], cmd->cmnd[5],
1822edd16368SStephen M. Cameron 					cmd->cmnd[6], cmd->cmnd[7],
1823807be732SMike Miller 					cmd->cmnd[8], cmd->cmnd[9],
1824807be732SMike Miller 					cmd->cmnd[10], cmd->cmnd[11],
1825807be732SMike Miller 					cmd->cmnd[12], cmd->cmnd[13],
1826807be732SMike Miller 					cmd->cmnd[14], cmd->cmnd[15]);
1827edd16368SStephen M. Cameron 			break;
1828edd16368SStephen M. Cameron 		}
1829edd16368SStephen M. Cameron 
1830edd16368SStephen M. Cameron 
1831edd16368SStephen M. Cameron 		/* Problem was not a check condition
1832edd16368SStephen M. Cameron 		 * Pass it up to the upper layers...
1833edd16368SStephen M. Cameron 		 */
1834edd16368SStephen M. Cameron 		if (ei->ScsiStatus) {
1835edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "cp %p has status 0x%x "
1836edd16368SStephen M. Cameron 				"Sense: 0x%x, ASC: 0x%x, ASCQ: 0x%x, "
1837edd16368SStephen M. Cameron 				"Returning result: 0x%x\n",
1838edd16368SStephen M. Cameron 				cp, ei->ScsiStatus,
1839edd16368SStephen M. Cameron 				sense_key, asc, ascq,
1840edd16368SStephen M. Cameron 				cmd->result);
1841edd16368SStephen M. Cameron 		} else {  /* scsi status is zero??? How??? */
1842edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "cp %p SCSI status was 0. "
1843edd16368SStephen M. Cameron 				"Returning no connection.\n", cp),
1844edd16368SStephen M. Cameron 
1845edd16368SStephen M. Cameron 			/* Ordinarily, this case should never happen,
1846edd16368SStephen M. Cameron 			 * but there is a bug in some released firmware
1847edd16368SStephen M. Cameron 			 * revisions that allows it to happen if, for
1848edd16368SStephen M. Cameron 			 * example, a 4100 backplane loses power and
1849edd16368SStephen M. Cameron 			 * the tape drive is in it.  We assume that
1850edd16368SStephen M. Cameron 			 * it's a fatal error of some kind because we
1851edd16368SStephen M. Cameron 			 * can't show that it wasn't. We will make it
1852edd16368SStephen M. Cameron 			 * look like selection timeout since that is
1853edd16368SStephen M. Cameron 			 * the most common reason for this to occur,
1854edd16368SStephen M. Cameron 			 * and it's severe enough.
1855edd16368SStephen M. Cameron 			 */
1856edd16368SStephen M. Cameron 
1857edd16368SStephen M. Cameron 			cmd->result = DID_NO_CONNECT << 16;
1858edd16368SStephen M. Cameron 		}
1859edd16368SStephen M. Cameron 		break;
1860edd16368SStephen M. Cameron 
1861edd16368SStephen M. Cameron 	case CMD_DATA_UNDERRUN: /* let mid layer handle it. */
1862edd16368SStephen M. Cameron 		break;
1863edd16368SStephen M. Cameron 	case CMD_DATA_OVERRUN:
1864edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p has"
1865edd16368SStephen M. Cameron 			" completed with data overrun "
1866edd16368SStephen M. Cameron 			"reported\n", cp);
1867edd16368SStephen M. Cameron 		break;
1868edd16368SStephen M. Cameron 	case CMD_INVALID: {
1869edd16368SStephen M. Cameron 		/* print_bytes(cp, sizeof(*cp), 1, 0);
1870edd16368SStephen M. Cameron 		print_cmd(cp); */
1871edd16368SStephen M. Cameron 		/* We get CMD_INVALID if you address a non-existent device
1872edd16368SStephen M. Cameron 		 * instead of a selection timeout (no response).  You will
1873edd16368SStephen M. Cameron 		 * see this if you yank out a drive, then try to access it.
1874edd16368SStephen M. Cameron 		 * This is kind of a shame because it means that any other
1875edd16368SStephen M. Cameron 		 * CMD_INVALID (e.g. driver bug) will get interpreted as a
1876edd16368SStephen M. Cameron 		 * missing target. */
1877edd16368SStephen M. Cameron 		cmd->result = DID_NO_CONNECT << 16;
1878edd16368SStephen M. Cameron 	}
1879edd16368SStephen M. Cameron 		break;
1880edd16368SStephen M. Cameron 	case CMD_PROTOCOL_ERR:
1881256d0eaaSStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1882edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p has "
1883edd16368SStephen M. Cameron 			"protocol error\n", cp);
1884edd16368SStephen M. Cameron 		break;
1885edd16368SStephen M. Cameron 	case CMD_HARDWARE_ERR:
1886edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1887edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p had  hardware error\n", cp);
1888edd16368SStephen M. Cameron 		break;
1889edd16368SStephen M. Cameron 	case CMD_CONNECTION_LOST:
1890edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1891edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p had connection lost\n", cp);
1892edd16368SStephen M. Cameron 		break;
1893edd16368SStephen M. Cameron 	case CMD_ABORTED:
1894edd16368SStephen M. Cameron 		cmd->result = DID_ABORT << 16;
1895edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p was aborted with status 0x%x\n",
1896edd16368SStephen M. Cameron 				cp, ei->ScsiStatus);
1897edd16368SStephen M. Cameron 		break;
1898edd16368SStephen M. Cameron 	case CMD_ABORT_FAILED:
1899edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1900edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p reports abort failed\n", cp);
1901edd16368SStephen M. Cameron 		break;
1902edd16368SStephen M. Cameron 	case CMD_UNSOLICITED_ABORT:
1903f6e76055SStephen M. Cameron 		cmd->result = DID_SOFT_ERROR << 16; /* retry the command */
1904f6e76055SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p aborted due to an unsolicited "
1905edd16368SStephen M. Cameron 			"abort\n", cp);
1906edd16368SStephen M. Cameron 		break;
1907edd16368SStephen M. Cameron 	case CMD_TIMEOUT:
1908edd16368SStephen M. Cameron 		cmd->result = DID_TIME_OUT << 16;
1909edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p timedout\n", cp);
1910edd16368SStephen M. Cameron 		break;
19111d5e2ed0SStephen M. Cameron 	case CMD_UNABORTABLE:
19121d5e2ed0SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
19131d5e2ed0SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Command unabortable\n");
19141d5e2ed0SStephen M. Cameron 		break;
1915283b4a9bSStephen M. Cameron 	case CMD_IOACCEL_DISABLED:
1916283b4a9bSStephen M. Cameron 		/* This only handles the direct pass-through case since RAID
1917283b4a9bSStephen M. Cameron 		 * offload is handled above.  Just attempt a retry.
1918283b4a9bSStephen M. Cameron 		 */
1919283b4a9bSStephen M. Cameron 		cmd->result = DID_SOFT_ERROR << 16;
1920283b4a9bSStephen M. Cameron 		dev_warn(&h->pdev->dev,
1921283b4a9bSStephen M. Cameron 				"cp %p had HP SSD Smart Path error\n", cp);
1922283b4a9bSStephen M. Cameron 		break;
1923edd16368SStephen M. Cameron 	default:
1924edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1925edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p returned unknown status %x\n",
1926edd16368SStephen M. Cameron 				cp, ei->CommandStatus);
1927edd16368SStephen M. Cameron 	}
1928edd16368SStephen M. Cameron 	cmd_free(h, cp);
19292cc5bfafSTomas Henzl 	cmd->scsi_done(cmd);
1930edd16368SStephen M. Cameron }
1931edd16368SStephen M. Cameron 
1932edd16368SStephen M. Cameron static void hpsa_pci_unmap(struct pci_dev *pdev,
1933edd16368SStephen M. Cameron 	struct CommandList *c, int sg_used, int data_direction)
1934edd16368SStephen M. Cameron {
1935edd16368SStephen M. Cameron 	int i;
1936edd16368SStephen M. Cameron 
1937*50a0decfSStephen M. Cameron 	for (i = 0; i < sg_used; i++)
1938*50a0decfSStephen M. Cameron 		pci_unmap_single(pdev, (dma_addr_t) le64_to_cpu(c->SG[i].Addr),
1939*50a0decfSStephen M. Cameron 				le32_to_cpu(c->SG[i].Len),
1940edd16368SStephen M. Cameron 				data_direction);
1941edd16368SStephen M. Cameron }
1942edd16368SStephen M. Cameron 
1943a2dac136SStephen M. Cameron static int hpsa_map_one(struct pci_dev *pdev,
1944edd16368SStephen M. Cameron 		struct CommandList *cp,
1945edd16368SStephen M. Cameron 		unsigned char *buf,
1946edd16368SStephen M. Cameron 		size_t buflen,
1947edd16368SStephen M. Cameron 		int data_direction)
1948edd16368SStephen M. Cameron {
194901a02ffcSStephen M. Cameron 	u64 addr64;
1950edd16368SStephen M. Cameron 
1951edd16368SStephen M. Cameron 	if (buflen == 0 || data_direction == PCI_DMA_NONE) {
1952edd16368SStephen M. Cameron 		cp->Header.SGList = 0;
1953*50a0decfSStephen M. Cameron 		cp->Header.SGTotal = cpu_to_le16(0);
1954a2dac136SStephen M. Cameron 		return 0;
1955edd16368SStephen M. Cameron 	}
1956edd16368SStephen M. Cameron 
1957*50a0decfSStephen M. Cameron 	addr64 = pci_map_single(pdev, buf, buflen, data_direction);
1958eceaae18SShuah Khan 	if (dma_mapping_error(&pdev->dev, addr64)) {
1959a2dac136SStephen M. Cameron 		/* Prevent subsequent unmap of something never mapped */
1960eceaae18SShuah Khan 		cp->Header.SGList = 0;
1961*50a0decfSStephen M. Cameron 		cp->Header.SGTotal = cpu_to_le16(0);
1962a2dac136SStephen M. Cameron 		return -1;
1963eceaae18SShuah Khan 	}
1964*50a0decfSStephen M. Cameron 	cp->SG[0].Addr = cpu_to_le64(addr64);
1965*50a0decfSStephen M. Cameron 	cp->SG[0].Len = cpu_to_le32(buflen);
1966*50a0decfSStephen M. Cameron 	cp->SG[0].Ext = cpu_to_le32(HPSA_SG_LAST); /* we are not chaining */
1967*50a0decfSStephen M. Cameron 	cp->Header.SGList = 1;   /* no. SGs contig in this cmd */
1968*50a0decfSStephen M. Cameron 	cp->Header.SGTotal = cpu_to_le16(1); /* total sgs in cmd list */
1969a2dac136SStephen M. Cameron 	return 0;
1970edd16368SStephen M. Cameron }
1971edd16368SStephen M. Cameron 
1972edd16368SStephen M. Cameron static inline void hpsa_scsi_do_simple_cmd_core(struct ctlr_info *h,
1973edd16368SStephen M. Cameron 	struct CommandList *c)
1974edd16368SStephen M. Cameron {
1975edd16368SStephen M. Cameron 	DECLARE_COMPLETION_ONSTACK(wait);
1976edd16368SStephen M. Cameron 
1977edd16368SStephen M. Cameron 	c->waiting = &wait;
1978edd16368SStephen M. Cameron 	enqueue_cmd_and_start_io(h, c);
1979edd16368SStephen M. Cameron 	wait_for_completion(&wait);
1980edd16368SStephen M. Cameron }
1981edd16368SStephen M. Cameron 
1982094963daSStephen M. Cameron static u32 lockup_detected(struct ctlr_info *h)
1983094963daSStephen M. Cameron {
1984094963daSStephen M. Cameron 	int cpu;
1985094963daSStephen M. Cameron 	u32 rc, *lockup_detected;
1986094963daSStephen M. Cameron 
1987094963daSStephen M. Cameron 	cpu = get_cpu();
1988094963daSStephen M. Cameron 	lockup_detected = per_cpu_ptr(h->lockup_detected, cpu);
1989094963daSStephen M. Cameron 	rc = *lockup_detected;
1990094963daSStephen M. Cameron 	put_cpu();
1991094963daSStephen M. Cameron 	return rc;
1992094963daSStephen M. Cameron }
1993094963daSStephen M. Cameron 
1994a0c12413SStephen M. Cameron static void hpsa_scsi_do_simple_cmd_core_if_no_lockup(struct ctlr_info *h,
1995a0c12413SStephen M. Cameron 	struct CommandList *c)
1996a0c12413SStephen M. Cameron {
1997a0c12413SStephen M. Cameron 	/* If controller lockup detected, fake a hardware error. */
1998094963daSStephen M. Cameron 	if (unlikely(lockup_detected(h)))
1999a0c12413SStephen M. Cameron 		c->err_info->CommandStatus = CMD_HARDWARE_ERR;
2000094963daSStephen M. Cameron 	else
2001a0c12413SStephen M. Cameron 		hpsa_scsi_do_simple_cmd_core(h, c);
2002a0c12413SStephen M. Cameron }
2003a0c12413SStephen M. Cameron 
20049c2fc160SStephen M. Cameron #define MAX_DRIVER_CMD_RETRIES 25
2005edd16368SStephen M. Cameron static void hpsa_scsi_do_simple_cmd_with_retry(struct ctlr_info *h,
2006edd16368SStephen M. Cameron 	struct CommandList *c, int data_direction)
2007edd16368SStephen M. Cameron {
20089c2fc160SStephen M. Cameron 	int backoff_time = 10, retry_count = 0;
2009edd16368SStephen M. Cameron 
2010edd16368SStephen M. Cameron 	do {
20117630abd0SJoe Perches 		memset(c->err_info, 0, sizeof(*c->err_info));
2012edd16368SStephen M. Cameron 		hpsa_scsi_do_simple_cmd_core(h, c);
2013edd16368SStephen M. Cameron 		retry_count++;
20149c2fc160SStephen M. Cameron 		if (retry_count > 3) {
20159c2fc160SStephen M. Cameron 			msleep(backoff_time);
20169c2fc160SStephen M. Cameron 			if (backoff_time < 1000)
20179c2fc160SStephen M. Cameron 				backoff_time *= 2;
20189c2fc160SStephen M. Cameron 		}
2019852af20aSMatt Bondurant 	} while ((check_for_unit_attention(h, c) ||
20209c2fc160SStephen M. Cameron 			check_for_busy(h, c)) &&
20219c2fc160SStephen M. Cameron 			retry_count <= MAX_DRIVER_CMD_RETRIES);
2022edd16368SStephen M. Cameron 	hpsa_pci_unmap(h->pdev, c, 1, data_direction);
2023edd16368SStephen M. Cameron }
2024edd16368SStephen M. Cameron 
2025d1e8beacSStephen M. Cameron static void hpsa_print_cmd(struct ctlr_info *h, char *txt,
2026d1e8beacSStephen M. Cameron 				struct CommandList *c)
2027edd16368SStephen M. Cameron {
2028d1e8beacSStephen M. Cameron 	const u8 *cdb = c->Request.CDB;
2029d1e8beacSStephen M. Cameron 	const u8 *lun = c->Header.LUN.LunAddrBytes;
2030edd16368SStephen M. Cameron 
2031d1e8beacSStephen M. Cameron 	dev_warn(&h->pdev->dev, "%s: LUN:%02x%02x%02x%02x%02x%02x%02x%02x"
2032d1e8beacSStephen M. Cameron 	" CDB:%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x%02x\n",
2033d1e8beacSStephen M. Cameron 		txt, lun[0], lun[1], lun[2], lun[3],
2034d1e8beacSStephen M. Cameron 		lun[4], lun[5], lun[6], lun[7],
2035d1e8beacSStephen M. Cameron 		cdb[0], cdb[1], cdb[2], cdb[3],
2036d1e8beacSStephen M. Cameron 		cdb[4], cdb[5], cdb[6], cdb[7],
2037d1e8beacSStephen M. Cameron 		cdb[8], cdb[9], cdb[10], cdb[11],
2038d1e8beacSStephen M. Cameron 		cdb[12], cdb[13], cdb[14], cdb[15]);
2039d1e8beacSStephen M. Cameron }
2040d1e8beacSStephen M. Cameron 
2041d1e8beacSStephen M. Cameron static void hpsa_scsi_interpret_error(struct ctlr_info *h,
2042d1e8beacSStephen M. Cameron 			struct CommandList *cp)
2043d1e8beacSStephen M. Cameron {
2044d1e8beacSStephen M. Cameron 	const struct ErrorInfo *ei = cp->err_info;
2045d1e8beacSStephen M. Cameron 	struct device *d = &cp->h->pdev->dev;
2046d1e8beacSStephen M. Cameron 	const u8 *sd = ei->SenseInfo;
2047d1e8beacSStephen M. Cameron 
2048edd16368SStephen M. Cameron 	switch (ei->CommandStatus) {
2049edd16368SStephen M. Cameron 	case CMD_TARGET_STATUS:
2050d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "SCSI status", cp);
2051d1e8beacSStephen M. Cameron 		if (ei->ScsiStatus == SAM_STAT_CHECK_CONDITION)
2052d1e8beacSStephen M. Cameron 			dev_warn(d, "SCSI Status = 02, Sense key = %02x, ASC = %02x, ASCQ = %02x\n",
2053d1e8beacSStephen M. Cameron 				sd[2] & 0x0f, sd[12], sd[13]);
2054d1e8beacSStephen M. Cameron 		else
2055d1e8beacSStephen M. Cameron 			dev_warn(d, "SCSI Status = %02x\n", ei->ScsiStatus);
2056edd16368SStephen M. Cameron 		if (ei->ScsiStatus == 0)
2057edd16368SStephen M. Cameron 			dev_warn(d, "SCSI status is abnormally zero.  "
2058edd16368SStephen M. Cameron 			"(probably indicates selection timeout "
2059edd16368SStephen M. Cameron 			"reported incorrectly due to a known "
2060edd16368SStephen M. Cameron 			"firmware bug, circa July, 2001.)\n");
2061edd16368SStephen M. Cameron 		break;
2062edd16368SStephen M. Cameron 	case CMD_DATA_UNDERRUN: /* let mid layer handle it. */
2063edd16368SStephen M. Cameron 		break;
2064edd16368SStephen M. Cameron 	case CMD_DATA_OVERRUN:
2065d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "overrun condition", cp);
2066edd16368SStephen M. Cameron 		break;
2067edd16368SStephen M. Cameron 	case CMD_INVALID: {
2068edd16368SStephen M. Cameron 		/* controller unfortunately reports SCSI passthru's
2069edd16368SStephen M. Cameron 		 * to non-existent targets as invalid commands.
2070edd16368SStephen M. Cameron 		 */
2071d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "invalid command", cp);
2072d1e8beacSStephen M. Cameron 		dev_warn(d, "probably means device no longer present\n");
2073edd16368SStephen M. Cameron 		}
2074edd16368SStephen M. Cameron 		break;
2075edd16368SStephen M. Cameron 	case CMD_PROTOCOL_ERR:
2076d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "protocol error", cp);
2077edd16368SStephen M. Cameron 		break;
2078edd16368SStephen M. Cameron 	case CMD_HARDWARE_ERR:
2079d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "hardware error", cp);
2080edd16368SStephen M. Cameron 		break;
2081edd16368SStephen M. Cameron 	case CMD_CONNECTION_LOST:
2082d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "connection lost", cp);
2083edd16368SStephen M. Cameron 		break;
2084edd16368SStephen M. Cameron 	case CMD_ABORTED:
2085d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "aborted", cp);
2086edd16368SStephen M. Cameron 		break;
2087edd16368SStephen M. Cameron 	case CMD_ABORT_FAILED:
2088d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "abort failed", cp);
2089edd16368SStephen M. Cameron 		break;
2090edd16368SStephen M. Cameron 	case CMD_UNSOLICITED_ABORT:
2091d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "unsolicited abort", cp);
2092edd16368SStephen M. Cameron 		break;
2093edd16368SStephen M. Cameron 	case CMD_TIMEOUT:
2094d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "timed out", cp);
2095edd16368SStephen M. Cameron 		break;
20961d5e2ed0SStephen M. Cameron 	case CMD_UNABORTABLE:
2097d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "unabortable", cp);
20981d5e2ed0SStephen M. Cameron 		break;
2099edd16368SStephen M. Cameron 	default:
2100d1e8beacSStephen M. Cameron 		hpsa_print_cmd(h, "unknown status", cp);
2101d1e8beacSStephen M. Cameron 		dev_warn(d, "Unknown command status %x\n",
2102edd16368SStephen M. Cameron 				ei->CommandStatus);
2103edd16368SStephen M. Cameron 	}
2104edd16368SStephen M. Cameron }
2105edd16368SStephen M. Cameron 
2106edd16368SStephen M. Cameron static int hpsa_scsi_do_inquiry(struct ctlr_info *h, unsigned char *scsi3addr,
2107b7bb24ebSStephen M. Cameron 			u16 page, unsigned char *buf,
2108edd16368SStephen M. Cameron 			unsigned char bufsize)
2109edd16368SStephen M. Cameron {
2110edd16368SStephen M. Cameron 	int rc = IO_OK;
2111edd16368SStephen M. Cameron 	struct CommandList *c;
2112edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
2113edd16368SStephen M. Cameron 
2114edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
2115edd16368SStephen M. Cameron 
2116edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
2117edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
2118ecd9aad4SStephen M. Cameron 		return -ENOMEM;
2119edd16368SStephen M. Cameron 	}
2120edd16368SStephen M. Cameron 
2121a2dac136SStephen M. Cameron 	if (fill_cmd(c, HPSA_INQUIRY, h, buf, bufsize,
2122a2dac136SStephen M. Cameron 			page, scsi3addr, TYPE_CMD)) {
2123a2dac136SStephen M. Cameron 		rc = -1;
2124a2dac136SStephen M. Cameron 		goto out;
2125a2dac136SStephen M. Cameron 	}
2126edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_FROMDEVICE);
2127edd16368SStephen M. Cameron 	ei = c->err_info;
2128edd16368SStephen M. Cameron 	if (ei->CommandStatus != 0 && ei->CommandStatus != CMD_DATA_UNDERRUN) {
2129d1e8beacSStephen M. Cameron 		hpsa_scsi_interpret_error(h, c);
2130edd16368SStephen M. Cameron 		rc = -1;
2131edd16368SStephen M. Cameron 	}
2132a2dac136SStephen M. Cameron out:
2133edd16368SStephen M. Cameron 	cmd_special_free(h, c);
2134edd16368SStephen M. Cameron 	return rc;
2135edd16368SStephen M. Cameron }
2136edd16368SStephen M. Cameron 
2137316b221aSStephen M. Cameron static int hpsa_bmic_ctrl_mode_sense(struct ctlr_info *h,
2138316b221aSStephen M. Cameron 		unsigned char *scsi3addr, unsigned char page,
2139316b221aSStephen M. Cameron 		struct bmic_controller_parameters *buf, size_t bufsize)
2140316b221aSStephen M. Cameron {
2141316b221aSStephen M. Cameron 	int rc = IO_OK;
2142316b221aSStephen M. Cameron 	struct CommandList *c;
2143316b221aSStephen M. Cameron 	struct ErrorInfo *ei;
2144316b221aSStephen M. Cameron 
2145316b221aSStephen M. Cameron 	c = cmd_special_alloc(h);
2146316b221aSStephen M. Cameron 
2147316b221aSStephen M. Cameron 	if (c == NULL) {			/* trouble... */
2148316b221aSStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
2149316b221aSStephen M. Cameron 		return -ENOMEM;
2150316b221aSStephen M. Cameron 	}
2151316b221aSStephen M. Cameron 
2152316b221aSStephen M. Cameron 	if (fill_cmd(c, BMIC_SENSE_CONTROLLER_PARAMETERS, h, buf, bufsize,
2153316b221aSStephen M. Cameron 			page, scsi3addr, TYPE_CMD)) {
2154316b221aSStephen M. Cameron 		rc = -1;
2155316b221aSStephen M. Cameron 		goto out;
2156316b221aSStephen M. Cameron 	}
2157316b221aSStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_FROMDEVICE);
2158316b221aSStephen M. Cameron 	ei = c->err_info;
2159316b221aSStephen M. Cameron 	if (ei->CommandStatus != 0 && ei->CommandStatus != CMD_DATA_UNDERRUN) {
2160316b221aSStephen M. Cameron 		hpsa_scsi_interpret_error(h, c);
2161316b221aSStephen M. Cameron 		rc = -1;
2162316b221aSStephen M. Cameron 	}
2163316b221aSStephen M. Cameron out:
2164316b221aSStephen M. Cameron 	cmd_special_free(h, c);
2165316b221aSStephen M. Cameron 	return rc;
2166316b221aSStephen M. Cameron 	}
2167316b221aSStephen M. Cameron 
2168bf711ac6SScott Teel static int hpsa_send_reset(struct ctlr_info *h, unsigned char *scsi3addr,
2169bf711ac6SScott Teel 	u8 reset_type)
2170edd16368SStephen M. Cameron {
2171edd16368SStephen M. Cameron 	int rc = IO_OK;
2172edd16368SStephen M. Cameron 	struct CommandList *c;
2173edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
2174edd16368SStephen M. Cameron 
2175edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
2176edd16368SStephen M. Cameron 
2177edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
2178edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
2179e9ea04a6SStephen M. Cameron 		return -ENOMEM;
2180edd16368SStephen M. Cameron 	}
2181edd16368SStephen M. Cameron 
2182a2dac136SStephen M. Cameron 	/* fill_cmd can't fail here, no data buffer to map. */
2183bf711ac6SScott Teel 	(void) fill_cmd(c, HPSA_DEVICE_RESET_MSG, h, NULL, 0, 0,
2184bf711ac6SScott Teel 			scsi3addr, TYPE_MSG);
2185bf711ac6SScott Teel 	c->Request.CDB[1] = reset_type; /* fill_cmd defaults to LUN reset */
2186edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core(h, c);
2187edd16368SStephen M. Cameron 	/* no unmap needed here because no data xfer. */
2188edd16368SStephen M. Cameron 
2189edd16368SStephen M. Cameron 	ei = c->err_info;
2190edd16368SStephen M. Cameron 	if (ei->CommandStatus != 0) {
2191d1e8beacSStephen M. Cameron 		hpsa_scsi_interpret_error(h, c);
2192edd16368SStephen M. Cameron 		rc = -1;
2193edd16368SStephen M. Cameron 	}
2194edd16368SStephen M. Cameron 	cmd_special_free(h, c);
2195edd16368SStephen M. Cameron 	return rc;
2196edd16368SStephen M. Cameron }
2197edd16368SStephen M. Cameron 
2198edd16368SStephen M. Cameron static void hpsa_get_raid_level(struct ctlr_info *h,
2199edd16368SStephen M. Cameron 	unsigned char *scsi3addr, unsigned char *raid_level)
2200edd16368SStephen M. Cameron {
2201edd16368SStephen M. Cameron 	int rc;
2202edd16368SStephen M. Cameron 	unsigned char *buf;
2203edd16368SStephen M. Cameron 
2204edd16368SStephen M. Cameron 	*raid_level = RAID_UNKNOWN;
2205edd16368SStephen M. Cameron 	buf = kzalloc(64, GFP_KERNEL);
2206edd16368SStephen M. Cameron 	if (!buf)
2207edd16368SStephen M. Cameron 		return;
2208b7bb24ebSStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr, VPD_PAGE | 0xC1, buf, 64);
2209edd16368SStephen M. Cameron 	if (rc == 0)
2210edd16368SStephen M. Cameron 		*raid_level = buf[8];
2211edd16368SStephen M. Cameron 	if (*raid_level > RAID_UNKNOWN)
2212edd16368SStephen M. Cameron 		*raid_level = RAID_UNKNOWN;
2213edd16368SStephen M. Cameron 	kfree(buf);
2214edd16368SStephen M. Cameron 	return;
2215edd16368SStephen M. Cameron }
2216edd16368SStephen M. Cameron 
2217283b4a9bSStephen M. Cameron #define HPSA_MAP_DEBUG
2218283b4a9bSStephen M. Cameron #ifdef HPSA_MAP_DEBUG
2219283b4a9bSStephen M. Cameron static void hpsa_debug_map_buff(struct ctlr_info *h, int rc,
2220283b4a9bSStephen M. Cameron 				struct raid_map_data *map_buff)
2221283b4a9bSStephen M. Cameron {
2222283b4a9bSStephen M. Cameron 	struct raid_map_disk_data *dd = &map_buff->data[0];
2223283b4a9bSStephen M. Cameron 	int map, row, col;
2224283b4a9bSStephen M. Cameron 	u16 map_cnt, row_cnt, disks_per_row;
2225283b4a9bSStephen M. Cameron 
2226283b4a9bSStephen M. Cameron 	if (rc != 0)
2227283b4a9bSStephen M. Cameron 		return;
2228283b4a9bSStephen M. Cameron 
22292ba8bfc8SStephen M. Cameron 	/* Show details only if debugging has been activated. */
22302ba8bfc8SStephen M. Cameron 	if (h->raid_offload_debug < 2)
22312ba8bfc8SStephen M. Cameron 		return;
22322ba8bfc8SStephen M. Cameron 
2233283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "structure_size = %u\n",
2234283b4a9bSStephen M. Cameron 				le32_to_cpu(map_buff->structure_size));
2235283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "volume_blk_size = %u\n",
2236283b4a9bSStephen M. Cameron 			le32_to_cpu(map_buff->volume_blk_size));
2237283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "volume_blk_cnt = 0x%llx\n",
2238283b4a9bSStephen M. Cameron 			le64_to_cpu(map_buff->volume_blk_cnt));
2239283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "physicalBlockShift = %u\n",
2240283b4a9bSStephen M. Cameron 			map_buff->phys_blk_shift);
2241283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "parity_rotation_shift = %u\n",
2242283b4a9bSStephen M. Cameron 			map_buff->parity_rotation_shift);
2243283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "strip_size = %u\n",
2244283b4a9bSStephen M. Cameron 			le16_to_cpu(map_buff->strip_size));
2245283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "disk_starting_blk = 0x%llx\n",
2246283b4a9bSStephen M. Cameron 			le64_to_cpu(map_buff->disk_starting_blk));
2247283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "disk_blk_cnt = 0x%llx\n",
2248283b4a9bSStephen M. Cameron 			le64_to_cpu(map_buff->disk_blk_cnt));
2249283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "data_disks_per_row = %u\n",
2250283b4a9bSStephen M. Cameron 			le16_to_cpu(map_buff->data_disks_per_row));
2251283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "metadata_disks_per_row = %u\n",
2252283b4a9bSStephen M. Cameron 			le16_to_cpu(map_buff->metadata_disks_per_row));
2253283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "row_cnt = %u\n",
2254283b4a9bSStephen M. Cameron 			le16_to_cpu(map_buff->row_cnt));
2255283b4a9bSStephen M. Cameron 	dev_info(&h->pdev->dev, "layout_map_count = %u\n",
2256283b4a9bSStephen M. Cameron 			le16_to_cpu(map_buff->layout_map_count));
2257dd0e19f3SScott Teel 	dev_info(&h->pdev->dev, "flags = %u\n",
2258dd0e19f3SScott Teel 			le16_to_cpu(map_buff->flags));
2259dd0e19f3SScott Teel 	if (map_buff->flags & RAID_MAP_FLAG_ENCRYPT_ON)
2260dd0e19f3SScott Teel 		dev_info(&h->pdev->dev, "encrypytion = ON\n");
2261dd0e19f3SScott Teel 	else
2262dd0e19f3SScott Teel 		dev_info(&h->pdev->dev, "encrypytion = OFF\n");
2263dd0e19f3SScott Teel 	dev_info(&h->pdev->dev, "dekindex = %u\n",
2264dd0e19f3SScott Teel 			le16_to_cpu(map_buff->dekindex));
2265283b4a9bSStephen M. Cameron 
2266283b4a9bSStephen M. Cameron 	map_cnt = le16_to_cpu(map_buff->layout_map_count);
2267283b4a9bSStephen M. Cameron 	for (map = 0; map < map_cnt; map++) {
2268283b4a9bSStephen M. Cameron 		dev_info(&h->pdev->dev, "Map%u:\n", map);
2269283b4a9bSStephen M. Cameron 		row_cnt = le16_to_cpu(map_buff->row_cnt);
2270283b4a9bSStephen M. Cameron 		for (row = 0; row < row_cnt; row++) {
2271283b4a9bSStephen M. Cameron 			dev_info(&h->pdev->dev, "  Row%u:\n", row);
2272283b4a9bSStephen M. Cameron 			disks_per_row =
2273283b4a9bSStephen M. Cameron 				le16_to_cpu(map_buff->data_disks_per_row);
2274283b4a9bSStephen M. Cameron 			for (col = 0; col < disks_per_row; col++, dd++)
2275283b4a9bSStephen M. Cameron 				dev_info(&h->pdev->dev,
2276283b4a9bSStephen M. Cameron 					"    D%02u: h=0x%04x xor=%u,%u\n",
2277283b4a9bSStephen M. Cameron 					col, dd->ioaccel_handle,
2278283b4a9bSStephen M. Cameron 					dd->xor_mult[0], dd->xor_mult[1]);
2279283b4a9bSStephen M. Cameron 			disks_per_row =
2280283b4a9bSStephen M. Cameron 				le16_to_cpu(map_buff->metadata_disks_per_row);
2281283b4a9bSStephen M. Cameron 			for (col = 0; col < disks_per_row; col++, dd++)
2282283b4a9bSStephen M. Cameron 				dev_info(&h->pdev->dev,
2283283b4a9bSStephen M. Cameron 					"    M%02u: h=0x%04x xor=%u,%u\n",
2284283b4a9bSStephen M. Cameron 					col, dd->ioaccel_handle,
2285283b4a9bSStephen M. Cameron 					dd->xor_mult[0], dd->xor_mult[1]);
2286283b4a9bSStephen M. Cameron 		}
2287283b4a9bSStephen M. Cameron 	}
2288283b4a9bSStephen M. Cameron }
2289283b4a9bSStephen M. Cameron #else
2290283b4a9bSStephen M. Cameron static void hpsa_debug_map_buff(__attribute__((unused)) struct ctlr_info *h,
2291283b4a9bSStephen M. Cameron 			__attribute__((unused)) int rc,
2292283b4a9bSStephen M. Cameron 			__attribute__((unused)) struct raid_map_data *map_buff)
2293283b4a9bSStephen M. Cameron {
2294283b4a9bSStephen M. Cameron }
2295283b4a9bSStephen M. Cameron #endif
2296283b4a9bSStephen M. Cameron 
2297283b4a9bSStephen M. Cameron static int hpsa_get_raid_map(struct ctlr_info *h,
2298283b4a9bSStephen M. Cameron 	unsigned char *scsi3addr, struct hpsa_scsi_dev_t *this_device)
2299283b4a9bSStephen M. Cameron {
2300283b4a9bSStephen M. Cameron 	int rc = 0;
2301283b4a9bSStephen M. Cameron 	struct CommandList *c;
2302283b4a9bSStephen M. Cameron 	struct ErrorInfo *ei;
2303283b4a9bSStephen M. Cameron 
2304283b4a9bSStephen M. Cameron 	c = cmd_special_alloc(h);
2305283b4a9bSStephen M. Cameron 	if (c == NULL) {
2306283b4a9bSStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
2307283b4a9bSStephen M. Cameron 		return -ENOMEM;
2308283b4a9bSStephen M. Cameron 	}
2309283b4a9bSStephen M. Cameron 	if (fill_cmd(c, HPSA_GET_RAID_MAP, h, &this_device->raid_map,
2310283b4a9bSStephen M. Cameron 			sizeof(this_device->raid_map), 0,
2311283b4a9bSStephen M. Cameron 			scsi3addr, TYPE_CMD)) {
2312283b4a9bSStephen M. Cameron 		dev_warn(&h->pdev->dev, "Out of memory in hpsa_get_raid_map()\n");
2313283b4a9bSStephen M. Cameron 		cmd_special_free(h, c);
2314283b4a9bSStephen M. Cameron 		return -ENOMEM;
2315283b4a9bSStephen M. Cameron 	}
2316283b4a9bSStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_FROMDEVICE);
2317283b4a9bSStephen M. Cameron 	ei = c->err_info;
2318283b4a9bSStephen M. Cameron 	if (ei->CommandStatus != 0 && ei->CommandStatus != CMD_DATA_UNDERRUN) {
2319d1e8beacSStephen M. Cameron 		hpsa_scsi_interpret_error(h, c);
2320283b4a9bSStephen M. Cameron 		cmd_special_free(h, c);
2321283b4a9bSStephen M. Cameron 		return -1;
2322283b4a9bSStephen M. Cameron 	}
2323283b4a9bSStephen M. Cameron 	cmd_special_free(h, c);
2324283b4a9bSStephen M. Cameron 
2325283b4a9bSStephen M. Cameron 	/* @todo in the future, dynamically allocate RAID map memory */
2326283b4a9bSStephen M. Cameron 	if (le32_to_cpu(this_device->raid_map.structure_size) >
2327283b4a9bSStephen M. Cameron 				sizeof(this_device->raid_map)) {
2328283b4a9bSStephen M. Cameron 		dev_warn(&h->pdev->dev, "RAID map size is too large!\n");
2329283b4a9bSStephen M. Cameron 		rc = -1;
2330283b4a9bSStephen M. Cameron 	}
2331283b4a9bSStephen M. Cameron 	hpsa_debug_map_buff(h, rc, &this_device->raid_map);
2332283b4a9bSStephen M. Cameron 	return rc;
2333283b4a9bSStephen M. Cameron }
2334283b4a9bSStephen M. Cameron 
23351b70150aSStephen M. Cameron static int hpsa_vpd_page_supported(struct ctlr_info *h,
23361b70150aSStephen M. Cameron 	unsigned char scsi3addr[], u8 page)
23371b70150aSStephen M. Cameron {
23381b70150aSStephen M. Cameron 	int rc;
23391b70150aSStephen M. Cameron 	int i;
23401b70150aSStephen M. Cameron 	int pages;
23411b70150aSStephen M. Cameron 	unsigned char *buf, bufsize;
23421b70150aSStephen M. Cameron 
23431b70150aSStephen M. Cameron 	buf = kzalloc(256, GFP_KERNEL);
23441b70150aSStephen M. Cameron 	if (!buf)
23451b70150aSStephen M. Cameron 		return 0;
23461b70150aSStephen M. Cameron 
23471b70150aSStephen M. Cameron 	/* Get the size of the page list first */
23481b70150aSStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr,
23491b70150aSStephen M. Cameron 				VPD_PAGE | HPSA_VPD_SUPPORTED_PAGES,
23501b70150aSStephen M. Cameron 				buf, HPSA_VPD_HEADER_SZ);
23511b70150aSStephen M. Cameron 	if (rc != 0)
23521b70150aSStephen M. Cameron 		goto exit_unsupported;
23531b70150aSStephen M. Cameron 	pages = buf[3];
23541b70150aSStephen M. Cameron 	if ((pages + HPSA_VPD_HEADER_SZ) <= 255)
23551b70150aSStephen M. Cameron 		bufsize = pages + HPSA_VPD_HEADER_SZ;
23561b70150aSStephen M. Cameron 	else
23571b70150aSStephen M. Cameron 		bufsize = 255;
23581b70150aSStephen M. Cameron 
23591b70150aSStephen M. Cameron 	/* Get the whole VPD page list */
23601b70150aSStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr,
23611b70150aSStephen M. Cameron 				VPD_PAGE | HPSA_VPD_SUPPORTED_PAGES,
23621b70150aSStephen M. Cameron 				buf, bufsize);
23631b70150aSStephen M. Cameron 	if (rc != 0)
23641b70150aSStephen M. Cameron 		goto exit_unsupported;
23651b70150aSStephen M. Cameron 
23661b70150aSStephen M. Cameron 	pages = buf[3];
23671b70150aSStephen M. Cameron 	for (i = 1; i <= pages; i++)
23681b70150aSStephen M. Cameron 		if (buf[3 + i] == page)
23691b70150aSStephen M. Cameron 			goto exit_supported;
23701b70150aSStephen M. Cameron exit_unsupported:
23711b70150aSStephen M. Cameron 	kfree(buf);
23721b70150aSStephen M. Cameron 	return 0;
23731b70150aSStephen M. Cameron exit_supported:
23741b70150aSStephen M. Cameron 	kfree(buf);
23751b70150aSStephen M. Cameron 	return 1;
23761b70150aSStephen M. Cameron }
23771b70150aSStephen M. Cameron 
2378283b4a9bSStephen M. Cameron static void hpsa_get_ioaccel_status(struct ctlr_info *h,
2379283b4a9bSStephen M. Cameron 	unsigned char *scsi3addr, struct hpsa_scsi_dev_t *this_device)
2380283b4a9bSStephen M. Cameron {
2381283b4a9bSStephen M. Cameron 	int rc;
2382283b4a9bSStephen M. Cameron 	unsigned char *buf;
2383283b4a9bSStephen M. Cameron 	u8 ioaccel_status;
2384283b4a9bSStephen M. Cameron 
2385283b4a9bSStephen M. Cameron 	this_device->offload_config = 0;
2386283b4a9bSStephen M. Cameron 	this_device->offload_enabled = 0;
2387283b4a9bSStephen M. Cameron 
2388283b4a9bSStephen M. Cameron 	buf = kzalloc(64, GFP_KERNEL);
2389283b4a9bSStephen M. Cameron 	if (!buf)
2390283b4a9bSStephen M. Cameron 		return;
23911b70150aSStephen M. Cameron 	if (!hpsa_vpd_page_supported(h, scsi3addr, HPSA_VPD_LV_IOACCEL_STATUS))
23921b70150aSStephen M. Cameron 		goto out;
2393283b4a9bSStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr,
2394b7bb24ebSStephen M. Cameron 			VPD_PAGE | HPSA_VPD_LV_IOACCEL_STATUS, buf, 64);
2395283b4a9bSStephen M. Cameron 	if (rc != 0)
2396283b4a9bSStephen M. Cameron 		goto out;
2397283b4a9bSStephen M. Cameron 
2398283b4a9bSStephen M. Cameron #define IOACCEL_STATUS_BYTE 4
2399283b4a9bSStephen M. Cameron #define OFFLOAD_CONFIGURED_BIT 0x01
2400283b4a9bSStephen M. Cameron #define OFFLOAD_ENABLED_BIT 0x02
2401283b4a9bSStephen M. Cameron 	ioaccel_status = buf[IOACCEL_STATUS_BYTE];
2402283b4a9bSStephen M. Cameron 	this_device->offload_config =
2403283b4a9bSStephen M. Cameron 		!!(ioaccel_status & OFFLOAD_CONFIGURED_BIT);
2404283b4a9bSStephen M. Cameron 	if (this_device->offload_config) {
2405283b4a9bSStephen M. Cameron 		this_device->offload_enabled =
2406283b4a9bSStephen M. Cameron 			!!(ioaccel_status & OFFLOAD_ENABLED_BIT);
2407283b4a9bSStephen M. Cameron 		if (hpsa_get_raid_map(h, scsi3addr, this_device))
2408283b4a9bSStephen M. Cameron 			this_device->offload_enabled = 0;
2409283b4a9bSStephen M. Cameron 	}
2410283b4a9bSStephen M. Cameron out:
2411283b4a9bSStephen M. Cameron 	kfree(buf);
2412283b4a9bSStephen M. Cameron 	return;
2413283b4a9bSStephen M. Cameron }
2414283b4a9bSStephen M. Cameron 
2415edd16368SStephen M. Cameron /* Get the device id from inquiry page 0x83 */
2416edd16368SStephen M. Cameron static int hpsa_get_device_id(struct ctlr_info *h, unsigned char *scsi3addr,
2417edd16368SStephen M. Cameron 	unsigned char *device_id, int buflen)
2418edd16368SStephen M. Cameron {
2419edd16368SStephen M. Cameron 	int rc;
2420edd16368SStephen M. Cameron 	unsigned char *buf;
2421edd16368SStephen M. Cameron 
2422edd16368SStephen M. Cameron 	if (buflen > 16)
2423edd16368SStephen M. Cameron 		buflen = 16;
2424edd16368SStephen M. Cameron 	buf = kzalloc(64, GFP_KERNEL);
2425edd16368SStephen M. Cameron 	if (!buf)
2426a84d794dSStephen M. Cameron 		return -ENOMEM;
2427b7bb24ebSStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr, VPD_PAGE | 0x83, buf, 64);
2428edd16368SStephen M. Cameron 	if (rc == 0)
2429edd16368SStephen M. Cameron 		memcpy(device_id, &buf[8], buflen);
2430edd16368SStephen M. Cameron 	kfree(buf);
2431edd16368SStephen M. Cameron 	return rc != 0;
2432edd16368SStephen M. Cameron }
2433edd16368SStephen M. Cameron 
2434edd16368SStephen M. Cameron static int hpsa_scsi_do_report_luns(struct ctlr_info *h, int logical,
2435edd16368SStephen M. Cameron 		struct ReportLUNdata *buf, int bufsize,
2436edd16368SStephen M. Cameron 		int extended_response)
2437edd16368SStephen M. Cameron {
2438edd16368SStephen M. Cameron 	int rc = IO_OK;
2439edd16368SStephen M. Cameron 	struct CommandList *c;
2440edd16368SStephen M. Cameron 	unsigned char scsi3addr[8];
2441edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
2442edd16368SStephen M. Cameron 
2443edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
2444edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
2445edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
2446edd16368SStephen M. Cameron 		return -1;
2447edd16368SStephen M. Cameron 	}
2448e89c0ae7SStephen M. Cameron 	/* address the controller */
2449e89c0ae7SStephen M. Cameron 	memset(scsi3addr, 0, sizeof(scsi3addr));
2450a2dac136SStephen M. Cameron 	if (fill_cmd(c, logical ? HPSA_REPORT_LOG : HPSA_REPORT_PHYS, h,
2451a2dac136SStephen M. Cameron 		buf, bufsize, 0, scsi3addr, TYPE_CMD)) {
2452a2dac136SStephen M. Cameron 		rc = -1;
2453a2dac136SStephen M. Cameron 		goto out;
2454a2dac136SStephen M. Cameron 	}
2455edd16368SStephen M. Cameron 	if (extended_response)
2456edd16368SStephen M. Cameron 		c->Request.CDB[1] = extended_response;
2457edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_FROMDEVICE);
2458edd16368SStephen M. Cameron 	ei = c->err_info;
2459edd16368SStephen M. Cameron 	if (ei->CommandStatus != 0 &&
2460edd16368SStephen M. Cameron 	    ei->CommandStatus != CMD_DATA_UNDERRUN) {
2461d1e8beacSStephen M. Cameron 		hpsa_scsi_interpret_error(h, c);
2462edd16368SStephen M. Cameron 		rc = -1;
2463283b4a9bSStephen M. Cameron 	} else {
2464283b4a9bSStephen M. Cameron 		if (buf->extended_response_flag != extended_response) {
2465283b4a9bSStephen M. Cameron 			dev_err(&h->pdev->dev,
2466283b4a9bSStephen M. Cameron 				"report luns requested format %u, got %u\n",
2467283b4a9bSStephen M. Cameron 				extended_response,
2468283b4a9bSStephen M. Cameron 				buf->extended_response_flag);
2469283b4a9bSStephen M. Cameron 			rc = -1;
2470283b4a9bSStephen M. Cameron 		}
2471edd16368SStephen M. Cameron 	}
2472a2dac136SStephen M. Cameron out:
2473edd16368SStephen M. Cameron 	cmd_special_free(h, c);
2474edd16368SStephen M. Cameron 	return rc;
2475edd16368SStephen M. Cameron }
2476edd16368SStephen M. Cameron 
2477edd16368SStephen M. Cameron static inline int hpsa_scsi_do_report_phys_luns(struct ctlr_info *h,
2478edd16368SStephen M. Cameron 		struct ReportLUNdata *buf,
2479edd16368SStephen M. Cameron 		int bufsize, int extended_response)
2480edd16368SStephen M. Cameron {
2481edd16368SStephen M. Cameron 	return hpsa_scsi_do_report_luns(h, 0, buf, bufsize, extended_response);
2482edd16368SStephen M. Cameron }
2483edd16368SStephen M. Cameron 
2484edd16368SStephen M. Cameron static inline int hpsa_scsi_do_report_log_luns(struct ctlr_info *h,
2485edd16368SStephen M. Cameron 		struct ReportLUNdata *buf, int bufsize)
2486edd16368SStephen M. Cameron {
2487edd16368SStephen M. Cameron 	return hpsa_scsi_do_report_luns(h, 1, buf, bufsize, 0);
2488edd16368SStephen M. Cameron }
2489edd16368SStephen M. Cameron 
2490edd16368SStephen M. Cameron static inline void hpsa_set_bus_target_lun(struct hpsa_scsi_dev_t *device,
2491edd16368SStephen M. Cameron 	int bus, int target, int lun)
2492edd16368SStephen M. Cameron {
2493edd16368SStephen M. Cameron 	device->bus = bus;
2494edd16368SStephen M. Cameron 	device->target = target;
2495edd16368SStephen M. Cameron 	device->lun = lun;
2496edd16368SStephen M. Cameron }
2497edd16368SStephen M. Cameron 
24989846590eSStephen M. Cameron /* Use VPD inquiry to get details of volume status */
24999846590eSStephen M. Cameron static int hpsa_get_volume_status(struct ctlr_info *h,
25009846590eSStephen M. Cameron 					unsigned char scsi3addr[])
25019846590eSStephen M. Cameron {
25029846590eSStephen M. Cameron 	int rc;
25039846590eSStephen M. Cameron 	int status;
25049846590eSStephen M. Cameron 	int size;
25059846590eSStephen M. Cameron 	unsigned char *buf;
25069846590eSStephen M. Cameron 
25079846590eSStephen M. Cameron 	buf = kzalloc(64, GFP_KERNEL);
25089846590eSStephen M. Cameron 	if (!buf)
25099846590eSStephen M. Cameron 		return HPSA_VPD_LV_STATUS_UNSUPPORTED;
25109846590eSStephen M. Cameron 
25119846590eSStephen M. Cameron 	/* Does controller have VPD for logical volume status? */
251224a4b078SStephen M. Cameron 	if (!hpsa_vpd_page_supported(h, scsi3addr, HPSA_VPD_LV_STATUS))
25139846590eSStephen M. Cameron 		goto exit_failed;
25149846590eSStephen M. Cameron 
25159846590eSStephen M. Cameron 	/* Get the size of the VPD return buffer */
25169846590eSStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr, VPD_PAGE | HPSA_VPD_LV_STATUS,
25179846590eSStephen M. Cameron 					buf, HPSA_VPD_HEADER_SZ);
251824a4b078SStephen M. Cameron 	if (rc != 0)
25199846590eSStephen M. Cameron 		goto exit_failed;
25209846590eSStephen M. Cameron 	size = buf[3];
25219846590eSStephen M. Cameron 
25229846590eSStephen M. Cameron 	/* Now get the whole VPD buffer */
25239846590eSStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr, VPD_PAGE | HPSA_VPD_LV_STATUS,
25249846590eSStephen M. Cameron 					buf, size + HPSA_VPD_HEADER_SZ);
252524a4b078SStephen M. Cameron 	if (rc != 0)
25269846590eSStephen M. Cameron 		goto exit_failed;
25279846590eSStephen M. Cameron 	status = buf[4]; /* status byte */
25289846590eSStephen M. Cameron 
25299846590eSStephen M. Cameron 	kfree(buf);
25309846590eSStephen M. Cameron 	return status;
25319846590eSStephen M. Cameron exit_failed:
25329846590eSStephen M. Cameron 	kfree(buf);
25339846590eSStephen M. Cameron 	return HPSA_VPD_LV_STATUS_UNSUPPORTED;
25349846590eSStephen M. Cameron }
25359846590eSStephen M. Cameron 
25369846590eSStephen M. Cameron /* Determine offline status of a volume.
25379846590eSStephen M. Cameron  * Return either:
25389846590eSStephen M. Cameron  *  0 (not offline)
253967955ba3SStephen M. Cameron  *  0xff (offline for unknown reasons)
25409846590eSStephen M. Cameron  *  # (integer code indicating one of several NOT READY states
25419846590eSStephen M. Cameron  *     describing why a volume is to be kept offline)
25429846590eSStephen M. Cameron  */
254367955ba3SStephen M. Cameron static int hpsa_volume_offline(struct ctlr_info *h,
25449846590eSStephen M. Cameron 					unsigned char scsi3addr[])
25459846590eSStephen M. Cameron {
25469846590eSStephen M. Cameron 	struct CommandList *c;
25479846590eSStephen M. Cameron 	unsigned char *sense, sense_key, asc, ascq;
25489846590eSStephen M. Cameron 	int ldstat = 0;
25499846590eSStephen M. Cameron 	u16 cmd_status;
25509846590eSStephen M. Cameron 	u8 scsi_status;
25519846590eSStephen M. Cameron #define ASC_LUN_NOT_READY 0x04
25529846590eSStephen M. Cameron #define ASCQ_LUN_NOT_READY_FORMAT_IN_PROGRESS 0x04
25539846590eSStephen M. Cameron #define ASCQ_LUN_NOT_READY_INITIALIZING_CMD_REQ 0x02
25549846590eSStephen M. Cameron 
25559846590eSStephen M. Cameron 	c = cmd_alloc(h);
25569846590eSStephen M. Cameron 	if (!c)
25579846590eSStephen M. Cameron 		return 0;
25589846590eSStephen M. Cameron 	(void) fill_cmd(c, TEST_UNIT_READY, h, NULL, 0, 0, scsi3addr, TYPE_CMD);
25599846590eSStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core(h, c);
25609846590eSStephen M. Cameron 	sense = c->err_info->SenseInfo;
25619846590eSStephen M. Cameron 	sense_key = sense[2];
25629846590eSStephen M. Cameron 	asc = sense[12];
25639846590eSStephen M. Cameron 	ascq = sense[13];
25649846590eSStephen M. Cameron 	cmd_status = c->err_info->CommandStatus;
25659846590eSStephen M. Cameron 	scsi_status = c->err_info->ScsiStatus;
25669846590eSStephen M. Cameron 	cmd_free(h, c);
25679846590eSStephen M. Cameron 	/* Is the volume 'not ready'? */
25689846590eSStephen M. Cameron 	if (cmd_status != CMD_TARGET_STATUS ||
25699846590eSStephen M. Cameron 		scsi_status != SAM_STAT_CHECK_CONDITION ||
25709846590eSStephen M. Cameron 		sense_key != NOT_READY ||
25719846590eSStephen M. Cameron 		asc != ASC_LUN_NOT_READY)  {
25729846590eSStephen M. Cameron 		return 0;
25739846590eSStephen M. Cameron 	}
25749846590eSStephen M. Cameron 
25759846590eSStephen M. Cameron 	/* Determine the reason for not ready state */
25769846590eSStephen M. Cameron 	ldstat = hpsa_get_volume_status(h, scsi3addr);
25779846590eSStephen M. Cameron 
25789846590eSStephen M. Cameron 	/* Keep volume offline in certain cases: */
25799846590eSStephen M. Cameron 	switch (ldstat) {
25809846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_ERASE:
25819846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_RPI:
25829846590eSStephen M. Cameron 	case HPSA_LV_PENDING_RPI:
25839846590eSStephen M. Cameron 	case HPSA_LV_ENCRYPTED_NO_KEY:
25849846590eSStephen M. Cameron 	case HPSA_LV_PLAINTEXT_IN_ENCRYPT_ONLY_CONTROLLER:
25859846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_ENCRYPTION:
25869846590eSStephen M. Cameron 	case HPSA_LV_UNDERGOING_ENCRYPTION_REKEYING:
25879846590eSStephen M. Cameron 	case HPSA_LV_ENCRYPTED_IN_NON_ENCRYPTED_CONTROLLER:
25889846590eSStephen M. Cameron 		return ldstat;
25899846590eSStephen M. Cameron 	case HPSA_VPD_LV_STATUS_UNSUPPORTED:
25909846590eSStephen M. Cameron 		/* If VPD status page isn't available,
25919846590eSStephen M. Cameron 		 * use ASC/ASCQ to determine state
25929846590eSStephen M. Cameron 		 */
25939846590eSStephen M. Cameron 		if ((ascq == ASCQ_LUN_NOT_READY_FORMAT_IN_PROGRESS) ||
25949846590eSStephen M. Cameron 			(ascq == ASCQ_LUN_NOT_READY_INITIALIZING_CMD_REQ))
25959846590eSStephen M. Cameron 			return ldstat;
25969846590eSStephen M. Cameron 		break;
25979846590eSStephen M. Cameron 	default:
25989846590eSStephen M. Cameron 		break;
25999846590eSStephen M. Cameron 	}
26009846590eSStephen M. Cameron 	return 0;
26019846590eSStephen M. Cameron }
26029846590eSStephen M. Cameron 
2603edd16368SStephen M. Cameron static int hpsa_update_device_info(struct ctlr_info *h,
26040b0e1d6cSStephen M. Cameron 	unsigned char scsi3addr[], struct hpsa_scsi_dev_t *this_device,
26050b0e1d6cSStephen M. Cameron 	unsigned char *is_OBDR_device)
2606edd16368SStephen M. Cameron {
26070b0e1d6cSStephen M. Cameron 
26080b0e1d6cSStephen M. Cameron #define OBDR_SIG_OFFSET 43
26090b0e1d6cSStephen M. Cameron #define OBDR_TAPE_SIG "$DR-10"
26100b0e1d6cSStephen M. Cameron #define OBDR_SIG_LEN (sizeof(OBDR_TAPE_SIG) - 1)
26110b0e1d6cSStephen M. Cameron #define OBDR_TAPE_INQ_SIZE (OBDR_SIG_OFFSET + OBDR_SIG_LEN)
26120b0e1d6cSStephen M. Cameron 
2613ea6d3bc3SStephen M. Cameron 	unsigned char *inq_buff;
26140b0e1d6cSStephen M. Cameron 	unsigned char *obdr_sig;
2615edd16368SStephen M. Cameron 
2616ea6d3bc3SStephen M. Cameron 	inq_buff = kzalloc(OBDR_TAPE_INQ_SIZE, GFP_KERNEL);
2617edd16368SStephen M. Cameron 	if (!inq_buff)
2618edd16368SStephen M. Cameron 		goto bail_out;
2619edd16368SStephen M. Cameron 
2620edd16368SStephen M. Cameron 	/* Do an inquiry to the device to see what it is. */
2621edd16368SStephen M. Cameron 	if (hpsa_scsi_do_inquiry(h, scsi3addr, 0, inq_buff,
2622edd16368SStephen M. Cameron 		(unsigned char) OBDR_TAPE_INQ_SIZE) != 0) {
2623edd16368SStephen M. Cameron 		/* Inquiry failed (msg printed already) */
2624edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev,
2625edd16368SStephen M. Cameron 			"hpsa_update_device_info: inquiry failed\n");
2626edd16368SStephen M. Cameron 		goto bail_out;
2627edd16368SStephen M. Cameron 	}
2628edd16368SStephen M. Cameron 
2629edd16368SStephen M. Cameron 	this_device->devtype = (inq_buff[0] & 0x1f);
2630edd16368SStephen M. Cameron 	memcpy(this_device->scsi3addr, scsi3addr, 8);
2631edd16368SStephen M. Cameron 	memcpy(this_device->vendor, &inq_buff[8],
2632edd16368SStephen M. Cameron 		sizeof(this_device->vendor));
2633edd16368SStephen M. Cameron 	memcpy(this_device->model, &inq_buff[16],
2634edd16368SStephen M. Cameron 		sizeof(this_device->model));
2635edd16368SStephen M. Cameron 	memset(this_device->device_id, 0,
2636edd16368SStephen M. Cameron 		sizeof(this_device->device_id));
2637edd16368SStephen M. Cameron 	hpsa_get_device_id(h, scsi3addr, this_device->device_id,
2638edd16368SStephen M. Cameron 		sizeof(this_device->device_id));
2639edd16368SStephen M. Cameron 
2640edd16368SStephen M. Cameron 	if (this_device->devtype == TYPE_DISK &&
2641283b4a9bSStephen M. Cameron 		is_logical_dev_addr_mode(scsi3addr)) {
264267955ba3SStephen M. Cameron 		int volume_offline;
264367955ba3SStephen M. Cameron 
2644edd16368SStephen M. Cameron 		hpsa_get_raid_level(h, scsi3addr, &this_device->raid_level);
2645283b4a9bSStephen M. Cameron 		if (h->fw_support & MISC_FW_RAID_OFFLOAD_BASIC)
2646283b4a9bSStephen M. Cameron 			hpsa_get_ioaccel_status(h, scsi3addr, this_device);
264767955ba3SStephen M. Cameron 		volume_offline = hpsa_volume_offline(h, scsi3addr);
264867955ba3SStephen M. Cameron 		if (volume_offline < 0 || volume_offline > 0xff)
264967955ba3SStephen M. Cameron 			volume_offline = HPSA_VPD_LV_STATUS_UNSUPPORTED;
265067955ba3SStephen M. Cameron 		this_device->volume_offline = volume_offline & 0xff;
2651283b4a9bSStephen M. Cameron 	} else {
2652edd16368SStephen M. Cameron 		this_device->raid_level = RAID_UNKNOWN;
2653283b4a9bSStephen M. Cameron 		this_device->offload_config = 0;
2654283b4a9bSStephen M. Cameron 		this_device->offload_enabled = 0;
26559846590eSStephen M. Cameron 		this_device->volume_offline = 0;
2656283b4a9bSStephen M. Cameron 	}
2657edd16368SStephen M. Cameron 
26580b0e1d6cSStephen M. Cameron 	if (is_OBDR_device) {
26590b0e1d6cSStephen M. Cameron 		/* See if this is a One-Button-Disaster-Recovery device
26600b0e1d6cSStephen M. Cameron 		 * by looking for "$DR-10" at offset 43 in inquiry data.
26610b0e1d6cSStephen M. Cameron 		 */
26620b0e1d6cSStephen M. Cameron 		obdr_sig = &inq_buff[OBDR_SIG_OFFSET];
26630b0e1d6cSStephen M. Cameron 		*is_OBDR_device = (this_device->devtype == TYPE_ROM &&
26640b0e1d6cSStephen M. Cameron 					strncmp(obdr_sig, OBDR_TAPE_SIG,
26650b0e1d6cSStephen M. Cameron 						OBDR_SIG_LEN) == 0);
26660b0e1d6cSStephen M. Cameron 	}
26670b0e1d6cSStephen M. Cameron 
2668edd16368SStephen M. Cameron 	kfree(inq_buff);
2669edd16368SStephen M. Cameron 	return 0;
2670edd16368SStephen M. Cameron 
2671edd16368SStephen M. Cameron bail_out:
2672edd16368SStephen M. Cameron 	kfree(inq_buff);
2673edd16368SStephen M. Cameron 	return 1;
2674edd16368SStephen M. Cameron }
2675edd16368SStephen M. Cameron 
26764f4eb9f1SScott Teel static unsigned char *ext_target_model[] = {
2677edd16368SStephen M. Cameron 	"MSA2012",
2678edd16368SStephen M. Cameron 	"MSA2024",
2679edd16368SStephen M. Cameron 	"MSA2312",
2680edd16368SStephen M. Cameron 	"MSA2324",
2681fda38518SStephen M. Cameron 	"P2000 G3 SAS",
2682e06c8e5cSStephen M. Cameron 	"MSA 2040 SAS",
2683edd16368SStephen M. Cameron 	NULL,
2684edd16368SStephen M. Cameron };
2685edd16368SStephen M. Cameron 
26864f4eb9f1SScott Teel static int is_ext_target(struct ctlr_info *h, struct hpsa_scsi_dev_t *device)
2687edd16368SStephen M. Cameron {
2688edd16368SStephen M. Cameron 	int i;
2689edd16368SStephen M. Cameron 
26904f4eb9f1SScott Teel 	for (i = 0; ext_target_model[i]; i++)
26914f4eb9f1SScott Teel 		if (strncmp(device->model, ext_target_model[i],
26924f4eb9f1SScott Teel 			strlen(ext_target_model[i])) == 0)
2693edd16368SStephen M. Cameron 			return 1;
2694edd16368SStephen M. Cameron 	return 0;
2695edd16368SStephen M. Cameron }
2696edd16368SStephen M. Cameron 
2697edd16368SStephen M. Cameron /* Helper function to assign bus, target, lun mapping of devices.
26984f4eb9f1SScott Teel  * Puts non-external target logical volumes on bus 0, external target logical
2699edd16368SStephen M. Cameron  * volumes on bus 1, physical devices on bus 2. and the hba on bus 3.
2700edd16368SStephen M. Cameron  * Logical drive target and lun are assigned at this time, but
2701edd16368SStephen M. Cameron  * physical device lun and target assignment are deferred (assigned
2702edd16368SStephen M. Cameron  * in hpsa_find_target_lun, called by hpsa_scsi_add_entry.)
2703edd16368SStephen M. Cameron  */
2704edd16368SStephen M. Cameron static void figure_bus_target_lun(struct ctlr_info *h,
27051f310bdeSStephen M. Cameron 	u8 *lunaddrbytes, struct hpsa_scsi_dev_t *device)
2706edd16368SStephen M. Cameron {
27071f310bdeSStephen M. Cameron 	u32 lunid = le32_to_cpu(*((__le32 *) lunaddrbytes));
2708edd16368SStephen M. Cameron 
27091f310bdeSStephen M. Cameron 	if (!is_logical_dev_addr_mode(lunaddrbytes)) {
27101f310bdeSStephen M. Cameron 		/* physical device, target and lun filled in later */
27111f310bdeSStephen M. Cameron 		if (is_hba_lunid(lunaddrbytes))
27121f310bdeSStephen M. Cameron 			hpsa_set_bus_target_lun(device, 3, 0, lunid & 0x3fff);
27131f310bdeSStephen M. Cameron 		else
27141f310bdeSStephen M. Cameron 			/* defer target, lun assignment for physical devices */
27151f310bdeSStephen M. Cameron 			hpsa_set_bus_target_lun(device, 2, -1, -1);
27161f310bdeSStephen M. Cameron 		return;
27171f310bdeSStephen M. Cameron 	}
27181f310bdeSStephen M. Cameron 	/* It's a logical device */
27194f4eb9f1SScott Teel 	if (is_ext_target(h, device)) {
27204f4eb9f1SScott Teel 		/* external target way, put logicals on bus 1
2721339b2b14SStephen M. Cameron 		 * and match target/lun numbers box
27221f310bdeSStephen M. Cameron 		 * reports, other smart array, bus 0, target 0, match lunid
2723339b2b14SStephen M. Cameron 		 */
27241f310bdeSStephen M. Cameron 		hpsa_set_bus_target_lun(device,
27251f310bdeSStephen M. Cameron 			1, (lunid >> 16) & 0x3fff, lunid & 0x00ff);
27261f310bdeSStephen M. Cameron 		return;
2727339b2b14SStephen M. Cameron 	}
27281f310bdeSStephen M. Cameron 	hpsa_set_bus_target_lun(device, 0, 0, lunid & 0x3fff);
2729edd16368SStephen M. Cameron }
2730edd16368SStephen M. Cameron 
2731edd16368SStephen M. Cameron /*
2732edd16368SStephen M. Cameron  * If there is no lun 0 on a target, linux won't find any devices.
27334f4eb9f1SScott Teel  * For the external targets (arrays), we have to manually detect the enclosure
2734edd16368SStephen M. Cameron  * which is at lun zero, as CCISS_REPORT_PHYSICAL_LUNS doesn't report
2735edd16368SStephen M. Cameron  * it for some reason.  *tmpdevice is the target we're adding,
2736edd16368SStephen M. Cameron  * this_device is a pointer into the current element of currentsd[]
2737edd16368SStephen M. Cameron  * that we're building up in update_scsi_devices(), below.
2738edd16368SStephen M. Cameron  * lunzerobits is a bitmap that tracks which targets already have a
2739edd16368SStephen M. Cameron  * lun 0 assigned.
2740edd16368SStephen M. Cameron  * Returns 1 if an enclosure was added, 0 if not.
2741edd16368SStephen M. Cameron  */
27424f4eb9f1SScott Teel static int add_ext_target_dev(struct ctlr_info *h,
2743edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *tmpdevice,
274401a02ffcSStephen M. Cameron 	struct hpsa_scsi_dev_t *this_device, u8 *lunaddrbytes,
27454f4eb9f1SScott Teel 	unsigned long lunzerobits[], int *n_ext_target_devs)
2746edd16368SStephen M. Cameron {
2747edd16368SStephen M. Cameron 	unsigned char scsi3addr[8];
2748edd16368SStephen M. Cameron 
27491f310bdeSStephen M. Cameron 	if (test_bit(tmpdevice->target, lunzerobits))
2750edd16368SStephen M. Cameron 		return 0; /* There is already a lun 0 on this target. */
2751edd16368SStephen M. Cameron 
2752edd16368SStephen M. Cameron 	if (!is_logical_dev_addr_mode(lunaddrbytes))
2753edd16368SStephen M. Cameron 		return 0; /* It's the logical targets that may lack lun 0. */
2754edd16368SStephen M. Cameron 
27554f4eb9f1SScott Teel 	if (!is_ext_target(h, tmpdevice))
27564f4eb9f1SScott Teel 		return 0; /* Only external target devices have this problem. */
2757edd16368SStephen M. Cameron 
27581f310bdeSStephen M. Cameron 	if (tmpdevice->lun == 0) /* if lun is 0, then we have a lun 0. */
2759edd16368SStephen M. Cameron 		return 0;
2760edd16368SStephen M. Cameron 
2761c4f8a299SStephen M. Cameron 	memset(scsi3addr, 0, 8);
27621f310bdeSStephen M. Cameron 	scsi3addr[3] = tmpdevice->target;
2763edd16368SStephen M. Cameron 	if (is_hba_lunid(scsi3addr))
2764edd16368SStephen M. Cameron 		return 0; /* Don't add the RAID controller here. */
2765edd16368SStephen M. Cameron 
2766339b2b14SStephen M. Cameron 	if (is_scsi_rev_5(h))
2767339b2b14SStephen M. Cameron 		return 0; /* p1210m doesn't need to do this. */
2768339b2b14SStephen M. Cameron 
27694f4eb9f1SScott Teel 	if (*n_ext_target_devs >= MAX_EXT_TARGETS) {
2770aca4a520SScott Teel 		dev_warn(&h->pdev->dev, "Maximum number of external "
2771aca4a520SScott Teel 			"target devices exceeded.  Check your hardware "
2772edd16368SStephen M. Cameron 			"configuration.");
2773edd16368SStephen M. Cameron 		return 0;
2774edd16368SStephen M. Cameron 	}
2775edd16368SStephen M. Cameron 
27760b0e1d6cSStephen M. Cameron 	if (hpsa_update_device_info(h, scsi3addr, this_device, NULL))
2777edd16368SStephen M. Cameron 		return 0;
27784f4eb9f1SScott Teel 	(*n_ext_target_devs)++;
27791f310bdeSStephen M. Cameron 	hpsa_set_bus_target_lun(this_device,
27801f310bdeSStephen M. Cameron 				tmpdevice->bus, tmpdevice->target, 0);
27811f310bdeSStephen M. Cameron 	set_bit(tmpdevice->target, lunzerobits);
2782edd16368SStephen M. Cameron 	return 1;
2783edd16368SStephen M. Cameron }
2784edd16368SStephen M. Cameron 
2785edd16368SStephen M. Cameron /*
278654b6e9e9SScott Teel  * Get address of physical disk used for an ioaccel2 mode command:
278754b6e9e9SScott Teel  *	1. Extract ioaccel2 handle from the command.
278854b6e9e9SScott Teel  *	2. Find a matching ioaccel2 handle from list of physical disks.
278954b6e9e9SScott Teel  *	3. Return:
279054b6e9e9SScott Teel  *		1 and set scsi3addr to address of matching physical
279154b6e9e9SScott Teel  *		0 if no matching physical disk was found.
279254b6e9e9SScott Teel  */
279354b6e9e9SScott Teel static int hpsa_get_pdisk_of_ioaccel2(struct ctlr_info *h,
279454b6e9e9SScott Teel 	struct CommandList *ioaccel2_cmd_to_abort, unsigned char *scsi3addr)
279554b6e9e9SScott Teel {
279654b6e9e9SScott Teel 	struct ReportExtendedLUNdata *physicals = NULL;
279754b6e9e9SScott Teel 	int responsesize = 24;	/* size of physical extended response */
279854b6e9e9SScott Teel 	int extended = 2;	/* flag forces reporting 'other dev info'. */
279954b6e9e9SScott Teel 	int reportsize = sizeof(*physicals) + HPSA_MAX_PHYS_LUN * responsesize;
280054b6e9e9SScott Teel 	u32 nphysicals = 0;	/* number of reported physical devs */
280154b6e9e9SScott Teel 	int found = 0;		/* found match (1) or not (0) */
280254b6e9e9SScott Teel 	u32 find;		/* handle we need to match */
280354b6e9e9SScott Teel 	int i;
280454b6e9e9SScott Teel 	struct scsi_cmnd *scmd;	/* scsi command within request being aborted */
280554b6e9e9SScott Teel 	struct hpsa_scsi_dev_t *d; /* device of request being aborted */
280654b6e9e9SScott Teel 	struct io_accel2_cmd *c2a; /* ioaccel2 command to abort */
280754b6e9e9SScott Teel 	u32 it_nexus;		/* 4 byte device handle for the ioaccel2 cmd */
280854b6e9e9SScott Teel 	u32 scsi_nexus;		/* 4 byte device handle for the ioaccel2 cmd */
280954b6e9e9SScott Teel 
281054b6e9e9SScott Teel 	if (ioaccel2_cmd_to_abort->cmd_type != CMD_IOACCEL2)
281154b6e9e9SScott Teel 		return 0; /* no match */
281254b6e9e9SScott Teel 
281354b6e9e9SScott Teel 	/* point to the ioaccel2 device handle */
281454b6e9e9SScott Teel 	c2a = &h->ioaccel2_cmd_pool[ioaccel2_cmd_to_abort->cmdindex];
281554b6e9e9SScott Teel 	if (c2a == NULL)
281654b6e9e9SScott Teel 		return 0; /* no match */
281754b6e9e9SScott Teel 
281854b6e9e9SScott Teel 	scmd = (struct scsi_cmnd *) ioaccel2_cmd_to_abort->scsi_cmd;
281954b6e9e9SScott Teel 	if (scmd == NULL)
282054b6e9e9SScott Teel 		return 0; /* no match */
282154b6e9e9SScott Teel 
282254b6e9e9SScott Teel 	d = scmd->device->hostdata;
282354b6e9e9SScott Teel 	if (d == NULL)
282454b6e9e9SScott Teel 		return 0; /* no match */
282554b6e9e9SScott Teel 
2826*50a0decfSStephen M. Cameron 	it_nexus = cpu_to_le32(d->ioaccel_handle);
2827*50a0decfSStephen M. Cameron 	scsi_nexus = cpu_to_le32(c2a->scsi_nexus);
282854b6e9e9SScott Teel 	find = c2a->scsi_nexus;
282954b6e9e9SScott Teel 
28302ba8bfc8SStephen M. Cameron 	if (h->raid_offload_debug > 0)
28312ba8bfc8SStephen M. Cameron 		dev_info(&h->pdev->dev,
28322ba8bfc8SStephen M. Cameron 			"%s: scsi_nexus:0x%08x device id: 0x%02x%02x%02x%02x %02x%02x%02x%02x %02x%02x%02x%02x %02x%02x%02x%02x\n",
28332ba8bfc8SStephen M. Cameron 			__func__, scsi_nexus,
28342ba8bfc8SStephen M. Cameron 			d->device_id[0], d->device_id[1], d->device_id[2],
28352ba8bfc8SStephen M. Cameron 			d->device_id[3], d->device_id[4], d->device_id[5],
28362ba8bfc8SStephen M. Cameron 			d->device_id[6], d->device_id[7], d->device_id[8],
28372ba8bfc8SStephen M. Cameron 			d->device_id[9], d->device_id[10], d->device_id[11],
28382ba8bfc8SStephen M. Cameron 			d->device_id[12], d->device_id[13], d->device_id[14],
28392ba8bfc8SStephen M. Cameron 			d->device_id[15]);
28402ba8bfc8SStephen M. Cameron 
284154b6e9e9SScott Teel 	/* Get the list of physical devices */
284254b6e9e9SScott Teel 	physicals = kzalloc(reportsize, GFP_KERNEL);
28433b51a7a3SJoe Handzik 	if (physicals == NULL)
28443b51a7a3SJoe Handzik 		return 0;
284554b6e9e9SScott Teel 	if (hpsa_scsi_do_report_phys_luns(h, (struct ReportLUNdata *) physicals,
284654b6e9e9SScott Teel 		reportsize, extended)) {
284754b6e9e9SScott Teel 		dev_err(&h->pdev->dev,
284854b6e9e9SScott Teel 			"Can't lookup %s device handle: report physical LUNs failed.\n",
284954b6e9e9SScott Teel 			"HP SSD Smart Path");
285054b6e9e9SScott Teel 		kfree(physicals);
285154b6e9e9SScott Teel 		return 0;
285254b6e9e9SScott Teel 	}
285354b6e9e9SScott Teel 	nphysicals = be32_to_cpu(*((__be32 *)physicals->LUNListLength)) /
285454b6e9e9SScott Teel 							responsesize;
285554b6e9e9SScott Teel 
285654b6e9e9SScott Teel 	/* find ioaccel2 handle in list of physicals: */
285754b6e9e9SScott Teel 	for (i = 0; i < nphysicals; i++) {
2858d5b5d964SStephen M. Cameron 		struct ext_report_lun_entry *entry = &physicals->LUN[i];
2859d5b5d964SStephen M. Cameron 
286054b6e9e9SScott Teel 		/* handle is in bytes 28-31 of each lun */
2861d5b5d964SStephen M. Cameron 		if (entry->ioaccel_handle != find)
286254b6e9e9SScott Teel 			continue; /* didn't match */
286354b6e9e9SScott Teel 		found = 1;
2864d5b5d964SStephen M. Cameron 		memcpy(scsi3addr, entry->lunid, 8);
28652ba8bfc8SStephen M. Cameron 		if (h->raid_offload_debug > 0)
28662ba8bfc8SStephen M. Cameron 			dev_info(&h->pdev->dev,
2867d5b5d964SStephen M. Cameron 				"%s: Searched h=0x%08x, Found h=0x%08x, scsiaddr 0x%8phN\n",
28682ba8bfc8SStephen M. Cameron 				__func__, find,
2869d5b5d964SStephen M. Cameron 				entry->ioaccel_handle, scsi3addr);
287054b6e9e9SScott Teel 		break; /* found it */
287154b6e9e9SScott Teel 	}
287254b6e9e9SScott Teel 
287354b6e9e9SScott Teel 	kfree(physicals);
287454b6e9e9SScott Teel 	if (found)
287554b6e9e9SScott Teel 		return 1;
287654b6e9e9SScott Teel 	else
287754b6e9e9SScott Teel 		return 0;
287854b6e9e9SScott Teel 
287954b6e9e9SScott Teel }
288054b6e9e9SScott Teel /*
2881edd16368SStephen M. Cameron  * Do CISS_REPORT_PHYS and CISS_REPORT_LOG.  Data is returned in physdev,
2882edd16368SStephen M. Cameron  * logdev.  The number of luns in physdev and logdev are returned in
2883edd16368SStephen M. Cameron  * *nphysicals and *nlogicals, respectively.
2884edd16368SStephen M. Cameron  * Returns 0 on success, -1 otherwise.
2885edd16368SStephen M. Cameron  */
2886edd16368SStephen M. Cameron static int hpsa_gather_lun_info(struct ctlr_info *h,
288792084715SStephen M. Cameron 	int reportphyslunsize, int reportloglunsize,
2888283b4a9bSStephen M. Cameron 	struct ReportLUNdata *physdev, u32 *nphysicals, int *physical_mode,
288901a02ffcSStephen M. Cameron 	struct ReportLUNdata *logdev, u32 *nlogicals)
2890edd16368SStephen M. Cameron {
2891283b4a9bSStephen M. Cameron 	int physical_entry_size = 8;
2892283b4a9bSStephen M. Cameron 
2893283b4a9bSStephen M. Cameron 	*physical_mode = 0;
2894283b4a9bSStephen M. Cameron 
2895283b4a9bSStephen M. Cameron 	/* For I/O accelerator mode we need to read physical device handles */
2896317d4adfSMike MIller 	if (h->transMethod & CFGTBL_Trans_io_accel1 ||
2897317d4adfSMike MIller 		h->transMethod & CFGTBL_Trans_io_accel2) {
2898283b4a9bSStephen M. Cameron 		*physical_mode = HPSA_REPORT_PHYS_EXTENDED;
2899283b4a9bSStephen M. Cameron 		physical_entry_size = 24;
2900283b4a9bSStephen M. Cameron 	}
290192084715SStephen M. Cameron 	if (hpsa_scsi_do_report_phys_luns(h, physdev, reportphyslunsize,
2902283b4a9bSStephen M. Cameron 							*physical_mode)) {
2903edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "report physical LUNs failed.\n");
2904edd16368SStephen M. Cameron 		return -1;
2905edd16368SStephen M. Cameron 	}
2906283b4a9bSStephen M. Cameron 	*nphysicals = be32_to_cpu(*((__be32 *)physdev->LUNListLength)) /
2907283b4a9bSStephen M. Cameron 							physical_entry_size;
2908edd16368SStephen M. Cameron 	if (*nphysicals > HPSA_MAX_PHYS_LUN) {
2909edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "maximum physical LUNs (%d) exceeded."
2910edd16368SStephen M. Cameron 			"  %d LUNs ignored.\n", HPSA_MAX_PHYS_LUN,
2911edd16368SStephen M. Cameron 			*nphysicals - HPSA_MAX_PHYS_LUN);
2912edd16368SStephen M. Cameron 		*nphysicals = HPSA_MAX_PHYS_LUN;
2913edd16368SStephen M. Cameron 	}
291492084715SStephen M. Cameron 	if (hpsa_scsi_do_report_log_luns(h, logdev, reportloglunsize)) {
2915edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "report logical LUNs failed.\n");
2916edd16368SStephen M. Cameron 		return -1;
2917edd16368SStephen M. Cameron 	}
29186df1e954SStephen M. Cameron 	*nlogicals = be32_to_cpu(*((__be32 *) logdev->LUNListLength)) / 8;
2919edd16368SStephen M. Cameron 	/* Reject Logicals in excess of our max capability. */
2920edd16368SStephen M. Cameron 	if (*nlogicals > HPSA_MAX_LUN) {
2921edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev,
2922edd16368SStephen M. Cameron 			"maximum logical LUNs (%d) exceeded.  "
2923edd16368SStephen M. Cameron 			"%d LUNs ignored.\n", HPSA_MAX_LUN,
2924edd16368SStephen M. Cameron 			*nlogicals - HPSA_MAX_LUN);
2925edd16368SStephen M. Cameron 			*nlogicals = HPSA_MAX_LUN;
2926edd16368SStephen M. Cameron 	}
2927edd16368SStephen M. Cameron 	if (*nlogicals + *nphysicals > HPSA_MAX_PHYS_LUN) {
2928edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev,
2929edd16368SStephen M. Cameron 			"maximum logical + physical LUNs (%d) exceeded. "
2930edd16368SStephen M. Cameron 			"%d LUNs ignored.\n", HPSA_MAX_PHYS_LUN,
2931edd16368SStephen M. Cameron 			*nphysicals + *nlogicals - HPSA_MAX_PHYS_LUN);
2932edd16368SStephen M. Cameron 		*nlogicals = HPSA_MAX_PHYS_LUN - *nphysicals;
2933edd16368SStephen M. Cameron 	}
2934edd16368SStephen M. Cameron 	return 0;
2935edd16368SStephen M. Cameron }
2936edd16368SStephen M. Cameron 
293742a91641SDon Brace static u8 *figure_lunaddrbytes(struct ctlr_info *h, int raid_ctlr_position,
293842a91641SDon Brace 	int i, int nphysicals, int nlogicals,
2939a93aa1feSMatt Gates 	struct ReportExtendedLUNdata *physdev_list,
2940339b2b14SStephen M. Cameron 	struct ReportLUNdata *logdev_list)
2941339b2b14SStephen M. Cameron {
2942339b2b14SStephen M. Cameron 	/* Helper function, figure out where the LUN ID info is coming from
2943339b2b14SStephen M. Cameron 	 * given index i, lists of physical and logical devices, where in
2944339b2b14SStephen M. Cameron 	 * the list the raid controller is supposed to appear (first or last)
2945339b2b14SStephen M. Cameron 	 */
2946339b2b14SStephen M. Cameron 
2947339b2b14SStephen M. Cameron 	int logicals_start = nphysicals + (raid_ctlr_position == 0);
2948339b2b14SStephen M. Cameron 	int last_device = nphysicals + nlogicals + (raid_ctlr_position == 0);
2949339b2b14SStephen M. Cameron 
2950339b2b14SStephen M. Cameron 	if (i == raid_ctlr_position)
2951339b2b14SStephen M. Cameron 		return RAID_CTLR_LUNID;
2952339b2b14SStephen M. Cameron 
2953339b2b14SStephen M. Cameron 	if (i < logicals_start)
2954d5b5d964SStephen M. Cameron 		return &physdev_list->LUN[i -
2955d5b5d964SStephen M. Cameron 				(raid_ctlr_position == 0)].lunid[0];
2956339b2b14SStephen M. Cameron 
2957339b2b14SStephen M. Cameron 	if (i < last_device)
2958339b2b14SStephen M. Cameron 		return &logdev_list->LUN[i - nphysicals -
2959339b2b14SStephen M. Cameron 			(raid_ctlr_position == 0)][0];
2960339b2b14SStephen M. Cameron 	BUG();
2961339b2b14SStephen M. Cameron 	return NULL;
2962339b2b14SStephen M. Cameron }
2963339b2b14SStephen M. Cameron 
2964316b221aSStephen M. Cameron static int hpsa_hba_mode_enabled(struct ctlr_info *h)
2965316b221aSStephen M. Cameron {
2966316b221aSStephen M. Cameron 	int rc;
29676e8e8088SJoe Handzik 	int hba_mode_enabled;
2968316b221aSStephen M. Cameron 	struct bmic_controller_parameters *ctlr_params;
2969316b221aSStephen M. Cameron 	ctlr_params = kzalloc(sizeof(struct bmic_controller_parameters),
2970316b221aSStephen M. Cameron 		GFP_KERNEL);
2971316b221aSStephen M. Cameron 
2972316b221aSStephen M. Cameron 	if (!ctlr_params)
297396444fbbSJoe Handzik 		return -ENOMEM;
2974316b221aSStephen M. Cameron 	rc = hpsa_bmic_ctrl_mode_sense(h, RAID_CTLR_LUNID, 0, ctlr_params,
2975316b221aSStephen M. Cameron 		sizeof(struct bmic_controller_parameters));
297696444fbbSJoe Handzik 	if (rc) {
2977316b221aSStephen M. Cameron 		kfree(ctlr_params);
297896444fbbSJoe Handzik 		return rc;
2979316b221aSStephen M. Cameron 	}
29806e8e8088SJoe Handzik 
29816e8e8088SJoe Handzik 	hba_mode_enabled =
29826e8e8088SJoe Handzik 		((ctlr_params->nvram_flags & HBA_MODE_ENABLED_FLAG) != 0);
29836e8e8088SJoe Handzik 	kfree(ctlr_params);
29846e8e8088SJoe Handzik 	return hba_mode_enabled;
2985316b221aSStephen M. Cameron }
2986316b221aSStephen M. Cameron 
2987edd16368SStephen M. Cameron static void hpsa_update_scsi_devices(struct ctlr_info *h, int hostno)
2988edd16368SStephen M. Cameron {
2989edd16368SStephen M. Cameron 	/* the idea here is we could get notified
2990edd16368SStephen M. Cameron 	 * that some devices have changed, so we do a report
2991edd16368SStephen M. Cameron 	 * physical luns and report logical luns cmd, and adjust
2992edd16368SStephen M. Cameron 	 * our list of devices accordingly.
2993edd16368SStephen M. Cameron 	 *
2994edd16368SStephen M. Cameron 	 * The scsi3addr's of devices won't change so long as the
2995edd16368SStephen M. Cameron 	 * adapter is not reset.  That means we can rescan and
2996edd16368SStephen M. Cameron 	 * tell which devices we already know about, vs. new
2997edd16368SStephen M. Cameron 	 * devices, vs.  disappearing devices.
2998edd16368SStephen M. Cameron 	 */
2999a93aa1feSMatt Gates 	struct ReportExtendedLUNdata *physdev_list = NULL;
3000edd16368SStephen M. Cameron 	struct ReportLUNdata *logdev_list = NULL;
300101a02ffcSStephen M. Cameron 	u32 nphysicals = 0;
300201a02ffcSStephen M. Cameron 	u32 nlogicals = 0;
3003283b4a9bSStephen M. Cameron 	int physical_mode = 0;
300401a02ffcSStephen M. Cameron 	u32 ndev_allocated = 0;
3005edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t **currentsd, *this_device, *tmpdevice;
3006edd16368SStephen M. Cameron 	int ncurrent = 0;
30074f4eb9f1SScott Teel 	int i, n_ext_target_devs, ndevs_to_allocate;
3008339b2b14SStephen M. Cameron 	int raid_ctlr_position;
30092bbf5c7fSJoe Handzik 	int rescan_hba_mode;
3010aca4a520SScott Teel 	DECLARE_BITMAP(lunzerobits, MAX_EXT_TARGETS);
3011edd16368SStephen M. Cameron 
3012cfe5badcSScott Teel 	currentsd = kzalloc(sizeof(*currentsd) * HPSA_MAX_DEVICES, GFP_KERNEL);
301392084715SStephen M. Cameron 	physdev_list = kzalloc(sizeof(*physdev_list), GFP_KERNEL);
301492084715SStephen M. Cameron 	logdev_list = kzalloc(sizeof(*logdev_list), GFP_KERNEL);
3015edd16368SStephen M. Cameron 	tmpdevice = kzalloc(sizeof(*tmpdevice), GFP_KERNEL);
3016edd16368SStephen M. Cameron 
30170b0e1d6cSStephen M. Cameron 	if (!currentsd || !physdev_list || !logdev_list || !tmpdevice) {
3018edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "out of memory\n");
3019edd16368SStephen M. Cameron 		goto out;
3020edd16368SStephen M. Cameron 	}
3021edd16368SStephen M. Cameron 	memset(lunzerobits, 0, sizeof(lunzerobits));
3022edd16368SStephen M. Cameron 
3023316b221aSStephen M. Cameron 	rescan_hba_mode = hpsa_hba_mode_enabled(h);
302496444fbbSJoe Handzik 	if (rescan_hba_mode < 0)
302596444fbbSJoe Handzik 		goto out;
3026316b221aSStephen M. Cameron 
3027316b221aSStephen M. Cameron 	if (!h->hba_mode_enabled && rescan_hba_mode)
3028316b221aSStephen M. Cameron 		dev_warn(&h->pdev->dev, "HBA mode enabled\n");
3029316b221aSStephen M. Cameron 	else if (h->hba_mode_enabled && !rescan_hba_mode)
3030316b221aSStephen M. Cameron 		dev_warn(&h->pdev->dev, "HBA mode disabled\n");
3031316b221aSStephen M. Cameron 
3032316b221aSStephen M. Cameron 	h->hba_mode_enabled = rescan_hba_mode;
3033316b221aSStephen M. Cameron 
303492084715SStephen M. Cameron 	if (hpsa_gather_lun_info(h,
303592084715SStephen M. Cameron 			sizeof(*physdev_list), sizeof(*logdev_list),
3036a93aa1feSMatt Gates 			(struct ReportLUNdata *) physdev_list, &nphysicals,
3037283b4a9bSStephen M. Cameron 			&physical_mode, logdev_list, &nlogicals))
3038edd16368SStephen M. Cameron 		goto out;
3039edd16368SStephen M. Cameron 
3040aca4a520SScott Teel 	/* We might see up to the maximum number of logical and physical disks
3041aca4a520SScott Teel 	 * plus external target devices, and a device for the local RAID
3042aca4a520SScott Teel 	 * controller.
3043edd16368SStephen M. Cameron 	 */
3044aca4a520SScott Teel 	ndevs_to_allocate = nphysicals + nlogicals + MAX_EXT_TARGETS + 1;
3045edd16368SStephen M. Cameron 
3046edd16368SStephen M. Cameron 	/* Allocate the per device structures */
3047edd16368SStephen M. Cameron 	for (i = 0; i < ndevs_to_allocate; i++) {
3048b7ec021fSScott Teel 		if (i >= HPSA_MAX_DEVICES) {
3049b7ec021fSScott Teel 			dev_warn(&h->pdev->dev, "maximum devices (%d) exceeded."
3050b7ec021fSScott Teel 				"  %d devices ignored.\n", HPSA_MAX_DEVICES,
3051b7ec021fSScott Teel 				ndevs_to_allocate - HPSA_MAX_DEVICES);
3052b7ec021fSScott Teel 			break;
3053b7ec021fSScott Teel 		}
3054b7ec021fSScott Teel 
3055edd16368SStephen M. Cameron 		currentsd[i] = kzalloc(sizeof(*currentsd[i]), GFP_KERNEL);
3056edd16368SStephen M. Cameron 		if (!currentsd[i]) {
3057edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "out of memory at %s:%d\n",
3058edd16368SStephen M. Cameron 				__FILE__, __LINE__);
3059edd16368SStephen M. Cameron 			goto out;
3060edd16368SStephen M. Cameron 		}
3061edd16368SStephen M. Cameron 		ndev_allocated++;
3062edd16368SStephen M. Cameron 	}
3063edd16368SStephen M. Cameron 
30648645291bSStephen M. Cameron 	if (is_scsi_rev_5(h))
3065339b2b14SStephen M. Cameron 		raid_ctlr_position = 0;
3066339b2b14SStephen M. Cameron 	else
3067339b2b14SStephen M. Cameron 		raid_ctlr_position = nphysicals + nlogicals;
3068339b2b14SStephen M. Cameron 
3069edd16368SStephen M. Cameron 	/* adjust our table of devices */
30704f4eb9f1SScott Teel 	n_ext_target_devs = 0;
3071edd16368SStephen M. Cameron 	for (i = 0; i < nphysicals + nlogicals + 1; i++) {
30720b0e1d6cSStephen M. Cameron 		u8 *lunaddrbytes, is_OBDR = 0;
3073edd16368SStephen M. Cameron 
3074edd16368SStephen M. Cameron 		/* Figure out where the LUN ID info is coming from */
3075339b2b14SStephen M. Cameron 		lunaddrbytes = figure_lunaddrbytes(h, raid_ctlr_position,
3076339b2b14SStephen M. Cameron 			i, nphysicals, nlogicals, physdev_list, logdev_list);
3077edd16368SStephen M. Cameron 		/* skip masked physical devices. */
3078339b2b14SStephen M. Cameron 		if (lunaddrbytes[3] & 0xC0 &&
3079339b2b14SStephen M. Cameron 			i < nphysicals + (raid_ctlr_position == 0))
3080edd16368SStephen M. Cameron 			continue;
3081edd16368SStephen M. Cameron 
3082edd16368SStephen M. Cameron 		/* Get device type, vendor, model, device id */
30830b0e1d6cSStephen M. Cameron 		if (hpsa_update_device_info(h, lunaddrbytes, tmpdevice,
30840b0e1d6cSStephen M. Cameron 							&is_OBDR))
3085edd16368SStephen M. Cameron 			continue; /* skip it if we can't talk to it. */
30861f310bdeSStephen M. Cameron 		figure_bus_target_lun(h, lunaddrbytes, tmpdevice);
3087edd16368SStephen M. Cameron 		this_device = currentsd[ncurrent];
3088edd16368SStephen M. Cameron 
3089edd16368SStephen M. Cameron 		/*
30904f4eb9f1SScott Teel 		 * For external target devices, we have to insert a LUN 0 which
3091edd16368SStephen M. Cameron 		 * doesn't show up in CCISS_REPORT_PHYSICAL data, but there
3092edd16368SStephen M. Cameron 		 * is nonetheless an enclosure device there.  We have to
3093edd16368SStephen M. Cameron 		 * present that otherwise linux won't find anything if
3094edd16368SStephen M. Cameron 		 * there is no lun 0.
3095edd16368SStephen M. Cameron 		 */
30964f4eb9f1SScott Teel 		if (add_ext_target_dev(h, tmpdevice, this_device,
30971f310bdeSStephen M. Cameron 				lunaddrbytes, lunzerobits,
30984f4eb9f1SScott Teel 				&n_ext_target_devs)) {
3099edd16368SStephen M. Cameron 			ncurrent++;
3100edd16368SStephen M. Cameron 			this_device = currentsd[ncurrent];
3101edd16368SStephen M. Cameron 		}
3102edd16368SStephen M. Cameron 
3103edd16368SStephen M. Cameron 		*this_device = *tmpdevice;
3104edd16368SStephen M. Cameron 
3105edd16368SStephen M. Cameron 		switch (this_device->devtype) {
31060b0e1d6cSStephen M. Cameron 		case TYPE_ROM:
3107edd16368SStephen M. Cameron 			/* We don't *really* support actual CD-ROM devices,
3108edd16368SStephen M. Cameron 			 * just "One Button Disaster Recovery" tape drive
3109edd16368SStephen M. Cameron 			 * which temporarily pretends to be a CD-ROM drive.
3110edd16368SStephen M. Cameron 			 * So we check that the device is really an OBDR tape
3111edd16368SStephen M. Cameron 			 * device by checking for "$DR-10" in bytes 43-48 of
3112edd16368SStephen M. Cameron 			 * the inquiry data.
3113edd16368SStephen M. Cameron 			 */
31140b0e1d6cSStephen M. Cameron 			if (is_OBDR)
3115edd16368SStephen M. Cameron 				ncurrent++;
3116edd16368SStephen M. Cameron 			break;
3117edd16368SStephen M. Cameron 		case TYPE_DISK:
3118316b221aSStephen M. Cameron 			if (h->hba_mode_enabled) {
3119316b221aSStephen M. Cameron 				/* never use raid mapper in HBA mode */
3120316b221aSStephen M. Cameron 				this_device->offload_enabled = 0;
3121316b221aSStephen M. Cameron 				ncurrent++;
3122316b221aSStephen M. Cameron 				break;
3123316b221aSStephen M. Cameron 			} else if (h->acciopath_status) {
3124283b4a9bSStephen M. Cameron 				if (i >= nphysicals) {
3125283b4a9bSStephen M. Cameron 					ncurrent++;
3126edd16368SStephen M. Cameron 					break;
3127283b4a9bSStephen M. Cameron 				}
3128316b221aSStephen M. Cameron 			} else {
3129316b221aSStephen M. Cameron 				if (i < nphysicals)
3130316b221aSStephen M. Cameron 					break;
3131316b221aSStephen M. Cameron 				ncurrent++;
3132316b221aSStephen M. Cameron 				break;
3133316b221aSStephen M. Cameron 			}
3134283b4a9bSStephen M. Cameron 			if (physical_mode == HPSA_REPORT_PHYS_EXTENDED) {
3135e1f7de0cSMatt Gates 				memcpy(&this_device->ioaccel_handle,
3136e1f7de0cSMatt Gates 					&lunaddrbytes[20],
3137e1f7de0cSMatt Gates 					sizeof(this_device->ioaccel_handle));
3138edd16368SStephen M. Cameron 				ncurrent++;
3139283b4a9bSStephen M. Cameron 			}
3140edd16368SStephen M. Cameron 			break;
3141edd16368SStephen M. Cameron 		case TYPE_TAPE:
3142edd16368SStephen M. Cameron 		case TYPE_MEDIUM_CHANGER:
3143edd16368SStephen M. Cameron 			ncurrent++;
3144edd16368SStephen M. Cameron 			break;
3145edd16368SStephen M. Cameron 		case TYPE_RAID:
3146edd16368SStephen M. Cameron 			/* Only present the Smartarray HBA as a RAID controller.
3147edd16368SStephen M. Cameron 			 * If it's a RAID controller other than the HBA itself
3148edd16368SStephen M. Cameron 			 * (an external RAID controller, MSA500 or similar)
3149edd16368SStephen M. Cameron 			 * don't present it.
3150edd16368SStephen M. Cameron 			 */
3151edd16368SStephen M. Cameron 			if (!is_hba_lunid(lunaddrbytes))
3152edd16368SStephen M. Cameron 				break;
3153edd16368SStephen M. Cameron 			ncurrent++;
3154edd16368SStephen M. Cameron 			break;
3155edd16368SStephen M. Cameron 		default:
3156edd16368SStephen M. Cameron 			break;
3157edd16368SStephen M. Cameron 		}
3158cfe5badcSScott Teel 		if (ncurrent >= HPSA_MAX_DEVICES)
3159edd16368SStephen M. Cameron 			break;
3160edd16368SStephen M. Cameron 	}
3161edd16368SStephen M. Cameron 	adjust_hpsa_scsi_table(h, hostno, currentsd, ncurrent);
3162edd16368SStephen M. Cameron out:
3163edd16368SStephen M. Cameron 	kfree(tmpdevice);
3164edd16368SStephen M. Cameron 	for (i = 0; i < ndev_allocated; i++)
3165edd16368SStephen M. Cameron 		kfree(currentsd[i]);
3166edd16368SStephen M. Cameron 	kfree(currentsd);
3167edd16368SStephen M. Cameron 	kfree(physdev_list);
3168edd16368SStephen M. Cameron 	kfree(logdev_list);
3169edd16368SStephen M. Cameron }
3170edd16368SStephen M. Cameron 
3171edd16368SStephen M. Cameron /* hpsa_scatter_gather takes a struct scsi_cmnd, (cmd), and does the pci
3172edd16368SStephen M. Cameron  * dma mapping  and fills in the scatter gather entries of the
3173edd16368SStephen M. Cameron  * hpsa command, cp.
3174edd16368SStephen M. Cameron  */
317533a2ffceSStephen M. Cameron static int hpsa_scatter_gather(struct ctlr_info *h,
3176edd16368SStephen M. Cameron 		struct CommandList *cp,
3177edd16368SStephen M. Cameron 		struct scsi_cmnd *cmd)
3178edd16368SStephen M. Cameron {
3179edd16368SStephen M. Cameron 	unsigned int len;
3180edd16368SStephen M. Cameron 	struct scatterlist *sg;
318101a02ffcSStephen M. Cameron 	u64 addr64;
318233a2ffceSStephen M. Cameron 	int use_sg, i, sg_index, chained;
318333a2ffceSStephen M. Cameron 	struct SGDescriptor *curr_sg;
3184edd16368SStephen M. Cameron 
318533a2ffceSStephen M. Cameron 	BUG_ON(scsi_sg_count(cmd) > h->maxsgentries);
3186edd16368SStephen M. Cameron 
3187edd16368SStephen M. Cameron 	use_sg = scsi_dma_map(cmd);
3188edd16368SStephen M. Cameron 	if (use_sg < 0)
3189edd16368SStephen M. Cameron 		return use_sg;
3190edd16368SStephen M. Cameron 
3191edd16368SStephen M. Cameron 	if (!use_sg)
3192edd16368SStephen M. Cameron 		goto sglist_finished;
3193edd16368SStephen M. Cameron 
319433a2ffceSStephen M. Cameron 	curr_sg = cp->SG;
319533a2ffceSStephen M. Cameron 	chained = 0;
319633a2ffceSStephen M. Cameron 	sg_index = 0;
3197edd16368SStephen M. Cameron 	scsi_for_each_sg(cmd, sg, use_sg, i) {
319833a2ffceSStephen M. Cameron 		if (i == h->max_cmd_sg_entries - 1 &&
319933a2ffceSStephen M. Cameron 			use_sg > h->max_cmd_sg_entries) {
320033a2ffceSStephen M. Cameron 			chained = 1;
320133a2ffceSStephen M. Cameron 			curr_sg = h->cmd_sg_list[cp->cmdindex];
320233a2ffceSStephen M. Cameron 			sg_index = 0;
320333a2ffceSStephen M. Cameron 		}
320401a02ffcSStephen M. Cameron 		addr64 = (u64) sg_dma_address(sg);
3205edd16368SStephen M. Cameron 		len  = sg_dma_len(sg);
3206*50a0decfSStephen M. Cameron 		curr_sg->Addr = cpu_to_le64(addr64);
3207*50a0decfSStephen M. Cameron 		curr_sg->Len = cpu_to_le32(len);
3208*50a0decfSStephen M. Cameron 		curr_sg->Ext = cpu_to_le32(0);
320933a2ffceSStephen M. Cameron 		curr_sg++;
321033a2ffceSStephen M. Cameron 	}
3211*50a0decfSStephen M. Cameron 	(--curr_sg)->Ext = cpu_to_le32(HPSA_SG_LAST);
321233a2ffceSStephen M. Cameron 
321333a2ffceSStephen M. Cameron 	if (use_sg + chained > h->maxSG)
321433a2ffceSStephen M. Cameron 		h->maxSG = use_sg + chained;
321533a2ffceSStephen M. Cameron 
321633a2ffceSStephen M. Cameron 	if (chained) {
321733a2ffceSStephen M. Cameron 		cp->Header.SGList = h->max_cmd_sg_entries;
3218*50a0decfSStephen M. Cameron 		cp->Header.SGTotal = cpu_to_le16(use_sg + 1);
3219e2bea6dfSStephen M. Cameron 		if (hpsa_map_sg_chain_block(h, cp)) {
3220e2bea6dfSStephen M. Cameron 			scsi_dma_unmap(cmd);
3221e2bea6dfSStephen M. Cameron 			return -1;
3222e2bea6dfSStephen M. Cameron 		}
322333a2ffceSStephen M. Cameron 		return 0;
3224edd16368SStephen M. Cameron 	}
3225edd16368SStephen M. Cameron 
3226edd16368SStephen M. Cameron sglist_finished:
3227edd16368SStephen M. Cameron 
322801a02ffcSStephen M. Cameron 	cp->Header.SGList = (u8) use_sg;   /* no. SGs contig in this cmd */
3229*50a0decfSStephen M. Cameron 	cp->Header.SGTotal = cpu_to_le16(use_sg); /* total sgs in this cmd list */
3230edd16368SStephen M. Cameron 	return 0;
3231edd16368SStephen M. Cameron }
3232edd16368SStephen M. Cameron 
3233283b4a9bSStephen M. Cameron #define IO_ACCEL_INELIGIBLE (1)
3234283b4a9bSStephen M. Cameron static int fixup_ioaccel_cdb(u8 *cdb, int *cdb_len)
3235283b4a9bSStephen M. Cameron {
3236283b4a9bSStephen M. Cameron 	int is_write = 0;
3237283b4a9bSStephen M. Cameron 	u32 block;
3238283b4a9bSStephen M. Cameron 	u32 block_cnt;
3239283b4a9bSStephen M. Cameron 
3240283b4a9bSStephen M. Cameron 	/* Perform some CDB fixups if needed using 10 byte reads/writes only */
3241283b4a9bSStephen M. Cameron 	switch (cdb[0]) {
3242283b4a9bSStephen M. Cameron 	case WRITE_6:
3243283b4a9bSStephen M. Cameron 	case WRITE_12:
3244283b4a9bSStephen M. Cameron 		is_write = 1;
3245283b4a9bSStephen M. Cameron 	case READ_6:
3246283b4a9bSStephen M. Cameron 	case READ_12:
3247283b4a9bSStephen M. Cameron 		if (*cdb_len == 6) {
3248283b4a9bSStephen M. Cameron 			block = (((u32) cdb[2]) << 8) | cdb[3];
3249283b4a9bSStephen M. Cameron 			block_cnt = cdb[4];
3250283b4a9bSStephen M. Cameron 		} else {
3251283b4a9bSStephen M. Cameron 			BUG_ON(*cdb_len != 12);
3252283b4a9bSStephen M. Cameron 			block = (((u32) cdb[2]) << 24) |
3253283b4a9bSStephen M. Cameron 				(((u32) cdb[3]) << 16) |
3254283b4a9bSStephen M. Cameron 				(((u32) cdb[4]) << 8) |
3255283b4a9bSStephen M. Cameron 				cdb[5];
3256283b4a9bSStephen M. Cameron 			block_cnt =
3257283b4a9bSStephen M. Cameron 				(((u32) cdb[6]) << 24) |
3258283b4a9bSStephen M. Cameron 				(((u32) cdb[7]) << 16) |
3259283b4a9bSStephen M. Cameron 				(((u32) cdb[8]) << 8) |
3260283b4a9bSStephen M. Cameron 				cdb[9];
3261283b4a9bSStephen M. Cameron 		}
3262283b4a9bSStephen M. Cameron 		if (block_cnt > 0xffff)
3263283b4a9bSStephen M. Cameron 			return IO_ACCEL_INELIGIBLE;
3264283b4a9bSStephen M. Cameron 
3265283b4a9bSStephen M. Cameron 		cdb[0] = is_write ? WRITE_10 : READ_10;
3266283b4a9bSStephen M. Cameron 		cdb[1] = 0;
3267283b4a9bSStephen M. Cameron 		cdb[2] = (u8) (block >> 24);
3268283b4a9bSStephen M. Cameron 		cdb[3] = (u8) (block >> 16);
3269283b4a9bSStephen M. Cameron 		cdb[4] = (u8) (block >> 8);
3270283b4a9bSStephen M. Cameron 		cdb[5] = (u8) (block);
3271283b4a9bSStephen M. Cameron 		cdb[6] = 0;
3272283b4a9bSStephen M. Cameron 		cdb[7] = (u8) (block_cnt >> 8);
3273283b4a9bSStephen M. Cameron 		cdb[8] = (u8) (block_cnt);
3274283b4a9bSStephen M. Cameron 		cdb[9] = 0;
3275283b4a9bSStephen M. Cameron 		*cdb_len = 10;
3276283b4a9bSStephen M. Cameron 		break;
3277283b4a9bSStephen M. Cameron 	}
3278283b4a9bSStephen M. Cameron 	return 0;
3279283b4a9bSStephen M. Cameron }
3280283b4a9bSStephen M. Cameron 
3281c349775eSScott Teel static int hpsa_scsi_ioaccel1_queue_command(struct ctlr_info *h,
3282283b4a9bSStephen M. Cameron 	struct CommandList *c, u32 ioaccel_handle, u8 *cdb, int cdb_len,
3283283b4a9bSStephen M. Cameron 	u8 *scsi3addr)
3284e1f7de0cSMatt Gates {
3285e1f7de0cSMatt Gates 	struct scsi_cmnd *cmd = c->scsi_cmd;
3286e1f7de0cSMatt Gates 	struct io_accel1_cmd *cp = &h->ioaccel_cmd_pool[c->cmdindex];
3287e1f7de0cSMatt Gates 	unsigned int len;
3288e1f7de0cSMatt Gates 	unsigned int total_len = 0;
3289e1f7de0cSMatt Gates 	struct scatterlist *sg;
3290e1f7de0cSMatt Gates 	u64 addr64;
3291e1f7de0cSMatt Gates 	int use_sg, i;
3292e1f7de0cSMatt Gates 	struct SGDescriptor *curr_sg;
3293e1f7de0cSMatt Gates 	u32 control = IOACCEL1_CONTROL_SIMPLEQUEUE;
3294e1f7de0cSMatt Gates 
3295283b4a9bSStephen M. Cameron 	/* TODO: implement chaining support */
3296283b4a9bSStephen M. Cameron 	if (scsi_sg_count(cmd) > h->ioaccel_maxsg)
3297283b4a9bSStephen M. Cameron 		return IO_ACCEL_INELIGIBLE;
3298283b4a9bSStephen M. Cameron 
3299e1f7de0cSMatt Gates 	BUG_ON(cmd->cmd_len > IOACCEL1_IOFLAGS_CDBLEN_MAX);
3300e1f7de0cSMatt Gates 
3301283b4a9bSStephen M. Cameron 	if (fixup_ioaccel_cdb(cdb, &cdb_len))
3302283b4a9bSStephen M. Cameron 		return IO_ACCEL_INELIGIBLE;
3303283b4a9bSStephen M. Cameron 
3304e1f7de0cSMatt Gates 	c->cmd_type = CMD_IOACCEL1;
3305e1f7de0cSMatt Gates 
3306e1f7de0cSMatt Gates 	/* Adjust the DMA address to point to the accelerated command buffer */
3307e1f7de0cSMatt Gates 	c->busaddr = (u32) h->ioaccel_cmd_pool_dhandle +
3308e1f7de0cSMatt Gates 				(c->cmdindex * sizeof(*cp));
3309e1f7de0cSMatt Gates 	BUG_ON(c->busaddr & 0x0000007F);
3310e1f7de0cSMatt Gates 
3311e1f7de0cSMatt Gates 	use_sg = scsi_dma_map(cmd);
3312e1f7de0cSMatt Gates 	if (use_sg < 0)
3313e1f7de0cSMatt Gates 		return use_sg;
3314e1f7de0cSMatt Gates 
3315e1f7de0cSMatt Gates 	if (use_sg) {
3316e1f7de0cSMatt Gates 		curr_sg = cp->SG;
3317e1f7de0cSMatt Gates 		scsi_for_each_sg(cmd, sg, use_sg, i) {
3318e1f7de0cSMatt Gates 			addr64 = (u64) sg_dma_address(sg);
3319e1f7de0cSMatt Gates 			len  = sg_dma_len(sg);
3320e1f7de0cSMatt Gates 			total_len += len;
3321*50a0decfSStephen M. Cameron 			curr_sg->Addr = cpu_to_le64(addr64);
3322*50a0decfSStephen M. Cameron 			curr_sg->Len = cpu_to_le32(len);
3323*50a0decfSStephen M. Cameron 			curr_sg->Ext = cpu_to_le32(0);
3324e1f7de0cSMatt Gates 			curr_sg++;
3325e1f7de0cSMatt Gates 		}
3326*50a0decfSStephen M. Cameron 		(--curr_sg)->Ext = cpu_to_le32(HPSA_SG_LAST);
3327e1f7de0cSMatt Gates 
3328e1f7de0cSMatt Gates 		switch (cmd->sc_data_direction) {
3329e1f7de0cSMatt Gates 		case DMA_TO_DEVICE:
3330e1f7de0cSMatt Gates 			control |= IOACCEL1_CONTROL_DATA_OUT;
3331e1f7de0cSMatt Gates 			break;
3332e1f7de0cSMatt Gates 		case DMA_FROM_DEVICE:
3333e1f7de0cSMatt Gates 			control |= IOACCEL1_CONTROL_DATA_IN;
3334e1f7de0cSMatt Gates 			break;
3335e1f7de0cSMatt Gates 		case DMA_NONE:
3336e1f7de0cSMatt Gates 			control |= IOACCEL1_CONTROL_NODATAXFER;
3337e1f7de0cSMatt Gates 			break;
3338e1f7de0cSMatt Gates 		default:
3339e1f7de0cSMatt Gates 			dev_err(&h->pdev->dev, "unknown data direction: %d\n",
3340e1f7de0cSMatt Gates 			cmd->sc_data_direction);
3341e1f7de0cSMatt Gates 			BUG();
3342e1f7de0cSMatt Gates 			break;
3343e1f7de0cSMatt Gates 		}
3344e1f7de0cSMatt Gates 	} else {
3345e1f7de0cSMatt Gates 		control |= IOACCEL1_CONTROL_NODATAXFER;
3346e1f7de0cSMatt Gates 	}
3347e1f7de0cSMatt Gates 
3348c349775eSScott Teel 	c->Header.SGList = use_sg;
3349e1f7de0cSMatt Gates 	/* Fill out the command structure to submit */
3350283b4a9bSStephen M. Cameron 	cp->dev_handle = ioaccel_handle & 0xFFFF;
3351e1f7de0cSMatt Gates 	cp->transfer_len = total_len;
3352e1f7de0cSMatt Gates 	cp->io_flags = IOACCEL1_IOFLAGS_IO_REQ |
3353283b4a9bSStephen M. Cameron 			(cdb_len & IOACCEL1_IOFLAGS_CDBLEN_MASK);
3354e1f7de0cSMatt Gates 	cp->control = control;
3355283b4a9bSStephen M. Cameron 	memcpy(cp->CDB, cdb, cdb_len);
3356283b4a9bSStephen M. Cameron 	memcpy(cp->CISS_LUN, scsi3addr, 8);
3357c349775eSScott Teel 	/* Tag was already set at init time. */
3358e1f7de0cSMatt Gates 	enqueue_cmd_and_start_io(h, c);
3359e1f7de0cSMatt Gates 	return 0;
3360e1f7de0cSMatt Gates }
3361edd16368SStephen M. Cameron 
3362283b4a9bSStephen M. Cameron /*
3363283b4a9bSStephen M. Cameron  * Queue a command directly to a device behind the controller using the
3364283b4a9bSStephen M. Cameron  * I/O accelerator path.
3365283b4a9bSStephen M. Cameron  */
3366283b4a9bSStephen M. Cameron static int hpsa_scsi_ioaccel_direct_map(struct ctlr_info *h,
3367283b4a9bSStephen M. Cameron 	struct CommandList *c)
3368283b4a9bSStephen M. Cameron {
3369283b4a9bSStephen M. Cameron 	struct scsi_cmnd *cmd = c->scsi_cmd;
3370283b4a9bSStephen M. Cameron 	struct hpsa_scsi_dev_t *dev = cmd->device->hostdata;
3371283b4a9bSStephen M. Cameron 
3372283b4a9bSStephen M. Cameron 	return hpsa_scsi_ioaccel_queue_command(h, c, dev->ioaccel_handle,
3373283b4a9bSStephen M. Cameron 		cmd->cmnd, cmd->cmd_len, dev->scsi3addr);
3374283b4a9bSStephen M. Cameron }
3375283b4a9bSStephen M. Cameron 
3376dd0e19f3SScott Teel /*
3377dd0e19f3SScott Teel  * Set encryption parameters for the ioaccel2 request
3378dd0e19f3SScott Teel  */
3379dd0e19f3SScott Teel static void set_encrypt_ioaccel2(struct ctlr_info *h,
3380dd0e19f3SScott Teel 	struct CommandList *c, struct io_accel2_cmd *cp)
3381dd0e19f3SScott Teel {
3382dd0e19f3SScott Teel 	struct scsi_cmnd *cmd = c->scsi_cmd;
3383dd0e19f3SScott Teel 	struct hpsa_scsi_dev_t *dev = cmd->device->hostdata;
3384dd0e19f3SScott Teel 	struct raid_map_data *map = &dev->raid_map;
3385dd0e19f3SScott Teel 	u64 first_block;
3386dd0e19f3SScott Teel 
3387dd0e19f3SScott Teel 	BUG_ON(!(dev->offload_config && dev->offload_enabled));
3388dd0e19f3SScott Teel 
3389dd0e19f3SScott Teel 	/* Are we doing encryption on this device */
3390dd0e19f3SScott Teel 	if (!(map->flags & RAID_MAP_FLAG_ENCRYPT_ON))
3391dd0e19f3SScott Teel 		return;
3392dd0e19f3SScott Teel 	/* Set the data encryption key index. */
3393dd0e19f3SScott Teel 	cp->dekindex = map->dekindex;
3394dd0e19f3SScott Teel 
3395dd0e19f3SScott Teel 	/* Set the encryption enable flag, encoded into direction field. */
3396dd0e19f3SScott Teel 	cp->direction |= IOACCEL2_DIRECTION_ENCRYPT_MASK;
3397dd0e19f3SScott Teel 
3398dd0e19f3SScott Teel 	/* Set encryption tweak values based on logical block address
3399dd0e19f3SScott Teel 	 * If block size is 512, tweak value is LBA.
3400dd0e19f3SScott Teel 	 * For other block sizes, tweak is (LBA * block size)/ 512)
3401dd0e19f3SScott Teel 	 */
3402dd0e19f3SScott Teel 	switch (cmd->cmnd[0]) {
3403dd0e19f3SScott Teel 	/* Required? 6-byte cdbs eliminated by fixup_ioaccel_cdb */
3404dd0e19f3SScott Teel 	case WRITE_6:
3405dd0e19f3SScott Teel 	case READ_6:
3406dd0e19f3SScott Teel 		if (map->volume_blk_size == 512) {
3407dd0e19f3SScott Teel 			cp->tweak_lower =
3408dd0e19f3SScott Teel 				(((u32) cmd->cmnd[2]) << 8) |
3409dd0e19f3SScott Teel 					cmd->cmnd[3];
3410dd0e19f3SScott Teel 			cp->tweak_upper = 0;
3411dd0e19f3SScott Teel 		} else {
3412dd0e19f3SScott Teel 			first_block =
3413dd0e19f3SScott Teel 				(((u64) cmd->cmnd[2]) << 8) |
3414dd0e19f3SScott Teel 					cmd->cmnd[3];
3415dd0e19f3SScott Teel 			first_block = (first_block * map->volume_blk_size)/512;
3416dd0e19f3SScott Teel 			cp->tweak_lower = (u32)first_block;
3417dd0e19f3SScott Teel 			cp->tweak_upper = (u32)(first_block >> 32);
3418dd0e19f3SScott Teel 		}
3419dd0e19f3SScott Teel 		break;
3420dd0e19f3SScott Teel 	case WRITE_10:
3421dd0e19f3SScott Teel 	case READ_10:
3422dd0e19f3SScott Teel 		if (map->volume_blk_size == 512) {
3423dd0e19f3SScott Teel 			cp->tweak_lower =
3424dd0e19f3SScott Teel 				(((u32) cmd->cmnd[2]) << 24) |
3425dd0e19f3SScott Teel 				(((u32) cmd->cmnd[3]) << 16) |
3426dd0e19f3SScott Teel 				(((u32) cmd->cmnd[4]) << 8) |
3427dd0e19f3SScott Teel 					cmd->cmnd[5];
3428dd0e19f3SScott Teel 			cp->tweak_upper = 0;
3429dd0e19f3SScott Teel 		} else {
3430dd0e19f3SScott Teel 			first_block =
3431dd0e19f3SScott Teel 				(((u64) cmd->cmnd[2]) << 24) |
3432dd0e19f3SScott Teel 				(((u64) cmd->cmnd[3]) << 16) |
3433dd0e19f3SScott Teel 				(((u64) cmd->cmnd[4]) << 8) |
3434dd0e19f3SScott Teel 					cmd->cmnd[5];
3435dd0e19f3SScott Teel 			first_block = (first_block * map->volume_blk_size)/512;
3436dd0e19f3SScott Teel 			cp->tweak_lower = (u32)first_block;
3437dd0e19f3SScott Teel 			cp->tweak_upper = (u32)(first_block >> 32);
3438dd0e19f3SScott Teel 		}
3439dd0e19f3SScott Teel 		break;
3440dd0e19f3SScott Teel 	/* Required? 12-byte cdbs eliminated by fixup_ioaccel_cdb */
3441dd0e19f3SScott Teel 	case WRITE_12:
3442dd0e19f3SScott Teel 	case READ_12:
3443dd0e19f3SScott Teel 		if (map->volume_blk_size == 512) {
3444dd0e19f3SScott Teel 			cp->tweak_lower =
3445dd0e19f3SScott Teel 				(((u32) cmd->cmnd[2]) << 24) |
3446dd0e19f3SScott Teel 				(((u32) cmd->cmnd[3]) << 16) |
3447dd0e19f3SScott Teel 				(((u32) cmd->cmnd[4]) << 8) |
3448dd0e19f3SScott Teel 					cmd->cmnd[5];
3449dd0e19f3SScott Teel 			cp->tweak_upper = 0;
3450dd0e19f3SScott Teel 		} else {
3451dd0e19f3SScott Teel 			first_block =
3452dd0e19f3SScott Teel 				(((u64) cmd->cmnd[2]) << 24) |
3453dd0e19f3SScott Teel 				(((u64) cmd->cmnd[3]) << 16) |
3454dd0e19f3SScott Teel 				(((u64) cmd->cmnd[4]) << 8) |
3455dd0e19f3SScott Teel 					cmd->cmnd[5];
3456dd0e19f3SScott Teel 			first_block = (first_block * map->volume_blk_size)/512;
3457dd0e19f3SScott Teel 			cp->tweak_lower = (u32)first_block;
3458dd0e19f3SScott Teel 			cp->tweak_upper = (u32)(first_block >> 32);
3459dd0e19f3SScott Teel 		}
3460dd0e19f3SScott Teel 		break;
3461dd0e19f3SScott Teel 	case WRITE_16:
3462dd0e19f3SScott Teel 	case READ_16:
3463dd0e19f3SScott Teel 		if (map->volume_blk_size == 512) {
3464dd0e19f3SScott Teel 			cp->tweak_lower =
3465dd0e19f3SScott Teel 				(((u32) cmd->cmnd[6]) << 24) |
3466dd0e19f3SScott Teel 				(((u32) cmd->cmnd[7]) << 16) |
3467dd0e19f3SScott Teel 				(((u32) cmd->cmnd[8]) << 8) |
3468dd0e19f3SScott Teel 					cmd->cmnd[9];
3469dd0e19f3SScott Teel 			cp->tweak_upper =
3470dd0e19f3SScott Teel 				(((u32) cmd->cmnd[2]) << 24) |
3471dd0e19f3SScott Teel 				(((u32) cmd->cmnd[3]) << 16) |
3472dd0e19f3SScott Teel 				(((u32) cmd->cmnd[4]) << 8) |
3473dd0e19f3SScott Teel 					cmd->cmnd[5];
3474dd0e19f3SScott Teel 		} else {
3475dd0e19f3SScott Teel 			first_block =
3476dd0e19f3SScott Teel 				(((u64) cmd->cmnd[2]) << 56) |
3477dd0e19f3SScott Teel 				(((u64) cmd->cmnd[3]) << 48) |
3478dd0e19f3SScott Teel 				(((u64) cmd->cmnd[4]) << 40) |
3479dd0e19f3SScott Teel 				(((u64) cmd->cmnd[5]) << 32) |
3480dd0e19f3SScott Teel 				(((u64) cmd->cmnd[6]) << 24) |
3481dd0e19f3SScott Teel 				(((u64) cmd->cmnd[7]) << 16) |
3482dd0e19f3SScott Teel 				(((u64) cmd->cmnd[8]) << 8) |
3483dd0e19f3SScott Teel 					cmd->cmnd[9];
3484dd0e19f3SScott Teel 			first_block = (first_block * map->volume_blk_size)/512;
3485dd0e19f3SScott Teel 			cp->tweak_lower = (u32)first_block;
3486dd0e19f3SScott Teel 			cp->tweak_upper = (u32)(first_block >> 32);
3487dd0e19f3SScott Teel 		}
3488dd0e19f3SScott Teel 		break;
3489dd0e19f3SScott Teel 	default:
3490dd0e19f3SScott Teel 		dev_err(&h->pdev->dev,
3491dd0e19f3SScott Teel 			"ERROR: %s: IOACCEL request CDB size not supported for encryption\n",
3492dd0e19f3SScott Teel 			__func__);
3493dd0e19f3SScott Teel 		BUG();
3494dd0e19f3SScott Teel 		break;
3495dd0e19f3SScott Teel 	}
3496dd0e19f3SScott Teel }
3497dd0e19f3SScott Teel 
3498c349775eSScott Teel static int hpsa_scsi_ioaccel2_queue_command(struct ctlr_info *h,
3499c349775eSScott Teel 	struct CommandList *c, u32 ioaccel_handle, u8 *cdb, int cdb_len,
3500c349775eSScott Teel 	u8 *scsi3addr)
3501c349775eSScott Teel {
3502c349775eSScott Teel 	struct scsi_cmnd *cmd = c->scsi_cmd;
3503c349775eSScott Teel 	struct io_accel2_cmd *cp = &h->ioaccel2_cmd_pool[c->cmdindex];
3504c349775eSScott Teel 	struct ioaccel2_sg_element *curr_sg;
3505c349775eSScott Teel 	int use_sg, i;
3506c349775eSScott Teel 	struct scatterlist *sg;
3507c349775eSScott Teel 	u64 addr64;
3508c349775eSScott Teel 	u32 len;
3509c349775eSScott Teel 	u32 total_len = 0;
3510c349775eSScott Teel 
3511c349775eSScott Teel 	if (scsi_sg_count(cmd) > h->ioaccel_maxsg)
3512c349775eSScott Teel 		return IO_ACCEL_INELIGIBLE;
3513c349775eSScott Teel 
3514c349775eSScott Teel 	if (fixup_ioaccel_cdb(cdb, &cdb_len))
3515c349775eSScott Teel 		return IO_ACCEL_INELIGIBLE;
3516c349775eSScott Teel 	c->cmd_type = CMD_IOACCEL2;
3517c349775eSScott Teel 	/* Adjust the DMA address to point to the accelerated command buffer */
3518c349775eSScott Teel 	c->busaddr = (u32) h->ioaccel2_cmd_pool_dhandle +
3519c349775eSScott Teel 				(c->cmdindex * sizeof(*cp));
3520c349775eSScott Teel 	BUG_ON(c->busaddr & 0x0000007F);
3521c349775eSScott Teel 
3522c349775eSScott Teel 	memset(cp, 0, sizeof(*cp));
3523c349775eSScott Teel 	cp->IU_type = IOACCEL2_IU_TYPE;
3524c349775eSScott Teel 
3525c349775eSScott Teel 	use_sg = scsi_dma_map(cmd);
3526c349775eSScott Teel 	if (use_sg < 0)
3527c349775eSScott Teel 		return use_sg;
3528c349775eSScott Teel 
3529c349775eSScott Teel 	if (use_sg) {
3530c349775eSScott Teel 		BUG_ON(use_sg > IOACCEL2_MAXSGENTRIES);
3531c349775eSScott Teel 		curr_sg = cp->sg;
3532c349775eSScott Teel 		scsi_for_each_sg(cmd, sg, use_sg, i) {
3533c349775eSScott Teel 			addr64 = (u64) sg_dma_address(sg);
3534c349775eSScott Teel 			len  = sg_dma_len(sg);
3535c349775eSScott Teel 			total_len += len;
3536c349775eSScott Teel 			curr_sg->address = cpu_to_le64(addr64);
3537c349775eSScott Teel 			curr_sg->length = cpu_to_le32(len);
3538c349775eSScott Teel 			curr_sg->reserved[0] = 0;
3539c349775eSScott Teel 			curr_sg->reserved[1] = 0;
3540c349775eSScott Teel 			curr_sg->reserved[2] = 0;
3541c349775eSScott Teel 			curr_sg->chain_indicator = 0;
3542c349775eSScott Teel 			curr_sg++;
3543c349775eSScott Teel 		}
3544c349775eSScott Teel 
3545c349775eSScott Teel 		switch (cmd->sc_data_direction) {
3546c349775eSScott Teel 		case DMA_TO_DEVICE:
3547dd0e19f3SScott Teel 			cp->direction &= ~IOACCEL2_DIRECTION_MASK;
3548dd0e19f3SScott Teel 			cp->direction |= IOACCEL2_DIR_DATA_OUT;
3549c349775eSScott Teel 			break;
3550c349775eSScott Teel 		case DMA_FROM_DEVICE:
3551dd0e19f3SScott Teel 			cp->direction &= ~IOACCEL2_DIRECTION_MASK;
3552dd0e19f3SScott Teel 			cp->direction |= IOACCEL2_DIR_DATA_IN;
3553c349775eSScott Teel 			break;
3554c349775eSScott Teel 		case DMA_NONE:
3555dd0e19f3SScott Teel 			cp->direction &= ~IOACCEL2_DIRECTION_MASK;
3556dd0e19f3SScott Teel 			cp->direction |= IOACCEL2_DIR_NO_DATA;
3557c349775eSScott Teel 			break;
3558c349775eSScott Teel 		default:
3559c349775eSScott Teel 			dev_err(&h->pdev->dev, "unknown data direction: %d\n",
3560c349775eSScott Teel 				cmd->sc_data_direction);
3561c349775eSScott Teel 			BUG();
3562c349775eSScott Teel 			break;
3563c349775eSScott Teel 		}
3564c349775eSScott Teel 	} else {
3565dd0e19f3SScott Teel 		cp->direction &= ~IOACCEL2_DIRECTION_MASK;
3566dd0e19f3SScott Teel 		cp->direction |= IOACCEL2_DIR_NO_DATA;
3567c349775eSScott Teel 	}
3568dd0e19f3SScott Teel 
3569dd0e19f3SScott Teel 	/* Set encryption parameters, if necessary */
3570dd0e19f3SScott Teel 	set_encrypt_ioaccel2(h, c, cp);
3571dd0e19f3SScott Teel 
3572c349775eSScott Teel 	cp->scsi_nexus = ioaccel_handle;
3573dd0e19f3SScott Teel 	cp->Tag = (c->cmdindex << DIRECT_LOOKUP_SHIFT) |
3574c349775eSScott Teel 				DIRECT_LOOKUP_BIT;
3575c349775eSScott Teel 	memcpy(cp->cdb, cdb, sizeof(cp->cdb));
3576c349775eSScott Teel 
3577c349775eSScott Teel 	/* fill in sg elements */
3578c349775eSScott Teel 	cp->sg_count = (u8) use_sg;
3579c349775eSScott Teel 
3580c349775eSScott Teel 	cp->data_len = cpu_to_le32(total_len);
3581c349775eSScott Teel 	cp->err_ptr = cpu_to_le64(c->busaddr +
3582c349775eSScott Teel 			offsetof(struct io_accel2_cmd, error_data));
3583*50a0decfSStephen M. Cameron 	cp->err_len = cpu_to_le32(sizeof(cp->error_data));
3584c349775eSScott Teel 
3585c349775eSScott Teel 	enqueue_cmd_and_start_io(h, c);
3586c349775eSScott Teel 	return 0;
3587c349775eSScott Teel }
3588c349775eSScott Teel 
3589c349775eSScott Teel /*
3590c349775eSScott Teel  * Queue a command to the correct I/O accelerator path.
3591c349775eSScott Teel  */
3592c349775eSScott Teel static int hpsa_scsi_ioaccel_queue_command(struct ctlr_info *h,
3593c349775eSScott Teel 	struct CommandList *c, u32 ioaccel_handle, u8 *cdb, int cdb_len,
3594c349775eSScott Teel 	u8 *scsi3addr)
3595c349775eSScott Teel {
3596c349775eSScott Teel 	if (h->transMethod & CFGTBL_Trans_io_accel1)
3597c349775eSScott Teel 		return hpsa_scsi_ioaccel1_queue_command(h, c, ioaccel_handle,
3598c349775eSScott Teel 						cdb, cdb_len, scsi3addr);
3599c349775eSScott Teel 	else
3600c349775eSScott Teel 		return hpsa_scsi_ioaccel2_queue_command(h, c, ioaccel_handle,
3601c349775eSScott Teel 						cdb, cdb_len, scsi3addr);
3602c349775eSScott Teel }
3603c349775eSScott Teel 
36046b80b18fSScott Teel static void raid_map_helper(struct raid_map_data *map,
36056b80b18fSScott Teel 		int offload_to_mirror, u32 *map_index, u32 *current_group)
36066b80b18fSScott Teel {
36076b80b18fSScott Teel 	if (offload_to_mirror == 0)  {
36086b80b18fSScott Teel 		/* use physical disk in the first mirrored group. */
36096b80b18fSScott Teel 		*map_index %= map->data_disks_per_row;
36106b80b18fSScott Teel 		return;
36116b80b18fSScott Teel 	}
36126b80b18fSScott Teel 	do {
36136b80b18fSScott Teel 		/* determine mirror group that *map_index indicates */
36146b80b18fSScott Teel 		*current_group = *map_index / map->data_disks_per_row;
36156b80b18fSScott Teel 		if (offload_to_mirror == *current_group)
36166b80b18fSScott Teel 			continue;
36176b80b18fSScott Teel 		if (*current_group < (map->layout_map_count - 1)) {
36186b80b18fSScott Teel 			/* select map index from next group */
36196b80b18fSScott Teel 			*map_index += map->data_disks_per_row;
36206b80b18fSScott Teel 			(*current_group)++;
36216b80b18fSScott Teel 		} else {
36226b80b18fSScott Teel 			/* select map index from first group */
36236b80b18fSScott Teel 			*map_index %= map->data_disks_per_row;
36246b80b18fSScott Teel 			*current_group = 0;
36256b80b18fSScott Teel 		}
36266b80b18fSScott Teel 	} while (offload_to_mirror != *current_group);
36276b80b18fSScott Teel }
36286b80b18fSScott Teel 
3629283b4a9bSStephen M. Cameron /*
3630283b4a9bSStephen M. Cameron  * Attempt to perform offload RAID mapping for a logical volume I/O.
3631283b4a9bSStephen M. Cameron  */
3632283b4a9bSStephen M. Cameron static int hpsa_scsi_ioaccel_raid_map(struct ctlr_info *h,
3633283b4a9bSStephen M. Cameron 	struct CommandList *c)
3634283b4a9bSStephen M. Cameron {
3635283b4a9bSStephen M. Cameron 	struct scsi_cmnd *cmd = c->scsi_cmd;
3636283b4a9bSStephen M. Cameron 	struct hpsa_scsi_dev_t *dev = cmd->device->hostdata;
3637283b4a9bSStephen M. Cameron 	struct raid_map_data *map = &dev->raid_map;
3638283b4a9bSStephen M. Cameron 	struct raid_map_disk_data *dd = &map->data[0];
3639283b4a9bSStephen M. Cameron 	int is_write = 0;
3640283b4a9bSStephen M. Cameron 	u32 map_index;
3641283b4a9bSStephen M. Cameron 	u64 first_block, last_block;
3642283b4a9bSStephen M. Cameron 	u32 block_cnt;
3643283b4a9bSStephen M. Cameron 	u32 blocks_per_row;
3644283b4a9bSStephen M. Cameron 	u64 first_row, last_row;
3645283b4a9bSStephen M. Cameron 	u32 first_row_offset, last_row_offset;
3646283b4a9bSStephen M. Cameron 	u32 first_column, last_column;
36476b80b18fSScott Teel 	u64 r0_first_row, r0_last_row;
36486b80b18fSScott Teel 	u32 r5or6_blocks_per_row;
36496b80b18fSScott Teel 	u64 r5or6_first_row, r5or6_last_row;
36506b80b18fSScott Teel 	u32 r5or6_first_row_offset, r5or6_last_row_offset;
36516b80b18fSScott Teel 	u32 r5or6_first_column, r5or6_last_column;
36526b80b18fSScott Teel 	u32 total_disks_per_row;
36536b80b18fSScott Teel 	u32 stripesize;
36546b80b18fSScott Teel 	u32 first_group, last_group, current_group;
3655283b4a9bSStephen M. Cameron 	u32 map_row;
3656283b4a9bSStephen M. Cameron 	u32 disk_handle;
3657283b4a9bSStephen M. Cameron 	u64 disk_block;
3658283b4a9bSStephen M. Cameron 	u32 disk_block_cnt;
3659283b4a9bSStephen M. Cameron 	u8 cdb[16];
3660283b4a9bSStephen M. Cameron 	u8 cdb_len;
3661283b4a9bSStephen M. Cameron #if BITS_PER_LONG == 32
3662283b4a9bSStephen M. Cameron 	u64 tmpdiv;
3663283b4a9bSStephen M. Cameron #endif
36646b80b18fSScott Teel 	int offload_to_mirror;
3665283b4a9bSStephen M. Cameron 
3666283b4a9bSStephen M. Cameron 	BUG_ON(!(dev->offload_config && dev->offload_enabled));
3667283b4a9bSStephen M. Cameron 
3668283b4a9bSStephen M. Cameron 	/* check for valid opcode, get LBA and block count */
3669283b4a9bSStephen M. Cameron 	switch (cmd->cmnd[0]) {
3670283b4a9bSStephen M. Cameron 	case WRITE_6:
3671283b4a9bSStephen M. Cameron 		is_write = 1;
3672283b4a9bSStephen M. Cameron 	case READ_6:
3673283b4a9bSStephen M. Cameron 		first_block =
3674283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[2]) << 8) |
3675283b4a9bSStephen M. Cameron 			cmd->cmnd[3];
3676283b4a9bSStephen M. Cameron 		block_cnt = cmd->cmnd[4];
36773fa89a04SStephen M. Cameron 		if (block_cnt == 0)
36783fa89a04SStephen M. Cameron 			block_cnt = 256;
3679283b4a9bSStephen M. Cameron 		break;
3680283b4a9bSStephen M. Cameron 	case WRITE_10:
3681283b4a9bSStephen M. Cameron 		is_write = 1;
3682283b4a9bSStephen M. Cameron 	case READ_10:
3683283b4a9bSStephen M. Cameron 		first_block =
3684283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[2]) << 24) |
3685283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[3]) << 16) |
3686283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[4]) << 8) |
3687283b4a9bSStephen M. Cameron 			cmd->cmnd[5];
3688283b4a9bSStephen M. Cameron 		block_cnt =
3689283b4a9bSStephen M. Cameron 			(((u32) cmd->cmnd[7]) << 8) |
3690283b4a9bSStephen M. Cameron 			cmd->cmnd[8];
3691283b4a9bSStephen M. Cameron 		break;
3692283b4a9bSStephen M. Cameron 	case WRITE_12:
3693283b4a9bSStephen M. Cameron 		is_write = 1;
3694283b4a9bSStephen M. Cameron 	case READ_12:
3695283b4a9bSStephen M. Cameron 		first_block =
3696283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[2]) << 24) |
3697283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[3]) << 16) |
3698283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[4]) << 8) |
3699283b4a9bSStephen M. Cameron 			cmd->cmnd[5];
3700283b4a9bSStephen M. Cameron 		block_cnt =
3701283b4a9bSStephen M. Cameron 			(((u32) cmd->cmnd[6]) << 24) |
3702283b4a9bSStephen M. Cameron 			(((u32) cmd->cmnd[7]) << 16) |
3703283b4a9bSStephen M. Cameron 			(((u32) cmd->cmnd[8]) << 8) |
3704283b4a9bSStephen M. Cameron 		cmd->cmnd[9];
3705283b4a9bSStephen M. Cameron 		break;
3706283b4a9bSStephen M. Cameron 	case WRITE_16:
3707283b4a9bSStephen M. Cameron 		is_write = 1;
3708283b4a9bSStephen M. Cameron 	case READ_16:
3709283b4a9bSStephen M. Cameron 		first_block =
3710283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[2]) << 56) |
3711283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[3]) << 48) |
3712283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[4]) << 40) |
3713283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[5]) << 32) |
3714283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[6]) << 24) |
3715283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[7]) << 16) |
3716283b4a9bSStephen M. Cameron 			(((u64) cmd->cmnd[8]) << 8) |
3717283b4a9bSStephen M. Cameron 			cmd->cmnd[9];
3718283b4a9bSStephen M. Cameron 		block_cnt =
3719283b4a9bSStephen M. Cameron 			(((u32) cmd->cmnd[10]) << 24) |
3720283b4a9bSStephen M. Cameron 			(((u32) cmd->cmnd[11]) << 16) |
3721283b4a9bSStephen M. Cameron 			(((u32) cmd->cmnd[12]) << 8) |
3722283b4a9bSStephen M. Cameron 			cmd->cmnd[13];
3723283b4a9bSStephen M. Cameron 		break;
3724283b4a9bSStephen M. Cameron 	default:
3725283b4a9bSStephen M. Cameron 		return IO_ACCEL_INELIGIBLE; /* process via normal I/O path */
3726283b4a9bSStephen M. Cameron 	}
3727283b4a9bSStephen M. Cameron 	last_block = first_block + block_cnt - 1;
3728283b4a9bSStephen M. Cameron 
3729283b4a9bSStephen M. Cameron 	/* check for write to non-RAID-0 */
3730283b4a9bSStephen M. Cameron 	if (is_write && dev->raid_level != 0)
3731283b4a9bSStephen M. Cameron 		return IO_ACCEL_INELIGIBLE;
3732283b4a9bSStephen M. Cameron 
3733283b4a9bSStephen M. Cameron 	/* check for invalid block or wraparound */
3734283b4a9bSStephen M. Cameron 	if (last_block >= map->volume_blk_cnt || last_block < first_block)
3735283b4a9bSStephen M. Cameron 		return IO_ACCEL_INELIGIBLE;
3736283b4a9bSStephen M. Cameron 
3737283b4a9bSStephen M. Cameron 	/* calculate stripe information for the request */
3738283b4a9bSStephen M. Cameron 	blocks_per_row = map->data_disks_per_row * map->strip_size;
3739283b4a9bSStephen M. Cameron #if BITS_PER_LONG == 32
3740283b4a9bSStephen M. Cameron 	tmpdiv = first_block;
3741283b4a9bSStephen M. Cameron 	(void) do_div(tmpdiv, blocks_per_row);
3742283b4a9bSStephen M. Cameron 	first_row = tmpdiv;
3743283b4a9bSStephen M. Cameron 	tmpdiv = last_block;
3744283b4a9bSStephen M. Cameron 	(void) do_div(tmpdiv, blocks_per_row);
3745283b4a9bSStephen M. Cameron 	last_row = tmpdiv;
3746283b4a9bSStephen M. Cameron 	first_row_offset = (u32) (first_block - (first_row * blocks_per_row));
3747283b4a9bSStephen M. Cameron 	last_row_offset = (u32) (last_block - (last_row * blocks_per_row));
3748283b4a9bSStephen M. Cameron 	tmpdiv = first_row_offset;
3749283b4a9bSStephen M. Cameron 	(void) do_div(tmpdiv,  map->strip_size);
3750283b4a9bSStephen M. Cameron 	first_column = tmpdiv;
3751283b4a9bSStephen M. Cameron 	tmpdiv = last_row_offset;
3752283b4a9bSStephen M. Cameron 	(void) do_div(tmpdiv, map->strip_size);
3753283b4a9bSStephen M. Cameron 	last_column = tmpdiv;
3754283b4a9bSStephen M. Cameron #else
3755283b4a9bSStephen M. Cameron 	first_row = first_block / blocks_per_row;
3756283b4a9bSStephen M. Cameron 	last_row = last_block / blocks_per_row;
3757283b4a9bSStephen M. Cameron 	first_row_offset = (u32) (first_block - (first_row * blocks_per_row));
3758283b4a9bSStephen M. Cameron 	last_row_offset = (u32) (last_block - (last_row * blocks_per_row));
3759283b4a9bSStephen M. Cameron 	first_column = first_row_offset / map->strip_size;
3760283b4a9bSStephen M. Cameron 	last_column = last_row_offset / map->strip_size;
3761283b4a9bSStephen M. Cameron #endif
3762283b4a9bSStephen M. Cameron 
3763283b4a9bSStephen M. Cameron 	/* if this isn't a single row/column then give to the controller */
3764283b4a9bSStephen M. Cameron 	if ((first_row != last_row) || (first_column != last_column))
3765283b4a9bSStephen M. Cameron 		return IO_ACCEL_INELIGIBLE;
3766283b4a9bSStephen M. Cameron 
3767283b4a9bSStephen M. Cameron 	/* proceeding with driver mapping */
37686b80b18fSScott Teel 	total_disks_per_row = map->data_disks_per_row +
37696b80b18fSScott Teel 				map->metadata_disks_per_row;
3770283b4a9bSStephen M. Cameron 	map_row = ((u32)(first_row >> map->parity_rotation_shift)) %
3771283b4a9bSStephen M. Cameron 				map->row_cnt;
37726b80b18fSScott Teel 	map_index = (map_row * total_disks_per_row) + first_column;
37736b80b18fSScott Teel 
37746b80b18fSScott Teel 	switch (dev->raid_level) {
37756b80b18fSScott Teel 	case HPSA_RAID_0:
37766b80b18fSScott Teel 		break; /* nothing special to do */
37776b80b18fSScott Teel 	case HPSA_RAID_1:
37786b80b18fSScott Teel 		/* Handles load balance across RAID 1 members.
37796b80b18fSScott Teel 		 * (2-drive R1 and R10 with even # of drives.)
37806b80b18fSScott Teel 		 * Appropriate for SSDs, not optimal for HDDs
3781283b4a9bSStephen M. Cameron 		 */
37826b80b18fSScott Teel 		BUG_ON(map->layout_map_count != 2);
3783283b4a9bSStephen M. Cameron 		if (dev->offload_to_mirror)
3784283b4a9bSStephen M. Cameron 			map_index += map->data_disks_per_row;
3785283b4a9bSStephen M. Cameron 		dev->offload_to_mirror = !dev->offload_to_mirror;
37866b80b18fSScott Teel 		break;
37876b80b18fSScott Teel 	case HPSA_RAID_ADM:
37886b80b18fSScott Teel 		/* Handles N-way mirrors  (R1-ADM)
37896b80b18fSScott Teel 		 * and R10 with # of drives divisible by 3.)
37906b80b18fSScott Teel 		 */
37916b80b18fSScott Teel 		BUG_ON(map->layout_map_count != 3);
37926b80b18fSScott Teel 
37936b80b18fSScott Teel 		offload_to_mirror = dev->offload_to_mirror;
37946b80b18fSScott Teel 		raid_map_helper(map, offload_to_mirror,
37956b80b18fSScott Teel 				&map_index, &current_group);
37966b80b18fSScott Teel 		/* set mirror group to use next time */
37976b80b18fSScott Teel 		offload_to_mirror =
37986b80b18fSScott Teel 			(offload_to_mirror >= map->layout_map_count - 1)
37996b80b18fSScott Teel 			? 0 : offload_to_mirror + 1;
38006b80b18fSScott Teel 		dev->offload_to_mirror = offload_to_mirror;
38016b80b18fSScott Teel 		/* Avoid direct use of dev->offload_to_mirror within this
38026b80b18fSScott Teel 		 * function since multiple threads might simultaneously
38036b80b18fSScott Teel 		 * increment it beyond the range of dev->layout_map_count -1.
38046b80b18fSScott Teel 		 */
38056b80b18fSScott Teel 		break;
38066b80b18fSScott Teel 	case HPSA_RAID_5:
38076b80b18fSScott Teel 	case HPSA_RAID_6:
38086b80b18fSScott Teel 		if (map->layout_map_count <= 1)
38096b80b18fSScott Teel 			break;
38106b80b18fSScott Teel 
38116b80b18fSScott Teel 		/* Verify first and last block are in same RAID group */
38126b80b18fSScott Teel 		r5or6_blocks_per_row =
38136b80b18fSScott Teel 			map->strip_size * map->data_disks_per_row;
38146b80b18fSScott Teel 		BUG_ON(r5or6_blocks_per_row == 0);
38156b80b18fSScott Teel 		stripesize = r5or6_blocks_per_row * map->layout_map_count;
38166b80b18fSScott Teel #if BITS_PER_LONG == 32
38176b80b18fSScott Teel 		tmpdiv = first_block;
38186b80b18fSScott Teel 		first_group = do_div(tmpdiv, stripesize);
38196b80b18fSScott Teel 		tmpdiv = first_group;
38206b80b18fSScott Teel 		(void) do_div(tmpdiv, r5or6_blocks_per_row);
38216b80b18fSScott Teel 		first_group = tmpdiv;
38226b80b18fSScott Teel 		tmpdiv = last_block;
38236b80b18fSScott Teel 		last_group = do_div(tmpdiv, stripesize);
38246b80b18fSScott Teel 		tmpdiv = last_group;
38256b80b18fSScott Teel 		(void) do_div(tmpdiv, r5or6_blocks_per_row);
38266b80b18fSScott Teel 		last_group = tmpdiv;
38276b80b18fSScott Teel #else
38286b80b18fSScott Teel 		first_group = (first_block % stripesize) / r5or6_blocks_per_row;
38296b80b18fSScott Teel 		last_group = (last_block % stripesize) / r5or6_blocks_per_row;
38306b80b18fSScott Teel #endif
3831000ff7c2SStephen M. Cameron 		if (first_group != last_group)
38326b80b18fSScott Teel 			return IO_ACCEL_INELIGIBLE;
38336b80b18fSScott Teel 
38346b80b18fSScott Teel 		/* Verify request is in a single row of RAID 5/6 */
38356b80b18fSScott Teel #if BITS_PER_LONG == 32
38366b80b18fSScott Teel 		tmpdiv = first_block;
38376b80b18fSScott Teel 		(void) do_div(tmpdiv, stripesize);
38386b80b18fSScott Teel 		first_row = r5or6_first_row = r0_first_row = tmpdiv;
38396b80b18fSScott Teel 		tmpdiv = last_block;
38406b80b18fSScott Teel 		(void) do_div(tmpdiv, stripesize);
38416b80b18fSScott Teel 		r5or6_last_row = r0_last_row = tmpdiv;
38426b80b18fSScott Teel #else
38436b80b18fSScott Teel 		first_row = r5or6_first_row = r0_first_row =
38446b80b18fSScott Teel 						first_block / stripesize;
38456b80b18fSScott Teel 		r5or6_last_row = r0_last_row = last_block / stripesize;
38466b80b18fSScott Teel #endif
38476b80b18fSScott Teel 		if (r5or6_first_row != r5or6_last_row)
38486b80b18fSScott Teel 			return IO_ACCEL_INELIGIBLE;
38496b80b18fSScott Teel 
38506b80b18fSScott Teel 
38516b80b18fSScott Teel 		/* Verify request is in a single column */
38526b80b18fSScott Teel #if BITS_PER_LONG == 32
38536b80b18fSScott Teel 		tmpdiv = first_block;
38546b80b18fSScott Teel 		first_row_offset = do_div(tmpdiv, stripesize);
38556b80b18fSScott Teel 		tmpdiv = first_row_offset;
38566b80b18fSScott Teel 		first_row_offset = (u32) do_div(tmpdiv, r5or6_blocks_per_row);
38576b80b18fSScott Teel 		r5or6_first_row_offset = first_row_offset;
38586b80b18fSScott Teel 		tmpdiv = last_block;
38596b80b18fSScott Teel 		r5or6_last_row_offset = do_div(tmpdiv, stripesize);
38606b80b18fSScott Teel 		tmpdiv = r5or6_last_row_offset;
38616b80b18fSScott Teel 		r5or6_last_row_offset = do_div(tmpdiv, r5or6_blocks_per_row);
38626b80b18fSScott Teel 		tmpdiv = r5or6_first_row_offset;
38636b80b18fSScott Teel 		(void) do_div(tmpdiv, map->strip_size);
38646b80b18fSScott Teel 		first_column = r5or6_first_column = tmpdiv;
38656b80b18fSScott Teel 		tmpdiv = r5or6_last_row_offset;
38666b80b18fSScott Teel 		(void) do_div(tmpdiv, map->strip_size);
38676b80b18fSScott Teel 		r5or6_last_column = tmpdiv;
38686b80b18fSScott Teel #else
38696b80b18fSScott Teel 		first_row_offset = r5or6_first_row_offset =
38706b80b18fSScott Teel 			(u32)((first_block % stripesize) %
38716b80b18fSScott Teel 						r5or6_blocks_per_row);
38726b80b18fSScott Teel 
38736b80b18fSScott Teel 		r5or6_last_row_offset =
38746b80b18fSScott Teel 			(u32)((last_block % stripesize) %
38756b80b18fSScott Teel 						r5or6_blocks_per_row);
38766b80b18fSScott Teel 
38776b80b18fSScott Teel 		first_column = r5or6_first_column =
38786b80b18fSScott Teel 			r5or6_first_row_offset / map->strip_size;
38796b80b18fSScott Teel 		r5or6_last_column =
38806b80b18fSScott Teel 			r5or6_last_row_offset / map->strip_size;
38816b80b18fSScott Teel #endif
38826b80b18fSScott Teel 		if (r5or6_first_column != r5or6_last_column)
38836b80b18fSScott Teel 			return IO_ACCEL_INELIGIBLE;
38846b80b18fSScott Teel 
38856b80b18fSScott Teel 		/* Request is eligible */
38866b80b18fSScott Teel 		map_row = ((u32)(first_row >> map->parity_rotation_shift)) %
38876b80b18fSScott Teel 			map->row_cnt;
38886b80b18fSScott Teel 
38896b80b18fSScott Teel 		map_index = (first_group *
38906b80b18fSScott Teel 			(map->row_cnt * total_disks_per_row)) +
38916b80b18fSScott Teel 			(map_row * total_disks_per_row) + first_column;
38926b80b18fSScott Teel 		break;
38936b80b18fSScott Teel 	default:
38946b80b18fSScott Teel 		return IO_ACCEL_INELIGIBLE;
3895283b4a9bSStephen M. Cameron 	}
38966b80b18fSScott Teel 
3897283b4a9bSStephen M. Cameron 	disk_handle = dd[map_index].ioaccel_handle;
3898283b4a9bSStephen M. Cameron 	disk_block = map->disk_starting_blk + (first_row * map->strip_size) +
3899283b4a9bSStephen M. Cameron 			(first_row_offset - (first_column * map->strip_size));
3900283b4a9bSStephen M. Cameron 	disk_block_cnt = block_cnt;
3901283b4a9bSStephen M. Cameron 
3902283b4a9bSStephen M. Cameron 	/* handle differing logical/physical block sizes */
3903283b4a9bSStephen M. Cameron 	if (map->phys_blk_shift) {
3904283b4a9bSStephen M. Cameron 		disk_block <<= map->phys_blk_shift;
3905283b4a9bSStephen M. Cameron 		disk_block_cnt <<= map->phys_blk_shift;
3906283b4a9bSStephen M. Cameron 	}
3907283b4a9bSStephen M. Cameron 	BUG_ON(disk_block_cnt > 0xffff);
3908283b4a9bSStephen M. Cameron 
3909283b4a9bSStephen M. Cameron 	/* build the new CDB for the physical disk I/O */
3910283b4a9bSStephen M. Cameron 	if (disk_block > 0xffffffff) {
3911283b4a9bSStephen M. Cameron 		cdb[0] = is_write ? WRITE_16 : READ_16;
3912283b4a9bSStephen M. Cameron 		cdb[1] = 0;
3913283b4a9bSStephen M. Cameron 		cdb[2] = (u8) (disk_block >> 56);
3914283b4a9bSStephen M. Cameron 		cdb[3] = (u8) (disk_block >> 48);
3915283b4a9bSStephen M. Cameron 		cdb[4] = (u8) (disk_block >> 40);
3916283b4a9bSStephen M. Cameron 		cdb[5] = (u8) (disk_block >> 32);
3917283b4a9bSStephen M. Cameron 		cdb[6] = (u8) (disk_block >> 24);
3918283b4a9bSStephen M. Cameron 		cdb[7] = (u8) (disk_block >> 16);
3919283b4a9bSStephen M. Cameron 		cdb[8] = (u8) (disk_block >> 8);
3920283b4a9bSStephen M. Cameron 		cdb[9] = (u8) (disk_block);
3921283b4a9bSStephen M. Cameron 		cdb[10] = (u8) (disk_block_cnt >> 24);
3922283b4a9bSStephen M. Cameron 		cdb[11] = (u8) (disk_block_cnt >> 16);
3923283b4a9bSStephen M. Cameron 		cdb[12] = (u8) (disk_block_cnt >> 8);
3924283b4a9bSStephen M. Cameron 		cdb[13] = (u8) (disk_block_cnt);
3925283b4a9bSStephen M. Cameron 		cdb[14] = 0;
3926283b4a9bSStephen M. Cameron 		cdb[15] = 0;
3927283b4a9bSStephen M. Cameron 		cdb_len = 16;
3928283b4a9bSStephen M. Cameron 	} else {
3929283b4a9bSStephen M. Cameron 		cdb[0] = is_write ? WRITE_10 : READ_10;
3930283b4a9bSStephen M. Cameron 		cdb[1] = 0;
3931283b4a9bSStephen M. Cameron 		cdb[2] = (u8) (disk_block >> 24);
3932283b4a9bSStephen M. Cameron 		cdb[3] = (u8) (disk_block >> 16);
3933283b4a9bSStephen M. Cameron 		cdb[4] = (u8) (disk_block >> 8);
3934283b4a9bSStephen M. Cameron 		cdb[5] = (u8) (disk_block);
3935283b4a9bSStephen M. Cameron 		cdb[6] = 0;
3936283b4a9bSStephen M. Cameron 		cdb[7] = (u8) (disk_block_cnt >> 8);
3937283b4a9bSStephen M. Cameron 		cdb[8] = (u8) (disk_block_cnt);
3938283b4a9bSStephen M. Cameron 		cdb[9] = 0;
3939283b4a9bSStephen M. Cameron 		cdb_len = 10;
3940283b4a9bSStephen M. Cameron 	}
3941283b4a9bSStephen M. Cameron 	return hpsa_scsi_ioaccel_queue_command(h, c, disk_handle, cdb, cdb_len,
3942283b4a9bSStephen M. Cameron 						dev->scsi3addr);
3943283b4a9bSStephen M. Cameron }
3944283b4a9bSStephen M. Cameron 
3945f281233dSJeff Garzik static int hpsa_scsi_queue_command_lck(struct scsi_cmnd *cmd,
3946edd16368SStephen M. Cameron 	void (*done)(struct scsi_cmnd *))
3947edd16368SStephen M. Cameron {
3948edd16368SStephen M. Cameron 	struct ctlr_info *h;
3949edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *dev;
3950edd16368SStephen M. Cameron 	unsigned char scsi3addr[8];
3951edd16368SStephen M. Cameron 	struct CommandList *c;
3952283b4a9bSStephen M. Cameron 	int rc = 0;
3953edd16368SStephen M. Cameron 
3954edd16368SStephen M. Cameron 	/* Get the ptr to our adapter structure out of cmd->host. */
3955edd16368SStephen M. Cameron 	h = sdev_to_hba(cmd->device);
3956edd16368SStephen M. Cameron 	dev = cmd->device->hostdata;
3957edd16368SStephen M. Cameron 	if (!dev) {
3958edd16368SStephen M. Cameron 		cmd->result = DID_NO_CONNECT << 16;
3959edd16368SStephen M. Cameron 		done(cmd);
3960edd16368SStephen M. Cameron 		return 0;
3961edd16368SStephen M. Cameron 	}
3962edd16368SStephen M. Cameron 	memcpy(scsi3addr, dev->scsi3addr, sizeof(scsi3addr));
3963edd16368SStephen M. Cameron 
3964094963daSStephen M. Cameron 	if (unlikely(lockup_detected(h))) {
3965a0c12413SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
3966a0c12413SStephen M. Cameron 		done(cmd);
3967a0c12413SStephen M. Cameron 		return 0;
3968a0c12413SStephen M. Cameron 	}
3969e16a33adSMatt Gates 	c = cmd_alloc(h);
3970edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
3971edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "cmd_alloc returned NULL!\n");
3972edd16368SStephen M. Cameron 		return SCSI_MLQUEUE_HOST_BUSY;
3973edd16368SStephen M. Cameron 	}
3974edd16368SStephen M. Cameron 
3975edd16368SStephen M. Cameron 	/* Fill in the command list header */
3976edd16368SStephen M. Cameron 
3977edd16368SStephen M. Cameron 	cmd->scsi_done = done;    /* save this for use by completion code */
3978edd16368SStephen M. Cameron 
3979edd16368SStephen M. Cameron 	/* save c in case we have to abort it  */
3980edd16368SStephen M. Cameron 	cmd->host_scribble = (unsigned char *) c;
3981edd16368SStephen M. Cameron 
3982edd16368SStephen M. Cameron 	c->cmd_type = CMD_SCSI;
3983edd16368SStephen M. Cameron 	c->scsi_cmd = cmd;
3984e1f7de0cSMatt Gates 
3985283b4a9bSStephen M. Cameron 	/* Call alternate submit routine for I/O accelerated commands.
3986283b4a9bSStephen M. Cameron 	 * Retries always go down the normal I/O path.
3987283b4a9bSStephen M. Cameron 	 */
3988283b4a9bSStephen M. Cameron 	if (likely(cmd->retries == 0 &&
3989da0697bdSScott Teel 		cmd->request->cmd_type == REQ_TYPE_FS &&
3990da0697bdSScott Teel 		h->acciopath_status)) {
3991283b4a9bSStephen M. Cameron 		if (dev->offload_enabled) {
3992283b4a9bSStephen M. Cameron 			rc = hpsa_scsi_ioaccel_raid_map(h, c);
3993283b4a9bSStephen M. Cameron 			if (rc == 0)
3994283b4a9bSStephen M. Cameron 				return 0; /* Sent on ioaccel path */
3995283b4a9bSStephen M. Cameron 			if (rc < 0) {   /* scsi_dma_map failed. */
3996283b4a9bSStephen M. Cameron 				cmd_free(h, c);
3997283b4a9bSStephen M. Cameron 				return SCSI_MLQUEUE_HOST_BUSY;
3998283b4a9bSStephen M. Cameron 			}
3999283b4a9bSStephen M. Cameron 		} else if (dev->ioaccel_handle) {
4000283b4a9bSStephen M. Cameron 			rc = hpsa_scsi_ioaccel_direct_map(h, c);
4001283b4a9bSStephen M. Cameron 			if (rc == 0)
4002283b4a9bSStephen M. Cameron 				return 0; /* Sent on direct map path */
4003283b4a9bSStephen M. Cameron 			if (rc < 0) {   /* scsi_dma_map failed. */
4004283b4a9bSStephen M. Cameron 				cmd_free(h, c);
4005283b4a9bSStephen M. Cameron 				return SCSI_MLQUEUE_HOST_BUSY;
4006283b4a9bSStephen M. Cameron 			}
4007283b4a9bSStephen M. Cameron 		}
4008283b4a9bSStephen M. Cameron 	}
4009e1f7de0cSMatt Gates 
4010edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0;  /* unused in simple mode */
4011edd16368SStephen M. Cameron 	memcpy(&c->Header.LUN.LunAddrBytes[0], &scsi3addr[0], 8);
4012*50a0decfSStephen M. Cameron 	c->Header.tag = cpu_to_le64((c->cmdindex << DIRECT_LOOKUP_SHIFT) |
4013*50a0decfSStephen M. Cameron 					DIRECT_LOOKUP_BIT);
4014edd16368SStephen M. Cameron 
4015edd16368SStephen M. Cameron 	/* Fill in the request block... */
4016edd16368SStephen M. Cameron 
4017edd16368SStephen M. Cameron 	c->Request.Timeout = 0;
4018edd16368SStephen M. Cameron 	memset(c->Request.CDB, 0, sizeof(c->Request.CDB));
4019edd16368SStephen M. Cameron 	BUG_ON(cmd->cmd_len > sizeof(c->Request.CDB));
4020edd16368SStephen M. Cameron 	c->Request.CDBLen = cmd->cmd_len;
4021edd16368SStephen M. Cameron 	memcpy(c->Request.CDB, cmd->cmnd, cmd->cmd_len);
4022edd16368SStephen M. Cameron 	c->Request.Type.Type = TYPE_CMD;
4023edd16368SStephen M. Cameron 	c->Request.Type.Attribute = ATTR_SIMPLE;
4024edd16368SStephen M. Cameron 	switch (cmd->sc_data_direction) {
4025edd16368SStephen M. Cameron 	case DMA_TO_DEVICE:
4026edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_WRITE;
4027edd16368SStephen M. Cameron 		break;
4028edd16368SStephen M. Cameron 	case DMA_FROM_DEVICE:
4029edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_READ;
4030edd16368SStephen M. Cameron 		break;
4031edd16368SStephen M. Cameron 	case DMA_NONE:
4032edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_NONE;
4033edd16368SStephen M. Cameron 		break;
4034edd16368SStephen M. Cameron 	case DMA_BIDIRECTIONAL:
4035edd16368SStephen M. Cameron 		/* This can happen if a buggy application does a scsi passthru
4036edd16368SStephen M. Cameron 		 * and sets both inlen and outlen to non-zero. ( see
4037edd16368SStephen M. Cameron 		 * ../scsi/scsi_ioctl.c:scsi_ioctl_send_command() )
4038edd16368SStephen M. Cameron 		 */
4039edd16368SStephen M. Cameron 
4040edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_RSVD;
4041edd16368SStephen M. Cameron 		/* This is technically wrong, and hpsa controllers should
4042edd16368SStephen M. Cameron 		 * reject it with CMD_INVALID, which is the most correct
4043edd16368SStephen M. Cameron 		 * response, but non-fibre backends appear to let it
4044edd16368SStephen M. Cameron 		 * slide by, and give the same results as if this field
4045edd16368SStephen M. Cameron 		 * were set correctly.  Either way is acceptable for
4046edd16368SStephen M. Cameron 		 * our purposes here.
4047edd16368SStephen M. Cameron 		 */
4048edd16368SStephen M. Cameron 
4049edd16368SStephen M. Cameron 		break;
4050edd16368SStephen M. Cameron 
4051edd16368SStephen M. Cameron 	default:
4052edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "unknown data direction: %d\n",
4053edd16368SStephen M. Cameron 			cmd->sc_data_direction);
4054edd16368SStephen M. Cameron 		BUG();
4055edd16368SStephen M. Cameron 		break;
4056edd16368SStephen M. Cameron 	}
4057edd16368SStephen M. Cameron 
405833a2ffceSStephen M. Cameron 	if (hpsa_scatter_gather(h, c, cmd) < 0) { /* Fill SG list */
4059edd16368SStephen M. Cameron 		cmd_free(h, c);
4060edd16368SStephen M. Cameron 		return SCSI_MLQUEUE_HOST_BUSY;
4061edd16368SStephen M. Cameron 	}
4062edd16368SStephen M. Cameron 	enqueue_cmd_and_start_io(h, c);
4063edd16368SStephen M. Cameron 	/* the cmd'll come back via intr handler in complete_scsi_command()  */
4064edd16368SStephen M. Cameron 	return 0;
4065edd16368SStephen M. Cameron }
4066edd16368SStephen M. Cameron 
4067f281233dSJeff Garzik static DEF_SCSI_QCMD(hpsa_scsi_queue_command)
4068f281233dSJeff Garzik 
40695f389360SStephen M. Cameron static int do_not_scan_if_controller_locked_up(struct ctlr_info *h)
40705f389360SStephen M. Cameron {
40715f389360SStephen M. Cameron 	unsigned long flags;
40725f389360SStephen M. Cameron 
40735f389360SStephen M. Cameron 	/*
40745f389360SStephen M. Cameron 	 * Don't let rescans be initiated on a controller known
40755f389360SStephen M. Cameron 	 * to be locked up.  If the controller locks up *during*
40765f389360SStephen M. Cameron 	 * a rescan, that thread is probably hosed, but at least
40775f389360SStephen M. Cameron 	 * we can prevent new rescan threads from piling up on a
40785f389360SStephen M. Cameron 	 * locked up controller.
40795f389360SStephen M. Cameron 	 */
4080094963daSStephen M. Cameron 	if (unlikely(lockup_detected(h))) {
40815f389360SStephen M. Cameron 		spin_lock_irqsave(&h->scan_lock, flags);
40825f389360SStephen M. Cameron 		h->scan_finished = 1;
40835f389360SStephen M. Cameron 		wake_up_all(&h->scan_wait_queue);
40845f389360SStephen M. Cameron 		spin_unlock_irqrestore(&h->scan_lock, flags);
40855f389360SStephen M. Cameron 		return 1;
40865f389360SStephen M. Cameron 	}
40875f389360SStephen M. Cameron 	return 0;
40885f389360SStephen M. Cameron }
40895f389360SStephen M. Cameron 
4090a08a8471SStephen M. Cameron static void hpsa_scan_start(struct Scsi_Host *sh)
4091a08a8471SStephen M. Cameron {
4092a08a8471SStephen M. Cameron 	struct ctlr_info *h = shost_to_hba(sh);
4093a08a8471SStephen M. Cameron 	unsigned long flags;
4094a08a8471SStephen M. Cameron 
40955f389360SStephen M. Cameron 	if (do_not_scan_if_controller_locked_up(h))
40965f389360SStephen M. Cameron 		return;
40975f389360SStephen M. Cameron 
4098a08a8471SStephen M. Cameron 	/* wait until any scan already in progress is finished. */
4099a08a8471SStephen M. Cameron 	while (1) {
4100a08a8471SStephen M. Cameron 		spin_lock_irqsave(&h->scan_lock, flags);
4101a08a8471SStephen M. Cameron 		if (h->scan_finished)
4102a08a8471SStephen M. Cameron 			break;
4103a08a8471SStephen M. Cameron 		spin_unlock_irqrestore(&h->scan_lock, flags);
4104a08a8471SStephen M. Cameron 		wait_event(h->scan_wait_queue, h->scan_finished);
4105a08a8471SStephen M. Cameron 		/* Note: We don't need to worry about a race between this
4106a08a8471SStephen M. Cameron 		 * thread and driver unload because the midlayer will
4107a08a8471SStephen M. Cameron 		 * have incremented the reference count, so unload won't
4108a08a8471SStephen M. Cameron 		 * happen if we're in here.
4109a08a8471SStephen M. Cameron 		 */
4110a08a8471SStephen M. Cameron 	}
4111a08a8471SStephen M. Cameron 	h->scan_finished = 0; /* mark scan as in progress */
4112a08a8471SStephen M. Cameron 	spin_unlock_irqrestore(&h->scan_lock, flags);
4113a08a8471SStephen M. Cameron 
41145f389360SStephen M. Cameron 	if (do_not_scan_if_controller_locked_up(h))
41155f389360SStephen M. Cameron 		return;
41165f389360SStephen M. Cameron 
4117a08a8471SStephen M. Cameron 	hpsa_update_scsi_devices(h, h->scsi_host->host_no);
4118a08a8471SStephen M. Cameron 
4119a08a8471SStephen M. Cameron 	spin_lock_irqsave(&h->scan_lock, flags);
4120a08a8471SStephen M. Cameron 	h->scan_finished = 1; /* mark scan as finished. */
4121a08a8471SStephen M. Cameron 	wake_up_all(&h->scan_wait_queue);
4122a08a8471SStephen M. Cameron 	spin_unlock_irqrestore(&h->scan_lock, flags);
4123a08a8471SStephen M. Cameron }
4124a08a8471SStephen M. Cameron 
4125a08a8471SStephen M. Cameron static int hpsa_scan_finished(struct Scsi_Host *sh,
4126a08a8471SStephen M. Cameron 	unsigned long elapsed_time)
4127a08a8471SStephen M. Cameron {
4128a08a8471SStephen M. Cameron 	struct ctlr_info *h = shost_to_hba(sh);
4129a08a8471SStephen M. Cameron 	unsigned long flags;
4130a08a8471SStephen M. Cameron 	int finished;
4131a08a8471SStephen M. Cameron 
4132a08a8471SStephen M. Cameron 	spin_lock_irqsave(&h->scan_lock, flags);
4133a08a8471SStephen M. Cameron 	finished = h->scan_finished;
4134a08a8471SStephen M. Cameron 	spin_unlock_irqrestore(&h->scan_lock, flags);
4135a08a8471SStephen M. Cameron 	return finished;
4136a08a8471SStephen M. Cameron }
4137a08a8471SStephen M. Cameron 
4138667e23d4SStephen M. Cameron static int hpsa_change_queue_depth(struct scsi_device *sdev,
4139667e23d4SStephen M. Cameron 	int qdepth, int reason)
4140667e23d4SStephen M. Cameron {
4141667e23d4SStephen M. Cameron 	struct ctlr_info *h = sdev_to_hba(sdev);
4142667e23d4SStephen M. Cameron 
4143667e23d4SStephen M. Cameron 	if (reason != SCSI_QDEPTH_DEFAULT)
4144667e23d4SStephen M. Cameron 		return -ENOTSUPP;
4145667e23d4SStephen M. Cameron 
4146667e23d4SStephen M. Cameron 	if (qdepth < 1)
4147667e23d4SStephen M. Cameron 		qdepth = 1;
4148667e23d4SStephen M. Cameron 	else
4149667e23d4SStephen M. Cameron 		if (qdepth > h->nr_cmds)
4150667e23d4SStephen M. Cameron 			qdepth = h->nr_cmds;
4151c8b09f6fSChristoph Hellwig 	scsi_adjust_queue_depth(sdev, qdepth);
4152667e23d4SStephen M. Cameron 	return sdev->queue_depth;
4153667e23d4SStephen M. Cameron }
4154667e23d4SStephen M. Cameron 
4155edd16368SStephen M. Cameron static void hpsa_unregister_scsi(struct ctlr_info *h)
4156edd16368SStephen M. Cameron {
4157edd16368SStephen M. Cameron 	/* we are being forcibly unloaded, and may not refuse. */
4158edd16368SStephen M. Cameron 	scsi_remove_host(h->scsi_host);
4159edd16368SStephen M. Cameron 	scsi_host_put(h->scsi_host);
4160edd16368SStephen M. Cameron 	h->scsi_host = NULL;
4161edd16368SStephen M. Cameron }
4162edd16368SStephen M. Cameron 
4163edd16368SStephen M. Cameron static int hpsa_register_scsi(struct ctlr_info *h)
4164edd16368SStephen M. Cameron {
4165b705690dSStephen M. Cameron 	struct Scsi_Host *sh;
4166b705690dSStephen M. Cameron 	int error;
4167edd16368SStephen M. Cameron 
4168b705690dSStephen M. Cameron 	sh = scsi_host_alloc(&hpsa_driver_template, sizeof(h));
4169b705690dSStephen M. Cameron 	if (sh == NULL)
4170b705690dSStephen M. Cameron 		goto fail;
4171b705690dSStephen M. Cameron 
4172b705690dSStephen M. Cameron 	sh->io_port = 0;
4173b705690dSStephen M. Cameron 	sh->n_io_port = 0;
4174b705690dSStephen M. Cameron 	sh->this_id = -1;
4175b705690dSStephen M. Cameron 	sh->max_channel = 3;
4176b705690dSStephen M. Cameron 	sh->max_cmd_len = MAX_COMMAND_SIZE;
4177b705690dSStephen M. Cameron 	sh->max_lun = HPSA_MAX_LUN;
4178b705690dSStephen M. Cameron 	sh->max_id = HPSA_MAX_LUN;
4179b705690dSStephen M. Cameron 	sh->can_queue = h->nr_cmds;
4180316b221aSStephen M. Cameron 	if (h->hba_mode_enabled)
4181316b221aSStephen M. Cameron 		sh->cmd_per_lun = 7;
4182316b221aSStephen M. Cameron 	else
4183b705690dSStephen M. Cameron 		sh->cmd_per_lun = h->nr_cmds;
4184b705690dSStephen M. Cameron 	sh->sg_tablesize = h->maxsgentries;
4185b705690dSStephen M. Cameron 	h->scsi_host = sh;
4186b705690dSStephen M. Cameron 	sh->hostdata[0] = (unsigned long) h;
4187b705690dSStephen M. Cameron 	sh->irq = h->intr[h->intr_mode];
4188b705690dSStephen M. Cameron 	sh->unique_id = sh->irq;
4189b705690dSStephen M. Cameron 	error = scsi_add_host(sh, &h->pdev->dev);
4190b705690dSStephen M. Cameron 	if (error)
4191b705690dSStephen M. Cameron 		goto fail_host_put;
4192b705690dSStephen M. Cameron 	scsi_scan_host(sh);
4193b705690dSStephen M. Cameron 	return 0;
4194b705690dSStephen M. Cameron 
4195b705690dSStephen M. Cameron  fail_host_put:
4196b705690dSStephen M. Cameron 	dev_err(&h->pdev->dev, "%s: scsi_add_host"
4197b705690dSStephen M. Cameron 		" failed for controller %d\n", __func__, h->ctlr);
4198b705690dSStephen M. Cameron 	scsi_host_put(sh);
4199b705690dSStephen M. Cameron 	return error;
4200b705690dSStephen M. Cameron  fail:
4201b705690dSStephen M. Cameron 	dev_err(&h->pdev->dev, "%s: scsi_host_alloc"
4202b705690dSStephen M. Cameron 		" failed for controller %d\n", __func__, h->ctlr);
4203b705690dSStephen M. Cameron 	return -ENOMEM;
4204edd16368SStephen M. Cameron }
4205edd16368SStephen M. Cameron 
4206edd16368SStephen M. Cameron static int wait_for_device_to_become_ready(struct ctlr_info *h,
4207edd16368SStephen M. Cameron 	unsigned char lunaddr[])
4208edd16368SStephen M. Cameron {
42098919358eSTomas Henzl 	int rc;
4210edd16368SStephen M. Cameron 	int count = 0;
4211edd16368SStephen M. Cameron 	int waittime = 1; /* seconds */
4212edd16368SStephen M. Cameron 	struct CommandList *c;
4213edd16368SStephen M. Cameron 
4214edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
4215edd16368SStephen M. Cameron 	if (!c) {
4216edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "out of memory in "
4217edd16368SStephen M. Cameron 			"wait_for_device_to_become_ready.\n");
4218edd16368SStephen M. Cameron 		return IO_ERROR;
4219edd16368SStephen M. Cameron 	}
4220edd16368SStephen M. Cameron 
4221edd16368SStephen M. Cameron 	/* Send test unit ready until device ready, or give up. */
4222edd16368SStephen M. Cameron 	while (count < HPSA_TUR_RETRY_LIMIT) {
4223edd16368SStephen M. Cameron 
4224edd16368SStephen M. Cameron 		/* Wait for a bit.  do this first, because if we send
4225edd16368SStephen M. Cameron 		 * the TUR right away, the reset will just abort it.
4226edd16368SStephen M. Cameron 		 */
4227edd16368SStephen M. Cameron 		msleep(1000 * waittime);
4228edd16368SStephen M. Cameron 		count++;
42298919358eSTomas Henzl 		rc = 0; /* Device ready. */
4230edd16368SStephen M. Cameron 
4231edd16368SStephen M. Cameron 		/* Increase wait time with each try, up to a point. */
4232edd16368SStephen M. Cameron 		if (waittime < HPSA_MAX_WAIT_INTERVAL_SECS)
4233edd16368SStephen M. Cameron 			waittime = waittime * 2;
4234edd16368SStephen M. Cameron 
4235a2dac136SStephen M. Cameron 		/* Send the Test Unit Ready, fill_cmd can't fail, no mapping */
4236a2dac136SStephen M. Cameron 		(void) fill_cmd(c, TEST_UNIT_READY, h,
4237a2dac136SStephen M. Cameron 				NULL, 0, 0, lunaddr, TYPE_CMD);
4238edd16368SStephen M. Cameron 		hpsa_scsi_do_simple_cmd_core(h, c);
4239edd16368SStephen M. Cameron 		/* no unmap needed here because no data xfer. */
4240edd16368SStephen M. Cameron 
4241edd16368SStephen M. Cameron 		if (c->err_info->CommandStatus == CMD_SUCCESS)
4242edd16368SStephen M. Cameron 			break;
4243edd16368SStephen M. Cameron 
4244edd16368SStephen M. Cameron 		if (c->err_info->CommandStatus == CMD_TARGET_STATUS &&
4245edd16368SStephen M. Cameron 			c->err_info->ScsiStatus == SAM_STAT_CHECK_CONDITION &&
4246edd16368SStephen M. Cameron 			(c->err_info->SenseInfo[2] == NO_SENSE ||
4247edd16368SStephen M. Cameron 			c->err_info->SenseInfo[2] == UNIT_ATTENTION))
4248edd16368SStephen M. Cameron 			break;
4249edd16368SStephen M. Cameron 
4250edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "waiting %d secs "
4251edd16368SStephen M. Cameron 			"for device to become ready.\n", waittime);
4252edd16368SStephen M. Cameron 		rc = 1; /* device not ready. */
4253edd16368SStephen M. Cameron 	}
4254edd16368SStephen M. Cameron 
4255edd16368SStephen M. Cameron 	if (rc)
4256edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "giving up on device.\n");
4257edd16368SStephen M. Cameron 	else
4258edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "device is ready.\n");
4259edd16368SStephen M. Cameron 
4260edd16368SStephen M. Cameron 	cmd_special_free(h, c);
4261edd16368SStephen M. Cameron 	return rc;
4262edd16368SStephen M. Cameron }
4263edd16368SStephen M. Cameron 
4264edd16368SStephen M. Cameron /* Need at least one of these error handlers to keep ../scsi/hosts.c from
4265edd16368SStephen M. Cameron  * complaining.  Doing a host- or bus-reset can't do anything good here.
4266edd16368SStephen M. Cameron  */
4267edd16368SStephen M. Cameron static int hpsa_eh_device_reset_handler(struct scsi_cmnd *scsicmd)
4268edd16368SStephen M. Cameron {
4269edd16368SStephen M. Cameron 	int rc;
4270edd16368SStephen M. Cameron 	struct ctlr_info *h;
4271edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *dev;
4272edd16368SStephen M. Cameron 
4273edd16368SStephen M. Cameron 	/* find the controller to which the command to be aborted was sent */
4274edd16368SStephen M. Cameron 	h = sdev_to_hba(scsicmd->device);
4275edd16368SStephen M. Cameron 	if (h == NULL) /* paranoia */
4276edd16368SStephen M. Cameron 		return FAILED;
4277edd16368SStephen M. Cameron 	dev = scsicmd->device->hostdata;
4278edd16368SStephen M. Cameron 	if (!dev) {
4279edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "hpsa_eh_device_reset_handler: "
4280edd16368SStephen M. Cameron 			"device lookup failed.\n");
4281edd16368SStephen M. Cameron 		return FAILED;
4282edd16368SStephen M. Cameron 	}
4283d416b0c7SStephen M. Cameron 	dev_warn(&h->pdev->dev, "resetting device %d:%d:%d:%d\n",
4284d416b0c7SStephen M. Cameron 		h->scsi_host->host_no, dev->bus, dev->target, dev->lun);
4285edd16368SStephen M. Cameron 	/* send a reset to the SCSI LUN which the command was sent to */
4286bf711ac6SScott Teel 	rc = hpsa_send_reset(h, dev->scsi3addr, HPSA_RESET_TYPE_LUN);
4287edd16368SStephen M. Cameron 	if (rc == 0 && wait_for_device_to_become_ready(h, dev->scsi3addr) == 0)
4288edd16368SStephen M. Cameron 		return SUCCESS;
4289edd16368SStephen M. Cameron 
4290edd16368SStephen M. Cameron 	dev_warn(&h->pdev->dev, "resetting device failed.\n");
4291edd16368SStephen M. Cameron 	return FAILED;
4292edd16368SStephen M. Cameron }
4293edd16368SStephen M. Cameron 
42946cba3f19SStephen M. Cameron static void swizzle_abort_tag(u8 *tag)
42956cba3f19SStephen M. Cameron {
42966cba3f19SStephen M. Cameron 	u8 original_tag[8];
42976cba3f19SStephen M. Cameron 
42986cba3f19SStephen M. Cameron 	memcpy(original_tag, tag, 8);
42996cba3f19SStephen M. Cameron 	tag[0] = original_tag[3];
43006cba3f19SStephen M. Cameron 	tag[1] = original_tag[2];
43016cba3f19SStephen M. Cameron 	tag[2] = original_tag[1];
43026cba3f19SStephen M. Cameron 	tag[3] = original_tag[0];
43036cba3f19SStephen M. Cameron 	tag[4] = original_tag[7];
43046cba3f19SStephen M. Cameron 	tag[5] = original_tag[6];
43056cba3f19SStephen M. Cameron 	tag[6] = original_tag[5];
43066cba3f19SStephen M. Cameron 	tag[7] = original_tag[4];
43076cba3f19SStephen M. Cameron }
43086cba3f19SStephen M. Cameron 
430917eb87d2SScott Teel static void hpsa_get_tag(struct ctlr_info *h,
431017eb87d2SScott Teel 	struct CommandList *c, u32 *taglower, u32 *tagupper)
431117eb87d2SScott Teel {
431217eb87d2SScott Teel 	if (c->cmd_type == CMD_IOACCEL1) {
431317eb87d2SScott Teel 		struct io_accel1_cmd *cm1 = (struct io_accel1_cmd *)
431417eb87d2SScott Teel 			&h->ioaccel_cmd_pool[c->cmdindex];
4315*50a0decfSStephen M. Cameron 		*tagupper = (u32) (cm1->tag >> 32);
4316*50a0decfSStephen M. Cameron 		*taglower = (u32) (cm1->tag & 0x0ffffffffULL);
431754b6e9e9SScott Teel 		return;
431854b6e9e9SScott Teel 	}
431954b6e9e9SScott Teel 	if (c->cmd_type == CMD_IOACCEL2) {
432054b6e9e9SScott Teel 		struct io_accel2_cmd *cm2 = (struct io_accel2_cmd *)
432154b6e9e9SScott Teel 			&h->ioaccel2_cmd_pool[c->cmdindex];
4322dd0e19f3SScott Teel 		/* upper tag not used in ioaccel2 mode */
4323dd0e19f3SScott Teel 		memset(tagupper, 0, sizeof(*tagupper));
4324dd0e19f3SScott Teel 		*taglower = cm2->Tag;
432554b6e9e9SScott Teel 		return;
432654b6e9e9SScott Teel 	}
4327*50a0decfSStephen M. Cameron 	*tagupper = (u32) (c->Header.tag >> 32);
4328*50a0decfSStephen M. Cameron 	*taglower = (u32) (c->Header.tag & 0x0ffffffffULL);
432917eb87d2SScott Teel }
433054b6e9e9SScott Teel 
433175167d2cSStephen M. Cameron static int hpsa_send_abort(struct ctlr_info *h, unsigned char *scsi3addr,
43326cba3f19SStephen M. Cameron 	struct CommandList *abort, int swizzle)
433375167d2cSStephen M. Cameron {
433475167d2cSStephen M. Cameron 	int rc = IO_OK;
433575167d2cSStephen M. Cameron 	struct CommandList *c;
433675167d2cSStephen M. Cameron 	struct ErrorInfo *ei;
433717eb87d2SScott Teel 	u32 tagupper, taglower;
433875167d2cSStephen M. Cameron 
433975167d2cSStephen M. Cameron 	c = cmd_special_alloc(h);
434075167d2cSStephen M. Cameron 	if (c == NULL) {	/* trouble... */
434175167d2cSStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
434275167d2cSStephen M. Cameron 		return -ENOMEM;
434375167d2cSStephen M. Cameron 	}
434475167d2cSStephen M. Cameron 
4345a2dac136SStephen M. Cameron 	/* fill_cmd can't fail here, no buffer to map */
4346a2dac136SStephen M. Cameron 	(void) fill_cmd(c, HPSA_ABORT_MSG, h, abort,
4347a2dac136SStephen M. Cameron 		0, 0, scsi3addr, TYPE_MSG);
43486cba3f19SStephen M. Cameron 	if (swizzle)
43496cba3f19SStephen M. Cameron 		swizzle_abort_tag(&c->Request.CDB[4]);
435075167d2cSStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core(h, c);
435117eb87d2SScott Teel 	hpsa_get_tag(h, abort, &taglower, &tagupper);
435275167d2cSStephen M. Cameron 	dev_dbg(&h->pdev->dev, "%s: Tag:0x%08x:%08x: do_simple_cmd_core completed.\n",
435317eb87d2SScott Teel 		__func__, tagupper, taglower);
435475167d2cSStephen M. Cameron 	/* no unmap needed here because no data xfer. */
435575167d2cSStephen M. Cameron 
435675167d2cSStephen M. Cameron 	ei = c->err_info;
435775167d2cSStephen M. Cameron 	switch (ei->CommandStatus) {
435875167d2cSStephen M. Cameron 	case CMD_SUCCESS:
435975167d2cSStephen M. Cameron 		break;
436075167d2cSStephen M. Cameron 	case CMD_UNABORTABLE: /* Very common, don't make noise. */
436175167d2cSStephen M. Cameron 		rc = -1;
436275167d2cSStephen M. Cameron 		break;
436375167d2cSStephen M. Cameron 	default:
436475167d2cSStephen M. Cameron 		dev_dbg(&h->pdev->dev, "%s: Tag:0x%08x:%08x: interpreting error.\n",
436517eb87d2SScott Teel 			__func__, tagupper, taglower);
4366d1e8beacSStephen M. Cameron 		hpsa_scsi_interpret_error(h, c);
436775167d2cSStephen M. Cameron 		rc = -1;
436875167d2cSStephen M. Cameron 		break;
436975167d2cSStephen M. Cameron 	}
437075167d2cSStephen M. Cameron 	cmd_special_free(h, c);
4371dd0e19f3SScott Teel 	dev_dbg(&h->pdev->dev, "%s: Tag:0x%08x:%08x: Finished.\n",
4372dd0e19f3SScott Teel 		__func__, tagupper, taglower);
437375167d2cSStephen M. Cameron 	return rc;
437475167d2cSStephen M. Cameron }
437575167d2cSStephen M. Cameron 
437675167d2cSStephen M. Cameron /*
437775167d2cSStephen M. Cameron  * hpsa_find_cmd_in_queue
437875167d2cSStephen M. Cameron  *
437975167d2cSStephen M. Cameron  * Used to determine whether a command (find) is still present
438075167d2cSStephen M. Cameron  * in queue_head.   Optionally excludes the last element of queue_head.
438175167d2cSStephen M. Cameron  *
438275167d2cSStephen M. Cameron  * This is used to avoid unnecessary aborts.  Commands in h->reqQ have
438375167d2cSStephen M. Cameron  * not yet been submitted, and so can be aborted by the driver without
438475167d2cSStephen M. Cameron  * sending an abort to the hardware.
438575167d2cSStephen M. Cameron  *
438675167d2cSStephen M. Cameron  * Returns pointer to command if found in queue, NULL otherwise.
438775167d2cSStephen M. Cameron  */
438875167d2cSStephen M. Cameron static struct CommandList *hpsa_find_cmd_in_queue(struct ctlr_info *h,
438975167d2cSStephen M. Cameron 			struct scsi_cmnd *find, struct list_head *queue_head)
439075167d2cSStephen M. Cameron {
439175167d2cSStephen M. Cameron 	unsigned long flags;
439275167d2cSStephen M. Cameron 	struct CommandList *c = NULL;	/* ptr into cmpQ */
439375167d2cSStephen M. Cameron 
439475167d2cSStephen M. Cameron 	if (!find)
439542a91641SDon Brace 		return NULL;
439675167d2cSStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
439775167d2cSStephen M. Cameron 	list_for_each_entry(c, queue_head, list) {
439875167d2cSStephen M. Cameron 		if (c->scsi_cmd == NULL) /* e.g.: passthru ioctl */
439975167d2cSStephen M. Cameron 			continue;
440075167d2cSStephen M. Cameron 		if (c->scsi_cmd == find) {
440175167d2cSStephen M. Cameron 			spin_unlock_irqrestore(&h->lock, flags);
440275167d2cSStephen M. Cameron 			return c;
440375167d2cSStephen M. Cameron 		}
440475167d2cSStephen M. Cameron 	}
440575167d2cSStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
440675167d2cSStephen M. Cameron 	return NULL;
440775167d2cSStephen M. Cameron }
440875167d2cSStephen M. Cameron 
44096cba3f19SStephen M. Cameron static struct CommandList *hpsa_find_cmd_in_queue_by_tag(struct ctlr_info *h,
44106cba3f19SStephen M. Cameron 					u8 *tag, struct list_head *queue_head)
44116cba3f19SStephen M. Cameron {
44126cba3f19SStephen M. Cameron 	unsigned long flags;
44136cba3f19SStephen M. Cameron 	struct CommandList *c;
44146cba3f19SStephen M. Cameron 
44156cba3f19SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
44166cba3f19SStephen M. Cameron 	list_for_each_entry(c, queue_head, list) {
4417*50a0decfSStephen M. Cameron 		if (memcmp(&c->Header.tag, tag, 8) != 0)
44186cba3f19SStephen M. Cameron 			continue;
44196cba3f19SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
44206cba3f19SStephen M. Cameron 		return c;
44216cba3f19SStephen M. Cameron 	}
44226cba3f19SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
44236cba3f19SStephen M. Cameron 	return NULL;
44246cba3f19SStephen M. Cameron }
44256cba3f19SStephen M. Cameron 
442654b6e9e9SScott Teel /* ioaccel2 path firmware cannot handle abort task requests.
442754b6e9e9SScott Teel  * Change abort requests to physical target reset, and send to the
442854b6e9e9SScott Teel  * address of the physical disk used for the ioaccel 2 command.
442954b6e9e9SScott Teel  * Return 0 on success (IO_OK)
443054b6e9e9SScott Teel  *	 -1 on failure
443154b6e9e9SScott Teel  */
443254b6e9e9SScott Teel 
443354b6e9e9SScott Teel static int hpsa_send_reset_as_abort_ioaccel2(struct ctlr_info *h,
443454b6e9e9SScott Teel 	unsigned char *scsi3addr, struct CommandList *abort)
443554b6e9e9SScott Teel {
443654b6e9e9SScott Teel 	int rc = IO_OK;
443754b6e9e9SScott Teel 	struct scsi_cmnd *scmd; /* scsi command within request being aborted */
443854b6e9e9SScott Teel 	struct hpsa_scsi_dev_t *dev; /* device to which scsi cmd was sent */
443954b6e9e9SScott Teel 	unsigned char phys_scsi3addr[8]; /* addr of phys disk with volume */
444054b6e9e9SScott Teel 	unsigned char *psa = &phys_scsi3addr[0];
444154b6e9e9SScott Teel 
444254b6e9e9SScott Teel 	/* Get a pointer to the hpsa logical device. */
444354b6e9e9SScott Teel 	scmd = (struct scsi_cmnd *) abort->scsi_cmd;
444454b6e9e9SScott Teel 	dev = (struct hpsa_scsi_dev_t *)(scmd->device->hostdata);
444554b6e9e9SScott Teel 	if (dev == NULL) {
444654b6e9e9SScott Teel 		dev_warn(&h->pdev->dev,
444754b6e9e9SScott Teel 			"Cannot abort: no device pointer for command.\n");
444854b6e9e9SScott Teel 			return -1; /* not abortable */
444954b6e9e9SScott Teel 	}
445054b6e9e9SScott Teel 
44512ba8bfc8SStephen M. Cameron 	if (h->raid_offload_debug > 0)
44522ba8bfc8SStephen M. Cameron 		dev_info(&h->pdev->dev,
44532ba8bfc8SStephen M. Cameron 			"Reset as abort: Abort requested on C%d:B%d:T%d:L%d scsi3addr 0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
44542ba8bfc8SStephen M. Cameron 			h->scsi_host->host_no, dev->bus, dev->target, dev->lun,
44552ba8bfc8SStephen M. Cameron 			scsi3addr[0], scsi3addr[1], scsi3addr[2], scsi3addr[3],
44562ba8bfc8SStephen M. Cameron 			scsi3addr[4], scsi3addr[5], scsi3addr[6], scsi3addr[7]);
44572ba8bfc8SStephen M. Cameron 
445854b6e9e9SScott Teel 	if (!dev->offload_enabled) {
445954b6e9e9SScott Teel 		dev_warn(&h->pdev->dev,
446054b6e9e9SScott Teel 			"Can't abort: device is not operating in HP SSD Smart Path mode.\n");
446154b6e9e9SScott Teel 		return -1; /* not abortable */
446254b6e9e9SScott Teel 	}
446354b6e9e9SScott Teel 
446454b6e9e9SScott Teel 	/* Incoming scsi3addr is logical addr. We need physical disk addr. */
446554b6e9e9SScott Teel 	if (!hpsa_get_pdisk_of_ioaccel2(h, abort, psa)) {
446654b6e9e9SScott Teel 		dev_warn(&h->pdev->dev, "Can't abort: Failed lookup of physical address.\n");
446754b6e9e9SScott Teel 		return -1; /* not abortable */
446854b6e9e9SScott Teel 	}
446954b6e9e9SScott Teel 
447054b6e9e9SScott Teel 	/* send the reset */
44712ba8bfc8SStephen M. Cameron 	if (h->raid_offload_debug > 0)
44722ba8bfc8SStephen M. Cameron 		dev_info(&h->pdev->dev,
44732ba8bfc8SStephen M. Cameron 			"Reset as abort: Resetting physical device at scsi3addr 0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
44742ba8bfc8SStephen M. Cameron 			psa[0], psa[1], psa[2], psa[3],
44752ba8bfc8SStephen M. Cameron 			psa[4], psa[5], psa[6], psa[7]);
447654b6e9e9SScott Teel 	rc = hpsa_send_reset(h, psa, HPSA_RESET_TYPE_TARGET);
447754b6e9e9SScott Teel 	if (rc != 0) {
447854b6e9e9SScott Teel 		dev_warn(&h->pdev->dev,
447954b6e9e9SScott Teel 			"Reset as abort: Failed on physical device at scsi3addr 0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
448054b6e9e9SScott Teel 			psa[0], psa[1], psa[2], psa[3],
448154b6e9e9SScott Teel 			psa[4], psa[5], psa[6], psa[7]);
448254b6e9e9SScott Teel 		return rc; /* failed to reset */
448354b6e9e9SScott Teel 	}
448454b6e9e9SScott Teel 
448554b6e9e9SScott Teel 	/* wait for device to recover */
448654b6e9e9SScott Teel 	if (wait_for_device_to_become_ready(h, psa) != 0) {
448754b6e9e9SScott Teel 		dev_warn(&h->pdev->dev,
448854b6e9e9SScott Teel 			"Reset as abort: Failed: Device never recovered from reset: 0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
448954b6e9e9SScott Teel 			psa[0], psa[1], psa[2], psa[3],
449054b6e9e9SScott Teel 			psa[4], psa[5], psa[6], psa[7]);
449154b6e9e9SScott Teel 		return -1;  /* failed to recover */
449254b6e9e9SScott Teel 	}
449354b6e9e9SScott Teel 
449454b6e9e9SScott Teel 	/* device recovered */
449554b6e9e9SScott Teel 	dev_info(&h->pdev->dev,
449654b6e9e9SScott Teel 		"Reset as abort: Device recovered from reset: scsi3addr 0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
449754b6e9e9SScott Teel 		psa[0], psa[1], psa[2], psa[3],
449854b6e9e9SScott Teel 		psa[4], psa[5], psa[6], psa[7]);
449954b6e9e9SScott Teel 
450054b6e9e9SScott Teel 	return rc; /* success */
450154b6e9e9SScott Teel }
450254b6e9e9SScott Teel 
45036cba3f19SStephen M. Cameron /* Some Smart Arrays need the abort tag swizzled, and some don't.  It's hard to
45046cba3f19SStephen M. Cameron  * tell which kind we're dealing with, so we send the abort both ways.  There
45056cba3f19SStephen M. Cameron  * shouldn't be any collisions between swizzled and unswizzled tags due to the
45066cba3f19SStephen M. Cameron  * way we construct our tags but we check anyway in case the assumptions which
45076cba3f19SStephen M. Cameron  * make this true someday become false.
45086cba3f19SStephen M. Cameron  */
45096cba3f19SStephen M. Cameron static int hpsa_send_abort_both_ways(struct ctlr_info *h,
45106cba3f19SStephen M. Cameron 	unsigned char *scsi3addr, struct CommandList *abort)
45116cba3f19SStephen M. Cameron {
45126cba3f19SStephen M. Cameron 	u8 swizzled_tag[8];
45136cba3f19SStephen M. Cameron 	struct CommandList *c;
45146cba3f19SStephen M. Cameron 	int rc = 0, rc2 = 0;
45156cba3f19SStephen M. Cameron 
451654b6e9e9SScott Teel 	/* ioccelerator mode 2 commands should be aborted via the
451754b6e9e9SScott Teel 	 * accelerated path, since RAID path is unaware of these commands,
451854b6e9e9SScott Teel 	 * but underlying firmware can't handle abort TMF.
451954b6e9e9SScott Teel 	 * Change abort to physical device reset.
452054b6e9e9SScott Teel 	 */
452154b6e9e9SScott Teel 	if (abort->cmd_type == CMD_IOACCEL2)
452254b6e9e9SScott Teel 		return hpsa_send_reset_as_abort_ioaccel2(h, scsi3addr, abort);
452354b6e9e9SScott Teel 
45246cba3f19SStephen M. Cameron 	/* we do not expect to find the swizzled tag in our queue, but
45256cba3f19SStephen M. Cameron 	 * check anyway just to be sure the assumptions which make this
45266cba3f19SStephen M. Cameron 	 * the case haven't become wrong.
45276cba3f19SStephen M. Cameron 	 */
45286cba3f19SStephen M. Cameron 	memcpy(swizzled_tag, &abort->Request.CDB[4], 8);
45296cba3f19SStephen M. Cameron 	swizzle_abort_tag(swizzled_tag);
45306cba3f19SStephen M. Cameron 	c = hpsa_find_cmd_in_queue_by_tag(h, swizzled_tag, &h->cmpQ);
45316cba3f19SStephen M. Cameron 	if (c != NULL) {
45326cba3f19SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Unexpectedly found byte-swapped tag in completion queue.\n");
45336cba3f19SStephen M. Cameron 		return hpsa_send_abort(h, scsi3addr, abort, 0);
45346cba3f19SStephen M. Cameron 	}
45356cba3f19SStephen M. Cameron 	rc = hpsa_send_abort(h, scsi3addr, abort, 0);
45366cba3f19SStephen M. Cameron 
45376cba3f19SStephen M. Cameron 	/* if the command is still in our queue, we can't conclude that it was
45386cba3f19SStephen M. Cameron 	 * aborted (it might have just completed normally) but in any case
45396cba3f19SStephen M. Cameron 	 * we don't need to try to abort it another way.
45406cba3f19SStephen M. Cameron 	 */
45416cba3f19SStephen M. Cameron 	c = hpsa_find_cmd_in_queue(h, abort->scsi_cmd, &h->cmpQ);
45426cba3f19SStephen M. Cameron 	if (c)
45436cba3f19SStephen M. Cameron 		rc2 = hpsa_send_abort(h, scsi3addr, abort, 1);
45446cba3f19SStephen M. Cameron 	return rc && rc2;
45456cba3f19SStephen M. Cameron }
45466cba3f19SStephen M. Cameron 
454775167d2cSStephen M. Cameron /* Send an abort for the specified command.
454875167d2cSStephen M. Cameron  *	If the device and controller support it,
454975167d2cSStephen M. Cameron  *		send a task abort request.
455075167d2cSStephen M. Cameron  */
455175167d2cSStephen M. Cameron static int hpsa_eh_abort_handler(struct scsi_cmnd *sc)
455275167d2cSStephen M. Cameron {
455375167d2cSStephen M. Cameron 
455475167d2cSStephen M. Cameron 	int i, rc;
455575167d2cSStephen M. Cameron 	struct ctlr_info *h;
455675167d2cSStephen M. Cameron 	struct hpsa_scsi_dev_t *dev;
455775167d2cSStephen M. Cameron 	struct CommandList *abort; /* pointer to command to be aborted */
455875167d2cSStephen M. Cameron 	struct CommandList *found;
455975167d2cSStephen M. Cameron 	struct scsi_cmnd *as;	/* ptr to scsi cmd inside aborted command. */
456075167d2cSStephen M. Cameron 	char msg[256];		/* For debug messaging. */
456175167d2cSStephen M. Cameron 	int ml = 0;
456217eb87d2SScott Teel 	u32 tagupper, taglower;
456375167d2cSStephen M. Cameron 
456475167d2cSStephen M. Cameron 	/* Find the controller of the command to be aborted */
456575167d2cSStephen M. Cameron 	h = sdev_to_hba(sc->device);
456675167d2cSStephen M. Cameron 	if (WARN(h == NULL,
456775167d2cSStephen M. Cameron 			"ABORT REQUEST FAILED, Controller lookup failed.\n"))
456875167d2cSStephen M. Cameron 		return FAILED;
456975167d2cSStephen M. Cameron 
457075167d2cSStephen M. Cameron 	/* Check that controller supports some kind of task abort */
457175167d2cSStephen M. Cameron 	if (!(HPSATMF_PHYS_TASK_ABORT & h->TMFSupportFlags) &&
457275167d2cSStephen M. Cameron 		!(HPSATMF_LOG_TASK_ABORT & h->TMFSupportFlags))
457375167d2cSStephen M. Cameron 		return FAILED;
457475167d2cSStephen M. Cameron 
457575167d2cSStephen M. Cameron 	memset(msg, 0, sizeof(msg));
45769cb78c16SHannes Reinecke 	ml += sprintf(msg+ml, "ABORT REQUEST on C%d:B%d:T%d:L%llu ",
457775167d2cSStephen M. Cameron 		h->scsi_host->host_no, sc->device->channel,
457875167d2cSStephen M. Cameron 		sc->device->id, sc->device->lun);
457975167d2cSStephen M. Cameron 
458075167d2cSStephen M. Cameron 	/* Find the device of the command to be aborted */
458175167d2cSStephen M. Cameron 	dev = sc->device->hostdata;
458275167d2cSStephen M. Cameron 	if (!dev) {
458375167d2cSStephen M. Cameron 		dev_err(&h->pdev->dev, "%s FAILED, Device lookup failed.\n",
458475167d2cSStephen M. Cameron 				msg);
458575167d2cSStephen M. Cameron 		return FAILED;
458675167d2cSStephen M. Cameron 	}
458775167d2cSStephen M. Cameron 
458875167d2cSStephen M. Cameron 	/* Get SCSI command to be aborted */
458975167d2cSStephen M. Cameron 	abort = (struct CommandList *) sc->host_scribble;
459075167d2cSStephen M. Cameron 	if (abort == NULL) {
459175167d2cSStephen M. Cameron 		dev_err(&h->pdev->dev, "%s FAILED, Command to abort is NULL.\n",
459275167d2cSStephen M. Cameron 				msg);
459375167d2cSStephen M. Cameron 		return FAILED;
459475167d2cSStephen M. Cameron 	}
459517eb87d2SScott Teel 	hpsa_get_tag(h, abort, &taglower, &tagupper);
459617eb87d2SScott Teel 	ml += sprintf(msg+ml, "Tag:0x%08x:%08x ", tagupper, taglower);
459775167d2cSStephen M. Cameron 	as  = (struct scsi_cmnd *) abort->scsi_cmd;
459875167d2cSStephen M. Cameron 	if (as != NULL)
459975167d2cSStephen M. Cameron 		ml += sprintf(msg+ml, "Command:0x%x SN:0x%lx ",
460075167d2cSStephen M. Cameron 			as->cmnd[0], as->serial_number);
460175167d2cSStephen M. Cameron 	dev_dbg(&h->pdev->dev, "%s\n", msg);
460275167d2cSStephen M. Cameron 	dev_warn(&h->pdev->dev, "Abort request on C%d:B%d:T%d:L%d\n",
460375167d2cSStephen M. Cameron 		h->scsi_host->host_no, dev->bus, dev->target, dev->lun);
460475167d2cSStephen M. Cameron 
460575167d2cSStephen M. Cameron 	/* Search reqQ to See if command is queued but not submitted,
460675167d2cSStephen M. Cameron 	 * if so, complete the command with aborted status and remove
460775167d2cSStephen M. Cameron 	 * it from the reqQ.
460875167d2cSStephen M. Cameron 	 */
460975167d2cSStephen M. Cameron 	found = hpsa_find_cmd_in_queue(h, sc, &h->reqQ);
461075167d2cSStephen M. Cameron 	if (found) {
461175167d2cSStephen M. Cameron 		found->err_info->CommandStatus = CMD_ABORTED;
461275167d2cSStephen M. Cameron 		finish_cmd(found);
461375167d2cSStephen M. Cameron 		dev_info(&h->pdev->dev, "%s Request SUCCEEDED (driver queue).\n",
461475167d2cSStephen M. Cameron 				msg);
461575167d2cSStephen M. Cameron 		return SUCCESS;
461675167d2cSStephen M. Cameron 	}
461775167d2cSStephen M. Cameron 
461875167d2cSStephen M. Cameron 	/* not in reqQ, if also not in cmpQ, must have already completed */
461975167d2cSStephen M. Cameron 	found = hpsa_find_cmd_in_queue(h, sc, &h->cmpQ);
462075167d2cSStephen M. Cameron 	if (!found)  {
4621d6ebd0f7SStephen M. Cameron 		dev_dbg(&h->pdev->dev, "%s Request SUCCEEDED (not known to driver).\n",
462275167d2cSStephen M. Cameron 				msg);
462375167d2cSStephen M. Cameron 		return SUCCESS;
462475167d2cSStephen M. Cameron 	}
462575167d2cSStephen M. Cameron 
462675167d2cSStephen M. Cameron 	/*
462775167d2cSStephen M. Cameron 	 * Command is in flight, or possibly already completed
462875167d2cSStephen M. Cameron 	 * by the firmware (but not to the scsi mid layer) but we can't
462975167d2cSStephen M. Cameron 	 * distinguish which.  Send the abort down.
463075167d2cSStephen M. Cameron 	 */
46316cba3f19SStephen M. Cameron 	rc = hpsa_send_abort_both_ways(h, dev->scsi3addr, abort);
463275167d2cSStephen M. Cameron 	if (rc != 0) {
463375167d2cSStephen M. Cameron 		dev_dbg(&h->pdev->dev, "%s Request FAILED.\n", msg);
463475167d2cSStephen M. Cameron 		dev_warn(&h->pdev->dev, "FAILED abort on device C%d:B%d:T%d:L%d\n",
463575167d2cSStephen M. Cameron 			h->scsi_host->host_no,
463675167d2cSStephen M. Cameron 			dev->bus, dev->target, dev->lun);
463775167d2cSStephen M. Cameron 		return FAILED;
463875167d2cSStephen M. Cameron 	}
463975167d2cSStephen M. Cameron 	dev_info(&h->pdev->dev, "%s REQUEST SUCCEEDED.\n", msg);
464075167d2cSStephen M. Cameron 
464175167d2cSStephen M. Cameron 	/* If the abort(s) above completed and actually aborted the
464275167d2cSStephen M. Cameron 	 * command, then the command to be aborted should already be
464375167d2cSStephen M. Cameron 	 * completed.  If not, wait around a bit more to see if they
464475167d2cSStephen M. Cameron 	 * manage to complete normally.
464575167d2cSStephen M. Cameron 	 */
464675167d2cSStephen M. Cameron #define ABORT_COMPLETE_WAIT_SECS 30
464775167d2cSStephen M. Cameron 	for (i = 0; i < ABORT_COMPLETE_WAIT_SECS * 10; i++) {
464875167d2cSStephen M. Cameron 		found = hpsa_find_cmd_in_queue(h, sc, &h->cmpQ);
464975167d2cSStephen M. Cameron 		if (!found)
465075167d2cSStephen M. Cameron 			return SUCCESS;
465175167d2cSStephen M. Cameron 		msleep(100);
465275167d2cSStephen M. Cameron 	}
465375167d2cSStephen M. Cameron 	dev_warn(&h->pdev->dev, "%s FAILED. Aborted command has not completed after %d seconds.\n",
465475167d2cSStephen M. Cameron 		msg, ABORT_COMPLETE_WAIT_SECS);
465575167d2cSStephen M. Cameron 	return FAILED;
465675167d2cSStephen M. Cameron }
465775167d2cSStephen M. Cameron 
465875167d2cSStephen M. Cameron 
4659edd16368SStephen M. Cameron /*
4660edd16368SStephen M. Cameron  * For operations that cannot sleep, a command block is allocated at init,
4661edd16368SStephen M. Cameron  * and managed by cmd_alloc() and cmd_free() using a simple bitmap to track
4662edd16368SStephen M. Cameron  * which ones are free or in use.  Lock must be held when calling this.
4663edd16368SStephen M. Cameron  * cmd_free() is the complement.
4664edd16368SStephen M. Cameron  */
4665edd16368SStephen M. Cameron static struct CommandList *cmd_alloc(struct ctlr_info *h)
4666edd16368SStephen M. Cameron {
4667edd16368SStephen M. Cameron 	struct CommandList *c;
4668edd16368SStephen M. Cameron 	int i;
4669edd16368SStephen M. Cameron 	union u64bit temp64;
4670edd16368SStephen M. Cameron 	dma_addr_t cmd_dma_handle, err_dma_handle;
4671e16a33adSMatt Gates 	unsigned long flags;
4672edd16368SStephen M. Cameron 
4673e16a33adSMatt Gates 	spin_lock_irqsave(&h->lock, flags);
4674edd16368SStephen M. Cameron 	do {
4675edd16368SStephen M. Cameron 		i = find_first_zero_bit(h->cmd_pool_bits, h->nr_cmds);
4676e16a33adSMatt Gates 		if (i == h->nr_cmds) {
4677e16a33adSMatt Gates 			spin_unlock_irqrestore(&h->lock, flags);
4678edd16368SStephen M. Cameron 			return NULL;
4679e16a33adSMatt Gates 		}
4680edd16368SStephen M. Cameron 	} while (test_and_set_bit
4681edd16368SStephen M. Cameron 		 (i & (BITS_PER_LONG - 1),
4682edd16368SStephen M. Cameron 		  h->cmd_pool_bits + (i / BITS_PER_LONG)) != 0);
4683e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
4684e16a33adSMatt Gates 
4685edd16368SStephen M. Cameron 	c = h->cmd_pool + i;
4686edd16368SStephen M. Cameron 	memset(c, 0, sizeof(*c));
4687edd16368SStephen M. Cameron 	cmd_dma_handle = h->cmd_pool_dhandle
4688edd16368SStephen M. Cameron 	    + i * sizeof(*c);
4689edd16368SStephen M. Cameron 	c->err_info = h->errinfo_pool + i;
4690edd16368SStephen M. Cameron 	memset(c->err_info, 0, sizeof(*c->err_info));
4691edd16368SStephen M. Cameron 	err_dma_handle = h->errinfo_pool_dhandle
4692edd16368SStephen M. Cameron 	    + i * sizeof(*c->err_info);
4693edd16368SStephen M. Cameron 
4694edd16368SStephen M. Cameron 	c->cmdindex = i;
4695edd16368SStephen M. Cameron 
46969e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&c->list);
469701a02ffcSStephen M. Cameron 	c->busaddr = (u32) cmd_dma_handle;
469801a02ffcSStephen M. Cameron 	temp64.val = (u64) err_dma_handle;
4699*50a0decfSStephen M. Cameron 	c->ErrDesc.Addr = cpu_to_le64(err_dma_handle);
4700*50a0decfSStephen M. Cameron 	c->ErrDesc.Len = cpu_to_le32(sizeof(*c->err_info));
4701edd16368SStephen M. Cameron 
4702edd16368SStephen M. Cameron 	c->h = h;
4703edd16368SStephen M. Cameron 	return c;
4704edd16368SStephen M. Cameron }
4705edd16368SStephen M. Cameron 
4706edd16368SStephen M. Cameron /* For operations that can wait for kmalloc to possibly sleep,
4707edd16368SStephen M. Cameron  * this routine can be called. Lock need not be held to call
4708edd16368SStephen M. Cameron  * cmd_special_alloc. cmd_special_free() is the complement.
4709edd16368SStephen M. Cameron  */
4710edd16368SStephen M. Cameron static struct CommandList *cmd_special_alloc(struct ctlr_info *h)
4711edd16368SStephen M. Cameron {
4712edd16368SStephen M. Cameron 	struct CommandList *c;
4713edd16368SStephen M. Cameron 	dma_addr_t cmd_dma_handle, err_dma_handle;
4714edd16368SStephen M. Cameron 
47157c845eb5SJoe Perches 	c = pci_zalloc_consistent(h->pdev, sizeof(*c), &cmd_dma_handle);
4716edd16368SStephen M. Cameron 	if (c == NULL)
4717edd16368SStephen M. Cameron 		return NULL;
4718edd16368SStephen M. Cameron 
4719e1f7de0cSMatt Gates 	c->cmd_type = CMD_SCSI;
4720edd16368SStephen M. Cameron 	c->cmdindex = -1;
4721edd16368SStephen M. Cameron 
47227c845eb5SJoe Perches 	c->err_info = pci_zalloc_consistent(h->pdev, sizeof(*c->err_info),
4723edd16368SStephen M. Cameron 					    &err_dma_handle);
4724edd16368SStephen M. Cameron 
4725edd16368SStephen M. Cameron 	if (c->err_info == NULL) {
4726edd16368SStephen M. Cameron 		pci_free_consistent(h->pdev,
4727edd16368SStephen M. Cameron 			sizeof(*c), c, cmd_dma_handle);
4728edd16368SStephen M. Cameron 		return NULL;
4729edd16368SStephen M. Cameron 	}
4730edd16368SStephen M. Cameron 
47319e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&c->list);
473201a02ffcSStephen M. Cameron 	c->busaddr = (u32) cmd_dma_handle;
4733*50a0decfSStephen M. Cameron 	c->ErrDesc.Addr = cpu_to_le64(err_dma_handle);
4734*50a0decfSStephen M. Cameron 	c->ErrDesc.Len = cpu_to_le32(sizeof(*c->err_info));
4735edd16368SStephen M. Cameron 
4736edd16368SStephen M. Cameron 	c->h = h;
4737edd16368SStephen M. Cameron 	return c;
4738edd16368SStephen M. Cameron }
4739edd16368SStephen M. Cameron 
4740edd16368SStephen M. Cameron static void cmd_free(struct ctlr_info *h, struct CommandList *c)
4741edd16368SStephen M. Cameron {
4742edd16368SStephen M. Cameron 	int i;
4743e16a33adSMatt Gates 	unsigned long flags;
4744edd16368SStephen M. Cameron 
4745edd16368SStephen M. Cameron 	i = c - h->cmd_pool;
4746e16a33adSMatt Gates 	spin_lock_irqsave(&h->lock, flags);
4747edd16368SStephen M. Cameron 	clear_bit(i & (BITS_PER_LONG - 1),
4748edd16368SStephen M. Cameron 		  h->cmd_pool_bits + (i / BITS_PER_LONG));
4749e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
4750edd16368SStephen M. Cameron }
4751edd16368SStephen M. Cameron 
4752edd16368SStephen M. Cameron static void cmd_special_free(struct ctlr_info *h, struct CommandList *c)
4753edd16368SStephen M. Cameron {
4754edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev, sizeof(*c->err_info),
4755*50a0decfSStephen M. Cameron 			    c->err_info,
4756*50a0decfSStephen M. Cameron 			    (dma_addr_t) le64_to_cpu(c->ErrDesc.Addr));
4757edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev, sizeof(*c),
4758d896f3f3SStephen M. Cameron 			    c, (dma_addr_t) (c->busaddr & DIRECT_LOOKUP_MASK));
4759edd16368SStephen M. Cameron }
4760edd16368SStephen M. Cameron 
4761edd16368SStephen M. Cameron #ifdef CONFIG_COMPAT
4762edd16368SStephen M. Cameron 
476342a91641SDon Brace static int hpsa_ioctl32_passthru(struct scsi_device *dev, int cmd,
476442a91641SDon Brace 	void __user *arg)
4765edd16368SStephen M. Cameron {
4766edd16368SStephen M. Cameron 	IOCTL32_Command_struct __user *arg32 =
4767edd16368SStephen M. Cameron 	    (IOCTL32_Command_struct __user *) arg;
4768edd16368SStephen M. Cameron 	IOCTL_Command_struct arg64;
4769edd16368SStephen M. Cameron 	IOCTL_Command_struct __user *p = compat_alloc_user_space(sizeof(arg64));
4770edd16368SStephen M. Cameron 	int err;
4771edd16368SStephen M. Cameron 	u32 cp;
4772edd16368SStephen M. Cameron 
4773938abd84SVasiliy Kulikov 	memset(&arg64, 0, sizeof(arg64));
4774edd16368SStephen M. Cameron 	err = 0;
4775edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.LUN_info, &arg32->LUN_info,
4776edd16368SStephen M. Cameron 			   sizeof(arg64.LUN_info));
4777edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.Request, &arg32->Request,
4778edd16368SStephen M. Cameron 			   sizeof(arg64.Request));
4779edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.error_info, &arg32->error_info,
4780edd16368SStephen M. Cameron 			   sizeof(arg64.error_info));
4781edd16368SStephen M. Cameron 	err |= get_user(arg64.buf_size, &arg32->buf_size);
4782edd16368SStephen M. Cameron 	err |= get_user(cp, &arg32->buf);
4783edd16368SStephen M. Cameron 	arg64.buf = compat_ptr(cp);
4784edd16368SStephen M. Cameron 	err |= copy_to_user(p, &arg64, sizeof(arg64));
4785edd16368SStephen M. Cameron 
4786edd16368SStephen M. Cameron 	if (err)
4787edd16368SStephen M. Cameron 		return -EFAULT;
4788edd16368SStephen M. Cameron 
478942a91641SDon Brace 	err = hpsa_ioctl(dev, CCISS_PASSTHRU, p);
4790edd16368SStephen M. Cameron 	if (err)
4791edd16368SStephen M. Cameron 		return err;
4792edd16368SStephen M. Cameron 	err |= copy_in_user(&arg32->error_info, &p->error_info,
4793edd16368SStephen M. Cameron 			 sizeof(arg32->error_info));
4794edd16368SStephen M. Cameron 	if (err)
4795edd16368SStephen M. Cameron 		return -EFAULT;
4796edd16368SStephen M. Cameron 	return err;
4797edd16368SStephen M. Cameron }
4798edd16368SStephen M. Cameron 
4799edd16368SStephen M. Cameron static int hpsa_ioctl32_big_passthru(struct scsi_device *dev,
480042a91641SDon Brace 	int cmd, void __user *arg)
4801edd16368SStephen M. Cameron {
4802edd16368SStephen M. Cameron 	BIG_IOCTL32_Command_struct __user *arg32 =
4803edd16368SStephen M. Cameron 	    (BIG_IOCTL32_Command_struct __user *) arg;
4804edd16368SStephen M. Cameron 	BIG_IOCTL_Command_struct arg64;
4805edd16368SStephen M. Cameron 	BIG_IOCTL_Command_struct __user *p =
4806edd16368SStephen M. Cameron 	    compat_alloc_user_space(sizeof(arg64));
4807edd16368SStephen M. Cameron 	int err;
4808edd16368SStephen M. Cameron 	u32 cp;
4809edd16368SStephen M. Cameron 
4810938abd84SVasiliy Kulikov 	memset(&arg64, 0, sizeof(arg64));
4811edd16368SStephen M. Cameron 	err = 0;
4812edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.LUN_info, &arg32->LUN_info,
4813edd16368SStephen M. Cameron 			   sizeof(arg64.LUN_info));
4814edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.Request, &arg32->Request,
4815edd16368SStephen M. Cameron 			   sizeof(arg64.Request));
4816edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.error_info, &arg32->error_info,
4817edd16368SStephen M. Cameron 			   sizeof(arg64.error_info));
4818edd16368SStephen M. Cameron 	err |= get_user(arg64.buf_size, &arg32->buf_size);
4819edd16368SStephen M. Cameron 	err |= get_user(arg64.malloc_size, &arg32->malloc_size);
4820edd16368SStephen M. Cameron 	err |= get_user(cp, &arg32->buf);
4821edd16368SStephen M. Cameron 	arg64.buf = compat_ptr(cp);
4822edd16368SStephen M. Cameron 	err |= copy_to_user(p, &arg64, sizeof(arg64));
4823edd16368SStephen M. Cameron 
4824edd16368SStephen M. Cameron 	if (err)
4825edd16368SStephen M. Cameron 		return -EFAULT;
4826edd16368SStephen M. Cameron 
482742a91641SDon Brace 	err = hpsa_ioctl(dev, CCISS_BIG_PASSTHRU, p);
4828edd16368SStephen M. Cameron 	if (err)
4829edd16368SStephen M. Cameron 		return err;
4830edd16368SStephen M. Cameron 	err |= copy_in_user(&arg32->error_info, &p->error_info,
4831edd16368SStephen M. Cameron 			 sizeof(arg32->error_info));
4832edd16368SStephen M. Cameron 	if (err)
4833edd16368SStephen M. Cameron 		return -EFAULT;
4834edd16368SStephen M. Cameron 	return err;
4835edd16368SStephen M. Cameron }
483671fe75a7SStephen M. Cameron 
483742a91641SDon Brace static int hpsa_compat_ioctl(struct scsi_device *dev, int cmd, void __user *arg)
483871fe75a7SStephen M. Cameron {
483971fe75a7SStephen M. Cameron 	switch (cmd) {
484071fe75a7SStephen M. Cameron 	case CCISS_GETPCIINFO:
484171fe75a7SStephen M. Cameron 	case CCISS_GETINTINFO:
484271fe75a7SStephen M. Cameron 	case CCISS_SETINTINFO:
484371fe75a7SStephen M. Cameron 	case CCISS_GETNODENAME:
484471fe75a7SStephen M. Cameron 	case CCISS_SETNODENAME:
484571fe75a7SStephen M. Cameron 	case CCISS_GETHEARTBEAT:
484671fe75a7SStephen M. Cameron 	case CCISS_GETBUSTYPES:
484771fe75a7SStephen M. Cameron 	case CCISS_GETFIRMVER:
484871fe75a7SStephen M. Cameron 	case CCISS_GETDRIVVER:
484971fe75a7SStephen M. Cameron 	case CCISS_REVALIDVOLS:
485071fe75a7SStephen M. Cameron 	case CCISS_DEREGDISK:
485171fe75a7SStephen M. Cameron 	case CCISS_REGNEWDISK:
485271fe75a7SStephen M. Cameron 	case CCISS_REGNEWD:
485371fe75a7SStephen M. Cameron 	case CCISS_RESCANDISK:
485471fe75a7SStephen M. Cameron 	case CCISS_GETLUNINFO:
485571fe75a7SStephen M. Cameron 		return hpsa_ioctl(dev, cmd, arg);
485671fe75a7SStephen M. Cameron 
485771fe75a7SStephen M. Cameron 	case CCISS_PASSTHRU32:
485871fe75a7SStephen M. Cameron 		return hpsa_ioctl32_passthru(dev, cmd, arg);
485971fe75a7SStephen M. Cameron 	case CCISS_BIG_PASSTHRU32:
486071fe75a7SStephen M. Cameron 		return hpsa_ioctl32_big_passthru(dev, cmd, arg);
486171fe75a7SStephen M. Cameron 
486271fe75a7SStephen M. Cameron 	default:
486371fe75a7SStephen M. Cameron 		return -ENOIOCTLCMD;
486471fe75a7SStephen M. Cameron 	}
486571fe75a7SStephen M. Cameron }
4866edd16368SStephen M. Cameron #endif
4867edd16368SStephen M. Cameron 
4868edd16368SStephen M. Cameron static int hpsa_getpciinfo_ioctl(struct ctlr_info *h, void __user *argp)
4869edd16368SStephen M. Cameron {
4870edd16368SStephen M. Cameron 	struct hpsa_pci_info pciinfo;
4871edd16368SStephen M. Cameron 
4872edd16368SStephen M. Cameron 	if (!argp)
4873edd16368SStephen M. Cameron 		return -EINVAL;
4874edd16368SStephen M. Cameron 	pciinfo.domain = pci_domain_nr(h->pdev->bus);
4875edd16368SStephen M. Cameron 	pciinfo.bus = h->pdev->bus->number;
4876edd16368SStephen M. Cameron 	pciinfo.dev_fn = h->pdev->devfn;
4877edd16368SStephen M. Cameron 	pciinfo.board_id = h->board_id;
4878edd16368SStephen M. Cameron 	if (copy_to_user(argp, &pciinfo, sizeof(pciinfo)))
4879edd16368SStephen M. Cameron 		return -EFAULT;
4880edd16368SStephen M. Cameron 	return 0;
4881edd16368SStephen M. Cameron }
4882edd16368SStephen M. Cameron 
4883edd16368SStephen M. Cameron static int hpsa_getdrivver_ioctl(struct ctlr_info *h, void __user *argp)
4884edd16368SStephen M. Cameron {
4885edd16368SStephen M. Cameron 	DriverVer_type DriverVer;
4886edd16368SStephen M. Cameron 	unsigned char vmaj, vmin, vsubmin;
4887edd16368SStephen M. Cameron 	int rc;
4888edd16368SStephen M. Cameron 
4889edd16368SStephen M. Cameron 	rc = sscanf(HPSA_DRIVER_VERSION, "%hhu.%hhu.%hhu",
4890edd16368SStephen M. Cameron 		&vmaj, &vmin, &vsubmin);
4891edd16368SStephen M. Cameron 	if (rc != 3) {
4892edd16368SStephen M. Cameron 		dev_info(&h->pdev->dev, "driver version string '%s' "
4893edd16368SStephen M. Cameron 			"unrecognized.", HPSA_DRIVER_VERSION);
4894edd16368SStephen M. Cameron 		vmaj = 0;
4895edd16368SStephen M. Cameron 		vmin = 0;
4896edd16368SStephen M. Cameron 		vsubmin = 0;
4897edd16368SStephen M. Cameron 	}
4898edd16368SStephen M. Cameron 	DriverVer = (vmaj << 16) | (vmin << 8) | vsubmin;
4899edd16368SStephen M. Cameron 	if (!argp)
4900edd16368SStephen M. Cameron 		return -EINVAL;
4901edd16368SStephen M. Cameron 	if (copy_to_user(argp, &DriverVer, sizeof(DriverVer_type)))
4902edd16368SStephen M. Cameron 		return -EFAULT;
4903edd16368SStephen M. Cameron 	return 0;
4904edd16368SStephen M. Cameron }
4905edd16368SStephen M. Cameron 
4906edd16368SStephen M. Cameron static int hpsa_passthru_ioctl(struct ctlr_info *h, void __user *argp)
4907edd16368SStephen M. Cameron {
4908edd16368SStephen M. Cameron 	IOCTL_Command_struct iocommand;
4909edd16368SStephen M. Cameron 	struct CommandList *c;
4910edd16368SStephen M. Cameron 	char *buff = NULL;
4911*50a0decfSStephen M. Cameron 	u64 temp64;
4912c1f63c8fSStephen M. Cameron 	int rc = 0;
4913edd16368SStephen M. Cameron 
4914edd16368SStephen M. Cameron 	if (!argp)
4915edd16368SStephen M. Cameron 		return -EINVAL;
4916edd16368SStephen M. Cameron 	if (!capable(CAP_SYS_RAWIO))
4917edd16368SStephen M. Cameron 		return -EPERM;
4918edd16368SStephen M. Cameron 	if (copy_from_user(&iocommand, argp, sizeof(iocommand)))
4919edd16368SStephen M. Cameron 		return -EFAULT;
4920edd16368SStephen M. Cameron 	if ((iocommand.buf_size < 1) &&
4921edd16368SStephen M. Cameron 	    (iocommand.Request.Type.Direction != XFER_NONE)) {
4922edd16368SStephen M. Cameron 		return -EINVAL;
4923edd16368SStephen M. Cameron 	}
4924edd16368SStephen M. Cameron 	if (iocommand.buf_size > 0) {
4925edd16368SStephen M. Cameron 		buff = kmalloc(iocommand.buf_size, GFP_KERNEL);
4926edd16368SStephen M. Cameron 		if (buff == NULL)
4927edd16368SStephen M. Cameron 			return -EFAULT;
49289233fb10SStephen M. Cameron 		if (iocommand.Request.Type.Direction & XFER_WRITE) {
4929edd16368SStephen M. Cameron 			/* Copy the data into the buffer we created */
4930b03a7771SStephen M. Cameron 			if (copy_from_user(buff, iocommand.buf,
4931b03a7771SStephen M. Cameron 				iocommand.buf_size)) {
4932c1f63c8fSStephen M. Cameron 				rc = -EFAULT;
4933c1f63c8fSStephen M. Cameron 				goto out_kfree;
4934edd16368SStephen M. Cameron 			}
4935b03a7771SStephen M. Cameron 		} else {
4936edd16368SStephen M. Cameron 			memset(buff, 0, iocommand.buf_size);
4937b03a7771SStephen M. Cameron 		}
4938b03a7771SStephen M. Cameron 	}
4939edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
4940edd16368SStephen M. Cameron 	if (c == NULL) {
4941c1f63c8fSStephen M. Cameron 		rc = -ENOMEM;
4942c1f63c8fSStephen M. Cameron 		goto out_kfree;
4943edd16368SStephen M. Cameron 	}
4944edd16368SStephen M. Cameron 	/* Fill in the command type */
4945edd16368SStephen M. Cameron 	c->cmd_type = CMD_IOCTL_PEND;
4946edd16368SStephen M. Cameron 	/* Fill in Command Header */
4947edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0; /* unused in simple mode */
4948edd16368SStephen M. Cameron 	if (iocommand.buf_size > 0) {	/* buffer to fill */
4949edd16368SStephen M. Cameron 		c->Header.SGList = 1;
4950*50a0decfSStephen M. Cameron 		c->Header.SGTotal = cpu_to_le16(1);
4951edd16368SStephen M. Cameron 	} else	{ /* no buffers to fill */
4952edd16368SStephen M. Cameron 		c->Header.SGList = 0;
4953*50a0decfSStephen M. Cameron 		c->Header.SGTotal = cpu_to_le16(0);
4954edd16368SStephen M. Cameron 	}
4955edd16368SStephen M. Cameron 	memcpy(&c->Header.LUN, &iocommand.LUN_info, sizeof(c->Header.LUN));
4956edd16368SStephen M. Cameron 	/* use the kernel address the cmd block for tag */
4957*50a0decfSStephen M. Cameron 	c->Header.tag = c->busaddr;
4958edd16368SStephen M. Cameron 
4959edd16368SStephen M. Cameron 	/* Fill in Request block */
4960edd16368SStephen M. Cameron 	memcpy(&c->Request, &iocommand.Request,
4961edd16368SStephen M. Cameron 		sizeof(c->Request));
4962edd16368SStephen M. Cameron 
4963edd16368SStephen M. Cameron 	/* Fill in the scatter gather information */
4964edd16368SStephen M. Cameron 	if (iocommand.buf_size > 0) {
4965*50a0decfSStephen M. Cameron 		temp64 = pci_map_single(h->pdev, buff,
4966edd16368SStephen M. Cameron 			iocommand.buf_size, PCI_DMA_BIDIRECTIONAL);
4967*50a0decfSStephen M. Cameron 		if (dma_mapping_error(&h->pdev->dev, (dma_addr_t) temp64)) {
4968*50a0decfSStephen M. Cameron 			c->SG[0].Addr = cpu_to_le64(0);
4969*50a0decfSStephen M. Cameron 			c->SG[0].Len = cpu_to_le32(0);
4970bcc48ffaSStephen M. Cameron 			rc = -ENOMEM;
4971bcc48ffaSStephen M. Cameron 			goto out;
4972bcc48ffaSStephen M. Cameron 		}
4973*50a0decfSStephen M. Cameron 		c->SG[0].Addr = cpu_to_le64(temp64);
4974*50a0decfSStephen M. Cameron 		c->SG[0].Len = cpu_to_le32(iocommand.buf_size);
4975*50a0decfSStephen M. Cameron 		c->SG[0].Ext = cpu_to_le32(HPSA_SG_LAST); /* not chaining */
4976edd16368SStephen M. Cameron 	}
4977a0c12413SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core_if_no_lockup(h, c);
4978c2dd32e0SStephen M. Cameron 	if (iocommand.buf_size > 0)
4979edd16368SStephen M. Cameron 		hpsa_pci_unmap(h->pdev, c, 1, PCI_DMA_BIDIRECTIONAL);
4980edd16368SStephen M. Cameron 	check_ioctl_unit_attention(h, c);
4981edd16368SStephen M. Cameron 
4982edd16368SStephen M. Cameron 	/* Copy the error information out */
4983edd16368SStephen M. Cameron 	memcpy(&iocommand.error_info, c->err_info,
4984edd16368SStephen M. Cameron 		sizeof(iocommand.error_info));
4985edd16368SStephen M. Cameron 	if (copy_to_user(argp, &iocommand, sizeof(iocommand))) {
4986c1f63c8fSStephen M. Cameron 		rc = -EFAULT;
4987c1f63c8fSStephen M. Cameron 		goto out;
4988edd16368SStephen M. Cameron 	}
49899233fb10SStephen M. Cameron 	if ((iocommand.Request.Type.Direction & XFER_READ) &&
4990b03a7771SStephen M. Cameron 		iocommand.buf_size > 0) {
4991edd16368SStephen M. Cameron 		/* Copy the data out of the buffer we created */
4992edd16368SStephen M. Cameron 		if (copy_to_user(iocommand.buf, buff, iocommand.buf_size)) {
4993c1f63c8fSStephen M. Cameron 			rc = -EFAULT;
4994c1f63c8fSStephen M. Cameron 			goto out;
4995edd16368SStephen M. Cameron 		}
4996edd16368SStephen M. Cameron 	}
4997c1f63c8fSStephen M. Cameron out:
4998edd16368SStephen M. Cameron 	cmd_special_free(h, c);
4999c1f63c8fSStephen M. Cameron out_kfree:
5000c1f63c8fSStephen M. Cameron 	kfree(buff);
5001c1f63c8fSStephen M. Cameron 	return rc;
5002edd16368SStephen M. Cameron }
5003edd16368SStephen M. Cameron 
5004edd16368SStephen M. Cameron static int hpsa_big_passthru_ioctl(struct ctlr_info *h, void __user *argp)
5005edd16368SStephen M. Cameron {
5006edd16368SStephen M. Cameron 	BIG_IOCTL_Command_struct *ioc;
5007edd16368SStephen M. Cameron 	struct CommandList *c;
5008edd16368SStephen M. Cameron 	unsigned char **buff = NULL;
5009edd16368SStephen M. Cameron 	int *buff_size = NULL;
5010*50a0decfSStephen M. Cameron 	u64 temp64;
5011edd16368SStephen M. Cameron 	BYTE sg_used = 0;
5012edd16368SStephen M. Cameron 	int status = 0;
5013edd16368SStephen M. Cameron 	int i;
501401a02ffcSStephen M. Cameron 	u32 left;
501501a02ffcSStephen M. Cameron 	u32 sz;
5016edd16368SStephen M. Cameron 	BYTE __user *data_ptr;
5017edd16368SStephen M. Cameron 
5018edd16368SStephen M. Cameron 	if (!argp)
5019edd16368SStephen M. Cameron 		return -EINVAL;
5020edd16368SStephen M. Cameron 	if (!capable(CAP_SYS_RAWIO))
5021edd16368SStephen M. Cameron 		return -EPERM;
5022edd16368SStephen M. Cameron 	ioc = (BIG_IOCTL_Command_struct *)
5023edd16368SStephen M. Cameron 	    kmalloc(sizeof(*ioc), GFP_KERNEL);
5024edd16368SStephen M. Cameron 	if (!ioc) {
5025edd16368SStephen M. Cameron 		status = -ENOMEM;
5026edd16368SStephen M. Cameron 		goto cleanup1;
5027edd16368SStephen M. Cameron 	}
5028edd16368SStephen M. Cameron 	if (copy_from_user(ioc, argp, sizeof(*ioc))) {
5029edd16368SStephen M. Cameron 		status = -EFAULT;
5030edd16368SStephen M. Cameron 		goto cleanup1;
5031edd16368SStephen M. Cameron 	}
5032edd16368SStephen M. Cameron 	if ((ioc->buf_size < 1) &&
5033edd16368SStephen M. Cameron 	    (ioc->Request.Type.Direction != XFER_NONE)) {
5034edd16368SStephen M. Cameron 		status = -EINVAL;
5035edd16368SStephen M. Cameron 		goto cleanup1;
5036edd16368SStephen M. Cameron 	}
5037edd16368SStephen M. Cameron 	/* Check kmalloc limits  using all SGs */
5038edd16368SStephen M. Cameron 	if (ioc->malloc_size > MAX_KMALLOC_SIZE) {
5039edd16368SStephen M. Cameron 		status = -EINVAL;
5040edd16368SStephen M. Cameron 		goto cleanup1;
5041edd16368SStephen M. Cameron 	}
5042d66ae08bSStephen M. Cameron 	if (ioc->buf_size > ioc->malloc_size * SG_ENTRIES_IN_CMD) {
5043edd16368SStephen M. Cameron 		status = -EINVAL;
5044edd16368SStephen M. Cameron 		goto cleanup1;
5045edd16368SStephen M. Cameron 	}
5046d66ae08bSStephen M. Cameron 	buff = kzalloc(SG_ENTRIES_IN_CMD * sizeof(char *), GFP_KERNEL);
5047edd16368SStephen M. Cameron 	if (!buff) {
5048edd16368SStephen M. Cameron 		status = -ENOMEM;
5049edd16368SStephen M. Cameron 		goto cleanup1;
5050edd16368SStephen M. Cameron 	}
5051d66ae08bSStephen M. Cameron 	buff_size = kmalloc(SG_ENTRIES_IN_CMD * sizeof(int), GFP_KERNEL);
5052edd16368SStephen M. Cameron 	if (!buff_size) {
5053edd16368SStephen M. Cameron 		status = -ENOMEM;
5054edd16368SStephen M. Cameron 		goto cleanup1;
5055edd16368SStephen M. Cameron 	}
5056edd16368SStephen M. Cameron 	left = ioc->buf_size;
5057edd16368SStephen M. Cameron 	data_ptr = ioc->buf;
5058edd16368SStephen M. Cameron 	while (left) {
5059edd16368SStephen M. Cameron 		sz = (left > ioc->malloc_size) ? ioc->malloc_size : left;
5060edd16368SStephen M. Cameron 		buff_size[sg_used] = sz;
5061edd16368SStephen M. Cameron 		buff[sg_used] = kmalloc(sz, GFP_KERNEL);
5062edd16368SStephen M. Cameron 		if (buff[sg_used] == NULL) {
5063edd16368SStephen M. Cameron 			status = -ENOMEM;
5064edd16368SStephen M. Cameron 			goto cleanup1;
5065edd16368SStephen M. Cameron 		}
50669233fb10SStephen M. Cameron 		if (ioc->Request.Type.Direction & XFER_WRITE) {
5067edd16368SStephen M. Cameron 			if (copy_from_user(buff[sg_used], data_ptr, sz)) {
50680758f4f7SStephen M. Cameron 				status = -EFAULT;
5069edd16368SStephen M. Cameron 				goto cleanup1;
5070edd16368SStephen M. Cameron 			}
5071edd16368SStephen M. Cameron 		} else
5072edd16368SStephen M. Cameron 			memset(buff[sg_used], 0, sz);
5073edd16368SStephen M. Cameron 		left -= sz;
5074edd16368SStephen M. Cameron 		data_ptr += sz;
5075edd16368SStephen M. Cameron 		sg_used++;
5076edd16368SStephen M. Cameron 	}
5077edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
5078edd16368SStephen M. Cameron 	if (c == NULL) {
5079edd16368SStephen M. Cameron 		status = -ENOMEM;
5080edd16368SStephen M. Cameron 		goto cleanup1;
5081edd16368SStephen M. Cameron 	}
5082edd16368SStephen M. Cameron 	c->cmd_type = CMD_IOCTL_PEND;
5083edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0;
5084*50a0decfSStephen M. Cameron 	c->Header.SGList = (u8) sg_used;
5085*50a0decfSStephen M. Cameron 	c->Header.SGTotal = cpu_to_le16(sg_used);
5086edd16368SStephen M. Cameron 	memcpy(&c->Header.LUN, &ioc->LUN_info, sizeof(c->Header.LUN));
5087*50a0decfSStephen M. Cameron 	c->Header.tag = c->busaddr;
5088edd16368SStephen M. Cameron 	memcpy(&c->Request, &ioc->Request, sizeof(c->Request));
5089edd16368SStephen M. Cameron 	if (ioc->buf_size > 0) {
5090edd16368SStephen M. Cameron 		int i;
5091edd16368SStephen M. Cameron 		for (i = 0; i < sg_used; i++) {
5092*50a0decfSStephen M. Cameron 			temp64 = pci_map_single(h->pdev, buff[i],
5093edd16368SStephen M. Cameron 				    buff_size[i], PCI_DMA_BIDIRECTIONAL);
5094*50a0decfSStephen M. Cameron 			if (dma_mapping_error(&h->pdev->dev,
5095*50a0decfSStephen M. Cameron 							(dma_addr_t) temp64)) {
5096*50a0decfSStephen M. Cameron 				c->SG[i].Addr = cpu_to_le64(0);
5097*50a0decfSStephen M. Cameron 				c->SG[i].Len = cpu_to_le32(0);
5098bcc48ffaSStephen M. Cameron 				hpsa_pci_unmap(h->pdev, c, i,
5099bcc48ffaSStephen M. Cameron 					PCI_DMA_BIDIRECTIONAL);
5100bcc48ffaSStephen M. Cameron 				status = -ENOMEM;
5101e2d4a1f6SStephen M. Cameron 				goto cleanup0;
5102bcc48ffaSStephen M. Cameron 			}
5103*50a0decfSStephen M. Cameron 			c->SG[i].Addr = cpu_to_le64(temp64);
5104*50a0decfSStephen M. Cameron 			c->SG[i].Len = cpu_to_le32(buff_size[i]);
5105*50a0decfSStephen M. Cameron 			c->SG[i].Ext = cpu_to_le32(0);
5106edd16368SStephen M. Cameron 		}
5107*50a0decfSStephen M. Cameron 		c->SG[--i].Ext = cpu_to_le32(HPSA_SG_LAST);
5108edd16368SStephen M. Cameron 	}
5109a0c12413SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core_if_no_lockup(h, c);
5110b03a7771SStephen M. Cameron 	if (sg_used)
5111edd16368SStephen M. Cameron 		hpsa_pci_unmap(h->pdev, c, sg_used, PCI_DMA_BIDIRECTIONAL);
5112edd16368SStephen M. Cameron 	check_ioctl_unit_attention(h, c);
5113edd16368SStephen M. Cameron 	/* Copy the error information out */
5114edd16368SStephen M. Cameron 	memcpy(&ioc->error_info, c->err_info, sizeof(ioc->error_info));
5115edd16368SStephen M. Cameron 	if (copy_to_user(argp, ioc, sizeof(*ioc))) {
5116edd16368SStephen M. Cameron 		status = -EFAULT;
5117e2d4a1f6SStephen M. Cameron 		goto cleanup0;
5118edd16368SStephen M. Cameron 	}
51199233fb10SStephen M. Cameron 	if ((ioc->Request.Type.Direction & XFER_READ) && ioc->buf_size > 0) {
5120edd16368SStephen M. Cameron 		/* Copy the data out of the buffer we created */
5121edd16368SStephen M. Cameron 		BYTE __user *ptr = ioc->buf;
5122edd16368SStephen M. Cameron 		for (i = 0; i < sg_used; i++) {
5123edd16368SStephen M. Cameron 			if (copy_to_user(ptr, buff[i], buff_size[i])) {
5124edd16368SStephen M. Cameron 				status = -EFAULT;
5125e2d4a1f6SStephen M. Cameron 				goto cleanup0;
5126edd16368SStephen M. Cameron 			}
5127edd16368SStephen M. Cameron 			ptr += buff_size[i];
5128edd16368SStephen M. Cameron 		}
5129edd16368SStephen M. Cameron 	}
5130edd16368SStephen M. Cameron 	status = 0;
5131e2d4a1f6SStephen M. Cameron cleanup0:
5132e2d4a1f6SStephen M. Cameron 	cmd_special_free(h, c);
5133edd16368SStephen M. Cameron cleanup1:
5134edd16368SStephen M. Cameron 	if (buff) {
5135edd16368SStephen M. Cameron 		for (i = 0; i < sg_used; i++)
5136edd16368SStephen M. Cameron 			kfree(buff[i]);
5137edd16368SStephen M. Cameron 		kfree(buff);
5138edd16368SStephen M. Cameron 	}
5139edd16368SStephen M. Cameron 	kfree(buff_size);
5140edd16368SStephen M. Cameron 	kfree(ioc);
5141edd16368SStephen M. Cameron 	return status;
5142edd16368SStephen M. Cameron }
5143edd16368SStephen M. Cameron 
5144edd16368SStephen M. Cameron static void check_ioctl_unit_attention(struct ctlr_info *h,
5145edd16368SStephen M. Cameron 	struct CommandList *c)
5146edd16368SStephen M. Cameron {
5147edd16368SStephen M. Cameron 	if (c->err_info->CommandStatus == CMD_TARGET_STATUS &&
5148edd16368SStephen M. Cameron 			c->err_info->ScsiStatus != SAM_STAT_CHECK_CONDITION)
5149edd16368SStephen M. Cameron 		(void) check_for_unit_attention(h, c);
5150edd16368SStephen M. Cameron }
51510390f0c0SStephen M. Cameron 
51520390f0c0SStephen M. Cameron static int increment_passthru_count(struct ctlr_info *h)
51530390f0c0SStephen M. Cameron {
51540390f0c0SStephen M. Cameron 	unsigned long flags;
51550390f0c0SStephen M. Cameron 
51560390f0c0SStephen M. Cameron 	spin_lock_irqsave(&h->passthru_count_lock, flags);
51570390f0c0SStephen M. Cameron 	if (h->passthru_count >= HPSA_MAX_CONCURRENT_PASSTHRUS) {
51580390f0c0SStephen M. Cameron 		spin_unlock_irqrestore(&h->passthru_count_lock, flags);
51590390f0c0SStephen M. Cameron 		return -1;
51600390f0c0SStephen M. Cameron 	}
51610390f0c0SStephen M. Cameron 	h->passthru_count++;
51620390f0c0SStephen M. Cameron 	spin_unlock_irqrestore(&h->passthru_count_lock, flags);
51630390f0c0SStephen M. Cameron 	return 0;
51640390f0c0SStephen M. Cameron }
51650390f0c0SStephen M. Cameron 
51660390f0c0SStephen M. Cameron static void decrement_passthru_count(struct ctlr_info *h)
51670390f0c0SStephen M. Cameron {
51680390f0c0SStephen M. Cameron 	unsigned long flags;
51690390f0c0SStephen M. Cameron 
51700390f0c0SStephen M. Cameron 	spin_lock_irqsave(&h->passthru_count_lock, flags);
51710390f0c0SStephen M. Cameron 	if (h->passthru_count <= 0) {
51720390f0c0SStephen M. Cameron 		spin_unlock_irqrestore(&h->passthru_count_lock, flags);
51730390f0c0SStephen M. Cameron 		/* not expecting to get here. */
51740390f0c0SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Bug detected, passthru_count seems to be incorrect.\n");
51750390f0c0SStephen M. Cameron 		return;
51760390f0c0SStephen M. Cameron 	}
51770390f0c0SStephen M. Cameron 	h->passthru_count--;
51780390f0c0SStephen M. Cameron 	spin_unlock_irqrestore(&h->passthru_count_lock, flags);
51790390f0c0SStephen M. Cameron }
51800390f0c0SStephen M. Cameron 
5181edd16368SStephen M. Cameron /*
5182edd16368SStephen M. Cameron  * ioctl
5183edd16368SStephen M. Cameron  */
518442a91641SDon Brace static int hpsa_ioctl(struct scsi_device *dev, int cmd, void __user *arg)
5185edd16368SStephen M. Cameron {
5186edd16368SStephen M. Cameron 	struct ctlr_info *h;
5187edd16368SStephen M. Cameron 	void __user *argp = (void __user *)arg;
51880390f0c0SStephen M. Cameron 	int rc;
5189edd16368SStephen M. Cameron 
5190edd16368SStephen M. Cameron 	h = sdev_to_hba(dev);
5191edd16368SStephen M. Cameron 
5192edd16368SStephen M. Cameron 	switch (cmd) {
5193edd16368SStephen M. Cameron 	case CCISS_DEREGDISK:
5194edd16368SStephen M. Cameron 	case CCISS_REGNEWDISK:
5195edd16368SStephen M. Cameron 	case CCISS_REGNEWD:
5196a08a8471SStephen M. Cameron 		hpsa_scan_start(h->scsi_host);
5197edd16368SStephen M. Cameron 		return 0;
5198edd16368SStephen M. Cameron 	case CCISS_GETPCIINFO:
5199edd16368SStephen M. Cameron 		return hpsa_getpciinfo_ioctl(h, argp);
5200edd16368SStephen M. Cameron 	case CCISS_GETDRIVVER:
5201edd16368SStephen M. Cameron 		return hpsa_getdrivver_ioctl(h, argp);
5202edd16368SStephen M. Cameron 	case CCISS_PASSTHRU:
52030390f0c0SStephen M. Cameron 		if (increment_passthru_count(h))
52040390f0c0SStephen M. Cameron 			return -EAGAIN;
52050390f0c0SStephen M. Cameron 		rc = hpsa_passthru_ioctl(h, argp);
52060390f0c0SStephen M. Cameron 		decrement_passthru_count(h);
52070390f0c0SStephen M. Cameron 		return rc;
5208edd16368SStephen M. Cameron 	case CCISS_BIG_PASSTHRU:
52090390f0c0SStephen M. Cameron 		if (increment_passthru_count(h))
52100390f0c0SStephen M. Cameron 			return -EAGAIN;
52110390f0c0SStephen M. Cameron 		rc = hpsa_big_passthru_ioctl(h, argp);
52120390f0c0SStephen M. Cameron 		decrement_passthru_count(h);
52130390f0c0SStephen M. Cameron 		return rc;
5214edd16368SStephen M. Cameron 	default:
5215edd16368SStephen M. Cameron 		return -ENOTTY;
5216edd16368SStephen M. Cameron 	}
5217edd16368SStephen M. Cameron }
5218edd16368SStephen M. Cameron 
52196f039790SGreg Kroah-Hartman static int hpsa_send_host_reset(struct ctlr_info *h, unsigned char *scsi3addr,
52206f039790SGreg Kroah-Hartman 				u8 reset_type)
522164670ac8SStephen M. Cameron {
522264670ac8SStephen M. Cameron 	struct CommandList *c;
522364670ac8SStephen M. Cameron 
522464670ac8SStephen M. Cameron 	c = cmd_alloc(h);
522564670ac8SStephen M. Cameron 	if (!c)
522664670ac8SStephen M. Cameron 		return -ENOMEM;
5227a2dac136SStephen M. Cameron 	/* fill_cmd can't fail here, no data buffer to map */
5228a2dac136SStephen M. Cameron 	(void) fill_cmd(c, HPSA_DEVICE_RESET_MSG, h, NULL, 0, 0,
522964670ac8SStephen M. Cameron 		RAID_CTLR_LUNID, TYPE_MSG);
523064670ac8SStephen M. Cameron 	c->Request.CDB[1] = reset_type; /* fill_cmd defaults to target reset */
523164670ac8SStephen M. Cameron 	c->waiting = NULL;
523264670ac8SStephen M. Cameron 	enqueue_cmd_and_start_io(h, c);
523364670ac8SStephen M. Cameron 	/* Don't wait for completion, the reset won't complete.  Don't free
523464670ac8SStephen M. Cameron 	 * the command either.  This is the last command we will send before
523564670ac8SStephen M. Cameron 	 * re-initializing everything, so it doesn't matter and won't leak.
523664670ac8SStephen M. Cameron 	 */
523764670ac8SStephen M. Cameron 	return 0;
523864670ac8SStephen M. Cameron }
523964670ac8SStephen M. Cameron 
5240a2dac136SStephen M. Cameron static int fill_cmd(struct CommandList *c, u8 cmd, struct ctlr_info *h,
5241b7bb24ebSStephen M. Cameron 	void *buff, size_t size, u16 page_code, unsigned char *scsi3addr,
5242edd16368SStephen M. Cameron 	int cmd_type)
5243edd16368SStephen M. Cameron {
5244edd16368SStephen M. Cameron 	int pci_dir = XFER_NONE;
524575167d2cSStephen M. Cameron 	struct CommandList *a; /* for commands to be aborted */
5246*50a0decfSStephen M. Cameron 	u32 tupper, tlower;
5247edd16368SStephen M. Cameron 
5248edd16368SStephen M. Cameron 	c->cmd_type = CMD_IOCTL_PEND;
5249edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0;
5250edd16368SStephen M. Cameron 	if (buff != NULL && size > 0) {
5251edd16368SStephen M. Cameron 		c->Header.SGList = 1;
5252*50a0decfSStephen M. Cameron 		c->Header.SGTotal = cpu_to_le16(1);
5253edd16368SStephen M. Cameron 	} else {
5254edd16368SStephen M. Cameron 		c->Header.SGList = 0;
5255*50a0decfSStephen M. Cameron 		c->Header.SGTotal = cpu_to_le16(0);
5256edd16368SStephen M. Cameron 	}
5257*50a0decfSStephen M. Cameron 	c->Header.tag = c->busaddr;
5258edd16368SStephen M. Cameron 	memcpy(c->Header.LUN.LunAddrBytes, scsi3addr, 8);
5259edd16368SStephen M. Cameron 
5260edd16368SStephen M. Cameron 	c->Request.Type.Type = cmd_type;
5261edd16368SStephen M. Cameron 	if (cmd_type == TYPE_CMD) {
5262edd16368SStephen M. Cameron 		switch (cmd) {
5263edd16368SStephen M. Cameron 		case HPSA_INQUIRY:
5264edd16368SStephen M. Cameron 			/* are we trying to read a vital product page */
5265b7bb24ebSStephen M. Cameron 			if (page_code & VPD_PAGE) {
5266edd16368SStephen M. Cameron 				c->Request.CDB[1] = 0x01;
5267b7bb24ebSStephen M. Cameron 				c->Request.CDB[2] = (page_code & 0xff);
5268edd16368SStephen M. Cameron 			}
5269edd16368SStephen M. Cameron 			c->Request.CDBLen = 6;
5270edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
5271edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_READ;
5272edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
5273edd16368SStephen M. Cameron 			c->Request.CDB[0] = HPSA_INQUIRY;
5274edd16368SStephen M. Cameron 			c->Request.CDB[4] = size & 0xFF;
5275edd16368SStephen M. Cameron 			break;
5276edd16368SStephen M. Cameron 		case HPSA_REPORT_LOG:
5277edd16368SStephen M. Cameron 		case HPSA_REPORT_PHYS:
5278edd16368SStephen M. Cameron 			/* Talking to controller so It's a physical command
5279edd16368SStephen M. Cameron 			   mode = 00 target = 0.  Nothing to write.
5280edd16368SStephen M. Cameron 			 */
5281edd16368SStephen M. Cameron 			c->Request.CDBLen = 12;
5282edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
5283edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_READ;
5284edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
5285edd16368SStephen M. Cameron 			c->Request.CDB[0] = cmd;
5286edd16368SStephen M. Cameron 			c->Request.CDB[6] = (size >> 24) & 0xFF; /* MSB */
5287edd16368SStephen M. Cameron 			c->Request.CDB[7] = (size >> 16) & 0xFF;
5288edd16368SStephen M. Cameron 			c->Request.CDB[8] = (size >> 8) & 0xFF;
5289edd16368SStephen M. Cameron 			c->Request.CDB[9] = size & 0xFF;
5290edd16368SStephen M. Cameron 			break;
5291edd16368SStephen M. Cameron 		case HPSA_CACHE_FLUSH:
5292edd16368SStephen M. Cameron 			c->Request.CDBLen = 12;
5293edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
5294edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_WRITE;
5295edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
5296edd16368SStephen M. Cameron 			c->Request.CDB[0] = BMIC_WRITE;
5297edd16368SStephen M. Cameron 			c->Request.CDB[6] = BMIC_CACHE_FLUSH;
5298bb158eabSStephen M. Cameron 			c->Request.CDB[7] = (size >> 8) & 0xFF;
5299bb158eabSStephen M. Cameron 			c->Request.CDB[8] = size & 0xFF;
5300edd16368SStephen M. Cameron 			break;
5301edd16368SStephen M. Cameron 		case TEST_UNIT_READY:
5302edd16368SStephen M. Cameron 			c->Request.CDBLen = 6;
5303edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
5304edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_NONE;
5305edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
5306edd16368SStephen M. Cameron 			break;
5307283b4a9bSStephen M. Cameron 		case HPSA_GET_RAID_MAP:
5308283b4a9bSStephen M. Cameron 			c->Request.CDBLen = 12;
5309283b4a9bSStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
5310283b4a9bSStephen M. Cameron 			c->Request.Type.Direction = XFER_READ;
5311283b4a9bSStephen M. Cameron 			c->Request.Timeout = 0;
5312283b4a9bSStephen M. Cameron 			c->Request.CDB[0] = HPSA_CISS_READ;
5313283b4a9bSStephen M. Cameron 			c->Request.CDB[1] = cmd;
5314283b4a9bSStephen M. Cameron 			c->Request.CDB[6] = (size >> 24) & 0xFF; /* MSB */
5315283b4a9bSStephen M. Cameron 			c->Request.CDB[7] = (size >> 16) & 0xFF;
5316283b4a9bSStephen M. Cameron 			c->Request.CDB[8] = (size >> 8) & 0xFF;
5317283b4a9bSStephen M. Cameron 			c->Request.CDB[9] = size & 0xFF;
5318283b4a9bSStephen M. Cameron 			break;
5319316b221aSStephen M. Cameron 		case BMIC_SENSE_CONTROLLER_PARAMETERS:
5320316b221aSStephen M. Cameron 			c->Request.CDBLen = 10;
5321316b221aSStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
5322316b221aSStephen M. Cameron 			c->Request.Type.Direction = XFER_READ;
5323316b221aSStephen M. Cameron 			c->Request.Timeout = 0;
5324316b221aSStephen M. Cameron 			c->Request.CDB[0] = BMIC_READ;
5325316b221aSStephen M. Cameron 			c->Request.CDB[6] = BMIC_SENSE_CONTROLLER_PARAMETERS;
5326316b221aSStephen M. Cameron 			c->Request.CDB[7] = (size >> 16) & 0xFF;
5327316b221aSStephen M. Cameron 			c->Request.CDB[8] = (size >> 8) & 0xFF;
5328316b221aSStephen M. Cameron 			break;
5329edd16368SStephen M. Cameron 		default:
5330edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "unknown command 0x%c\n", cmd);
5331edd16368SStephen M. Cameron 			BUG();
5332a2dac136SStephen M. Cameron 			return -1;
5333edd16368SStephen M. Cameron 		}
5334edd16368SStephen M. Cameron 	} else if (cmd_type == TYPE_MSG) {
5335edd16368SStephen M. Cameron 		switch (cmd) {
5336edd16368SStephen M. Cameron 
5337edd16368SStephen M. Cameron 		case  HPSA_DEVICE_RESET_MSG:
5338edd16368SStephen M. Cameron 			c->Request.CDBLen = 16;
5339edd16368SStephen M. Cameron 			c->Request.Type.Type =  1; /* It is a MSG not a CMD */
5340edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
5341edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_NONE;
5342edd16368SStephen M. Cameron 			c->Request.Timeout = 0; /* Don't time out */
534364670ac8SStephen M. Cameron 			memset(&c->Request.CDB[0], 0, sizeof(c->Request.CDB));
534464670ac8SStephen M. Cameron 			c->Request.CDB[0] =  cmd;
534521e89afdSStephen M. Cameron 			c->Request.CDB[1] = HPSA_RESET_TYPE_LUN;
5346edd16368SStephen M. Cameron 			/* If bytes 4-7 are zero, it means reset the */
5347edd16368SStephen M. Cameron 			/* LunID device */
5348edd16368SStephen M. Cameron 			c->Request.CDB[4] = 0x00;
5349edd16368SStephen M. Cameron 			c->Request.CDB[5] = 0x00;
5350edd16368SStephen M. Cameron 			c->Request.CDB[6] = 0x00;
5351edd16368SStephen M. Cameron 			c->Request.CDB[7] = 0x00;
5352edd16368SStephen M. Cameron 			break;
535375167d2cSStephen M. Cameron 		case  HPSA_ABORT_MSG:
535475167d2cSStephen M. Cameron 			a = buff;       /* point to command to be aborted */
5355*50a0decfSStephen M. Cameron 			dev_dbg(&h->pdev->dev, "Abort Tag:0x%016llx using request Tag:0x%016llx",
5356*50a0decfSStephen M. Cameron 				a->Header.tag, c->Header.tag);
5357*50a0decfSStephen M. Cameron 			tlower = (u32) (a->Header.tag >> 32);
5358*50a0decfSStephen M. Cameron 			tupper = (u32) (a->Header.tag & 0x0ffffffffULL);
535975167d2cSStephen M. Cameron 			c->Request.CDBLen = 16;
536075167d2cSStephen M. Cameron 			c->Request.Type.Type = TYPE_MSG;
536175167d2cSStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
536275167d2cSStephen M. Cameron 			c->Request.Type.Direction = XFER_WRITE;
536375167d2cSStephen M. Cameron 			c->Request.Timeout = 0; /* Don't time out */
536475167d2cSStephen M. Cameron 			c->Request.CDB[0] = HPSA_TASK_MANAGEMENT;
536575167d2cSStephen M. Cameron 			c->Request.CDB[1] = HPSA_TMF_ABORT_TASK;
536675167d2cSStephen M. Cameron 			c->Request.CDB[2] = 0x00; /* reserved */
536775167d2cSStephen M. Cameron 			c->Request.CDB[3] = 0x00; /* reserved */
536875167d2cSStephen M. Cameron 			/* Tag to abort goes in CDB[4]-CDB[11] */
5369*50a0decfSStephen M. Cameron 			c->Request.CDB[4] = tlower & 0xFF;
5370*50a0decfSStephen M. Cameron 			c->Request.CDB[5] = (tlower >> 8) & 0xFF;
5371*50a0decfSStephen M. Cameron 			c->Request.CDB[6] = (tlower >> 16) & 0xFF;
5372*50a0decfSStephen M. Cameron 			c->Request.CDB[7] = (tlower >> 24) & 0xFF;
5373*50a0decfSStephen M. Cameron 			c->Request.CDB[8] = tupper & 0xFF;
5374*50a0decfSStephen M. Cameron 			c->Request.CDB[9] = (tupper >> 8) & 0xFF;
5375*50a0decfSStephen M. Cameron 			c->Request.CDB[10] = (tupper >> 16) & 0xFF;
5376*50a0decfSStephen M. Cameron 			c->Request.CDB[11] = (tupper >> 24) & 0xFF;
537775167d2cSStephen M. Cameron 			c->Request.CDB[12] = 0x00; /* reserved */
537875167d2cSStephen M. Cameron 			c->Request.CDB[13] = 0x00; /* reserved */
537975167d2cSStephen M. Cameron 			c->Request.CDB[14] = 0x00; /* reserved */
538075167d2cSStephen M. Cameron 			c->Request.CDB[15] = 0x00; /* reserved */
538175167d2cSStephen M. Cameron 		break;
5382edd16368SStephen M. Cameron 		default:
5383edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "unknown message type %d\n",
5384edd16368SStephen M. Cameron 				cmd);
5385edd16368SStephen M. Cameron 			BUG();
5386edd16368SStephen M. Cameron 		}
5387edd16368SStephen M. Cameron 	} else {
5388edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "unknown command type %d\n", cmd_type);
5389edd16368SStephen M. Cameron 		BUG();
5390edd16368SStephen M. Cameron 	}
5391edd16368SStephen M. Cameron 
5392edd16368SStephen M. Cameron 	switch (c->Request.Type.Direction) {
5393edd16368SStephen M. Cameron 	case XFER_READ:
5394edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_FROMDEVICE;
5395edd16368SStephen M. Cameron 		break;
5396edd16368SStephen M. Cameron 	case XFER_WRITE:
5397edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_TODEVICE;
5398edd16368SStephen M. Cameron 		break;
5399edd16368SStephen M. Cameron 	case XFER_NONE:
5400edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_NONE;
5401edd16368SStephen M. Cameron 		break;
5402edd16368SStephen M. Cameron 	default:
5403edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_BIDIRECTIONAL;
5404edd16368SStephen M. Cameron 	}
5405a2dac136SStephen M. Cameron 	if (hpsa_map_one(h->pdev, c, buff, size, pci_dir))
5406a2dac136SStephen M. Cameron 		return -1;
5407a2dac136SStephen M. Cameron 	return 0;
5408edd16368SStephen M. Cameron }
5409edd16368SStephen M. Cameron 
5410edd16368SStephen M. Cameron /*
5411edd16368SStephen M. Cameron  * Map (physical) PCI mem into (virtual) kernel space
5412edd16368SStephen M. Cameron  */
5413edd16368SStephen M. Cameron static void __iomem *remap_pci_mem(ulong base, ulong size)
5414edd16368SStephen M. Cameron {
5415edd16368SStephen M. Cameron 	ulong page_base = ((ulong) base) & PAGE_MASK;
5416edd16368SStephen M. Cameron 	ulong page_offs = ((ulong) base) - page_base;
5417088ba34cSStephen M. Cameron 	void __iomem *page_remapped = ioremap_nocache(page_base,
5418088ba34cSStephen M. Cameron 		page_offs + size);
5419edd16368SStephen M. Cameron 
5420edd16368SStephen M. Cameron 	return page_remapped ? (page_remapped + page_offs) : NULL;
5421edd16368SStephen M. Cameron }
5422edd16368SStephen M. Cameron 
5423edd16368SStephen M. Cameron /* Takes cmds off the submission queue and sends them to the hardware,
5424edd16368SStephen M. Cameron  * then puts them on the queue of cmds waiting for completion.
54250b57075dSStephen M. Cameron  * Assumes h->lock is held
5426edd16368SStephen M. Cameron  */
54270b57075dSStephen M. Cameron static void start_io(struct ctlr_info *h, unsigned long *flags)
5428edd16368SStephen M. Cameron {
5429edd16368SStephen M. Cameron 	struct CommandList *c;
5430edd16368SStephen M. Cameron 
54319e0fc764SStephen M. Cameron 	while (!list_empty(&h->reqQ)) {
54329e0fc764SStephen M. Cameron 		c = list_entry(h->reqQ.next, struct CommandList, list);
5433edd16368SStephen M. Cameron 		/* can't do anything if fifo is full */
5434edd16368SStephen M. Cameron 		if ((h->access.fifo_full(h))) {
5435396883e2SStephen M. Cameron 			h->fifo_recently_full = 1;
5436edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "fifo full\n");
5437edd16368SStephen M. Cameron 			break;
5438edd16368SStephen M. Cameron 		}
5439396883e2SStephen M. Cameron 		h->fifo_recently_full = 0;
5440edd16368SStephen M. Cameron 
5441edd16368SStephen M. Cameron 		/* Get the first entry from the Request Q */
5442edd16368SStephen M. Cameron 		removeQ(c);
5443edd16368SStephen M. Cameron 		h->Qdepth--;
5444edd16368SStephen M. Cameron 
5445edd16368SStephen M. Cameron 		/* Put job onto the completed Q */
5446edd16368SStephen M. Cameron 		addQ(&h->cmpQ, c);
5447e16a33adSMatt Gates 
5448e16a33adSMatt Gates 		/* Must increment commands_outstanding before unlocking
5449e16a33adSMatt Gates 		 * and submitting to avoid race checking for fifo full
5450e16a33adSMatt Gates 		 * condition.
5451e16a33adSMatt Gates 		 */
5452e16a33adSMatt Gates 		h->commands_outstanding++;
5453e16a33adSMatt Gates 
5454e16a33adSMatt Gates 		/* Tell the controller execute command */
54550b57075dSStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, *flags);
5456e16a33adSMatt Gates 		h->access.submit_command(h, c);
54570b57075dSStephen M. Cameron 		spin_lock_irqsave(&h->lock, *flags);
5458edd16368SStephen M. Cameron 	}
54590b57075dSStephen M. Cameron }
54600b57075dSStephen M. Cameron 
54610b57075dSStephen M. Cameron static void lock_and_start_io(struct ctlr_info *h)
54620b57075dSStephen M. Cameron {
54630b57075dSStephen M. Cameron 	unsigned long flags;
54640b57075dSStephen M. Cameron 
54650b57075dSStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
54660b57075dSStephen M. Cameron 	start_io(h, &flags);
5467e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
5468edd16368SStephen M. Cameron }
5469edd16368SStephen M. Cameron 
5470254f796bSMatt Gates static inline unsigned long get_next_completion(struct ctlr_info *h, u8 q)
5471edd16368SStephen M. Cameron {
5472254f796bSMatt Gates 	return h->access.command_completed(h, q);
5473edd16368SStephen M. Cameron }
5474edd16368SStephen M. Cameron 
5475900c5440SStephen M. Cameron static inline bool interrupt_pending(struct ctlr_info *h)
5476edd16368SStephen M. Cameron {
5477edd16368SStephen M. Cameron 	return h->access.intr_pending(h);
5478edd16368SStephen M. Cameron }
5479edd16368SStephen M. Cameron 
5480edd16368SStephen M. Cameron static inline long interrupt_not_for_us(struct ctlr_info *h)
5481edd16368SStephen M. Cameron {
548210f66018SStephen M. Cameron 	return (h->access.intr_pending(h) == 0) ||
548310f66018SStephen M. Cameron 		(h->interrupts_enabled == 0);
5484edd16368SStephen M. Cameron }
5485edd16368SStephen M. Cameron 
548601a02ffcSStephen M. Cameron static inline int bad_tag(struct ctlr_info *h, u32 tag_index,
548701a02ffcSStephen M. Cameron 	u32 raw_tag)
5488edd16368SStephen M. Cameron {
5489edd16368SStephen M. Cameron 	if (unlikely(tag_index >= h->nr_cmds)) {
5490edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "bad tag 0x%08x ignored.\n", raw_tag);
5491edd16368SStephen M. Cameron 		return 1;
5492edd16368SStephen M. Cameron 	}
5493edd16368SStephen M. Cameron 	return 0;
5494edd16368SStephen M. Cameron }
5495edd16368SStephen M. Cameron 
54965a3d16f5SStephen M. Cameron static inline void finish_cmd(struct CommandList *c)
5497edd16368SStephen M. Cameron {
5498e16a33adSMatt Gates 	unsigned long flags;
5499396883e2SStephen M. Cameron 	int io_may_be_stalled = 0;
5500396883e2SStephen M. Cameron 	struct ctlr_info *h = c->h;
5501e16a33adSMatt Gates 
5502396883e2SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
5503edd16368SStephen M. Cameron 	removeQ(c);
5504396883e2SStephen M. Cameron 
5505396883e2SStephen M. Cameron 	/*
5506396883e2SStephen M. Cameron 	 * Check for possibly stalled i/o.
5507396883e2SStephen M. Cameron 	 *
5508396883e2SStephen M. Cameron 	 * If a fifo_full condition is encountered, requests will back up
5509396883e2SStephen M. Cameron 	 * in h->reqQ.  This queue is only emptied out by start_io which is
5510396883e2SStephen M. Cameron 	 * only called when a new i/o request comes in.  If no i/o's are
5511396883e2SStephen M. Cameron 	 * forthcoming, the i/o's in h->reqQ can get stuck.  So we call
5512396883e2SStephen M. Cameron 	 * start_io from here if we detect such a danger.
5513396883e2SStephen M. Cameron 	 *
5514396883e2SStephen M. Cameron 	 * Normally, we shouldn't hit this case, but pounding on the
5515396883e2SStephen M. Cameron 	 * CCISS_PASSTHRU ioctl can provoke it.  Only call start_io if
5516396883e2SStephen M. Cameron 	 * commands_outstanding is low.  We want to avoid calling
5517396883e2SStephen M. Cameron 	 * start_io from in here as much as possible, and esp. don't
5518396883e2SStephen M. Cameron 	 * want to get in a cycle where we call start_io every time
5519396883e2SStephen M. Cameron 	 * through here.
5520396883e2SStephen M. Cameron 	 */
5521396883e2SStephen M. Cameron 	if (unlikely(h->fifo_recently_full) &&
5522396883e2SStephen M. Cameron 		h->commands_outstanding < 5)
5523396883e2SStephen M. Cameron 		io_may_be_stalled = 1;
5524396883e2SStephen M. Cameron 
5525396883e2SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
5526396883e2SStephen M. Cameron 
5527e85c5974SStephen M. Cameron 	dial_up_lockup_detection_on_fw_flash_complete(c->h, c);
5528c349775eSScott Teel 	if (likely(c->cmd_type == CMD_IOACCEL1 || c->cmd_type == CMD_SCSI
5529c349775eSScott Teel 			|| c->cmd_type == CMD_IOACCEL2))
55301fb011fbSStephen M. Cameron 		complete_scsi_command(c);
5531edd16368SStephen M. Cameron 	else if (c->cmd_type == CMD_IOCTL_PEND)
5532edd16368SStephen M. Cameron 		complete(c->waiting);
5533396883e2SStephen M. Cameron 	if (unlikely(io_may_be_stalled))
55340b57075dSStephen M. Cameron 		lock_and_start_io(h);
5535edd16368SStephen M. Cameron }
5536edd16368SStephen M. Cameron 
5537a104c99fSStephen M. Cameron static inline u32 hpsa_tag_contains_index(u32 tag)
5538a104c99fSStephen M. Cameron {
5539a104c99fSStephen M. Cameron 	return tag & DIRECT_LOOKUP_BIT;
5540a104c99fSStephen M. Cameron }
5541a104c99fSStephen M. Cameron 
5542a104c99fSStephen M. Cameron static inline u32 hpsa_tag_to_index(u32 tag)
5543a104c99fSStephen M. Cameron {
5544a104c99fSStephen M. Cameron 	return tag >> DIRECT_LOOKUP_SHIFT;
5545a104c99fSStephen M. Cameron }
5546a104c99fSStephen M. Cameron 
5547a9a3a273SStephen M. Cameron 
5548a9a3a273SStephen M. Cameron static inline u32 hpsa_tag_discard_error_bits(struct ctlr_info *h, u32 tag)
5549a104c99fSStephen M. Cameron {
5550a9a3a273SStephen M. Cameron #define HPSA_PERF_ERROR_BITS ((1 << DIRECT_LOOKUP_SHIFT) - 1)
5551a9a3a273SStephen M. Cameron #define HPSA_SIMPLE_ERROR_BITS 0x03
5552960a30e7SStephen M. Cameron 	if (unlikely(!(h->transMethod & CFGTBL_Trans_Performant)))
5553a9a3a273SStephen M. Cameron 		return tag & ~HPSA_SIMPLE_ERROR_BITS;
5554a9a3a273SStephen M. Cameron 	return tag & ~HPSA_PERF_ERROR_BITS;
5555a104c99fSStephen M. Cameron }
5556a104c99fSStephen M. Cameron 
5557303932fdSDon Brace /* process completion of an indexed ("direct lookup") command */
55581d94f94dSStephen M. Cameron static inline void process_indexed_cmd(struct ctlr_info *h,
5559303932fdSDon Brace 	u32 raw_tag)
5560303932fdSDon Brace {
5561303932fdSDon Brace 	u32 tag_index;
5562303932fdSDon Brace 	struct CommandList *c;
5563303932fdSDon Brace 
5564303932fdSDon Brace 	tag_index = hpsa_tag_to_index(raw_tag);
55651d94f94dSStephen M. Cameron 	if (!bad_tag(h, tag_index, raw_tag)) {
5566303932fdSDon Brace 		c = h->cmd_pool + tag_index;
55675a3d16f5SStephen M. Cameron 		finish_cmd(c);
55681d94f94dSStephen M. Cameron 	}
5569303932fdSDon Brace }
5570303932fdSDon Brace 
5571303932fdSDon Brace /* process completion of a non-indexed command */
55721d94f94dSStephen M. Cameron static inline void process_nonindexed_cmd(struct ctlr_info *h,
5573303932fdSDon Brace 	u32 raw_tag)
5574303932fdSDon Brace {
5575303932fdSDon Brace 	u32 tag;
5576303932fdSDon Brace 	struct CommandList *c = NULL;
5577e16a33adSMatt Gates 	unsigned long flags;
5578303932fdSDon Brace 
5579a9a3a273SStephen M. Cameron 	tag = hpsa_tag_discard_error_bits(h, raw_tag);
5580e16a33adSMatt Gates 	spin_lock_irqsave(&h->lock, flags);
55819e0fc764SStephen M. Cameron 	list_for_each_entry(c, &h->cmpQ, list) {
5582303932fdSDon Brace 		if ((c->busaddr & 0xFFFFFFE0) == (tag & 0xFFFFFFE0)) {
5583e16a33adSMatt Gates 			spin_unlock_irqrestore(&h->lock, flags);
55845a3d16f5SStephen M. Cameron 			finish_cmd(c);
55851d94f94dSStephen M. Cameron 			return;
5586303932fdSDon Brace 		}
5587303932fdSDon Brace 	}
5588e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
5589303932fdSDon Brace 	bad_tag(h, h->nr_cmds + 1, raw_tag);
5590303932fdSDon Brace }
5591303932fdSDon Brace 
559264670ac8SStephen M. Cameron /* Some controllers, like p400, will give us one interrupt
559364670ac8SStephen M. Cameron  * after a soft reset, even if we turned interrupts off.
559464670ac8SStephen M. Cameron  * Only need to check for this in the hpsa_xxx_discard_completions
559564670ac8SStephen M. Cameron  * functions.
559664670ac8SStephen M. Cameron  */
559764670ac8SStephen M. Cameron static int ignore_bogus_interrupt(struct ctlr_info *h)
559864670ac8SStephen M. Cameron {
559964670ac8SStephen M. Cameron 	if (likely(!reset_devices))
560064670ac8SStephen M. Cameron 		return 0;
560164670ac8SStephen M. Cameron 
560264670ac8SStephen M. Cameron 	if (likely(h->interrupts_enabled))
560364670ac8SStephen M. Cameron 		return 0;
560464670ac8SStephen M. Cameron 
560564670ac8SStephen M. Cameron 	dev_info(&h->pdev->dev, "Received interrupt while interrupts disabled "
560664670ac8SStephen M. Cameron 		"(known firmware bug.)  Ignoring.\n");
560764670ac8SStephen M. Cameron 
560864670ac8SStephen M. Cameron 	return 1;
560964670ac8SStephen M. Cameron }
561064670ac8SStephen M. Cameron 
5611254f796bSMatt Gates /*
5612254f796bSMatt Gates  * Convert &h->q[x] (passed to interrupt handlers) back to h.
5613254f796bSMatt Gates  * Relies on (h-q[x] == x) being true for x such that
5614254f796bSMatt Gates  * 0 <= x < MAX_REPLY_QUEUES.
5615254f796bSMatt Gates  */
5616254f796bSMatt Gates static struct ctlr_info *queue_to_hba(u8 *queue)
561764670ac8SStephen M. Cameron {
5618254f796bSMatt Gates 	return container_of((queue - *queue), struct ctlr_info, q[0]);
5619254f796bSMatt Gates }
5620254f796bSMatt Gates 
5621254f796bSMatt Gates static irqreturn_t hpsa_intx_discard_completions(int irq, void *queue)
5622254f796bSMatt Gates {
5623254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba(queue);
5624254f796bSMatt Gates 	u8 q = *(u8 *) queue;
562564670ac8SStephen M. Cameron 	u32 raw_tag;
562664670ac8SStephen M. Cameron 
562764670ac8SStephen M. Cameron 	if (ignore_bogus_interrupt(h))
562864670ac8SStephen M. Cameron 		return IRQ_NONE;
562964670ac8SStephen M. Cameron 
563064670ac8SStephen M. Cameron 	if (interrupt_not_for_us(h))
563164670ac8SStephen M. Cameron 		return IRQ_NONE;
5632a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
563364670ac8SStephen M. Cameron 	while (interrupt_pending(h)) {
5634254f796bSMatt Gates 		raw_tag = get_next_completion(h, q);
563564670ac8SStephen M. Cameron 		while (raw_tag != FIFO_EMPTY)
5636254f796bSMatt Gates 			raw_tag = next_command(h, q);
563764670ac8SStephen M. Cameron 	}
563864670ac8SStephen M. Cameron 	return IRQ_HANDLED;
563964670ac8SStephen M. Cameron }
564064670ac8SStephen M. Cameron 
5641254f796bSMatt Gates static irqreturn_t hpsa_msix_discard_completions(int irq, void *queue)
564264670ac8SStephen M. Cameron {
5643254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba(queue);
564464670ac8SStephen M. Cameron 	u32 raw_tag;
5645254f796bSMatt Gates 	u8 q = *(u8 *) queue;
564664670ac8SStephen M. Cameron 
564764670ac8SStephen M. Cameron 	if (ignore_bogus_interrupt(h))
564864670ac8SStephen M. Cameron 		return IRQ_NONE;
564964670ac8SStephen M. Cameron 
5650a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
5651254f796bSMatt Gates 	raw_tag = get_next_completion(h, q);
565264670ac8SStephen M. Cameron 	while (raw_tag != FIFO_EMPTY)
5653254f796bSMatt Gates 		raw_tag = next_command(h, q);
565464670ac8SStephen M. Cameron 	return IRQ_HANDLED;
565564670ac8SStephen M. Cameron }
565664670ac8SStephen M. Cameron 
5657254f796bSMatt Gates static irqreturn_t do_hpsa_intr_intx(int irq, void *queue)
5658edd16368SStephen M. Cameron {
5659254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba((u8 *) queue);
5660303932fdSDon Brace 	u32 raw_tag;
5661254f796bSMatt Gates 	u8 q = *(u8 *) queue;
5662edd16368SStephen M. Cameron 
5663edd16368SStephen M. Cameron 	if (interrupt_not_for_us(h))
5664edd16368SStephen M. Cameron 		return IRQ_NONE;
5665a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
566610f66018SStephen M. Cameron 	while (interrupt_pending(h)) {
5667254f796bSMatt Gates 		raw_tag = get_next_completion(h, q);
566810f66018SStephen M. Cameron 		while (raw_tag != FIFO_EMPTY) {
56691d94f94dSStephen M. Cameron 			if (likely(hpsa_tag_contains_index(raw_tag)))
56701d94f94dSStephen M. Cameron 				process_indexed_cmd(h, raw_tag);
567110f66018SStephen M. Cameron 			else
56721d94f94dSStephen M. Cameron 				process_nonindexed_cmd(h, raw_tag);
5673254f796bSMatt Gates 			raw_tag = next_command(h, q);
567410f66018SStephen M. Cameron 		}
567510f66018SStephen M. Cameron 	}
567610f66018SStephen M. Cameron 	return IRQ_HANDLED;
567710f66018SStephen M. Cameron }
567810f66018SStephen M. Cameron 
5679254f796bSMatt Gates static irqreturn_t do_hpsa_intr_msi(int irq, void *queue)
568010f66018SStephen M. Cameron {
5681254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba(queue);
568210f66018SStephen M. Cameron 	u32 raw_tag;
5683254f796bSMatt Gates 	u8 q = *(u8 *) queue;
568410f66018SStephen M. Cameron 
5685a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
5686254f796bSMatt Gates 	raw_tag = get_next_completion(h, q);
5687303932fdSDon Brace 	while (raw_tag != FIFO_EMPTY) {
56881d94f94dSStephen M. Cameron 		if (likely(hpsa_tag_contains_index(raw_tag)))
56891d94f94dSStephen M. Cameron 			process_indexed_cmd(h, raw_tag);
5690303932fdSDon Brace 		else
56911d94f94dSStephen M. Cameron 			process_nonindexed_cmd(h, raw_tag);
5692254f796bSMatt Gates 		raw_tag = next_command(h, q);
5693edd16368SStephen M. Cameron 	}
5694edd16368SStephen M. Cameron 	return IRQ_HANDLED;
5695edd16368SStephen M. Cameron }
5696edd16368SStephen M. Cameron 
5697a9a3a273SStephen M. Cameron /* Send a message CDB to the firmware. Careful, this only works
5698a9a3a273SStephen M. Cameron  * in simple mode, not performant mode due to the tag lookup.
5699a9a3a273SStephen M. Cameron  * We only ever use this immediately after a controller reset.
5700a9a3a273SStephen M. Cameron  */
57016f039790SGreg Kroah-Hartman static int hpsa_message(struct pci_dev *pdev, unsigned char opcode,
5702edd16368SStephen M. Cameron 			unsigned char type)
5703edd16368SStephen M. Cameron {
5704edd16368SStephen M. Cameron 	struct Command {
5705edd16368SStephen M. Cameron 		struct CommandListHeader CommandHeader;
5706edd16368SStephen M. Cameron 		struct RequestBlock Request;
5707edd16368SStephen M. Cameron 		struct ErrDescriptor ErrorDescriptor;
5708edd16368SStephen M. Cameron 	};
5709edd16368SStephen M. Cameron 	struct Command *cmd;
5710edd16368SStephen M. Cameron 	static const size_t cmd_sz = sizeof(*cmd) +
5711edd16368SStephen M. Cameron 					sizeof(cmd->ErrorDescriptor);
5712edd16368SStephen M. Cameron 	dma_addr_t paddr64;
5713edd16368SStephen M. Cameron 	uint32_t paddr32, tag;
5714edd16368SStephen M. Cameron 	void __iomem *vaddr;
5715edd16368SStephen M. Cameron 	int i, err;
5716edd16368SStephen M. Cameron 
5717edd16368SStephen M. Cameron 	vaddr = pci_ioremap_bar(pdev, 0);
5718edd16368SStephen M. Cameron 	if (vaddr == NULL)
5719edd16368SStephen M. Cameron 		return -ENOMEM;
5720edd16368SStephen M. Cameron 
5721edd16368SStephen M. Cameron 	/* The Inbound Post Queue only accepts 32-bit physical addresses for the
5722edd16368SStephen M. Cameron 	 * CCISS commands, so they must be allocated from the lower 4GiB of
5723edd16368SStephen M. Cameron 	 * memory.
5724edd16368SStephen M. Cameron 	 */
5725edd16368SStephen M. Cameron 	err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
5726edd16368SStephen M. Cameron 	if (err) {
5727edd16368SStephen M. Cameron 		iounmap(vaddr);
5728edd16368SStephen M. Cameron 		return -ENOMEM;
5729edd16368SStephen M. Cameron 	}
5730edd16368SStephen M. Cameron 
5731edd16368SStephen M. Cameron 	cmd = pci_alloc_consistent(pdev, cmd_sz, &paddr64);
5732edd16368SStephen M. Cameron 	if (cmd == NULL) {
5733edd16368SStephen M. Cameron 		iounmap(vaddr);
5734edd16368SStephen M. Cameron 		return -ENOMEM;
5735edd16368SStephen M. Cameron 	}
5736edd16368SStephen M. Cameron 
5737edd16368SStephen M. Cameron 	/* This must fit, because of the 32-bit consistent DMA mask.  Also,
5738edd16368SStephen M. Cameron 	 * although there's no guarantee, we assume that the address is at
5739edd16368SStephen M. Cameron 	 * least 4-byte aligned (most likely, it's page-aligned).
5740edd16368SStephen M. Cameron 	 */
5741edd16368SStephen M. Cameron 	paddr32 = paddr64;
5742edd16368SStephen M. Cameron 
5743edd16368SStephen M. Cameron 	cmd->CommandHeader.ReplyQueue = 0;
5744edd16368SStephen M. Cameron 	cmd->CommandHeader.SGList = 0;
5745*50a0decfSStephen M. Cameron 	cmd->CommandHeader.SGTotal = cpu_to_le16(0);
5746*50a0decfSStephen M. Cameron 	cmd->CommandHeader.tag = paddr32;
5747edd16368SStephen M. Cameron 	memset(&cmd->CommandHeader.LUN.LunAddrBytes, 0, 8);
5748edd16368SStephen M. Cameron 
5749edd16368SStephen M. Cameron 	cmd->Request.CDBLen = 16;
5750edd16368SStephen M. Cameron 	cmd->Request.Type.Type = TYPE_MSG;
5751edd16368SStephen M. Cameron 	cmd->Request.Type.Attribute = ATTR_HEADOFQUEUE;
5752edd16368SStephen M. Cameron 	cmd->Request.Type.Direction = XFER_NONE;
5753edd16368SStephen M. Cameron 	cmd->Request.Timeout = 0; /* Don't time out */
5754edd16368SStephen M. Cameron 	cmd->Request.CDB[0] = opcode;
5755edd16368SStephen M. Cameron 	cmd->Request.CDB[1] = type;
5756edd16368SStephen M. Cameron 	memset(&cmd->Request.CDB[2], 0, 14); /* rest of the CDB is reserved */
5757*50a0decfSStephen M. Cameron 	cmd->ErrorDescriptor.Addr =
5758*50a0decfSStephen M. Cameron 			cpu_to_le64((paddr32 + sizeof(*cmd)));
5759*50a0decfSStephen M. Cameron 	cmd->ErrorDescriptor.Len = cpu_to_le32(sizeof(struct ErrorInfo));
5760edd16368SStephen M. Cameron 
5761edd16368SStephen M. Cameron 	writel(paddr32, vaddr + SA5_REQUEST_PORT_OFFSET);
5762edd16368SStephen M. Cameron 
5763edd16368SStephen M. Cameron 	for (i = 0; i < HPSA_MSG_SEND_RETRY_LIMIT; i++) {
5764edd16368SStephen M. Cameron 		tag = readl(vaddr + SA5_REPLY_PORT_OFFSET);
5765a9a3a273SStephen M. Cameron 		if ((tag & ~HPSA_SIMPLE_ERROR_BITS) == paddr32)
5766edd16368SStephen M. Cameron 			break;
5767edd16368SStephen M. Cameron 		msleep(HPSA_MSG_SEND_RETRY_INTERVAL_MSECS);
5768edd16368SStephen M. Cameron 	}
5769edd16368SStephen M. Cameron 
5770edd16368SStephen M. Cameron 	iounmap(vaddr);
5771edd16368SStephen M. Cameron 
5772edd16368SStephen M. Cameron 	/* we leak the DMA buffer here ... no choice since the controller could
5773edd16368SStephen M. Cameron 	 *  still complete the command.
5774edd16368SStephen M. Cameron 	 */
5775edd16368SStephen M. Cameron 	if (i == HPSA_MSG_SEND_RETRY_LIMIT) {
5776edd16368SStephen M. Cameron 		dev_err(&pdev->dev, "controller message %02x:%02x timed out\n",
5777edd16368SStephen M. Cameron 			opcode, type);
5778edd16368SStephen M. Cameron 		return -ETIMEDOUT;
5779edd16368SStephen M. Cameron 	}
5780edd16368SStephen M. Cameron 
5781edd16368SStephen M. Cameron 	pci_free_consistent(pdev, cmd_sz, cmd, paddr64);
5782edd16368SStephen M. Cameron 
5783edd16368SStephen M. Cameron 	if (tag & HPSA_ERROR_BIT) {
5784edd16368SStephen M. Cameron 		dev_err(&pdev->dev, "controller message %02x:%02x failed\n",
5785edd16368SStephen M. Cameron 			opcode, type);
5786edd16368SStephen M. Cameron 		return -EIO;
5787edd16368SStephen M. Cameron 	}
5788edd16368SStephen M. Cameron 
5789edd16368SStephen M. Cameron 	dev_info(&pdev->dev, "controller message %02x:%02x succeeded\n",
5790edd16368SStephen M. Cameron 		opcode, type);
5791edd16368SStephen M. Cameron 	return 0;
5792edd16368SStephen M. Cameron }
5793edd16368SStephen M. Cameron 
5794edd16368SStephen M. Cameron #define hpsa_noop(p) hpsa_message(p, 3, 0)
5795edd16368SStephen M. Cameron 
57961df8552aSStephen M. Cameron static int hpsa_controller_hard_reset(struct pci_dev *pdev,
579742a91641SDon Brace 	void __iomem *vaddr, u32 use_doorbell)
5798edd16368SStephen M. Cameron {
57991df8552aSStephen M. Cameron 	u16 pmcsr;
58001df8552aSStephen M. Cameron 	int pos;
5801edd16368SStephen M. Cameron 
58021df8552aSStephen M. Cameron 	if (use_doorbell) {
58031df8552aSStephen M. Cameron 		/* For everything after the P600, the PCI power state method
58041df8552aSStephen M. Cameron 		 * of resetting the controller doesn't work, so we have this
58051df8552aSStephen M. Cameron 		 * other way using the doorbell register.
5806edd16368SStephen M. Cameron 		 */
58071df8552aSStephen M. Cameron 		dev_info(&pdev->dev, "using doorbell to reset controller\n");
5808cf0b08d0SStephen M. Cameron 		writel(use_doorbell, vaddr + SA5_DOORBELL);
580985009239SStephen M. Cameron 
581000701a96SJustin Lindley 		/* PMC hardware guys tell us we need a 10 second delay after
581185009239SStephen M. Cameron 		 * doorbell reset and before any attempt to talk to the board
581285009239SStephen M. Cameron 		 * at all to ensure that this actually works and doesn't fall
581385009239SStephen M. Cameron 		 * over in some weird corner cases.
581485009239SStephen M. Cameron 		 */
581500701a96SJustin Lindley 		msleep(10000);
58161df8552aSStephen M. Cameron 	} else { /* Try to do it the PCI power state way */
5817edd16368SStephen M. Cameron 
5818edd16368SStephen M. Cameron 		/* Quoting from the Open CISS Specification: "The Power
5819edd16368SStephen M. Cameron 		 * Management Control/Status Register (CSR) controls the power
5820edd16368SStephen M. Cameron 		 * state of the device.  The normal operating state is D0,
5821edd16368SStephen M. Cameron 		 * CSR=00h.  The software off state is D3, CSR=03h.  To reset
58221df8552aSStephen M. Cameron 		 * the controller, place the interface device in D3 then to D0,
58231df8552aSStephen M. Cameron 		 * this causes a secondary PCI reset which will reset the
58241df8552aSStephen M. Cameron 		 * controller." */
5825edd16368SStephen M. Cameron 
58261df8552aSStephen M. Cameron 		pos = pci_find_capability(pdev, PCI_CAP_ID_PM);
58271df8552aSStephen M. Cameron 		if (pos == 0) {
58281df8552aSStephen M. Cameron 			dev_err(&pdev->dev,
58291df8552aSStephen M. Cameron 				"hpsa_reset_controller: "
58301df8552aSStephen M. Cameron 				"PCI PM not supported\n");
58311df8552aSStephen M. Cameron 			return -ENODEV;
58321df8552aSStephen M. Cameron 		}
58331df8552aSStephen M. Cameron 		dev_info(&pdev->dev, "using PCI PM to reset controller\n");
5834edd16368SStephen M. Cameron 		/* enter the D3hot power management state */
5835edd16368SStephen M. Cameron 		pci_read_config_word(pdev, pos + PCI_PM_CTRL, &pmcsr);
5836edd16368SStephen M. Cameron 		pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
5837edd16368SStephen M. Cameron 		pmcsr |= PCI_D3hot;
5838edd16368SStephen M. Cameron 		pci_write_config_word(pdev, pos + PCI_PM_CTRL, pmcsr);
5839edd16368SStephen M. Cameron 
5840edd16368SStephen M. Cameron 		msleep(500);
5841edd16368SStephen M. Cameron 
5842edd16368SStephen M. Cameron 		/* enter the D0 power management state */
5843edd16368SStephen M. Cameron 		pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
5844edd16368SStephen M. Cameron 		pmcsr |= PCI_D0;
5845edd16368SStephen M. Cameron 		pci_write_config_word(pdev, pos + PCI_PM_CTRL, pmcsr);
5846c4853efeSMike Miller 
5847c4853efeSMike Miller 		/*
5848c4853efeSMike Miller 		 * The P600 requires a small delay when changing states.
5849c4853efeSMike Miller 		 * Otherwise we may think the board did not reset and we bail.
5850c4853efeSMike Miller 		 * This for kdump only and is particular to the P600.
5851c4853efeSMike Miller 		 */
5852c4853efeSMike Miller 		msleep(500);
58531df8552aSStephen M. Cameron 	}
58541df8552aSStephen M. Cameron 	return 0;
58551df8552aSStephen M. Cameron }
58561df8552aSStephen M. Cameron 
58576f039790SGreg Kroah-Hartman static void init_driver_version(char *driver_version, int len)
5858580ada3cSStephen M. Cameron {
5859580ada3cSStephen M. Cameron 	memset(driver_version, 0, len);
5860f79cfec6SStephen M. Cameron 	strncpy(driver_version, HPSA " " HPSA_DRIVER_VERSION, len - 1);
5861580ada3cSStephen M. Cameron }
5862580ada3cSStephen M. Cameron 
58636f039790SGreg Kroah-Hartman static int write_driver_ver_to_cfgtable(struct CfgTable __iomem *cfgtable)
5864580ada3cSStephen M. Cameron {
5865580ada3cSStephen M. Cameron 	char *driver_version;
5866580ada3cSStephen M. Cameron 	int i, size = sizeof(cfgtable->driver_version);
5867580ada3cSStephen M. Cameron 
5868580ada3cSStephen M. Cameron 	driver_version = kmalloc(size, GFP_KERNEL);
5869580ada3cSStephen M. Cameron 	if (!driver_version)
5870580ada3cSStephen M. Cameron 		return -ENOMEM;
5871580ada3cSStephen M. Cameron 
5872580ada3cSStephen M. Cameron 	init_driver_version(driver_version, size);
5873580ada3cSStephen M. Cameron 	for (i = 0; i < size; i++)
5874580ada3cSStephen M. Cameron 		writeb(driver_version[i], &cfgtable->driver_version[i]);
5875580ada3cSStephen M. Cameron 	kfree(driver_version);
5876580ada3cSStephen M. Cameron 	return 0;
5877580ada3cSStephen M. Cameron }
5878580ada3cSStephen M. Cameron 
58796f039790SGreg Kroah-Hartman static void read_driver_ver_from_cfgtable(struct CfgTable __iomem *cfgtable,
58806f039790SGreg Kroah-Hartman 					  unsigned char *driver_ver)
5881580ada3cSStephen M. Cameron {
5882580ada3cSStephen M. Cameron 	int i;
5883580ada3cSStephen M. Cameron 
5884580ada3cSStephen M. Cameron 	for (i = 0; i < sizeof(cfgtable->driver_version); i++)
5885580ada3cSStephen M. Cameron 		driver_ver[i] = readb(&cfgtable->driver_version[i]);
5886580ada3cSStephen M. Cameron }
5887580ada3cSStephen M. Cameron 
58886f039790SGreg Kroah-Hartman static int controller_reset_failed(struct CfgTable __iomem *cfgtable)
5889580ada3cSStephen M. Cameron {
5890580ada3cSStephen M. Cameron 
5891580ada3cSStephen M. Cameron 	char *driver_ver, *old_driver_ver;
5892580ada3cSStephen M. Cameron 	int rc, size = sizeof(cfgtable->driver_version);
5893580ada3cSStephen M. Cameron 
5894580ada3cSStephen M. Cameron 	old_driver_ver = kmalloc(2 * size, GFP_KERNEL);
5895580ada3cSStephen M. Cameron 	if (!old_driver_ver)
5896580ada3cSStephen M. Cameron 		return -ENOMEM;
5897580ada3cSStephen M. Cameron 	driver_ver = old_driver_ver + size;
5898580ada3cSStephen M. Cameron 
5899580ada3cSStephen M. Cameron 	/* After a reset, the 32 bytes of "driver version" in the cfgtable
5900580ada3cSStephen M. Cameron 	 * should have been changed, otherwise we know the reset failed.
5901580ada3cSStephen M. Cameron 	 */
5902580ada3cSStephen M. Cameron 	init_driver_version(old_driver_ver, size);
5903580ada3cSStephen M. Cameron 	read_driver_ver_from_cfgtable(cfgtable, driver_ver);
5904580ada3cSStephen M. Cameron 	rc = !memcmp(driver_ver, old_driver_ver, size);
5905580ada3cSStephen M. Cameron 	kfree(old_driver_ver);
5906580ada3cSStephen M. Cameron 	return rc;
5907580ada3cSStephen M. Cameron }
59081df8552aSStephen M. Cameron /* This does a hard reset of the controller using PCI power management
59091df8552aSStephen M. Cameron  * states or the using the doorbell register.
59101df8552aSStephen M. Cameron  */
59116f039790SGreg Kroah-Hartman static int hpsa_kdump_hard_reset_controller(struct pci_dev *pdev)
59121df8552aSStephen M. Cameron {
59131df8552aSStephen M. Cameron 	u64 cfg_offset;
59141df8552aSStephen M. Cameron 	u32 cfg_base_addr;
59151df8552aSStephen M. Cameron 	u64 cfg_base_addr_index;
59161df8552aSStephen M. Cameron 	void __iomem *vaddr;
59171df8552aSStephen M. Cameron 	unsigned long paddr;
5918580ada3cSStephen M. Cameron 	u32 misc_fw_support;
5919270d05deSStephen M. Cameron 	int rc;
59201df8552aSStephen M. Cameron 	struct CfgTable __iomem *cfgtable;
5921cf0b08d0SStephen M. Cameron 	u32 use_doorbell;
592218867659SStephen M. Cameron 	u32 board_id;
5923270d05deSStephen M. Cameron 	u16 command_register;
59241df8552aSStephen M. Cameron 
59251df8552aSStephen M. Cameron 	/* For controllers as old as the P600, this is very nearly
59261df8552aSStephen M. Cameron 	 * the same thing as
59271df8552aSStephen M. Cameron 	 *
59281df8552aSStephen M. Cameron 	 * pci_save_state(pci_dev);
59291df8552aSStephen M. Cameron 	 * pci_set_power_state(pci_dev, PCI_D3hot);
59301df8552aSStephen M. Cameron 	 * pci_set_power_state(pci_dev, PCI_D0);
59311df8552aSStephen M. Cameron 	 * pci_restore_state(pci_dev);
59321df8552aSStephen M. Cameron 	 *
59331df8552aSStephen M. Cameron 	 * For controllers newer than the P600, the pci power state
59341df8552aSStephen M. Cameron 	 * method of resetting doesn't work so we have another way
59351df8552aSStephen M. Cameron 	 * using the doorbell register.
59361df8552aSStephen M. Cameron 	 */
593718867659SStephen M. Cameron 
593825c1e56aSStephen M. Cameron 	rc = hpsa_lookup_board_id(pdev, &board_id);
593946380786SStephen M. Cameron 	if (rc < 0 || !ctlr_is_resettable(board_id)) {
594025c1e56aSStephen M. Cameron 		dev_warn(&pdev->dev, "Not resetting device.\n");
594125c1e56aSStephen M. Cameron 		return -ENODEV;
594225c1e56aSStephen M. Cameron 	}
594346380786SStephen M. Cameron 
594446380786SStephen M. Cameron 	/* if controller is soft- but not hard resettable... */
594546380786SStephen M. Cameron 	if (!ctlr_is_hard_resettable(board_id))
594646380786SStephen M. Cameron 		return -ENOTSUPP; /* try soft reset later. */
594718867659SStephen M. Cameron 
5948270d05deSStephen M. Cameron 	/* Save the PCI command register */
5949270d05deSStephen M. Cameron 	pci_read_config_word(pdev, 4, &command_register);
5950270d05deSStephen M. Cameron 	pci_save_state(pdev);
59511df8552aSStephen M. Cameron 
59521df8552aSStephen M. Cameron 	/* find the first memory BAR, so we can find the cfg table */
59531df8552aSStephen M. Cameron 	rc = hpsa_pci_find_memory_BAR(pdev, &paddr);
59541df8552aSStephen M. Cameron 	if (rc)
59551df8552aSStephen M. Cameron 		return rc;
59561df8552aSStephen M. Cameron 	vaddr = remap_pci_mem(paddr, 0x250);
59571df8552aSStephen M. Cameron 	if (!vaddr)
59581df8552aSStephen M. Cameron 		return -ENOMEM;
59591df8552aSStephen M. Cameron 
59601df8552aSStephen M. Cameron 	/* find cfgtable in order to check if reset via doorbell is supported */
59611df8552aSStephen M. Cameron 	rc = hpsa_find_cfg_addrs(pdev, vaddr, &cfg_base_addr,
59621df8552aSStephen M. Cameron 					&cfg_base_addr_index, &cfg_offset);
59631df8552aSStephen M. Cameron 	if (rc)
59641df8552aSStephen M. Cameron 		goto unmap_vaddr;
59651df8552aSStephen M. Cameron 	cfgtable = remap_pci_mem(pci_resource_start(pdev,
59661df8552aSStephen M. Cameron 		       cfg_base_addr_index) + cfg_offset, sizeof(*cfgtable));
59671df8552aSStephen M. Cameron 	if (!cfgtable) {
59681df8552aSStephen M. Cameron 		rc = -ENOMEM;
59691df8552aSStephen M. Cameron 		goto unmap_vaddr;
59701df8552aSStephen M. Cameron 	}
5971580ada3cSStephen M. Cameron 	rc = write_driver_ver_to_cfgtable(cfgtable);
5972580ada3cSStephen M. Cameron 	if (rc)
5973580ada3cSStephen M. Cameron 		goto unmap_vaddr;
59741df8552aSStephen M. Cameron 
5975cf0b08d0SStephen M. Cameron 	/* If reset via doorbell register is supported, use that.
5976cf0b08d0SStephen M. Cameron 	 * There are two such methods.  Favor the newest method.
5977cf0b08d0SStephen M. Cameron 	 */
59781df8552aSStephen M. Cameron 	misc_fw_support = readl(&cfgtable->misc_fw_support);
5979cf0b08d0SStephen M. Cameron 	use_doorbell = misc_fw_support & MISC_FW_DOORBELL_RESET2;
5980cf0b08d0SStephen M. Cameron 	if (use_doorbell) {
5981cf0b08d0SStephen M. Cameron 		use_doorbell = DOORBELL_CTLR_RESET2;
5982cf0b08d0SStephen M. Cameron 	} else {
59831df8552aSStephen M. Cameron 		use_doorbell = misc_fw_support & MISC_FW_DOORBELL_RESET;
5984cf0b08d0SStephen M. Cameron 		if (use_doorbell) {
5985fba63097SMike Miller 			dev_warn(&pdev->dev, "Soft reset not supported. "
5986fba63097SMike Miller 				"Firmware update is required.\n");
598764670ac8SStephen M. Cameron 			rc = -ENOTSUPP; /* try soft reset */
5988cf0b08d0SStephen M. Cameron 			goto unmap_cfgtable;
5989cf0b08d0SStephen M. Cameron 		}
5990cf0b08d0SStephen M. Cameron 	}
59911df8552aSStephen M. Cameron 
59921df8552aSStephen M. Cameron 	rc = hpsa_controller_hard_reset(pdev, vaddr, use_doorbell);
59931df8552aSStephen M. Cameron 	if (rc)
59941df8552aSStephen M. Cameron 		goto unmap_cfgtable;
5995edd16368SStephen M. Cameron 
5996270d05deSStephen M. Cameron 	pci_restore_state(pdev);
5997270d05deSStephen M. Cameron 	pci_write_config_word(pdev, 4, command_register);
5998edd16368SStephen M. Cameron 
59991df8552aSStephen M. Cameron 	/* Some devices (notably the HP Smart Array 5i Controller)
60001df8552aSStephen M. Cameron 	   need a little pause here */
60011df8552aSStephen M. Cameron 	msleep(HPSA_POST_RESET_PAUSE_MSECS);
60021df8552aSStephen M. Cameron 
6003fe5389c8SStephen M. Cameron 	rc = hpsa_wait_for_board_state(pdev, vaddr, BOARD_READY);
6004fe5389c8SStephen M. Cameron 	if (rc) {
6005fe5389c8SStephen M. Cameron 		dev_warn(&pdev->dev,
600664670ac8SStephen M. Cameron 			"failed waiting for board to become ready "
600764670ac8SStephen M. Cameron 			"after hard reset\n");
6008fe5389c8SStephen M. Cameron 		goto unmap_cfgtable;
6009fe5389c8SStephen M. Cameron 	}
6010fe5389c8SStephen M. Cameron 
6011580ada3cSStephen M. Cameron 	rc = controller_reset_failed(vaddr);
6012580ada3cSStephen M. Cameron 	if (rc < 0)
6013580ada3cSStephen M. Cameron 		goto unmap_cfgtable;
6014580ada3cSStephen M. Cameron 	if (rc) {
601564670ac8SStephen M. Cameron 		dev_warn(&pdev->dev, "Unable to successfully reset "
601664670ac8SStephen M. Cameron 			"controller. Will try soft reset.\n");
601764670ac8SStephen M. Cameron 		rc = -ENOTSUPP;
6018580ada3cSStephen M. Cameron 	} else {
601964670ac8SStephen M. Cameron 		dev_info(&pdev->dev, "board ready after hard reset.\n");
60201df8552aSStephen M. Cameron 	}
60211df8552aSStephen M. Cameron 
60221df8552aSStephen M. Cameron unmap_cfgtable:
60231df8552aSStephen M. Cameron 	iounmap(cfgtable);
60241df8552aSStephen M. Cameron 
60251df8552aSStephen M. Cameron unmap_vaddr:
60261df8552aSStephen M. Cameron 	iounmap(vaddr);
60271df8552aSStephen M. Cameron 	return rc;
6028edd16368SStephen M. Cameron }
6029edd16368SStephen M. Cameron 
6030edd16368SStephen M. Cameron /*
6031edd16368SStephen M. Cameron  *  We cannot read the structure directly, for portability we must use
6032edd16368SStephen M. Cameron  *   the io functions.
6033edd16368SStephen M. Cameron  *   This is for debug only.
6034edd16368SStephen M. Cameron  */
603542a91641SDon Brace static void print_cfg_table(struct device *dev, struct CfgTable __iomem *tb)
6036edd16368SStephen M. Cameron {
603758f8665cSStephen M. Cameron #ifdef HPSA_DEBUG
6038edd16368SStephen M. Cameron 	int i;
6039edd16368SStephen M. Cameron 	char temp_name[17];
6040edd16368SStephen M. Cameron 
6041edd16368SStephen M. Cameron 	dev_info(dev, "Controller Configuration information\n");
6042edd16368SStephen M. Cameron 	dev_info(dev, "------------------------------------\n");
6043edd16368SStephen M. Cameron 	for (i = 0; i < 4; i++)
6044edd16368SStephen M. Cameron 		temp_name[i] = readb(&(tb->Signature[i]));
6045edd16368SStephen M. Cameron 	temp_name[4] = '\0';
6046edd16368SStephen M. Cameron 	dev_info(dev, "   Signature = %s\n", temp_name);
6047edd16368SStephen M. Cameron 	dev_info(dev, "   Spec Number = %d\n", readl(&(tb->SpecValence)));
6048edd16368SStephen M. Cameron 	dev_info(dev, "   Transport methods supported = 0x%x\n",
6049edd16368SStephen M. Cameron 	       readl(&(tb->TransportSupport)));
6050edd16368SStephen M. Cameron 	dev_info(dev, "   Transport methods active = 0x%x\n",
6051edd16368SStephen M. Cameron 	       readl(&(tb->TransportActive)));
6052edd16368SStephen M. Cameron 	dev_info(dev, "   Requested transport Method = 0x%x\n",
6053edd16368SStephen M. Cameron 	       readl(&(tb->HostWrite.TransportRequest)));
6054edd16368SStephen M. Cameron 	dev_info(dev, "   Coalesce Interrupt Delay = 0x%x\n",
6055edd16368SStephen M. Cameron 	       readl(&(tb->HostWrite.CoalIntDelay)));
6056edd16368SStephen M. Cameron 	dev_info(dev, "   Coalesce Interrupt Count = 0x%x\n",
6057edd16368SStephen M. Cameron 	       readl(&(tb->HostWrite.CoalIntCount)));
6058edd16368SStephen M. Cameron 	dev_info(dev, "   Max outstanding commands = 0x%d\n",
6059edd16368SStephen M. Cameron 	       readl(&(tb->CmdsOutMax)));
6060edd16368SStephen M. Cameron 	dev_info(dev, "   Bus Types = 0x%x\n", readl(&(tb->BusTypes)));
6061edd16368SStephen M. Cameron 	for (i = 0; i < 16; i++)
6062edd16368SStephen M. Cameron 		temp_name[i] = readb(&(tb->ServerName[i]));
6063edd16368SStephen M. Cameron 	temp_name[16] = '\0';
6064edd16368SStephen M. Cameron 	dev_info(dev, "   Server Name = %s\n", temp_name);
6065edd16368SStephen M. Cameron 	dev_info(dev, "   Heartbeat Counter = 0x%x\n\n\n",
6066edd16368SStephen M. Cameron 		readl(&(tb->HeartBeat)));
6067edd16368SStephen M. Cameron #endif				/* HPSA_DEBUG */
606858f8665cSStephen M. Cameron }
6069edd16368SStephen M. Cameron 
6070edd16368SStephen M. Cameron static int find_PCI_BAR_index(struct pci_dev *pdev, unsigned long pci_bar_addr)
6071edd16368SStephen M. Cameron {
6072edd16368SStephen M. Cameron 	int i, offset, mem_type, bar_type;
6073edd16368SStephen M. Cameron 
6074edd16368SStephen M. Cameron 	if (pci_bar_addr == PCI_BASE_ADDRESS_0)	/* looking for BAR zero? */
6075edd16368SStephen M. Cameron 		return 0;
6076edd16368SStephen M. Cameron 	offset = 0;
6077edd16368SStephen M. Cameron 	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
6078edd16368SStephen M. Cameron 		bar_type = pci_resource_flags(pdev, i) & PCI_BASE_ADDRESS_SPACE;
6079edd16368SStephen M. Cameron 		if (bar_type == PCI_BASE_ADDRESS_SPACE_IO)
6080edd16368SStephen M. Cameron 			offset += 4;
6081edd16368SStephen M. Cameron 		else {
6082edd16368SStephen M. Cameron 			mem_type = pci_resource_flags(pdev, i) &
6083edd16368SStephen M. Cameron 			    PCI_BASE_ADDRESS_MEM_TYPE_MASK;
6084edd16368SStephen M. Cameron 			switch (mem_type) {
6085edd16368SStephen M. Cameron 			case PCI_BASE_ADDRESS_MEM_TYPE_32:
6086edd16368SStephen M. Cameron 			case PCI_BASE_ADDRESS_MEM_TYPE_1M:
6087edd16368SStephen M. Cameron 				offset += 4;	/* 32 bit */
6088edd16368SStephen M. Cameron 				break;
6089edd16368SStephen M. Cameron 			case PCI_BASE_ADDRESS_MEM_TYPE_64:
6090edd16368SStephen M. Cameron 				offset += 8;
6091edd16368SStephen M. Cameron 				break;
6092edd16368SStephen M. Cameron 			default:	/* reserved in PCI 2.2 */
6093edd16368SStephen M. Cameron 				dev_warn(&pdev->dev,
6094edd16368SStephen M. Cameron 				       "base address is invalid\n");
6095edd16368SStephen M. Cameron 				return -1;
6096edd16368SStephen M. Cameron 				break;
6097edd16368SStephen M. Cameron 			}
6098edd16368SStephen M. Cameron 		}
6099edd16368SStephen M. Cameron 		if (offset == pci_bar_addr - PCI_BASE_ADDRESS_0)
6100edd16368SStephen M. Cameron 			return i + 1;
6101edd16368SStephen M. Cameron 	}
6102edd16368SStephen M. Cameron 	return -1;
6103edd16368SStephen M. Cameron }
6104edd16368SStephen M. Cameron 
6105edd16368SStephen M. Cameron /* If MSI/MSI-X is supported by the kernel we will try to enable it on
6106edd16368SStephen M. Cameron  * controllers that are capable. If not, we use IO-APIC mode.
6107edd16368SStephen M. Cameron  */
6108edd16368SStephen M. Cameron 
61096f039790SGreg Kroah-Hartman static void hpsa_interrupt_mode(struct ctlr_info *h)
6110edd16368SStephen M. Cameron {
6111edd16368SStephen M. Cameron #ifdef CONFIG_PCI_MSI
6112254f796bSMatt Gates 	int err, i;
6113254f796bSMatt Gates 	struct msix_entry hpsa_msix_entries[MAX_REPLY_QUEUES];
6114254f796bSMatt Gates 
6115254f796bSMatt Gates 	for (i = 0; i < MAX_REPLY_QUEUES; i++) {
6116254f796bSMatt Gates 		hpsa_msix_entries[i].vector = 0;
6117254f796bSMatt Gates 		hpsa_msix_entries[i].entry = i;
6118254f796bSMatt Gates 	}
6119edd16368SStephen M. Cameron 
6120edd16368SStephen M. Cameron 	/* Some boards advertise MSI but don't really support it */
61216b3f4c52SStephen M. Cameron 	if ((h->board_id == 0x40700E11) || (h->board_id == 0x40800E11) ||
61226b3f4c52SStephen M. Cameron 	    (h->board_id == 0x40820E11) || (h->board_id == 0x40830E11))
6123edd16368SStephen M. Cameron 		goto default_int_mode;
612455c06c71SStephen M. Cameron 	if (pci_find_capability(h->pdev, PCI_CAP_ID_MSIX)) {
612555c06c71SStephen M. Cameron 		dev_info(&h->pdev->dev, "MSIX\n");
6126eee0f03aSHannes Reinecke 		h->msix_vector = MAX_REPLY_QUEUES;
6127f89439bcSStephen M. Cameron 		if (h->msix_vector > num_online_cpus())
6128f89439bcSStephen M. Cameron 			h->msix_vector = num_online_cpus();
612918fce3c4SAlexander Gordeev 		err = pci_enable_msix_range(h->pdev, hpsa_msix_entries,
613018fce3c4SAlexander Gordeev 					    1, h->msix_vector);
613118fce3c4SAlexander Gordeev 		if (err < 0) {
613218fce3c4SAlexander Gordeev 			dev_warn(&h->pdev->dev, "MSI-X init failed %d\n", err);
613318fce3c4SAlexander Gordeev 			h->msix_vector = 0;
613418fce3c4SAlexander Gordeev 			goto single_msi_mode;
613518fce3c4SAlexander Gordeev 		} else if (err < h->msix_vector) {
613655c06c71SStephen M. Cameron 			dev_warn(&h->pdev->dev, "only %d MSI-X vectors "
6137edd16368SStephen M. Cameron 			       "available\n", err);
6138eee0f03aSHannes Reinecke 		}
613918fce3c4SAlexander Gordeev 		h->msix_vector = err;
6140eee0f03aSHannes Reinecke 		for (i = 0; i < h->msix_vector; i++)
6141eee0f03aSHannes Reinecke 			h->intr[i] = hpsa_msix_entries[i].vector;
6142eee0f03aSHannes Reinecke 		return;
6143edd16368SStephen M. Cameron 	}
614418fce3c4SAlexander Gordeev single_msi_mode:
614555c06c71SStephen M. Cameron 	if (pci_find_capability(h->pdev, PCI_CAP_ID_MSI)) {
614655c06c71SStephen M. Cameron 		dev_info(&h->pdev->dev, "MSI\n");
614755c06c71SStephen M. Cameron 		if (!pci_enable_msi(h->pdev))
6148edd16368SStephen M. Cameron 			h->msi_vector = 1;
6149edd16368SStephen M. Cameron 		else
615055c06c71SStephen M. Cameron 			dev_warn(&h->pdev->dev, "MSI init failed\n");
6151edd16368SStephen M. Cameron 	}
6152edd16368SStephen M. Cameron default_int_mode:
6153edd16368SStephen M. Cameron #endif				/* CONFIG_PCI_MSI */
6154edd16368SStephen M. Cameron 	/* if we get here we're going to use the default interrupt mode */
6155a9a3a273SStephen M. Cameron 	h->intr[h->intr_mode] = h->pdev->irq;
6156edd16368SStephen M. Cameron }
6157edd16368SStephen M. Cameron 
61586f039790SGreg Kroah-Hartman static int hpsa_lookup_board_id(struct pci_dev *pdev, u32 *board_id)
6159e5c880d1SStephen M. Cameron {
6160e5c880d1SStephen M. Cameron 	int i;
6161e5c880d1SStephen M. Cameron 	u32 subsystem_vendor_id, subsystem_device_id;
6162e5c880d1SStephen M. Cameron 
6163e5c880d1SStephen M. Cameron 	subsystem_vendor_id = pdev->subsystem_vendor;
6164e5c880d1SStephen M. Cameron 	subsystem_device_id = pdev->subsystem_device;
6165e5c880d1SStephen M. Cameron 	*board_id = ((subsystem_device_id << 16) & 0xffff0000) |
6166e5c880d1SStephen M. Cameron 		    subsystem_vendor_id;
6167e5c880d1SStephen M. Cameron 
6168e5c880d1SStephen M. Cameron 	for (i = 0; i < ARRAY_SIZE(products); i++)
6169e5c880d1SStephen M. Cameron 		if (*board_id == products[i].board_id)
6170e5c880d1SStephen M. Cameron 			return i;
6171e5c880d1SStephen M. Cameron 
61726798cc0aSStephen M. Cameron 	if ((subsystem_vendor_id != PCI_VENDOR_ID_HP &&
61736798cc0aSStephen M. Cameron 		subsystem_vendor_id != PCI_VENDOR_ID_COMPAQ) ||
61746798cc0aSStephen M. Cameron 		!hpsa_allow_any) {
6175e5c880d1SStephen M. Cameron 		dev_warn(&pdev->dev, "unrecognized board ID: "
6176e5c880d1SStephen M. Cameron 			"0x%08x, ignoring.\n", *board_id);
6177e5c880d1SStephen M. Cameron 			return -ENODEV;
6178e5c880d1SStephen M. Cameron 	}
6179e5c880d1SStephen M. Cameron 	return ARRAY_SIZE(products) - 1; /* generic unknown smart array */
6180e5c880d1SStephen M. Cameron }
6181e5c880d1SStephen M. Cameron 
61826f039790SGreg Kroah-Hartman static int hpsa_pci_find_memory_BAR(struct pci_dev *pdev,
61833a7774ceSStephen M. Cameron 				    unsigned long *memory_bar)
61843a7774ceSStephen M. Cameron {
61853a7774ceSStephen M. Cameron 	int i;
61863a7774ceSStephen M. Cameron 
61873a7774ceSStephen M. Cameron 	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
618812d2cd47SStephen M. Cameron 		if (pci_resource_flags(pdev, i) & IORESOURCE_MEM) {
61893a7774ceSStephen M. Cameron 			/* addressing mode bits already removed */
619012d2cd47SStephen M. Cameron 			*memory_bar = pci_resource_start(pdev, i);
619112d2cd47SStephen M. Cameron 			dev_dbg(&pdev->dev, "memory BAR = %lx\n",
61923a7774ceSStephen M. Cameron 				*memory_bar);
61933a7774ceSStephen M. Cameron 			return 0;
61943a7774ceSStephen M. Cameron 		}
619512d2cd47SStephen M. Cameron 	dev_warn(&pdev->dev, "no memory BAR found\n");
61963a7774ceSStephen M. Cameron 	return -ENODEV;
61973a7774ceSStephen M. Cameron }
61983a7774ceSStephen M. Cameron 
61996f039790SGreg Kroah-Hartman static int hpsa_wait_for_board_state(struct pci_dev *pdev, void __iomem *vaddr,
62006f039790SGreg Kroah-Hartman 				     int wait_for_ready)
62012c4c8c8bSStephen M. Cameron {
6202fe5389c8SStephen M. Cameron 	int i, iterations;
62032c4c8c8bSStephen M. Cameron 	u32 scratchpad;
6204fe5389c8SStephen M. Cameron 	if (wait_for_ready)
6205fe5389c8SStephen M. Cameron 		iterations = HPSA_BOARD_READY_ITERATIONS;
6206fe5389c8SStephen M. Cameron 	else
6207fe5389c8SStephen M. Cameron 		iterations = HPSA_BOARD_NOT_READY_ITERATIONS;
62082c4c8c8bSStephen M. Cameron 
6209fe5389c8SStephen M. Cameron 	for (i = 0; i < iterations; i++) {
6210fe5389c8SStephen M. Cameron 		scratchpad = readl(vaddr + SA5_SCRATCHPAD_OFFSET);
6211fe5389c8SStephen M. Cameron 		if (wait_for_ready) {
62122c4c8c8bSStephen M. Cameron 			if (scratchpad == HPSA_FIRMWARE_READY)
62132c4c8c8bSStephen M. Cameron 				return 0;
6214fe5389c8SStephen M. Cameron 		} else {
6215fe5389c8SStephen M. Cameron 			if (scratchpad != HPSA_FIRMWARE_READY)
6216fe5389c8SStephen M. Cameron 				return 0;
6217fe5389c8SStephen M. Cameron 		}
62182c4c8c8bSStephen M. Cameron 		msleep(HPSA_BOARD_READY_POLL_INTERVAL_MSECS);
62192c4c8c8bSStephen M. Cameron 	}
6220fe5389c8SStephen M. Cameron 	dev_warn(&pdev->dev, "board not ready, timed out.\n");
62212c4c8c8bSStephen M. Cameron 	return -ENODEV;
62222c4c8c8bSStephen M. Cameron }
62232c4c8c8bSStephen M. Cameron 
62246f039790SGreg Kroah-Hartman static int hpsa_find_cfg_addrs(struct pci_dev *pdev, void __iomem *vaddr,
62256f039790SGreg Kroah-Hartman 			       u32 *cfg_base_addr, u64 *cfg_base_addr_index,
6226a51fd47fSStephen M. Cameron 			       u64 *cfg_offset)
6227a51fd47fSStephen M. Cameron {
6228a51fd47fSStephen M. Cameron 	*cfg_base_addr = readl(vaddr + SA5_CTCFG_OFFSET);
6229a51fd47fSStephen M. Cameron 	*cfg_offset = readl(vaddr + SA5_CTMEM_OFFSET);
6230a51fd47fSStephen M. Cameron 	*cfg_base_addr &= (u32) 0x0000ffff;
6231a51fd47fSStephen M. Cameron 	*cfg_base_addr_index = find_PCI_BAR_index(pdev, *cfg_base_addr);
6232a51fd47fSStephen M. Cameron 	if (*cfg_base_addr_index == -1) {
6233a51fd47fSStephen M. Cameron 		dev_warn(&pdev->dev, "cannot find cfg_base_addr_index\n");
6234a51fd47fSStephen M. Cameron 		return -ENODEV;
6235a51fd47fSStephen M. Cameron 	}
6236a51fd47fSStephen M. Cameron 	return 0;
6237a51fd47fSStephen M. Cameron }
6238a51fd47fSStephen M. Cameron 
62396f039790SGreg Kroah-Hartman static int hpsa_find_cfgtables(struct ctlr_info *h)
6240edd16368SStephen M. Cameron {
624101a02ffcSStephen M. Cameron 	u64 cfg_offset;
624201a02ffcSStephen M. Cameron 	u32 cfg_base_addr;
624301a02ffcSStephen M. Cameron 	u64 cfg_base_addr_index;
6244303932fdSDon Brace 	u32 trans_offset;
6245a51fd47fSStephen M. Cameron 	int rc;
624677c4495cSStephen M. Cameron 
6247a51fd47fSStephen M. Cameron 	rc = hpsa_find_cfg_addrs(h->pdev, h->vaddr, &cfg_base_addr,
6248a51fd47fSStephen M. Cameron 		&cfg_base_addr_index, &cfg_offset);
6249a51fd47fSStephen M. Cameron 	if (rc)
6250a51fd47fSStephen M. Cameron 		return rc;
625177c4495cSStephen M. Cameron 	h->cfgtable = remap_pci_mem(pci_resource_start(h->pdev,
6252a51fd47fSStephen M. Cameron 		       cfg_base_addr_index) + cfg_offset, sizeof(*h->cfgtable));
625377c4495cSStephen M. Cameron 	if (!h->cfgtable)
625477c4495cSStephen M. Cameron 		return -ENOMEM;
6255580ada3cSStephen M. Cameron 	rc = write_driver_ver_to_cfgtable(h->cfgtable);
6256580ada3cSStephen M. Cameron 	if (rc)
6257580ada3cSStephen M. Cameron 		return rc;
625877c4495cSStephen M. Cameron 	/* Find performant mode table. */
6259a51fd47fSStephen M. Cameron 	trans_offset = readl(&h->cfgtable->TransMethodOffset);
626077c4495cSStephen M. Cameron 	h->transtable = remap_pci_mem(pci_resource_start(h->pdev,
626177c4495cSStephen M. Cameron 				cfg_base_addr_index)+cfg_offset+trans_offset,
626277c4495cSStephen M. Cameron 				sizeof(*h->transtable));
626377c4495cSStephen M. Cameron 	if (!h->transtable)
626477c4495cSStephen M. Cameron 		return -ENOMEM;
626577c4495cSStephen M. Cameron 	return 0;
626677c4495cSStephen M. Cameron }
626777c4495cSStephen M. Cameron 
62686f039790SGreg Kroah-Hartman static void hpsa_get_max_perf_mode_cmds(struct ctlr_info *h)
6269cba3d38bSStephen M. Cameron {
6270cba3d38bSStephen M. Cameron 	h->max_commands = readl(&(h->cfgtable->MaxPerformantModeCommands));
627172ceeaecSStephen M. Cameron 
627272ceeaecSStephen M. Cameron 	/* Limit commands in memory limited kdump scenario. */
627372ceeaecSStephen M. Cameron 	if (reset_devices && h->max_commands > 32)
627472ceeaecSStephen M. Cameron 		h->max_commands = 32;
627572ceeaecSStephen M. Cameron 
6276cba3d38bSStephen M. Cameron 	if (h->max_commands < 16) {
6277cba3d38bSStephen M. Cameron 		dev_warn(&h->pdev->dev, "Controller reports "
6278cba3d38bSStephen M. Cameron 			"max supported commands of %d, an obvious lie. "
6279cba3d38bSStephen M. Cameron 			"Using 16.  Ensure that firmware is up to date.\n",
6280cba3d38bSStephen M. Cameron 			h->max_commands);
6281cba3d38bSStephen M. Cameron 		h->max_commands = 16;
6282cba3d38bSStephen M. Cameron 	}
6283cba3d38bSStephen M. Cameron }
6284cba3d38bSStephen M. Cameron 
6285b93d7536SStephen M. Cameron /* Interrogate the hardware for some limits:
6286b93d7536SStephen M. Cameron  * max commands, max SG elements without chaining, and with chaining,
6287b93d7536SStephen M. Cameron  * SG chain block size, etc.
6288b93d7536SStephen M. Cameron  */
62896f039790SGreg Kroah-Hartman static void hpsa_find_board_params(struct ctlr_info *h)
6290b93d7536SStephen M. Cameron {
6291cba3d38bSStephen M. Cameron 	hpsa_get_max_perf_mode_cmds(h);
6292b93d7536SStephen M. Cameron 	h->nr_cmds = h->max_commands - 4; /* Allow room for some ioctls */
6293b93d7536SStephen M. Cameron 	h->maxsgentries = readl(&(h->cfgtable->MaxScatterGatherElements));
6294283b4a9bSStephen M. Cameron 	h->fw_support = readl(&(h->cfgtable->misc_fw_support));
6295b93d7536SStephen M. Cameron 	/*
6296b93d7536SStephen M. Cameron 	 * Limit in-command s/g elements to 32 save dma'able memory.
6297b93d7536SStephen M. Cameron 	 * Howvever spec says if 0, use 31
6298b93d7536SStephen M. Cameron 	 */
6299b93d7536SStephen M. Cameron 	h->max_cmd_sg_entries = 31;
6300b93d7536SStephen M. Cameron 	if (h->maxsgentries > 512) {
6301b93d7536SStephen M. Cameron 		h->max_cmd_sg_entries = 32;
63021a63ea6fSWebb Scales 		h->chainsize = h->maxsgentries - h->max_cmd_sg_entries;
6303b93d7536SStephen M. Cameron 		h->maxsgentries--; /* save one for chain pointer */
6304b93d7536SStephen M. Cameron 	} else {
6305b93d7536SStephen M. Cameron 		h->chainsize = 0;
63061a63ea6fSWebb Scales 		h->maxsgentries = 31; /* default to traditional values */
6307b93d7536SStephen M. Cameron 	}
630875167d2cSStephen M. Cameron 
630975167d2cSStephen M. Cameron 	/* Find out what task management functions are supported and cache */
631075167d2cSStephen M. Cameron 	h->TMFSupportFlags = readl(&(h->cfgtable->TMFSupportFlags));
63110e7a7fceSScott Teel 	if (!(HPSATMF_PHYS_TASK_ABORT & h->TMFSupportFlags))
63120e7a7fceSScott Teel 		dev_warn(&h->pdev->dev, "Physical aborts not supported\n");
63130e7a7fceSScott Teel 	if (!(HPSATMF_LOG_TASK_ABORT & h->TMFSupportFlags))
63140e7a7fceSScott Teel 		dev_warn(&h->pdev->dev, "Logical aborts not supported\n");
6315b93d7536SStephen M. Cameron }
6316b93d7536SStephen M. Cameron 
631776c46e49SStephen M. Cameron static inline bool hpsa_CISS_signature_present(struct ctlr_info *h)
631876c46e49SStephen M. Cameron {
63190fc9fd40SAkinobu Mita 	if (!check_signature(h->cfgtable->Signature, "CISS", 4)) {
632076c46e49SStephen M. Cameron 		dev_warn(&h->pdev->dev, "not a valid CISS config table\n");
632176c46e49SStephen M. Cameron 		return false;
632276c46e49SStephen M. Cameron 	}
632376c46e49SStephen M. Cameron 	return true;
632476c46e49SStephen M. Cameron }
632576c46e49SStephen M. Cameron 
632697a5e98cSStephen M. Cameron static inline void hpsa_set_driver_support_bits(struct ctlr_info *h)
6327f7c39101SStephen M. Cameron {
632897a5e98cSStephen M. Cameron 	u32 driver_support;
6329f7c39101SStephen M. Cameron 
633097a5e98cSStephen M. Cameron 	driver_support = readl(&(h->cfgtable->driver_support));
63310b9e7b74SArnd Bergmann 	/* Need to enable prefetch in the SCSI core for 6400 in x86 */
63320b9e7b74SArnd Bergmann #ifdef CONFIG_X86
633397a5e98cSStephen M. Cameron 	driver_support |= ENABLE_SCSI_PREFETCH;
6334f7c39101SStephen M. Cameron #endif
633528e13446SStephen M. Cameron 	driver_support |= ENABLE_UNIT_ATTN;
633628e13446SStephen M. Cameron 	writel(driver_support, &(h->cfgtable->driver_support));
6337f7c39101SStephen M. Cameron }
6338f7c39101SStephen M. Cameron 
63393d0eab67SStephen M. Cameron /* Disable DMA prefetch for the P600.  Otherwise an ASIC bug may result
63403d0eab67SStephen M. Cameron  * in a prefetch beyond physical memory.
63413d0eab67SStephen M. Cameron  */
63423d0eab67SStephen M. Cameron static inline void hpsa_p600_dma_prefetch_quirk(struct ctlr_info *h)
63433d0eab67SStephen M. Cameron {
63443d0eab67SStephen M. Cameron 	u32 dma_prefetch;
63453d0eab67SStephen M. Cameron 
63463d0eab67SStephen M. Cameron 	if (h->board_id != 0x3225103C)
63473d0eab67SStephen M. Cameron 		return;
63483d0eab67SStephen M. Cameron 	dma_prefetch = readl(h->vaddr + I2O_DMA1_CFG);
63493d0eab67SStephen M. Cameron 	dma_prefetch |= 0x8000;
63503d0eab67SStephen M. Cameron 	writel(dma_prefetch, h->vaddr + I2O_DMA1_CFG);
63513d0eab67SStephen M. Cameron }
63523d0eab67SStephen M. Cameron 
635376438d08SStephen M. Cameron static void hpsa_wait_for_clear_event_notify_ack(struct ctlr_info *h)
635476438d08SStephen M. Cameron {
635576438d08SStephen M. Cameron 	int i;
635676438d08SStephen M. Cameron 	u32 doorbell_value;
635776438d08SStephen M. Cameron 	unsigned long flags;
635876438d08SStephen M. Cameron 	/* wait until the clear_event_notify bit 6 is cleared by controller. */
635976438d08SStephen M. Cameron 	for (i = 0; i < MAX_CONFIG_WAIT; i++) {
636076438d08SStephen M. Cameron 		spin_lock_irqsave(&h->lock, flags);
636176438d08SStephen M. Cameron 		doorbell_value = readl(h->vaddr + SA5_DOORBELL);
636276438d08SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
636376438d08SStephen M. Cameron 		if (!(doorbell_value & DOORBELL_CLEAR_EVENTS))
636476438d08SStephen M. Cameron 			break;
636576438d08SStephen M. Cameron 		/* delay and try again */
636676438d08SStephen M. Cameron 		msleep(20);
636776438d08SStephen M. Cameron 	}
636876438d08SStephen M. Cameron }
636976438d08SStephen M. Cameron 
63706f039790SGreg Kroah-Hartman static void hpsa_wait_for_mode_change_ack(struct ctlr_info *h)
6371eb6b2ae9SStephen M. Cameron {
6372eb6b2ae9SStephen M. Cameron 	int i;
63736eaf46fdSStephen M. Cameron 	u32 doorbell_value;
63746eaf46fdSStephen M. Cameron 	unsigned long flags;
6375eb6b2ae9SStephen M. Cameron 
6376eb6b2ae9SStephen M. Cameron 	/* under certain very rare conditions, this can take awhile.
6377eb6b2ae9SStephen M. Cameron 	 * (e.g.: hot replace a failed 144GB drive in a RAID 5 set right
6378eb6b2ae9SStephen M. Cameron 	 * as we enter this code.)
6379eb6b2ae9SStephen M. Cameron 	 */
6380eb6b2ae9SStephen M. Cameron 	for (i = 0; i < MAX_CONFIG_WAIT; i++) {
63816eaf46fdSStephen M. Cameron 		spin_lock_irqsave(&h->lock, flags);
63826eaf46fdSStephen M. Cameron 		doorbell_value = readl(h->vaddr + SA5_DOORBELL);
63836eaf46fdSStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
6384382be668SDan Carpenter 		if (!(doorbell_value & CFGTBL_ChangeReq))
6385eb6b2ae9SStephen M. Cameron 			break;
6386eb6b2ae9SStephen M. Cameron 		/* delay and try again */
638760d3f5b0SStephen M. Cameron 		usleep_range(10000, 20000);
6388eb6b2ae9SStephen M. Cameron 	}
63893f4336f3SStephen M. Cameron }
63903f4336f3SStephen M. Cameron 
63916f039790SGreg Kroah-Hartman static int hpsa_enter_simple_mode(struct ctlr_info *h)
63923f4336f3SStephen M. Cameron {
63933f4336f3SStephen M. Cameron 	u32 trans_support;
63943f4336f3SStephen M. Cameron 
63953f4336f3SStephen M. Cameron 	trans_support = readl(&(h->cfgtable->TransportSupport));
63963f4336f3SStephen M. Cameron 	if (!(trans_support & SIMPLE_MODE))
63973f4336f3SStephen M. Cameron 		return -ENOTSUPP;
63983f4336f3SStephen M. Cameron 
63993f4336f3SStephen M. Cameron 	h->max_commands = readl(&(h->cfgtable->CmdsOutMax));
6400283b4a9bSStephen M. Cameron 
64013f4336f3SStephen M. Cameron 	/* Update the field, and then ring the doorbell */
64023f4336f3SStephen M. Cameron 	writel(CFGTBL_Trans_Simple, &(h->cfgtable->HostWrite.TransportRequest));
6403b9af4937SStephen M. Cameron 	writel(0, &h->cfgtable->HostWrite.command_pool_addr_hi);
64043f4336f3SStephen M. Cameron 	writel(CFGTBL_ChangeReq, h->vaddr + SA5_DOORBELL);
64053f4336f3SStephen M. Cameron 	hpsa_wait_for_mode_change_ack(h);
6406eb6b2ae9SStephen M. Cameron 	print_cfg_table(&h->pdev->dev, h->cfgtable);
6407283b4a9bSStephen M. Cameron 	if (!(readl(&(h->cfgtable->TransportActive)) & CFGTBL_Trans_Simple))
6408283b4a9bSStephen M. Cameron 		goto error;
6409960a30e7SStephen M. Cameron 	h->transMethod = CFGTBL_Trans_Simple;
6410eb6b2ae9SStephen M. Cameron 	return 0;
6411283b4a9bSStephen M. Cameron error:
6412283b4a9bSStephen M. Cameron 	dev_warn(&h->pdev->dev, "unable to get board into simple mode\n");
6413283b4a9bSStephen M. Cameron 	return -ENODEV;
6414eb6b2ae9SStephen M. Cameron }
6415eb6b2ae9SStephen M. Cameron 
64166f039790SGreg Kroah-Hartman static int hpsa_pci_init(struct ctlr_info *h)
641777c4495cSStephen M. Cameron {
6418eb6b2ae9SStephen M. Cameron 	int prod_index, err;
6419edd16368SStephen M. Cameron 
6420e5c880d1SStephen M. Cameron 	prod_index = hpsa_lookup_board_id(h->pdev, &h->board_id);
6421e5c880d1SStephen M. Cameron 	if (prod_index < 0)
6422edd16368SStephen M. Cameron 		return -ENODEV;
6423e5c880d1SStephen M. Cameron 	h->product_name = products[prod_index].product_name;
6424e5c880d1SStephen M. Cameron 	h->access = *(products[prod_index].access);
6425e5c880d1SStephen M. Cameron 
6426e5a44df8SMatthew Garrett 	pci_disable_link_state(h->pdev, PCIE_LINK_STATE_L0S |
6427e5a44df8SMatthew Garrett 			       PCIE_LINK_STATE_L1 | PCIE_LINK_STATE_CLKPM);
6428e5a44df8SMatthew Garrett 
642955c06c71SStephen M. Cameron 	err = pci_enable_device(h->pdev);
6430edd16368SStephen M. Cameron 	if (err) {
643155c06c71SStephen M. Cameron 		dev_warn(&h->pdev->dev, "unable to enable PCI device\n");
6432edd16368SStephen M. Cameron 		return err;
6433edd16368SStephen M. Cameron 	}
6434edd16368SStephen M. Cameron 
64355cb460a6SStephen M. Cameron 	/* Enable bus mastering (pci_disable_device may disable this) */
64365cb460a6SStephen M. Cameron 	pci_set_master(h->pdev);
64375cb460a6SStephen M. Cameron 
6438f79cfec6SStephen M. Cameron 	err = pci_request_regions(h->pdev, HPSA);
6439edd16368SStephen M. Cameron 	if (err) {
644055c06c71SStephen M. Cameron 		dev_err(&h->pdev->dev,
644155c06c71SStephen M. Cameron 			"cannot obtain PCI resources, aborting\n");
6442edd16368SStephen M. Cameron 		return err;
6443edd16368SStephen M. Cameron 	}
64446b3f4c52SStephen M. Cameron 	hpsa_interrupt_mode(h);
644512d2cd47SStephen M. Cameron 	err = hpsa_pci_find_memory_BAR(h->pdev, &h->paddr);
64463a7774ceSStephen M. Cameron 	if (err)
6447edd16368SStephen M. Cameron 		goto err_out_free_res;
6448edd16368SStephen M. Cameron 	h->vaddr = remap_pci_mem(h->paddr, 0x250);
6449204892e9SStephen M. Cameron 	if (!h->vaddr) {
6450204892e9SStephen M. Cameron 		err = -ENOMEM;
6451204892e9SStephen M. Cameron 		goto err_out_free_res;
6452204892e9SStephen M. Cameron 	}
6453fe5389c8SStephen M. Cameron 	err = hpsa_wait_for_board_state(h->pdev, h->vaddr, BOARD_READY);
64542c4c8c8bSStephen M. Cameron 	if (err)
6455edd16368SStephen M. Cameron 		goto err_out_free_res;
645677c4495cSStephen M. Cameron 	err = hpsa_find_cfgtables(h);
645777c4495cSStephen M. Cameron 	if (err)
6458edd16368SStephen M. Cameron 		goto err_out_free_res;
6459b93d7536SStephen M. Cameron 	hpsa_find_board_params(h);
6460edd16368SStephen M. Cameron 
646176c46e49SStephen M. Cameron 	if (!hpsa_CISS_signature_present(h)) {
6462edd16368SStephen M. Cameron 		err = -ENODEV;
6463edd16368SStephen M. Cameron 		goto err_out_free_res;
6464edd16368SStephen M. Cameron 	}
646597a5e98cSStephen M. Cameron 	hpsa_set_driver_support_bits(h);
64663d0eab67SStephen M. Cameron 	hpsa_p600_dma_prefetch_quirk(h);
6467eb6b2ae9SStephen M. Cameron 	err = hpsa_enter_simple_mode(h);
6468eb6b2ae9SStephen M. Cameron 	if (err)
6469edd16368SStephen M. Cameron 		goto err_out_free_res;
6470edd16368SStephen M. Cameron 	return 0;
6471edd16368SStephen M. Cameron 
6472edd16368SStephen M. Cameron err_out_free_res:
6473204892e9SStephen M. Cameron 	if (h->transtable)
6474204892e9SStephen M. Cameron 		iounmap(h->transtable);
6475204892e9SStephen M. Cameron 	if (h->cfgtable)
6476204892e9SStephen M. Cameron 		iounmap(h->cfgtable);
6477204892e9SStephen M. Cameron 	if (h->vaddr)
6478204892e9SStephen M. Cameron 		iounmap(h->vaddr);
6479f0bd0b68SStephen M. Cameron 	pci_disable_device(h->pdev);
648055c06c71SStephen M. Cameron 	pci_release_regions(h->pdev);
6481edd16368SStephen M. Cameron 	return err;
6482edd16368SStephen M. Cameron }
6483edd16368SStephen M. Cameron 
64846f039790SGreg Kroah-Hartman static void hpsa_hba_inquiry(struct ctlr_info *h)
6485339b2b14SStephen M. Cameron {
6486339b2b14SStephen M. Cameron 	int rc;
6487339b2b14SStephen M. Cameron 
6488339b2b14SStephen M. Cameron #define HBA_INQUIRY_BYTE_COUNT 64
6489339b2b14SStephen M. Cameron 	h->hba_inquiry_data = kmalloc(HBA_INQUIRY_BYTE_COUNT, GFP_KERNEL);
6490339b2b14SStephen M. Cameron 	if (!h->hba_inquiry_data)
6491339b2b14SStephen M. Cameron 		return;
6492339b2b14SStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, RAID_CTLR_LUNID, 0,
6493339b2b14SStephen M. Cameron 		h->hba_inquiry_data, HBA_INQUIRY_BYTE_COUNT);
6494339b2b14SStephen M. Cameron 	if (rc != 0) {
6495339b2b14SStephen M. Cameron 		kfree(h->hba_inquiry_data);
6496339b2b14SStephen M. Cameron 		h->hba_inquiry_data = NULL;
6497339b2b14SStephen M. Cameron 	}
6498339b2b14SStephen M. Cameron }
6499339b2b14SStephen M. Cameron 
65006f039790SGreg Kroah-Hartman static int hpsa_init_reset_devices(struct pci_dev *pdev)
6501edd16368SStephen M. Cameron {
65021df8552aSStephen M. Cameron 	int rc, i;
6503edd16368SStephen M. Cameron 
65044c2a8c40SStephen M. Cameron 	if (!reset_devices)
65054c2a8c40SStephen M. Cameron 		return 0;
65064c2a8c40SStephen M. Cameron 
6507132aa220STomas Henzl 	/* kdump kernel is loading, we don't know in which state is
6508132aa220STomas Henzl 	 * the pci interface. The dev->enable_cnt is equal zero
6509132aa220STomas Henzl 	 * so we call enable+disable, wait a while and switch it on.
6510132aa220STomas Henzl 	 */
6511132aa220STomas Henzl 	rc = pci_enable_device(pdev);
6512132aa220STomas Henzl 	if (rc) {
6513132aa220STomas Henzl 		dev_warn(&pdev->dev, "Failed to enable PCI device\n");
6514132aa220STomas Henzl 		return -ENODEV;
6515132aa220STomas Henzl 	}
6516132aa220STomas Henzl 	pci_disable_device(pdev);
6517132aa220STomas Henzl 	msleep(260);			/* a randomly chosen number */
6518132aa220STomas Henzl 	rc = pci_enable_device(pdev);
6519132aa220STomas Henzl 	if (rc) {
6520132aa220STomas Henzl 		dev_warn(&pdev->dev, "failed to enable device.\n");
6521132aa220STomas Henzl 		return -ENODEV;
6522132aa220STomas Henzl 	}
6523859c75abSTomas Henzl 	pci_set_master(pdev);
65241df8552aSStephen M. Cameron 	/* Reset the controller with a PCI power-cycle or via doorbell */
65251df8552aSStephen M. Cameron 	rc = hpsa_kdump_hard_reset_controller(pdev);
6526edd16368SStephen M. Cameron 
65271df8552aSStephen M. Cameron 	/* -ENOTSUPP here means we cannot reset the controller
65281df8552aSStephen M. Cameron 	 * but it's already (and still) up and running in
652918867659SStephen M. Cameron 	 * "performant mode".  Or, it might be 640x, which can't reset
653018867659SStephen M. Cameron 	 * due to concerns about shared bbwc between 6402/6404 pair.
65311df8552aSStephen M. Cameron 	 */
6532132aa220STomas Henzl 	if (rc) {
6533132aa220STomas Henzl 		if (rc != -ENOTSUPP) /* just try to do the kdump anyhow. */
6534132aa220STomas Henzl 			rc = -ENODEV;
6535132aa220STomas Henzl 		goto out_disable;
6536132aa220STomas Henzl 	}
6537edd16368SStephen M. Cameron 
6538edd16368SStephen M. Cameron 	/* Now try to get the controller to respond to a no-op */
65392b870cb3SStephen M. Cameron 	dev_warn(&pdev->dev, "Waiting for controller to respond to no-op\n");
6540edd16368SStephen M. Cameron 	for (i = 0; i < HPSA_POST_RESET_NOOP_RETRIES; i++) {
6541edd16368SStephen M. Cameron 		if (hpsa_noop(pdev) == 0)
6542edd16368SStephen M. Cameron 			break;
6543edd16368SStephen M. Cameron 		else
6544edd16368SStephen M. Cameron 			dev_warn(&pdev->dev, "no-op failed%s\n",
6545edd16368SStephen M. Cameron 					(i < 11 ? "; re-trying" : ""));
6546edd16368SStephen M. Cameron 	}
6547132aa220STomas Henzl 
6548132aa220STomas Henzl out_disable:
6549132aa220STomas Henzl 
6550132aa220STomas Henzl 	pci_disable_device(pdev);
6551132aa220STomas Henzl 	return rc;
6552edd16368SStephen M. Cameron }
6553edd16368SStephen M. Cameron 
65546f039790SGreg Kroah-Hartman static int hpsa_allocate_cmd_pool(struct ctlr_info *h)
65552e9d1b36SStephen M. Cameron {
65562e9d1b36SStephen M. Cameron 	h->cmd_pool_bits = kzalloc(
65572e9d1b36SStephen M. Cameron 		DIV_ROUND_UP(h->nr_cmds, BITS_PER_LONG) *
65582e9d1b36SStephen M. Cameron 		sizeof(unsigned long), GFP_KERNEL);
65592e9d1b36SStephen M. Cameron 	h->cmd_pool = pci_alloc_consistent(h->pdev,
65602e9d1b36SStephen M. Cameron 		    h->nr_cmds * sizeof(*h->cmd_pool),
65612e9d1b36SStephen M. Cameron 		    &(h->cmd_pool_dhandle));
65622e9d1b36SStephen M. Cameron 	h->errinfo_pool = pci_alloc_consistent(h->pdev,
65632e9d1b36SStephen M. Cameron 		    h->nr_cmds * sizeof(*h->errinfo_pool),
65642e9d1b36SStephen M. Cameron 		    &(h->errinfo_pool_dhandle));
65652e9d1b36SStephen M. Cameron 	if ((h->cmd_pool_bits == NULL)
65662e9d1b36SStephen M. Cameron 	    || (h->cmd_pool == NULL)
65672e9d1b36SStephen M. Cameron 	    || (h->errinfo_pool == NULL)) {
65682e9d1b36SStephen M. Cameron 		dev_err(&h->pdev->dev, "out of memory in %s", __func__);
65692e9d1b36SStephen M. Cameron 		return -ENOMEM;
65702e9d1b36SStephen M. Cameron 	}
65712e9d1b36SStephen M. Cameron 	return 0;
65722e9d1b36SStephen M. Cameron }
65732e9d1b36SStephen M. Cameron 
65742e9d1b36SStephen M. Cameron static void hpsa_free_cmd_pool(struct ctlr_info *h)
65752e9d1b36SStephen M. Cameron {
65762e9d1b36SStephen M. Cameron 	kfree(h->cmd_pool_bits);
65772e9d1b36SStephen M. Cameron 	if (h->cmd_pool)
65782e9d1b36SStephen M. Cameron 		pci_free_consistent(h->pdev,
65792e9d1b36SStephen M. Cameron 			    h->nr_cmds * sizeof(struct CommandList),
65802e9d1b36SStephen M. Cameron 			    h->cmd_pool, h->cmd_pool_dhandle);
6581aca9012aSStephen M. Cameron 	if (h->ioaccel2_cmd_pool)
6582aca9012aSStephen M. Cameron 		pci_free_consistent(h->pdev,
6583aca9012aSStephen M. Cameron 			h->nr_cmds * sizeof(*h->ioaccel2_cmd_pool),
6584aca9012aSStephen M. Cameron 			h->ioaccel2_cmd_pool, h->ioaccel2_cmd_pool_dhandle);
65852e9d1b36SStephen M. Cameron 	if (h->errinfo_pool)
65862e9d1b36SStephen M. Cameron 		pci_free_consistent(h->pdev,
65872e9d1b36SStephen M. Cameron 			    h->nr_cmds * sizeof(struct ErrorInfo),
65882e9d1b36SStephen M. Cameron 			    h->errinfo_pool,
65892e9d1b36SStephen M. Cameron 			    h->errinfo_pool_dhandle);
6590e1f7de0cSMatt Gates 	if (h->ioaccel_cmd_pool)
6591e1f7de0cSMatt Gates 		pci_free_consistent(h->pdev,
6592e1f7de0cSMatt Gates 			h->nr_cmds * sizeof(struct io_accel1_cmd),
6593e1f7de0cSMatt Gates 			h->ioaccel_cmd_pool, h->ioaccel_cmd_pool_dhandle);
65942e9d1b36SStephen M. Cameron }
65952e9d1b36SStephen M. Cameron 
659641b3cf08SStephen M. Cameron static void hpsa_irq_affinity_hints(struct ctlr_info *h)
659741b3cf08SStephen M. Cameron {
659841b3cf08SStephen M. Cameron 	int i, cpu, rc;
659941b3cf08SStephen M. Cameron 
660041b3cf08SStephen M. Cameron 	cpu = cpumask_first(cpu_online_mask);
660141b3cf08SStephen M. Cameron 	for (i = 0; i < h->msix_vector; i++) {
660241b3cf08SStephen M. Cameron 		rc = irq_set_affinity_hint(h->intr[i], get_cpu_mask(cpu));
660341b3cf08SStephen M. Cameron 		cpu = cpumask_next(cpu, cpu_online_mask);
660441b3cf08SStephen M. Cameron 	}
660541b3cf08SStephen M. Cameron }
660641b3cf08SStephen M. Cameron 
66070ae01a32SStephen M. Cameron static int hpsa_request_irq(struct ctlr_info *h,
66080ae01a32SStephen M. Cameron 	irqreturn_t (*msixhandler)(int, void *),
66090ae01a32SStephen M. Cameron 	irqreturn_t (*intxhandler)(int, void *))
66100ae01a32SStephen M. Cameron {
6611254f796bSMatt Gates 	int rc, i;
66120ae01a32SStephen M. Cameron 
6613254f796bSMatt Gates 	/*
6614254f796bSMatt Gates 	 * initialize h->q[x] = x so that interrupt handlers know which
6615254f796bSMatt Gates 	 * queue to process.
6616254f796bSMatt Gates 	 */
6617254f796bSMatt Gates 	for (i = 0; i < MAX_REPLY_QUEUES; i++)
6618254f796bSMatt Gates 		h->q[i] = (u8) i;
6619254f796bSMatt Gates 
6620eee0f03aSHannes Reinecke 	if (h->intr_mode == PERF_MODE_INT && h->msix_vector > 0) {
6621254f796bSMatt Gates 		/* If performant mode and MSI-X, use multiple reply queues */
6622eee0f03aSHannes Reinecke 		for (i = 0; i < h->msix_vector; i++)
6623254f796bSMatt Gates 			rc = request_irq(h->intr[i], msixhandler,
6624254f796bSMatt Gates 					0, h->devname,
6625254f796bSMatt Gates 					&h->q[i]);
662641b3cf08SStephen M. Cameron 		hpsa_irq_affinity_hints(h);
6627254f796bSMatt Gates 	} else {
6628254f796bSMatt Gates 		/* Use single reply pool */
6629eee0f03aSHannes Reinecke 		if (h->msix_vector > 0 || h->msi_vector) {
6630254f796bSMatt Gates 			rc = request_irq(h->intr[h->intr_mode],
6631254f796bSMatt Gates 				msixhandler, 0, h->devname,
6632254f796bSMatt Gates 				&h->q[h->intr_mode]);
6633254f796bSMatt Gates 		} else {
6634254f796bSMatt Gates 			rc = request_irq(h->intr[h->intr_mode],
6635254f796bSMatt Gates 				intxhandler, IRQF_SHARED, h->devname,
6636254f796bSMatt Gates 				&h->q[h->intr_mode]);
6637254f796bSMatt Gates 		}
6638254f796bSMatt Gates 	}
66390ae01a32SStephen M. Cameron 	if (rc) {
66400ae01a32SStephen M. Cameron 		dev_err(&h->pdev->dev, "unable to get irq %d for %s\n",
66410ae01a32SStephen M. Cameron 		       h->intr[h->intr_mode], h->devname);
66420ae01a32SStephen M. Cameron 		return -ENODEV;
66430ae01a32SStephen M. Cameron 	}
66440ae01a32SStephen M. Cameron 	return 0;
66450ae01a32SStephen M. Cameron }
66460ae01a32SStephen M. Cameron 
66476f039790SGreg Kroah-Hartman static int hpsa_kdump_soft_reset(struct ctlr_info *h)
664864670ac8SStephen M. Cameron {
664964670ac8SStephen M. Cameron 	if (hpsa_send_host_reset(h, RAID_CTLR_LUNID,
665064670ac8SStephen M. Cameron 		HPSA_RESET_TYPE_CONTROLLER)) {
665164670ac8SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Resetting array controller failed.\n");
665264670ac8SStephen M. Cameron 		return -EIO;
665364670ac8SStephen M. Cameron 	}
665464670ac8SStephen M. Cameron 
665564670ac8SStephen M. Cameron 	dev_info(&h->pdev->dev, "Waiting for board to soft reset.\n");
665664670ac8SStephen M. Cameron 	if (hpsa_wait_for_board_state(h->pdev, h->vaddr, BOARD_NOT_READY)) {
665764670ac8SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Soft reset had no effect.\n");
665864670ac8SStephen M. Cameron 		return -1;
665964670ac8SStephen M. Cameron 	}
666064670ac8SStephen M. Cameron 
666164670ac8SStephen M. Cameron 	dev_info(&h->pdev->dev, "Board reset, awaiting READY status.\n");
666264670ac8SStephen M. Cameron 	if (hpsa_wait_for_board_state(h->pdev, h->vaddr, BOARD_READY)) {
666364670ac8SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Board failed to become ready "
666464670ac8SStephen M. Cameron 			"after soft reset.\n");
666564670ac8SStephen M. Cameron 		return -1;
666664670ac8SStephen M. Cameron 	}
666764670ac8SStephen M. Cameron 
666864670ac8SStephen M. Cameron 	return 0;
666964670ac8SStephen M. Cameron }
667064670ac8SStephen M. Cameron 
6671254f796bSMatt Gates static void free_irqs(struct ctlr_info *h)
6672254f796bSMatt Gates {
6673254f796bSMatt Gates 	int i;
6674254f796bSMatt Gates 
6675254f796bSMatt Gates 	if (!h->msix_vector || h->intr_mode != PERF_MODE_INT) {
6676254f796bSMatt Gates 		/* Single reply queue, only one irq to free */
6677254f796bSMatt Gates 		i = h->intr_mode;
667841b3cf08SStephen M. Cameron 		irq_set_affinity_hint(h->intr[i], NULL);
6679254f796bSMatt Gates 		free_irq(h->intr[i], &h->q[i]);
6680254f796bSMatt Gates 		return;
6681254f796bSMatt Gates 	}
6682254f796bSMatt Gates 
668341b3cf08SStephen M. Cameron 	for (i = 0; i < h->msix_vector; i++) {
668441b3cf08SStephen M. Cameron 		irq_set_affinity_hint(h->intr[i], NULL);
6685254f796bSMatt Gates 		free_irq(h->intr[i], &h->q[i]);
6686254f796bSMatt Gates 	}
668741b3cf08SStephen M. Cameron }
6688254f796bSMatt Gates 
66890097f0f4SStephen M. Cameron static void hpsa_free_irqs_and_disable_msix(struct ctlr_info *h)
669064670ac8SStephen M. Cameron {
6691254f796bSMatt Gates 	free_irqs(h);
669264670ac8SStephen M. Cameron #ifdef CONFIG_PCI_MSI
66930097f0f4SStephen M. Cameron 	if (h->msix_vector) {
66940097f0f4SStephen M. Cameron 		if (h->pdev->msix_enabled)
669564670ac8SStephen M. Cameron 			pci_disable_msix(h->pdev);
66960097f0f4SStephen M. Cameron 	} else if (h->msi_vector) {
66970097f0f4SStephen M. Cameron 		if (h->pdev->msi_enabled)
669864670ac8SStephen M. Cameron 			pci_disable_msi(h->pdev);
66990097f0f4SStephen M. Cameron 	}
670064670ac8SStephen M. Cameron #endif /* CONFIG_PCI_MSI */
67010097f0f4SStephen M. Cameron }
67020097f0f4SStephen M. Cameron 
6703072b0518SStephen M. Cameron static void hpsa_free_reply_queues(struct ctlr_info *h)
6704072b0518SStephen M. Cameron {
6705072b0518SStephen M. Cameron 	int i;
6706072b0518SStephen M. Cameron 
6707072b0518SStephen M. Cameron 	for (i = 0; i < h->nreply_queues; i++) {
6708072b0518SStephen M. Cameron 		if (!h->reply_queue[i].head)
6709072b0518SStephen M. Cameron 			continue;
6710072b0518SStephen M. Cameron 		pci_free_consistent(h->pdev, h->reply_queue_size,
6711072b0518SStephen M. Cameron 			h->reply_queue[i].head, h->reply_queue[i].busaddr);
6712072b0518SStephen M. Cameron 		h->reply_queue[i].head = NULL;
6713072b0518SStephen M. Cameron 		h->reply_queue[i].busaddr = 0;
6714072b0518SStephen M. Cameron 	}
6715072b0518SStephen M. Cameron }
6716072b0518SStephen M. Cameron 
67170097f0f4SStephen M. Cameron static void hpsa_undo_allocations_after_kdump_soft_reset(struct ctlr_info *h)
67180097f0f4SStephen M. Cameron {
67190097f0f4SStephen M. Cameron 	hpsa_free_irqs_and_disable_msix(h);
672064670ac8SStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
672164670ac8SStephen M. Cameron 	hpsa_free_cmd_pool(h);
6722e1f7de0cSMatt Gates 	kfree(h->ioaccel1_blockFetchTable);
672364670ac8SStephen M. Cameron 	kfree(h->blockFetchTable);
6724072b0518SStephen M. Cameron 	hpsa_free_reply_queues(h);
672564670ac8SStephen M. Cameron 	if (h->vaddr)
672664670ac8SStephen M. Cameron 		iounmap(h->vaddr);
672764670ac8SStephen M. Cameron 	if (h->transtable)
672864670ac8SStephen M. Cameron 		iounmap(h->transtable);
672964670ac8SStephen M. Cameron 	if (h->cfgtable)
673064670ac8SStephen M. Cameron 		iounmap(h->cfgtable);
6731132aa220STomas Henzl 	pci_disable_device(h->pdev);
673264670ac8SStephen M. Cameron 	pci_release_regions(h->pdev);
673364670ac8SStephen M. Cameron 	kfree(h);
673464670ac8SStephen M. Cameron }
673564670ac8SStephen M. Cameron 
6736a0c12413SStephen M. Cameron /* Called when controller lockup detected. */
6737a0c12413SStephen M. Cameron static void fail_all_cmds_on_list(struct ctlr_info *h, struct list_head *list)
6738a0c12413SStephen M. Cameron {
6739a0c12413SStephen M. Cameron 	struct CommandList *c = NULL;
6740a0c12413SStephen M. Cameron 
6741a0c12413SStephen M. Cameron 	assert_spin_locked(&h->lock);
6742a0c12413SStephen M. Cameron 	/* Mark all outstanding commands as failed and complete them. */
6743a0c12413SStephen M. Cameron 	while (!list_empty(list)) {
6744a0c12413SStephen M. Cameron 		c = list_entry(list->next, struct CommandList, list);
6745a0c12413SStephen M. Cameron 		c->err_info->CommandStatus = CMD_HARDWARE_ERR;
67465a3d16f5SStephen M. Cameron 		finish_cmd(c);
6747a0c12413SStephen M. Cameron 	}
6748a0c12413SStephen M. Cameron }
6749a0c12413SStephen M. Cameron 
6750094963daSStephen M. Cameron static void set_lockup_detected_for_all_cpus(struct ctlr_info *h, u32 value)
6751094963daSStephen M. Cameron {
6752094963daSStephen M. Cameron 	int i, cpu;
6753094963daSStephen M. Cameron 
6754094963daSStephen M. Cameron 	cpu = cpumask_first(cpu_online_mask);
6755094963daSStephen M. Cameron 	for (i = 0; i < num_online_cpus(); i++) {
6756094963daSStephen M. Cameron 		u32 *lockup_detected;
6757094963daSStephen M. Cameron 		lockup_detected = per_cpu_ptr(h->lockup_detected, cpu);
6758094963daSStephen M. Cameron 		*lockup_detected = value;
6759094963daSStephen M. Cameron 		cpu = cpumask_next(cpu, cpu_online_mask);
6760094963daSStephen M. Cameron 	}
6761094963daSStephen M. Cameron 	wmb(); /* be sure the per-cpu variables are out to memory */
6762094963daSStephen M. Cameron }
6763094963daSStephen M. Cameron 
6764a0c12413SStephen M. Cameron static void controller_lockup_detected(struct ctlr_info *h)
6765a0c12413SStephen M. Cameron {
6766a0c12413SStephen M. Cameron 	unsigned long flags;
6767094963daSStephen M. Cameron 	u32 lockup_detected;
6768a0c12413SStephen M. Cameron 
6769a0c12413SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_OFF);
6770a0c12413SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
6771094963daSStephen M. Cameron 	lockup_detected = readl(h->vaddr + SA5_SCRATCHPAD_OFFSET);
6772094963daSStephen M. Cameron 	if (!lockup_detected) {
6773094963daSStephen M. Cameron 		/* no heartbeat, but controller gave us a zero. */
6774094963daSStephen M. Cameron 		dev_warn(&h->pdev->dev,
6775094963daSStephen M. Cameron 			"lockup detected but scratchpad register is zero\n");
6776094963daSStephen M. Cameron 		lockup_detected = 0xffffffff;
6777094963daSStephen M. Cameron 	}
6778094963daSStephen M. Cameron 	set_lockup_detected_for_all_cpus(h, lockup_detected);
6779a0c12413SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
6780a0c12413SStephen M. Cameron 	dev_warn(&h->pdev->dev, "Controller lockup detected: 0x%08x\n",
6781094963daSStephen M. Cameron 			lockup_detected);
6782a0c12413SStephen M. Cameron 	pci_disable_device(h->pdev);
6783a0c12413SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
6784a0c12413SStephen M. Cameron 	fail_all_cmds_on_list(h, &h->cmpQ);
6785a0c12413SStephen M. Cameron 	fail_all_cmds_on_list(h, &h->reqQ);
6786a0c12413SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
6787a0c12413SStephen M. Cameron }
6788a0c12413SStephen M. Cameron 
6789a0c12413SStephen M. Cameron static void detect_controller_lockup(struct ctlr_info *h)
6790a0c12413SStephen M. Cameron {
6791a0c12413SStephen M. Cameron 	u64 now;
6792a0c12413SStephen M. Cameron 	u32 heartbeat;
6793a0c12413SStephen M. Cameron 	unsigned long flags;
6794a0c12413SStephen M. Cameron 
6795a0c12413SStephen M. Cameron 	now = get_jiffies_64();
6796a0c12413SStephen M. Cameron 	/* If we've received an interrupt recently, we're ok. */
6797a0c12413SStephen M. Cameron 	if (time_after64(h->last_intr_timestamp +
6798e85c5974SStephen M. Cameron 				(h->heartbeat_sample_interval), now))
6799a0c12413SStephen M. Cameron 		return;
6800a0c12413SStephen M. Cameron 
6801a0c12413SStephen M. Cameron 	/*
6802a0c12413SStephen M. Cameron 	 * If we've already checked the heartbeat recently, we're ok.
6803a0c12413SStephen M. Cameron 	 * This could happen if someone sends us a signal. We
6804a0c12413SStephen M. Cameron 	 * otherwise don't care about signals in this thread.
6805a0c12413SStephen M. Cameron 	 */
6806a0c12413SStephen M. Cameron 	if (time_after64(h->last_heartbeat_timestamp +
6807e85c5974SStephen M. Cameron 				(h->heartbeat_sample_interval), now))
6808a0c12413SStephen M. Cameron 		return;
6809a0c12413SStephen M. Cameron 
6810a0c12413SStephen M. Cameron 	/* If heartbeat has not changed since we last looked, we're not ok. */
6811a0c12413SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
6812a0c12413SStephen M. Cameron 	heartbeat = readl(&h->cfgtable->HeartBeat);
6813a0c12413SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
6814a0c12413SStephen M. Cameron 	if (h->last_heartbeat == heartbeat) {
6815a0c12413SStephen M. Cameron 		controller_lockup_detected(h);
6816a0c12413SStephen M. Cameron 		return;
6817a0c12413SStephen M. Cameron 	}
6818a0c12413SStephen M. Cameron 
6819a0c12413SStephen M. Cameron 	/* We're ok. */
6820a0c12413SStephen M. Cameron 	h->last_heartbeat = heartbeat;
6821a0c12413SStephen M. Cameron 	h->last_heartbeat_timestamp = now;
6822a0c12413SStephen M. Cameron }
6823a0c12413SStephen M. Cameron 
68249846590eSStephen M. Cameron static void hpsa_ack_ctlr_events(struct ctlr_info *h)
682576438d08SStephen M. Cameron {
682676438d08SStephen M. Cameron 	int i;
682776438d08SStephen M. Cameron 	char *event_type;
682876438d08SStephen M. Cameron 
6829e863d68eSScott Teel 	/* Clear the driver-requested rescan flag */
6830e863d68eSScott Teel 	h->drv_req_rescan = 0;
6831e863d68eSScott Teel 
683276438d08SStephen M. Cameron 	/* Ask the controller to clear the events we're handling. */
68331f7cee8cSStephen M. Cameron 	if ((h->transMethod & (CFGTBL_Trans_io_accel1
68341f7cee8cSStephen M. Cameron 			| CFGTBL_Trans_io_accel2)) &&
683576438d08SStephen M. Cameron 		(h->events & HPSA_EVENT_NOTIFY_ACCEL_IO_PATH_STATE_CHANGE ||
683676438d08SStephen M. Cameron 		 h->events & HPSA_EVENT_NOTIFY_ACCEL_IO_PATH_CONFIG_CHANGE)) {
683776438d08SStephen M. Cameron 
683876438d08SStephen M. Cameron 		if (h->events & HPSA_EVENT_NOTIFY_ACCEL_IO_PATH_STATE_CHANGE)
683976438d08SStephen M. Cameron 			event_type = "state change";
684076438d08SStephen M. Cameron 		if (h->events & HPSA_EVENT_NOTIFY_ACCEL_IO_PATH_CONFIG_CHANGE)
684176438d08SStephen M. Cameron 			event_type = "configuration change";
684276438d08SStephen M. Cameron 		/* Stop sending new RAID offload reqs via the IO accelerator */
684376438d08SStephen M. Cameron 		scsi_block_requests(h->scsi_host);
684476438d08SStephen M. Cameron 		for (i = 0; i < h->ndevices; i++)
684576438d08SStephen M. Cameron 			h->dev[i]->offload_enabled = 0;
684623100dd9SStephen M. Cameron 		hpsa_drain_accel_commands(h);
684776438d08SStephen M. Cameron 		/* Set 'accelerator path config change' bit */
684876438d08SStephen M. Cameron 		dev_warn(&h->pdev->dev,
684976438d08SStephen M. Cameron 			"Acknowledging event: 0x%08x (HP SSD Smart Path %s)\n",
685076438d08SStephen M. Cameron 			h->events, event_type);
685176438d08SStephen M. Cameron 		writel(h->events, &(h->cfgtable->clear_event_notify));
685276438d08SStephen M. Cameron 		/* Set the "clear event notify field update" bit 6 */
685376438d08SStephen M. Cameron 		writel(DOORBELL_CLEAR_EVENTS, h->vaddr + SA5_DOORBELL);
685476438d08SStephen M. Cameron 		/* Wait until ctlr clears 'clear event notify field', bit 6 */
685576438d08SStephen M. Cameron 		hpsa_wait_for_clear_event_notify_ack(h);
685676438d08SStephen M. Cameron 		scsi_unblock_requests(h->scsi_host);
685776438d08SStephen M. Cameron 	} else {
685876438d08SStephen M. Cameron 		/* Acknowledge controller notification events. */
685976438d08SStephen M. Cameron 		writel(h->events, &(h->cfgtable->clear_event_notify));
686076438d08SStephen M. Cameron 		writel(DOORBELL_CLEAR_EVENTS, h->vaddr + SA5_DOORBELL);
686176438d08SStephen M. Cameron 		hpsa_wait_for_clear_event_notify_ack(h);
686276438d08SStephen M. Cameron #if 0
686376438d08SStephen M. Cameron 		writel(CFGTBL_ChangeReq, h->vaddr + SA5_DOORBELL);
686476438d08SStephen M. Cameron 		hpsa_wait_for_mode_change_ack(h);
686576438d08SStephen M. Cameron #endif
686676438d08SStephen M. Cameron 	}
68679846590eSStephen M. Cameron 	return;
686876438d08SStephen M. Cameron }
686976438d08SStephen M. Cameron 
687076438d08SStephen M. Cameron /* Check a register on the controller to see if there are configuration
687176438d08SStephen M. Cameron  * changes (added/changed/removed logical drives, etc.) which mean that
6872e863d68eSScott Teel  * we should rescan the controller for devices.
6873e863d68eSScott Teel  * Also check flag for driver-initiated rescan.
687476438d08SStephen M. Cameron  */
68759846590eSStephen M. Cameron static int hpsa_ctlr_needs_rescan(struct ctlr_info *h)
687676438d08SStephen M. Cameron {
68779846590eSStephen M. Cameron 	if (h->drv_req_rescan)
68789846590eSStephen M. Cameron 		return 1;
68799846590eSStephen M. Cameron 
688076438d08SStephen M. Cameron 	if (!(h->fw_support & MISC_FW_EVENT_NOTIFY))
68819846590eSStephen M. Cameron 		return 0;
688276438d08SStephen M. Cameron 
688376438d08SStephen M. Cameron 	h->events = readl(&(h->cfgtable->event_notify));
68849846590eSStephen M. Cameron 	return h->events & RESCAN_REQUIRED_EVENT_BITS;
68859846590eSStephen M. Cameron }
688676438d08SStephen M. Cameron 
688776438d08SStephen M. Cameron /*
68889846590eSStephen M. Cameron  * Check if any of the offline devices have become ready
688976438d08SStephen M. Cameron  */
68909846590eSStephen M. Cameron static int hpsa_offline_devices_ready(struct ctlr_info *h)
68919846590eSStephen M. Cameron {
68929846590eSStephen M. Cameron 	unsigned long flags;
68939846590eSStephen M. Cameron 	struct offline_device_entry *d;
68949846590eSStephen M. Cameron 	struct list_head *this, *tmp;
68959846590eSStephen M. Cameron 
68969846590eSStephen M. Cameron 	spin_lock_irqsave(&h->offline_device_lock, flags);
68979846590eSStephen M. Cameron 	list_for_each_safe(this, tmp, &h->offline_device_list) {
68989846590eSStephen M. Cameron 		d = list_entry(this, struct offline_device_entry,
68999846590eSStephen M. Cameron 				offline_list);
69009846590eSStephen M. Cameron 		spin_unlock_irqrestore(&h->offline_device_lock, flags);
6901d1fea47cSStephen M. Cameron 		if (!hpsa_volume_offline(h, d->scsi3addr)) {
6902d1fea47cSStephen M. Cameron 			spin_lock_irqsave(&h->offline_device_lock, flags);
6903d1fea47cSStephen M. Cameron 			list_del(&d->offline_list);
6904d1fea47cSStephen M. Cameron 			spin_unlock_irqrestore(&h->offline_device_lock, flags);
69059846590eSStephen M. Cameron 			return 1;
6906d1fea47cSStephen M. Cameron 		}
69079846590eSStephen M. Cameron 		spin_lock_irqsave(&h->offline_device_lock, flags);
690876438d08SStephen M. Cameron 	}
69099846590eSStephen M. Cameron 	spin_unlock_irqrestore(&h->offline_device_lock, flags);
69109846590eSStephen M. Cameron 	return 0;
69119846590eSStephen M. Cameron }
69129846590eSStephen M. Cameron 
691376438d08SStephen M. Cameron 
69148a98db73SStephen M. Cameron static void hpsa_monitor_ctlr_worker(struct work_struct *work)
6915a0c12413SStephen M. Cameron {
6916a0c12413SStephen M. Cameron 	unsigned long flags;
69178a98db73SStephen M. Cameron 	struct ctlr_info *h = container_of(to_delayed_work(work),
69188a98db73SStephen M. Cameron 					struct ctlr_info, monitor_ctlr_work);
6919a0c12413SStephen M. Cameron 	detect_controller_lockup(h);
6920094963daSStephen M. Cameron 	if (lockup_detected(h))
69218a98db73SStephen M. Cameron 		return;
69229846590eSStephen M. Cameron 
69239846590eSStephen M. Cameron 	if (hpsa_ctlr_needs_rescan(h) || hpsa_offline_devices_ready(h)) {
69249846590eSStephen M. Cameron 		scsi_host_get(h->scsi_host);
69259846590eSStephen M. Cameron 		h->drv_req_rescan = 0;
69269846590eSStephen M. Cameron 		hpsa_ack_ctlr_events(h);
69279846590eSStephen M. Cameron 		hpsa_scan_start(h->scsi_host);
69289846590eSStephen M. Cameron 		scsi_host_put(h->scsi_host);
69299846590eSStephen M. Cameron 	}
69309846590eSStephen M. Cameron 
69318a98db73SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
69328a98db73SStephen M. Cameron 	if (h->remove_in_progress) {
69338a98db73SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
6934a0c12413SStephen M. Cameron 		return;
6935a0c12413SStephen M. Cameron 	}
69368a98db73SStephen M. Cameron 	schedule_delayed_work(&h->monitor_ctlr_work,
69378a98db73SStephen M. Cameron 				h->heartbeat_sample_interval);
69388a98db73SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
6939a0c12413SStephen M. Cameron }
6940a0c12413SStephen M. Cameron 
69416f039790SGreg Kroah-Hartman static int hpsa_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
69424c2a8c40SStephen M. Cameron {
69434c2a8c40SStephen M. Cameron 	int dac, rc;
69444c2a8c40SStephen M. Cameron 	struct ctlr_info *h;
694564670ac8SStephen M. Cameron 	int try_soft_reset = 0;
694664670ac8SStephen M. Cameron 	unsigned long flags;
69474c2a8c40SStephen M. Cameron 
69484c2a8c40SStephen M. Cameron 	if (number_of_controllers == 0)
69494c2a8c40SStephen M. Cameron 		printk(KERN_INFO DRIVER_NAME "\n");
69504c2a8c40SStephen M. Cameron 
69514c2a8c40SStephen M. Cameron 	rc = hpsa_init_reset_devices(pdev);
695264670ac8SStephen M. Cameron 	if (rc) {
695364670ac8SStephen M. Cameron 		if (rc != -ENOTSUPP)
69544c2a8c40SStephen M. Cameron 			return rc;
695564670ac8SStephen M. Cameron 		/* If the reset fails in a particular way (it has no way to do
695664670ac8SStephen M. Cameron 		 * a proper hard reset, so returns -ENOTSUPP) we can try to do
695764670ac8SStephen M. Cameron 		 * a soft reset once we get the controller configured up to the
695864670ac8SStephen M. Cameron 		 * point that it can accept a command.
695964670ac8SStephen M. Cameron 		 */
696064670ac8SStephen M. Cameron 		try_soft_reset = 1;
696164670ac8SStephen M. Cameron 		rc = 0;
696264670ac8SStephen M. Cameron 	}
696364670ac8SStephen M. Cameron 
696464670ac8SStephen M. Cameron reinit_after_soft_reset:
69654c2a8c40SStephen M. Cameron 
6966303932fdSDon Brace 	/* Command structures must be aligned on a 32-byte boundary because
6967303932fdSDon Brace 	 * the 5 lower bits of the address are used by the hardware. and by
6968303932fdSDon Brace 	 * the driver.  See comments in hpsa.h for more info.
6969303932fdSDon Brace 	 */
6970303932fdSDon Brace 	BUILD_BUG_ON(sizeof(struct CommandList) % COMMANDLIST_ALIGNMENT);
6971edd16368SStephen M. Cameron 	h = kzalloc(sizeof(*h), GFP_KERNEL);
6972edd16368SStephen M. Cameron 	if (!h)
6973ecd9aad4SStephen M. Cameron 		return -ENOMEM;
6974edd16368SStephen M. Cameron 
697555c06c71SStephen M. Cameron 	h->pdev = pdev;
6976a9a3a273SStephen M. Cameron 	h->intr_mode = hpsa_simple_mode ? SIMPLE_MODE_INT : PERF_MODE_INT;
69779e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&h->cmpQ);
69789e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&h->reqQ);
69799846590eSStephen M. Cameron 	INIT_LIST_HEAD(&h->offline_device_list);
69806eaf46fdSStephen M. Cameron 	spin_lock_init(&h->lock);
69819846590eSStephen M. Cameron 	spin_lock_init(&h->offline_device_lock);
69826eaf46fdSStephen M. Cameron 	spin_lock_init(&h->scan_lock);
69830390f0c0SStephen M. Cameron 	spin_lock_init(&h->passthru_count_lock);
6984094963daSStephen M. Cameron 
6985094963daSStephen M. Cameron 	/* Allocate and clear per-cpu variable lockup_detected */
6986094963daSStephen M. Cameron 	h->lockup_detected = alloc_percpu(u32);
69872a5ac326SStephen M. Cameron 	if (!h->lockup_detected) {
69882a5ac326SStephen M. Cameron 		rc = -ENOMEM;
6989094963daSStephen M. Cameron 		goto clean1;
69902a5ac326SStephen M. Cameron 	}
6991094963daSStephen M. Cameron 	set_lockup_detected_for_all_cpus(h, 0);
6992094963daSStephen M. Cameron 
699355c06c71SStephen M. Cameron 	rc = hpsa_pci_init(h);
6994ecd9aad4SStephen M. Cameron 	if (rc != 0)
6995edd16368SStephen M. Cameron 		goto clean1;
6996edd16368SStephen M. Cameron 
6997f79cfec6SStephen M. Cameron 	sprintf(h->devname, HPSA "%d", number_of_controllers);
6998edd16368SStephen M. Cameron 	h->ctlr = number_of_controllers;
6999edd16368SStephen M. Cameron 	number_of_controllers++;
7000edd16368SStephen M. Cameron 
7001edd16368SStephen M. Cameron 	/* configure PCI DMA stuff */
7002ecd9aad4SStephen M. Cameron 	rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
7003ecd9aad4SStephen M. Cameron 	if (rc == 0) {
7004edd16368SStephen M. Cameron 		dac = 1;
7005ecd9aad4SStephen M. Cameron 	} else {
7006ecd9aad4SStephen M. Cameron 		rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
7007ecd9aad4SStephen M. Cameron 		if (rc == 0) {
7008edd16368SStephen M. Cameron 			dac = 0;
7009ecd9aad4SStephen M. Cameron 		} else {
7010edd16368SStephen M. Cameron 			dev_err(&pdev->dev, "no suitable DMA available\n");
7011edd16368SStephen M. Cameron 			goto clean1;
7012edd16368SStephen M. Cameron 		}
7013ecd9aad4SStephen M. Cameron 	}
7014edd16368SStephen M. Cameron 
7015edd16368SStephen M. Cameron 	/* make sure the board interrupts are off */
7016edd16368SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_OFF);
701710f66018SStephen M. Cameron 
70180ae01a32SStephen M. Cameron 	if (hpsa_request_irq(h, do_hpsa_intr_msi, do_hpsa_intr_intx))
7019edd16368SStephen M. Cameron 		goto clean2;
7020303932fdSDon Brace 	dev_info(&pdev->dev, "%s: <0x%x> at IRQ %d%s using DAC\n",
7021303932fdSDon Brace 	       h->devname, pdev->device,
7022a9a3a273SStephen M. Cameron 	       h->intr[h->intr_mode], dac ? "" : " not");
70232e9d1b36SStephen M. Cameron 	if (hpsa_allocate_cmd_pool(h))
7024edd16368SStephen M. Cameron 		goto clean4;
702533a2ffceSStephen M. Cameron 	if (hpsa_allocate_sg_chain_blocks(h))
702633a2ffceSStephen M. Cameron 		goto clean4;
7027a08a8471SStephen M. Cameron 	init_waitqueue_head(&h->scan_wait_queue);
7028a08a8471SStephen M. Cameron 	h->scan_finished = 1; /* no scan currently in progress */
7029edd16368SStephen M. Cameron 
7030edd16368SStephen M. Cameron 	pci_set_drvdata(pdev, h);
70319a41338eSStephen M. Cameron 	h->ndevices = 0;
7032316b221aSStephen M. Cameron 	h->hba_mode_enabled = 0;
70339a41338eSStephen M. Cameron 	h->scsi_host = NULL;
70349a41338eSStephen M. Cameron 	spin_lock_init(&h->devlock);
703564670ac8SStephen M. Cameron 	hpsa_put_ctlr_into_performant_mode(h);
703664670ac8SStephen M. Cameron 
703764670ac8SStephen M. Cameron 	/* At this point, the controller is ready to take commands.
703864670ac8SStephen M. Cameron 	 * Now, if reset_devices and the hard reset didn't work, try
703964670ac8SStephen M. Cameron 	 * the soft reset and see if that works.
704064670ac8SStephen M. Cameron 	 */
704164670ac8SStephen M. Cameron 	if (try_soft_reset) {
704264670ac8SStephen M. Cameron 
704364670ac8SStephen M. Cameron 		/* This is kind of gross.  We may or may not get a completion
704464670ac8SStephen M. Cameron 		 * from the soft reset command, and if we do, then the value
704564670ac8SStephen M. Cameron 		 * from the fifo may or may not be valid.  So, we wait 10 secs
704664670ac8SStephen M. Cameron 		 * after the reset throwing away any completions we get during
704764670ac8SStephen M. Cameron 		 * that time.  Unregister the interrupt handler and register
704864670ac8SStephen M. Cameron 		 * fake ones to scoop up any residual completions.
704964670ac8SStephen M. Cameron 		 */
705064670ac8SStephen M. Cameron 		spin_lock_irqsave(&h->lock, flags);
705164670ac8SStephen M. Cameron 		h->access.set_intr_mask(h, HPSA_INTR_OFF);
705264670ac8SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
7053254f796bSMatt Gates 		free_irqs(h);
705464670ac8SStephen M. Cameron 		rc = hpsa_request_irq(h, hpsa_msix_discard_completions,
705564670ac8SStephen M. Cameron 					hpsa_intx_discard_completions);
705664670ac8SStephen M. Cameron 		if (rc) {
705764670ac8SStephen M. Cameron 			dev_warn(&h->pdev->dev, "Failed to request_irq after "
705864670ac8SStephen M. Cameron 				"soft reset.\n");
705964670ac8SStephen M. Cameron 			goto clean4;
706064670ac8SStephen M. Cameron 		}
706164670ac8SStephen M. Cameron 
706264670ac8SStephen M. Cameron 		rc = hpsa_kdump_soft_reset(h);
706364670ac8SStephen M. Cameron 		if (rc)
706464670ac8SStephen M. Cameron 			/* Neither hard nor soft reset worked, we're hosed. */
706564670ac8SStephen M. Cameron 			goto clean4;
706664670ac8SStephen M. Cameron 
706764670ac8SStephen M. Cameron 		dev_info(&h->pdev->dev, "Board READY.\n");
706864670ac8SStephen M. Cameron 		dev_info(&h->pdev->dev,
706964670ac8SStephen M. Cameron 			"Waiting for stale completions to drain.\n");
707064670ac8SStephen M. Cameron 		h->access.set_intr_mask(h, HPSA_INTR_ON);
707164670ac8SStephen M. Cameron 		msleep(10000);
707264670ac8SStephen M. Cameron 		h->access.set_intr_mask(h, HPSA_INTR_OFF);
707364670ac8SStephen M. Cameron 
707464670ac8SStephen M. Cameron 		rc = controller_reset_failed(h->cfgtable);
707564670ac8SStephen M. Cameron 		if (rc)
707664670ac8SStephen M. Cameron 			dev_info(&h->pdev->dev,
707764670ac8SStephen M. Cameron 				"Soft reset appears to have failed.\n");
707864670ac8SStephen M. Cameron 
707964670ac8SStephen M. Cameron 		/* since the controller's reset, we have to go back and re-init
708064670ac8SStephen M. Cameron 		 * everything.  Easiest to just forget what we've done and do it
708164670ac8SStephen M. Cameron 		 * all over again.
708264670ac8SStephen M. Cameron 		 */
708364670ac8SStephen M. Cameron 		hpsa_undo_allocations_after_kdump_soft_reset(h);
708464670ac8SStephen M. Cameron 		try_soft_reset = 0;
708564670ac8SStephen M. Cameron 		if (rc)
708664670ac8SStephen M. Cameron 			/* don't go to clean4, we already unallocated */
708764670ac8SStephen M. Cameron 			return -ENODEV;
708864670ac8SStephen M. Cameron 
708964670ac8SStephen M. Cameron 		goto reinit_after_soft_reset;
709064670ac8SStephen M. Cameron 	}
7091edd16368SStephen M. Cameron 
7092da0697bdSScott Teel 		/* Enable Accelerated IO path at driver layer */
7093da0697bdSScott Teel 		h->acciopath_status = 1;
7094da0697bdSScott Teel 
7095e863d68eSScott Teel 	h->drv_req_rescan = 0;
7096e863d68eSScott Teel 
7097edd16368SStephen M. Cameron 	/* Turn the interrupts on so we can service requests */
7098edd16368SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_ON);
7099edd16368SStephen M. Cameron 
7100339b2b14SStephen M. Cameron 	hpsa_hba_inquiry(h);
7101edd16368SStephen M. Cameron 	hpsa_register_scsi(h);	/* hook ourselves into SCSI subsystem */
71028a98db73SStephen M. Cameron 
71038a98db73SStephen M. Cameron 	/* Monitor the controller for firmware lockups */
71048a98db73SStephen M. Cameron 	h->heartbeat_sample_interval = HEARTBEAT_SAMPLE_INTERVAL;
71058a98db73SStephen M. Cameron 	INIT_DELAYED_WORK(&h->monitor_ctlr_work, hpsa_monitor_ctlr_worker);
71068a98db73SStephen M. Cameron 	schedule_delayed_work(&h->monitor_ctlr_work,
71078a98db73SStephen M. Cameron 				h->heartbeat_sample_interval);
710888bf6d62SStephen M. Cameron 	return 0;
7109edd16368SStephen M. Cameron 
7110edd16368SStephen M. Cameron clean4:
711133a2ffceSStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
71122e9d1b36SStephen M. Cameron 	hpsa_free_cmd_pool(h);
7113254f796bSMatt Gates 	free_irqs(h);
7114edd16368SStephen M. Cameron clean2:
7115edd16368SStephen M. Cameron clean1:
7116094963daSStephen M. Cameron 	if (h->lockup_detected)
7117094963daSStephen M. Cameron 		free_percpu(h->lockup_detected);
7118edd16368SStephen M. Cameron 	kfree(h);
7119ecd9aad4SStephen M. Cameron 	return rc;
7120edd16368SStephen M. Cameron }
7121edd16368SStephen M. Cameron 
7122edd16368SStephen M. Cameron static void hpsa_flush_cache(struct ctlr_info *h)
7123edd16368SStephen M. Cameron {
7124edd16368SStephen M. Cameron 	char *flush_buf;
7125edd16368SStephen M. Cameron 	struct CommandList *c;
7126702890e3SStephen M. Cameron 
7127702890e3SStephen M. Cameron 	/* Don't bother trying to flush the cache if locked up */
7128094963daSStephen M. Cameron 	if (unlikely(lockup_detected(h)))
7129702890e3SStephen M. Cameron 		return;
7130edd16368SStephen M. Cameron 	flush_buf = kzalloc(4, GFP_KERNEL);
7131edd16368SStephen M. Cameron 	if (!flush_buf)
7132edd16368SStephen M. Cameron 		return;
7133edd16368SStephen M. Cameron 
7134edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
7135edd16368SStephen M. Cameron 	if (!c) {
7136edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
7137edd16368SStephen M. Cameron 		goto out_of_memory;
7138edd16368SStephen M. Cameron 	}
7139a2dac136SStephen M. Cameron 	if (fill_cmd(c, HPSA_CACHE_FLUSH, h, flush_buf, 4, 0,
7140a2dac136SStephen M. Cameron 		RAID_CTLR_LUNID, TYPE_CMD)) {
7141a2dac136SStephen M. Cameron 		goto out;
7142a2dac136SStephen M. Cameron 	}
7143edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_TODEVICE);
7144edd16368SStephen M. Cameron 	if (c->err_info->CommandStatus != 0)
7145a2dac136SStephen M. Cameron out:
7146edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev,
7147edd16368SStephen M. Cameron 			"error flushing cache on controller\n");
7148edd16368SStephen M. Cameron 	cmd_special_free(h, c);
7149edd16368SStephen M. Cameron out_of_memory:
7150edd16368SStephen M. Cameron 	kfree(flush_buf);
7151edd16368SStephen M. Cameron }
7152edd16368SStephen M. Cameron 
7153edd16368SStephen M. Cameron static void hpsa_shutdown(struct pci_dev *pdev)
7154edd16368SStephen M. Cameron {
7155edd16368SStephen M. Cameron 	struct ctlr_info *h;
7156edd16368SStephen M. Cameron 
7157edd16368SStephen M. Cameron 	h = pci_get_drvdata(pdev);
7158edd16368SStephen M. Cameron 	/* Turn board interrupts off  and send the flush cache command
7159edd16368SStephen M. Cameron 	 * sendcmd will turn off interrupt, and send the flush...
7160edd16368SStephen M. Cameron 	 * To write all data in the battery backed cache to disks
7161edd16368SStephen M. Cameron 	 */
7162edd16368SStephen M. Cameron 	hpsa_flush_cache(h);
7163edd16368SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_OFF);
71640097f0f4SStephen M. Cameron 	hpsa_free_irqs_and_disable_msix(h);
7165edd16368SStephen M. Cameron }
7166edd16368SStephen M. Cameron 
71676f039790SGreg Kroah-Hartman static void hpsa_free_device_info(struct ctlr_info *h)
716855e14e76SStephen M. Cameron {
716955e14e76SStephen M. Cameron 	int i;
717055e14e76SStephen M. Cameron 
717155e14e76SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++)
717255e14e76SStephen M. Cameron 		kfree(h->dev[i]);
717355e14e76SStephen M. Cameron }
717455e14e76SStephen M. Cameron 
71756f039790SGreg Kroah-Hartman static void hpsa_remove_one(struct pci_dev *pdev)
7176edd16368SStephen M. Cameron {
7177edd16368SStephen M. Cameron 	struct ctlr_info *h;
71788a98db73SStephen M. Cameron 	unsigned long flags;
7179edd16368SStephen M. Cameron 
7180edd16368SStephen M. Cameron 	if (pci_get_drvdata(pdev) == NULL) {
7181edd16368SStephen M. Cameron 		dev_err(&pdev->dev, "unable to remove device\n");
7182edd16368SStephen M. Cameron 		return;
7183edd16368SStephen M. Cameron 	}
7184edd16368SStephen M. Cameron 	h = pci_get_drvdata(pdev);
71858a98db73SStephen M. Cameron 
71868a98db73SStephen M. Cameron 	/* Get rid of any controller monitoring work items */
71878a98db73SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
71888a98db73SStephen M. Cameron 	h->remove_in_progress = 1;
71898a98db73SStephen M. Cameron 	cancel_delayed_work(&h->monitor_ctlr_work);
71908a98db73SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
71918a98db73SStephen M. Cameron 
7192edd16368SStephen M. Cameron 	hpsa_unregister_scsi(h);	/* unhook from SCSI subsystem */
7193edd16368SStephen M. Cameron 	hpsa_shutdown(pdev);
7194edd16368SStephen M. Cameron 	iounmap(h->vaddr);
7195204892e9SStephen M. Cameron 	iounmap(h->transtable);
7196204892e9SStephen M. Cameron 	iounmap(h->cfgtable);
719755e14e76SStephen M. Cameron 	hpsa_free_device_info(h);
719833a2ffceSStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
7199edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev,
7200edd16368SStephen M. Cameron 		h->nr_cmds * sizeof(struct CommandList),
7201edd16368SStephen M. Cameron 		h->cmd_pool, h->cmd_pool_dhandle);
7202edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev,
7203edd16368SStephen M. Cameron 		h->nr_cmds * sizeof(struct ErrorInfo),
7204edd16368SStephen M. Cameron 		h->errinfo_pool, h->errinfo_pool_dhandle);
7205072b0518SStephen M. Cameron 	hpsa_free_reply_queues(h);
7206edd16368SStephen M. Cameron 	kfree(h->cmd_pool_bits);
7207303932fdSDon Brace 	kfree(h->blockFetchTable);
7208e1f7de0cSMatt Gates 	kfree(h->ioaccel1_blockFetchTable);
7209aca9012aSStephen M. Cameron 	kfree(h->ioaccel2_blockFetchTable);
7210339b2b14SStephen M. Cameron 	kfree(h->hba_inquiry_data);
7211f0bd0b68SStephen M. Cameron 	pci_disable_device(pdev);
7212edd16368SStephen M. Cameron 	pci_release_regions(pdev);
7213094963daSStephen M. Cameron 	free_percpu(h->lockup_detected);
7214edd16368SStephen M. Cameron 	kfree(h);
7215edd16368SStephen M. Cameron }
7216edd16368SStephen M. Cameron 
7217edd16368SStephen M. Cameron static int hpsa_suspend(__attribute__((unused)) struct pci_dev *pdev,
7218edd16368SStephen M. Cameron 	__attribute__((unused)) pm_message_t state)
7219edd16368SStephen M. Cameron {
7220edd16368SStephen M. Cameron 	return -ENOSYS;
7221edd16368SStephen M. Cameron }
7222edd16368SStephen M. Cameron 
7223edd16368SStephen M. Cameron static int hpsa_resume(__attribute__((unused)) struct pci_dev *pdev)
7224edd16368SStephen M. Cameron {
7225edd16368SStephen M. Cameron 	return -ENOSYS;
7226edd16368SStephen M. Cameron }
7227edd16368SStephen M. Cameron 
7228edd16368SStephen M. Cameron static struct pci_driver hpsa_pci_driver = {
7229f79cfec6SStephen M. Cameron 	.name = HPSA,
7230edd16368SStephen M. Cameron 	.probe = hpsa_init_one,
72316f039790SGreg Kroah-Hartman 	.remove = hpsa_remove_one,
7232edd16368SStephen M. Cameron 	.id_table = hpsa_pci_device_id,	/* id_table */
7233edd16368SStephen M. Cameron 	.shutdown = hpsa_shutdown,
7234edd16368SStephen M. Cameron 	.suspend = hpsa_suspend,
7235edd16368SStephen M. Cameron 	.resume = hpsa_resume,
7236edd16368SStephen M. Cameron };
7237edd16368SStephen M. Cameron 
7238303932fdSDon Brace /* Fill in bucket_map[], given nsgs (the max number of
7239303932fdSDon Brace  * scatter gather elements supported) and bucket[],
7240303932fdSDon Brace  * which is an array of 8 integers.  The bucket[] array
7241303932fdSDon Brace  * contains 8 different DMA transfer sizes (in 16
7242303932fdSDon Brace  * byte increments) which the controller uses to fetch
7243303932fdSDon Brace  * commands.  This function fills in bucket_map[], which
7244303932fdSDon Brace  * maps a given number of scatter gather elements to one of
7245303932fdSDon Brace  * the 8 DMA transfer sizes.  The point of it is to allow the
7246303932fdSDon Brace  * controller to only do as much DMA as needed to fetch the
7247303932fdSDon Brace  * command, with the DMA transfer size encoded in the lower
7248303932fdSDon Brace  * bits of the command address.
7249303932fdSDon Brace  */
7250303932fdSDon Brace static void  calc_bucket_map(int bucket[], int num_buckets,
7251e1f7de0cSMatt Gates 	int nsgs, int min_blocks, int *bucket_map)
7252303932fdSDon Brace {
7253303932fdSDon Brace 	int i, j, b, size;
7254303932fdSDon Brace 
7255303932fdSDon Brace 	/* Note, bucket_map must have nsgs+1 entries. */
7256303932fdSDon Brace 	for (i = 0; i <= nsgs; i++) {
7257303932fdSDon Brace 		/* Compute size of a command with i SG entries */
7258e1f7de0cSMatt Gates 		size = i + min_blocks;
7259303932fdSDon Brace 		b = num_buckets; /* Assume the biggest bucket */
7260303932fdSDon Brace 		/* Find the bucket that is just big enough */
7261e1f7de0cSMatt Gates 		for (j = 0; j < num_buckets; j++) {
7262303932fdSDon Brace 			if (bucket[j] >= size) {
7263303932fdSDon Brace 				b = j;
7264303932fdSDon Brace 				break;
7265303932fdSDon Brace 			}
7266303932fdSDon Brace 		}
7267303932fdSDon Brace 		/* for a command with i SG entries, use bucket b. */
7268303932fdSDon Brace 		bucket_map[i] = b;
7269303932fdSDon Brace 	}
7270303932fdSDon Brace }
7271303932fdSDon Brace 
7272e1f7de0cSMatt Gates static void hpsa_enter_performant_mode(struct ctlr_info *h, u32 trans_support)
7273303932fdSDon Brace {
72746c311b57SStephen M. Cameron 	int i;
72756c311b57SStephen M. Cameron 	unsigned long register_value;
7276e1f7de0cSMatt Gates 	unsigned long transMethod = CFGTBL_Trans_Performant |
7277e1f7de0cSMatt Gates 			(trans_support & CFGTBL_Trans_use_short_tags) |
7278e1f7de0cSMatt Gates 				CFGTBL_Trans_enable_directed_msix |
7279b9af4937SStephen M. Cameron 			(trans_support & (CFGTBL_Trans_io_accel1 |
7280b9af4937SStephen M. Cameron 				CFGTBL_Trans_io_accel2));
7281e1f7de0cSMatt Gates 	struct access_method access = SA5_performant_access;
7282def342bdSStephen M. Cameron 
7283def342bdSStephen M. Cameron 	/* This is a bit complicated.  There are 8 registers on
7284def342bdSStephen M. Cameron 	 * the controller which we write to to tell it 8 different
7285def342bdSStephen M. Cameron 	 * sizes of commands which there may be.  It's a way of
7286def342bdSStephen M. Cameron 	 * reducing the DMA done to fetch each command.  Encoded into
7287def342bdSStephen M. Cameron 	 * each command's tag are 3 bits which communicate to the controller
7288def342bdSStephen M. Cameron 	 * which of the eight sizes that command fits within.  The size of
7289def342bdSStephen M. Cameron 	 * each command depends on how many scatter gather entries there are.
7290def342bdSStephen M. Cameron 	 * Each SG entry requires 16 bytes.  The eight registers are programmed
7291def342bdSStephen M. Cameron 	 * with the number of 16-byte blocks a command of that size requires.
7292def342bdSStephen M. Cameron 	 * The smallest command possible requires 5 such 16 byte blocks.
7293d66ae08bSStephen M. Cameron 	 * the largest command possible requires SG_ENTRIES_IN_CMD + 4 16-byte
7294def342bdSStephen M. Cameron 	 * blocks.  Note, this only extends to the SG entries contained
7295def342bdSStephen M. Cameron 	 * within the command block, and does not extend to chained blocks
7296def342bdSStephen M. Cameron 	 * of SG elements.   bft[] contains the eight values we write to
7297def342bdSStephen M. Cameron 	 * the registers.  They are not evenly distributed, but have more
7298def342bdSStephen M. Cameron 	 * sizes for small commands, and fewer sizes for larger commands.
7299def342bdSStephen M. Cameron 	 */
7300d66ae08bSStephen M. Cameron 	int bft[8] = {5, 6, 8, 10, 12, 20, 28, SG_ENTRIES_IN_CMD + 4};
7301b9af4937SStephen M. Cameron #define MIN_IOACCEL2_BFT_ENTRY 5
7302b9af4937SStephen M. Cameron #define HPSA_IOACCEL2_HEADER_SZ 4
7303b9af4937SStephen M. Cameron 	int bft2[16] = {MIN_IOACCEL2_BFT_ENTRY, 6, 7, 8, 9, 10, 11, 12,
7304b9af4937SStephen M. Cameron 			13, 14, 15, 16, 17, 18, 19,
7305b9af4937SStephen M. Cameron 			HPSA_IOACCEL2_HEADER_SZ + IOACCEL2_MAXSGENTRIES};
7306b9af4937SStephen M. Cameron 	BUILD_BUG_ON(ARRAY_SIZE(bft2) != 16);
7307b9af4937SStephen M. Cameron 	BUILD_BUG_ON(ARRAY_SIZE(bft) != 8);
7308b9af4937SStephen M. Cameron 	BUILD_BUG_ON(offsetof(struct io_accel2_cmd, sg) >
7309b9af4937SStephen M. Cameron 				 16 * MIN_IOACCEL2_BFT_ENTRY);
7310b9af4937SStephen M. Cameron 	BUILD_BUG_ON(sizeof(struct ioaccel2_sg_element) != 16);
7311d66ae08bSStephen M. Cameron 	BUILD_BUG_ON(28 > SG_ENTRIES_IN_CMD + 4);
7312303932fdSDon Brace 	/*  5 = 1 s/g entry or 4k
7313303932fdSDon Brace 	 *  6 = 2 s/g entry or 8k
7314303932fdSDon Brace 	 *  8 = 4 s/g entry or 16k
7315303932fdSDon Brace 	 * 10 = 6 s/g entry or 24k
7316303932fdSDon Brace 	 */
7317303932fdSDon Brace 
7318b3a52e79SStephen M. Cameron 	/* If the controller supports either ioaccel method then
7319b3a52e79SStephen M. Cameron 	 * we can also use the RAID stack submit path that does not
7320b3a52e79SStephen M. Cameron 	 * perform the superfluous readl() after each command submission.
7321b3a52e79SStephen M. Cameron 	 */
7322b3a52e79SStephen M. Cameron 	if (trans_support & (CFGTBL_Trans_io_accel1 | CFGTBL_Trans_io_accel2))
7323b3a52e79SStephen M. Cameron 		access = SA5_performant_access_no_read;
7324b3a52e79SStephen M. Cameron 
7325303932fdSDon Brace 	/* Controller spec: zero out this buffer. */
7326072b0518SStephen M. Cameron 	for (i = 0; i < h->nreply_queues; i++)
7327072b0518SStephen M. Cameron 		memset(h->reply_queue[i].head, 0, h->reply_queue_size);
7328303932fdSDon Brace 
7329d66ae08bSStephen M. Cameron 	bft[7] = SG_ENTRIES_IN_CMD + 4;
7330d66ae08bSStephen M. Cameron 	calc_bucket_map(bft, ARRAY_SIZE(bft),
7331e1f7de0cSMatt Gates 				SG_ENTRIES_IN_CMD, 4, h->blockFetchTable);
7332303932fdSDon Brace 	for (i = 0; i < 8; i++)
7333303932fdSDon Brace 		writel(bft[i], &h->transtable->BlockFetch[i]);
7334303932fdSDon Brace 
7335303932fdSDon Brace 	/* size of controller ring buffer */
7336303932fdSDon Brace 	writel(h->max_commands, &h->transtable->RepQSize);
7337254f796bSMatt Gates 	writel(h->nreply_queues, &h->transtable->RepQCount);
7338303932fdSDon Brace 	writel(0, &h->transtable->RepQCtrAddrLow32);
7339303932fdSDon Brace 	writel(0, &h->transtable->RepQCtrAddrHigh32);
7340254f796bSMatt Gates 
7341254f796bSMatt Gates 	for (i = 0; i < h->nreply_queues; i++) {
7342254f796bSMatt Gates 		writel(0, &h->transtable->RepQAddr[i].upper);
7343072b0518SStephen M. Cameron 		writel(h->reply_queue[i].busaddr,
7344254f796bSMatt Gates 			&h->transtable->RepQAddr[i].lower);
7345254f796bSMatt Gates 	}
7346254f796bSMatt Gates 
7347b9af4937SStephen M. Cameron 	writel(0, &h->cfgtable->HostWrite.command_pool_addr_hi);
7348e1f7de0cSMatt Gates 	writel(transMethod, &(h->cfgtable->HostWrite.TransportRequest));
7349e1f7de0cSMatt Gates 	/*
7350e1f7de0cSMatt Gates 	 * enable outbound interrupt coalescing in accelerator mode;
7351e1f7de0cSMatt Gates 	 */
7352e1f7de0cSMatt Gates 	if (trans_support & CFGTBL_Trans_io_accel1) {
7353e1f7de0cSMatt Gates 		access = SA5_ioaccel_mode1_access;
7354e1f7de0cSMatt Gates 		writel(10, &h->cfgtable->HostWrite.CoalIntDelay);
7355e1f7de0cSMatt Gates 		writel(4, &h->cfgtable->HostWrite.CoalIntCount);
7356c349775eSScott Teel 	} else {
7357c349775eSScott Teel 		if (trans_support & CFGTBL_Trans_io_accel2) {
7358c349775eSScott Teel 			access = SA5_ioaccel_mode2_access;
7359c349775eSScott Teel 			writel(10, &h->cfgtable->HostWrite.CoalIntDelay);
7360c349775eSScott Teel 			writel(4, &h->cfgtable->HostWrite.CoalIntCount);
7361c349775eSScott Teel 		}
7362e1f7de0cSMatt Gates 	}
7363303932fdSDon Brace 	writel(CFGTBL_ChangeReq, h->vaddr + SA5_DOORBELL);
73643f4336f3SStephen M. Cameron 	hpsa_wait_for_mode_change_ack(h);
7365303932fdSDon Brace 	register_value = readl(&(h->cfgtable->TransportActive));
7366303932fdSDon Brace 	if (!(register_value & CFGTBL_Trans_Performant)) {
7367303932fdSDon Brace 		dev_warn(&h->pdev->dev, "unable to get board into"
7368303932fdSDon Brace 					" performant mode\n");
7369303932fdSDon Brace 		return;
7370303932fdSDon Brace 	}
7371960a30e7SStephen M. Cameron 	/* Change the access methods to the performant access methods */
7372e1f7de0cSMatt Gates 	h->access = access;
7373e1f7de0cSMatt Gates 	h->transMethod = transMethod;
7374e1f7de0cSMatt Gates 
7375b9af4937SStephen M. Cameron 	if (!((trans_support & CFGTBL_Trans_io_accel1) ||
7376b9af4937SStephen M. Cameron 		(trans_support & CFGTBL_Trans_io_accel2)))
7377e1f7de0cSMatt Gates 		return;
7378e1f7de0cSMatt Gates 
7379b9af4937SStephen M. Cameron 	if (trans_support & CFGTBL_Trans_io_accel1) {
7380e1f7de0cSMatt Gates 		/* Set up I/O accelerator mode */
7381e1f7de0cSMatt Gates 		for (i = 0; i < h->nreply_queues; i++) {
7382e1f7de0cSMatt Gates 			writel(i, h->vaddr + IOACCEL_MODE1_REPLY_QUEUE_INDEX);
7383e1f7de0cSMatt Gates 			h->reply_queue[i].current_entry =
7384e1f7de0cSMatt Gates 				readl(h->vaddr + IOACCEL_MODE1_PRODUCER_INDEX);
7385e1f7de0cSMatt Gates 		}
7386283b4a9bSStephen M. Cameron 		bft[7] = h->ioaccel_maxsg + 8;
7387283b4a9bSStephen M. Cameron 		calc_bucket_map(bft, ARRAY_SIZE(bft), h->ioaccel_maxsg, 8,
7388e1f7de0cSMatt Gates 				h->ioaccel1_blockFetchTable);
7389e1f7de0cSMatt Gates 
7390e1f7de0cSMatt Gates 		/* initialize all reply queue entries to unused */
7391072b0518SStephen M. Cameron 		for (i = 0; i < h->nreply_queues; i++)
7392072b0518SStephen M. Cameron 			memset(h->reply_queue[i].head,
7393072b0518SStephen M. Cameron 				(u8) IOACCEL_MODE1_REPLY_UNUSED,
7394072b0518SStephen M. Cameron 				h->reply_queue_size);
7395e1f7de0cSMatt Gates 
7396e1f7de0cSMatt Gates 		/* set all the constant fields in the accelerator command
7397e1f7de0cSMatt Gates 		 * frames once at init time to save CPU cycles later.
7398e1f7de0cSMatt Gates 		 */
7399e1f7de0cSMatt Gates 		for (i = 0; i < h->nr_cmds; i++) {
7400e1f7de0cSMatt Gates 			struct io_accel1_cmd *cp = &h->ioaccel_cmd_pool[i];
7401e1f7de0cSMatt Gates 
7402e1f7de0cSMatt Gates 			cp->function = IOACCEL1_FUNCTION_SCSIIO;
7403e1f7de0cSMatt Gates 			cp->err_info = (u32) (h->errinfo_pool_dhandle +
7404e1f7de0cSMatt Gates 					(i * sizeof(struct ErrorInfo)));
7405e1f7de0cSMatt Gates 			cp->err_info_len = sizeof(struct ErrorInfo);
7406e1f7de0cSMatt Gates 			cp->sgl_offset = IOACCEL1_SGLOFFSET;
7407e1f7de0cSMatt Gates 			cp->host_context_flags = IOACCEL1_HCFLAGS_CISS_FORMAT;
7408e1f7de0cSMatt Gates 			cp->timeout_sec = 0;
7409e1f7de0cSMatt Gates 			cp->ReplyQueue = 0;
7410*50a0decfSStephen M. Cameron 			cp->tag =
7411*50a0decfSStephen M. Cameron 				cpu_to_le64((i << DIRECT_LOOKUP_SHIFT) |
7412*50a0decfSStephen M. Cameron 						DIRECT_LOOKUP_BIT);
7413*50a0decfSStephen M. Cameron 			cp->host_addr =
7414*50a0decfSStephen M. Cameron 				cpu_to_le64(h->ioaccel_cmd_pool_dhandle +
7415e1f7de0cSMatt Gates 					(i * sizeof(struct io_accel1_cmd)));
7416e1f7de0cSMatt Gates 		}
7417b9af4937SStephen M. Cameron 	} else if (trans_support & CFGTBL_Trans_io_accel2) {
7418b9af4937SStephen M. Cameron 		u64 cfg_offset, cfg_base_addr_index;
7419b9af4937SStephen M. Cameron 		u32 bft2_offset, cfg_base_addr;
7420b9af4937SStephen M. Cameron 		int rc;
7421b9af4937SStephen M. Cameron 
7422b9af4937SStephen M. Cameron 		rc = hpsa_find_cfg_addrs(h->pdev, h->vaddr, &cfg_base_addr,
7423b9af4937SStephen M. Cameron 			&cfg_base_addr_index, &cfg_offset);
7424b9af4937SStephen M. Cameron 		BUILD_BUG_ON(offsetof(struct io_accel2_cmd, sg) != 64);
7425b9af4937SStephen M. Cameron 		bft2[15] = h->ioaccel_maxsg + HPSA_IOACCEL2_HEADER_SZ;
7426b9af4937SStephen M. Cameron 		calc_bucket_map(bft2, ARRAY_SIZE(bft2), h->ioaccel_maxsg,
7427b9af4937SStephen M. Cameron 				4, h->ioaccel2_blockFetchTable);
7428b9af4937SStephen M. Cameron 		bft2_offset = readl(&h->cfgtable->io_accel_request_size_offset);
7429b9af4937SStephen M. Cameron 		BUILD_BUG_ON(offsetof(struct CfgTable,
7430b9af4937SStephen M. Cameron 				io_accel_request_size_offset) != 0xb8);
7431b9af4937SStephen M. Cameron 		h->ioaccel2_bft2_regs =
7432b9af4937SStephen M. Cameron 			remap_pci_mem(pci_resource_start(h->pdev,
7433b9af4937SStephen M. Cameron 					cfg_base_addr_index) +
7434b9af4937SStephen M. Cameron 					cfg_offset + bft2_offset,
7435b9af4937SStephen M. Cameron 					ARRAY_SIZE(bft2) *
7436b9af4937SStephen M. Cameron 					sizeof(*h->ioaccel2_bft2_regs));
7437b9af4937SStephen M. Cameron 		for (i = 0; i < ARRAY_SIZE(bft2); i++)
7438b9af4937SStephen M. Cameron 			writel(bft2[i], &h->ioaccel2_bft2_regs[i]);
7439b9af4937SStephen M. Cameron 	}
7440b9af4937SStephen M. Cameron 	writel(CFGTBL_ChangeReq, h->vaddr + SA5_DOORBELL);
7441b9af4937SStephen M. Cameron 	hpsa_wait_for_mode_change_ack(h);
7442e1f7de0cSMatt Gates }
7443e1f7de0cSMatt Gates 
7444e1f7de0cSMatt Gates static int hpsa_alloc_ioaccel_cmd_and_bft(struct ctlr_info *h)
7445e1f7de0cSMatt Gates {
7446283b4a9bSStephen M. Cameron 	h->ioaccel_maxsg =
7447283b4a9bSStephen M. Cameron 		readl(&(h->cfgtable->io_accel_max_embedded_sg_count));
7448283b4a9bSStephen M. Cameron 	if (h->ioaccel_maxsg > IOACCEL1_MAXSGENTRIES)
7449283b4a9bSStephen M. Cameron 		h->ioaccel_maxsg = IOACCEL1_MAXSGENTRIES;
7450283b4a9bSStephen M. Cameron 
7451e1f7de0cSMatt Gates 	/* Command structures must be aligned on a 128-byte boundary
7452e1f7de0cSMatt Gates 	 * because the 7 lower bits of the address are used by the
7453e1f7de0cSMatt Gates 	 * hardware.
7454e1f7de0cSMatt Gates 	 */
7455e1f7de0cSMatt Gates 	BUILD_BUG_ON(sizeof(struct io_accel1_cmd) %
7456e1f7de0cSMatt Gates 			IOACCEL1_COMMANDLIST_ALIGNMENT);
7457e1f7de0cSMatt Gates 	h->ioaccel_cmd_pool =
7458e1f7de0cSMatt Gates 		pci_alloc_consistent(h->pdev,
7459e1f7de0cSMatt Gates 			h->nr_cmds * sizeof(*h->ioaccel_cmd_pool),
7460e1f7de0cSMatt Gates 			&(h->ioaccel_cmd_pool_dhandle));
7461e1f7de0cSMatt Gates 
7462e1f7de0cSMatt Gates 	h->ioaccel1_blockFetchTable =
7463283b4a9bSStephen M. Cameron 		kmalloc(((h->ioaccel_maxsg + 1) *
7464e1f7de0cSMatt Gates 				sizeof(u32)), GFP_KERNEL);
7465e1f7de0cSMatt Gates 
7466e1f7de0cSMatt Gates 	if ((h->ioaccel_cmd_pool == NULL) ||
7467e1f7de0cSMatt Gates 		(h->ioaccel1_blockFetchTable == NULL))
7468e1f7de0cSMatt Gates 		goto clean_up;
7469e1f7de0cSMatt Gates 
7470e1f7de0cSMatt Gates 	memset(h->ioaccel_cmd_pool, 0,
7471e1f7de0cSMatt Gates 		h->nr_cmds * sizeof(*h->ioaccel_cmd_pool));
7472e1f7de0cSMatt Gates 	return 0;
7473e1f7de0cSMatt Gates 
7474e1f7de0cSMatt Gates clean_up:
7475e1f7de0cSMatt Gates 	if (h->ioaccel_cmd_pool)
7476e1f7de0cSMatt Gates 		pci_free_consistent(h->pdev,
7477e1f7de0cSMatt Gates 			h->nr_cmds * sizeof(*h->ioaccel_cmd_pool),
7478e1f7de0cSMatt Gates 			h->ioaccel_cmd_pool, h->ioaccel_cmd_pool_dhandle);
7479e1f7de0cSMatt Gates 	kfree(h->ioaccel1_blockFetchTable);
7480e1f7de0cSMatt Gates 	return 1;
74816c311b57SStephen M. Cameron }
74826c311b57SStephen M. Cameron 
7483aca9012aSStephen M. Cameron static int ioaccel2_alloc_cmds_and_bft(struct ctlr_info *h)
7484aca9012aSStephen M. Cameron {
7485aca9012aSStephen M. Cameron 	/* Allocate ioaccel2 mode command blocks and block fetch table */
7486aca9012aSStephen M. Cameron 
7487aca9012aSStephen M. Cameron 	h->ioaccel_maxsg =
7488aca9012aSStephen M. Cameron 		readl(&(h->cfgtable->io_accel_max_embedded_sg_count));
7489aca9012aSStephen M. Cameron 	if (h->ioaccel_maxsg > IOACCEL2_MAXSGENTRIES)
7490aca9012aSStephen M. Cameron 		h->ioaccel_maxsg = IOACCEL2_MAXSGENTRIES;
7491aca9012aSStephen M. Cameron 
7492aca9012aSStephen M. Cameron 	BUILD_BUG_ON(sizeof(struct io_accel2_cmd) %
7493aca9012aSStephen M. Cameron 			IOACCEL2_COMMANDLIST_ALIGNMENT);
7494aca9012aSStephen M. Cameron 	h->ioaccel2_cmd_pool =
7495aca9012aSStephen M. Cameron 		pci_alloc_consistent(h->pdev,
7496aca9012aSStephen M. Cameron 			h->nr_cmds * sizeof(*h->ioaccel2_cmd_pool),
7497aca9012aSStephen M. Cameron 			&(h->ioaccel2_cmd_pool_dhandle));
7498aca9012aSStephen M. Cameron 
7499aca9012aSStephen M. Cameron 	h->ioaccel2_blockFetchTable =
7500aca9012aSStephen M. Cameron 		kmalloc(((h->ioaccel_maxsg + 1) *
7501aca9012aSStephen M. Cameron 				sizeof(u32)), GFP_KERNEL);
7502aca9012aSStephen M. Cameron 
7503aca9012aSStephen M. Cameron 	if ((h->ioaccel2_cmd_pool == NULL) ||
7504aca9012aSStephen M. Cameron 		(h->ioaccel2_blockFetchTable == NULL))
7505aca9012aSStephen M. Cameron 		goto clean_up;
7506aca9012aSStephen M. Cameron 
7507aca9012aSStephen M. Cameron 	memset(h->ioaccel2_cmd_pool, 0,
7508aca9012aSStephen M. Cameron 		h->nr_cmds * sizeof(*h->ioaccel2_cmd_pool));
7509aca9012aSStephen M. Cameron 	return 0;
7510aca9012aSStephen M. Cameron 
7511aca9012aSStephen M. Cameron clean_up:
7512aca9012aSStephen M. Cameron 	if (h->ioaccel2_cmd_pool)
7513aca9012aSStephen M. Cameron 		pci_free_consistent(h->pdev,
7514aca9012aSStephen M. Cameron 			h->nr_cmds * sizeof(*h->ioaccel2_cmd_pool),
7515aca9012aSStephen M. Cameron 			h->ioaccel2_cmd_pool, h->ioaccel2_cmd_pool_dhandle);
7516aca9012aSStephen M. Cameron 	kfree(h->ioaccel2_blockFetchTable);
7517aca9012aSStephen M. Cameron 	return 1;
7518aca9012aSStephen M. Cameron }
7519aca9012aSStephen M. Cameron 
75206f039790SGreg Kroah-Hartman static void hpsa_put_ctlr_into_performant_mode(struct ctlr_info *h)
75216c311b57SStephen M. Cameron {
75226c311b57SStephen M. Cameron 	u32 trans_support;
7523e1f7de0cSMatt Gates 	unsigned long transMethod = CFGTBL_Trans_Performant |
7524e1f7de0cSMatt Gates 					CFGTBL_Trans_use_short_tags;
7525254f796bSMatt Gates 	int i;
75266c311b57SStephen M. Cameron 
752702ec19c8SStephen M. Cameron 	if (hpsa_simple_mode)
752802ec19c8SStephen M. Cameron 		return;
752902ec19c8SStephen M. Cameron 
753067c99a72Sscameron@beardog.cce.hp.com 	trans_support = readl(&(h->cfgtable->TransportSupport));
753167c99a72Sscameron@beardog.cce.hp.com 	if (!(trans_support & PERFORMANT_MODE))
753267c99a72Sscameron@beardog.cce.hp.com 		return;
753367c99a72Sscameron@beardog.cce.hp.com 
7534e1f7de0cSMatt Gates 	/* Check for I/O accelerator mode support */
7535e1f7de0cSMatt Gates 	if (trans_support & CFGTBL_Trans_io_accel1) {
7536e1f7de0cSMatt Gates 		transMethod |= CFGTBL_Trans_io_accel1 |
7537e1f7de0cSMatt Gates 				CFGTBL_Trans_enable_directed_msix;
7538e1f7de0cSMatt Gates 		if (hpsa_alloc_ioaccel_cmd_and_bft(h))
7539e1f7de0cSMatt Gates 			goto clean_up;
7540aca9012aSStephen M. Cameron 	} else {
7541aca9012aSStephen M. Cameron 		if (trans_support & CFGTBL_Trans_io_accel2) {
7542aca9012aSStephen M. Cameron 				transMethod |= CFGTBL_Trans_io_accel2 |
7543aca9012aSStephen M. Cameron 				CFGTBL_Trans_enable_directed_msix;
7544aca9012aSStephen M. Cameron 		if (ioaccel2_alloc_cmds_and_bft(h))
7545aca9012aSStephen M. Cameron 			goto clean_up;
7546aca9012aSStephen M. Cameron 		}
7547e1f7de0cSMatt Gates 	}
7548e1f7de0cSMatt Gates 
7549eee0f03aSHannes Reinecke 	h->nreply_queues = h->msix_vector > 0 ? h->msix_vector : 1;
7550cba3d38bSStephen M. Cameron 	hpsa_get_max_perf_mode_cmds(h);
75516c311b57SStephen M. Cameron 	/* Performant mode ring buffer and supporting data structures */
7552072b0518SStephen M. Cameron 	h->reply_queue_size = h->max_commands * sizeof(u64);
75536c311b57SStephen M. Cameron 
7554254f796bSMatt Gates 	for (i = 0; i < h->nreply_queues; i++) {
7555072b0518SStephen M. Cameron 		h->reply_queue[i].head = pci_alloc_consistent(h->pdev,
7556072b0518SStephen M. Cameron 						h->reply_queue_size,
7557072b0518SStephen M. Cameron 						&(h->reply_queue[i].busaddr));
7558072b0518SStephen M. Cameron 		if (!h->reply_queue[i].head)
7559072b0518SStephen M. Cameron 			goto clean_up;
7560254f796bSMatt Gates 		h->reply_queue[i].size = h->max_commands;
7561254f796bSMatt Gates 		h->reply_queue[i].wraparound = 1;  /* spec: init to 1 */
7562254f796bSMatt Gates 		h->reply_queue[i].current_entry = 0;
7563254f796bSMatt Gates 	}
7564254f796bSMatt Gates 
75656c311b57SStephen M. Cameron 	/* Need a block fetch table for performant mode */
7566d66ae08bSStephen M. Cameron 	h->blockFetchTable = kmalloc(((SG_ENTRIES_IN_CMD + 1) *
75676c311b57SStephen M. Cameron 				sizeof(u32)), GFP_KERNEL);
7568072b0518SStephen M. Cameron 	if (!h->blockFetchTable)
75696c311b57SStephen M. Cameron 		goto clean_up;
75706c311b57SStephen M. Cameron 
7571e1f7de0cSMatt Gates 	hpsa_enter_performant_mode(h, trans_support);
7572303932fdSDon Brace 	return;
7573303932fdSDon Brace 
7574303932fdSDon Brace clean_up:
7575072b0518SStephen M. Cameron 	hpsa_free_reply_queues(h);
7576303932fdSDon Brace 	kfree(h->blockFetchTable);
7577303932fdSDon Brace }
7578303932fdSDon Brace 
757923100dd9SStephen M. Cameron static int is_accelerated_cmd(struct CommandList *c)
758076438d08SStephen M. Cameron {
758123100dd9SStephen M. Cameron 	return c->cmd_type == CMD_IOACCEL1 || c->cmd_type == CMD_IOACCEL2;
758223100dd9SStephen M. Cameron }
758323100dd9SStephen M. Cameron 
758423100dd9SStephen M. Cameron static void hpsa_drain_accel_commands(struct ctlr_info *h)
758523100dd9SStephen M. Cameron {
758623100dd9SStephen M. Cameron 	struct CommandList *c = NULL;
758776438d08SStephen M. Cameron 	unsigned long flags;
758823100dd9SStephen M. Cameron 	int accel_cmds_out;
758976438d08SStephen M. Cameron 
759076438d08SStephen M. Cameron 	do { /* wait for all outstanding commands to drain out */
759123100dd9SStephen M. Cameron 		accel_cmds_out = 0;
759276438d08SStephen M. Cameron 		spin_lock_irqsave(&h->lock, flags);
759323100dd9SStephen M. Cameron 		list_for_each_entry(c, &h->cmpQ, list)
759423100dd9SStephen M. Cameron 			accel_cmds_out += is_accelerated_cmd(c);
759523100dd9SStephen M. Cameron 		list_for_each_entry(c, &h->reqQ, list)
759623100dd9SStephen M. Cameron 			accel_cmds_out += is_accelerated_cmd(c);
759776438d08SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
759823100dd9SStephen M. Cameron 		if (accel_cmds_out <= 0)
759976438d08SStephen M. Cameron 			break;
760076438d08SStephen M. Cameron 		msleep(100);
760176438d08SStephen M. Cameron 	} while (1);
760276438d08SStephen M. Cameron }
760376438d08SStephen M. Cameron 
7604edd16368SStephen M. Cameron /*
7605edd16368SStephen M. Cameron  *  This is it.  Register the PCI driver information for the cards we control
7606edd16368SStephen M. Cameron  *  the OS will call our registered routines when it finds one of our cards.
7607edd16368SStephen M. Cameron  */
7608edd16368SStephen M. Cameron static int __init hpsa_init(void)
7609edd16368SStephen M. Cameron {
761031468401SMike Miller 	return pci_register_driver(&hpsa_pci_driver);
7611edd16368SStephen M. Cameron }
7612edd16368SStephen M. Cameron 
7613edd16368SStephen M. Cameron static void __exit hpsa_cleanup(void)
7614edd16368SStephen M. Cameron {
7615edd16368SStephen M. Cameron 	pci_unregister_driver(&hpsa_pci_driver);
7616edd16368SStephen M. Cameron }
7617edd16368SStephen M. Cameron 
7618e1f7de0cSMatt Gates static void __attribute__((unused)) verify_offsets(void)
7619e1f7de0cSMatt Gates {
7620e1f7de0cSMatt Gates #define VERIFY_OFFSET(member, offset) \
7621dd0e19f3SScott Teel 	BUILD_BUG_ON(offsetof(struct raid_map_data, member) != offset)
7622dd0e19f3SScott Teel 
7623dd0e19f3SScott Teel 	VERIFY_OFFSET(structure_size, 0);
7624dd0e19f3SScott Teel 	VERIFY_OFFSET(volume_blk_size, 4);
7625dd0e19f3SScott Teel 	VERIFY_OFFSET(volume_blk_cnt, 8);
7626dd0e19f3SScott Teel 	VERIFY_OFFSET(phys_blk_shift, 16);
7627dd0e19f3SScott Teel 	VERIFY_OFFSET(parity_rotation_shift, 17);
7628dd0e19f3SScott Teel 	VERIFY_OFFSET(strip_size, 18);
7629dd0e19f3SScott Teel 	VERIFY_OFFSET(disk_starting_blk, 20);
7630dd0e19f3SScott Teel 	VERIFY_OFFSET(disk_blk_cnt, 28);
7631dd0e19f3SScott Teel 	VERIFY_OFFSET(data_disks_per_row, 36);
7632dd0e19f3SScott Teel 	VERIFY_OFFSET(metadata_disks_per_row, 38);
7633dd0e19f3SScott Teel 	VERIFY_OFFSET(row_cnt, 40);
7634dd0e19f3SScott Teel 	VERIFY_OFFSET(layout_map_count, 42);
7635dd0e19f3SScott Teel 	VERIFY_OFFSET(flags, 44);
7636dd0e19f3SScott Teel 	VERIFY_OFFSET(dekindex, 46);
7637dd0e19f3SScott Teel 	/* VERIFY_OFFSET(reserved, 48 */
7638dd0e19f3SScott Teel 	VERIFY_OFFSET(data, 64);
7639dd0e19f3SScott Teel 
7640dd0e19f3SScott Teel #undef VERIFY_OFFSET
7641dd0e19f3SScott Teel 
7642dd0e19f3SScott Teel #define VERIFY_OFFSET(member, offset) \
7643b66cc250SMike Miller 	BUILD_BUG_ON(offsetof(struct io_accel2_cmd, member) != offset)
7644b66cc250SMike Miller 
7645b66cc250SMike Miller 	VERIFY_OFFSET(IU_type, 0);
7646b66cc250SMike Miller 	VERIFY_OFFSET(direction, 1);
7647b66cc250SMike Miller 	VERIFY_OFFSET(reply_queue, 2);
7648b66cc250SMike Miller 	/* VERIFY_OFFSET(reserved1, 3);  */
7649b66cc250SMike Miller 	VERIFY_OFFSET(scsi_nexus, 4);
7650b66cc250SMike Miller 	VERIFY_OFFSET(Tag, 8);
7651b66cc250SMike Miller 	VERIFY_OFFSET(cdb, 16);
7652b66cc250SMike Miller 	VERIFY_OFFSET(cciss_lun, 32);
7653b66cc250SMike Miller 	VERIFY_OFFSET(data_len, 40);
7654b66cc250SMike Miller 	VERIFY_OFFSET(cmd_priority_task_attr, 44);
7655b66cc250SMike Miller 	VERIFY_OFFSET(sg_count, 45);
7656b66cc250SMike Miller 	/* VERIFY_OFFSET(reserved3 */
7657b66cc250SMike Miller 	VERIFY_OFFSET(err_ptr, 48);
7658b66cc250SMike Miller 	VERIFY_OFFSET(err_len, 56);
7659b66cc250SMike Miller 	/* VERIFY_OFFSET(reserved4  */
7660b66cc250SMike Miller 	VERIFY_OFFSET(sg, 64);
7661b66cc250SMike Miller 
7662b66cc250SMike Miller #undef VERIFY_OFFSET
7663b66cc250SMike Miller 
7664b66cc250SMike Miller #define VERIFY_OFFSET(member, offset) \
7665e1f7de0cSMatt Gates 	BUILD_BUG_ON(offsetof(struct io_accel1_cmd, member) != offset)
7666e1f7de0cSMatt Gates 
7667e1f7de0cSMatt Gates 	VERIFY_OFFSET(dev_handle, 0x00);
7668e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved1, 0x02);
7669e1f7de0cSMatt Gates 	VERIFY_OFFSET(function, 0x03);
7670e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved2, 0x04);
7671e1f7de0cSMatt Gates 	VERIFY_OFFSET(err_info, 0x0C);
7672e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved3, 0x10);
7673e1f7de0cSMatt Gates 	VERIFY_OFFSET(err_info_len, 0x12);
7674e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved4, 0x13);
7675e1f7de0cSMatt Gates 	VERIFY_OFFSET(sgl_offset, 0x14);
7676e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved5, 0x15);
7677e1f7de0cSMatt Gates 	VERIFY_OFFSET(transfer_len, 0x1C);
7678e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved6, 0x20);
7679e1f7de0cSMatt Gates 	VERIFY_OFFSET(io_flags, 0x24);
7680e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved7, 0x26);
7681e1f7de0cSMatt Gates 	VERIFY_OFFSET(LUN, 0x34);
7682e1f7de0cSMatt Gates 	VERIFY_OFFSET(control, 0x3C);
7683e1f7de0cSMatt Gates 	VERIFY_OFFSET(CDB, 0x40);
7684e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved8, 0x50);
7685e1f7de0cSMatt Gates 	VERIFY_OFFSET(host_context_flags, 0x60);
7686e1f7de0cSMatt Gates 	VERIFY_OFFSET(timeout_sec, 0x62);
7687e1f7de0cSMatt Gates 	VERIFY_OFFSET(ReplyQueue, 0x64);
7688e1f7de0cSMatt Gates 	VERIFY_OFFSET(reserved9, 0x65);
7689*50a0decfSStephen M. Cameron 	VERIFY_OFFSET(tag, 0x68);
7690e1f7de0cSMatt Gates 	VERIFY_OFFSET(host_addr, 0x70);
7691e1f7de0cSMatt Gates 	VERIFY_OFFSET(CISS_LUN, 0x78);
7692e1f7de0cSMatt Gates 	VERIFY_OFFSET(SG, 0x78 + 8);
7693e1f7de0cSMatt Gates #undef VERIFY_OFFSET
7694e1f7de0cSMatt Gates }
7695e1f7de0cSMatt Gates 
7696edd16368SStephen M. Cameron module_init(hpsa_init);
7697edd16368SStephen M. Cameron module_exit(hpsa_cleanup);
7698