xref: /openbmc/linux/drivers/scsi/hpsa.c (revision 3ce438df106826edde7ad724f3819716a3f0cf56)
1edd16368SStephen M. Cameron /*
2edd16368SStephen M. Cameron  *    Disk Array driver for HP Smart Array SAS controllers
3edd16368SStephen M. Cameron  *    Copyright 2000, 2009 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>
50edd16368SStephen M. Cameron #include <linux/kthread.h>
51a0c12413SStephen M. Cameron #include <linux/jiffies.h>
52edd16368SStephen M. Cameron #include "hpsa_cmd.h"
53edd16368SStephen M. Cameron #include "hpsa.h"
54edd16368SStephen M. Cameron 
55edd16368SStephen M. Cameron /* HPSA_DRIVER_VERSION must be 3 byte values (0-255) separated by '.' */
56e481cce8SMike Miller #define HPSA_DRIVER_VERSION "3.4.0-1"
57edd16368SStephen M. Cameron #define DRIVER_NAME "HP HPSA Driver (v " HPSA_DRIVER_VERSION ")"
58f79cfec6SStephen M. Cameron #define HPSA "hpsa"
59edd16368SStephen M. Cameron 
60edd16368SStephen M. Cameron /* How long to wait (in milliseconds) for board to go into simple mode */
61edd16368SStephen M. Cameron #define MAX_CONFIG_WAIT 30000
62edd16368SStephen M. Cameron #define MAX_IOCTL_CONFIG_WAIT 1000
63edd16368SStephen M. Cameron 
64edd16368SStephen M. Cameron /*define how many times we will try a command because of bus resets */
65edd16368SStephen M. Cameron #define MAX_CMD_RETRIES 3
66edd16368SStephen M. Cameron 
67edd16368SStephen M. Cameron /* Embedded module documentation macros - see modules.h */
68edd16368SStephen M. Cameron MODULE_AUTHOR("Hewlett-Packard Company");
69edd16368SStephen M. Cameron MODULE_DESCRIPTION("Driver for HP Smart Array Controller version " \
70edd16368SStephen M. Cameron 	HPSA_DRIVER_VERSION);
71edd16368SStephen M. Cameron MODULE_SUPPORTED_DEVICE("HP Smart Array Controllers");
72edd16368SStephen M. Cameron MODULE_VERSION(HPSA_DRIVER_VERSION);
73edd16368SStephen M. Cameron MODULE_LICENSE("GPL");
74edd16368SStephen M. Cameron 
75edd16368SStephen M. Cameron static int hpsa_allow_any;
76edd16368SStephen M. Cameron module_param(hpsa_allow_any, int, S_IRUGO|S_IWUSR);
77edd16368SStephen M. Cameron MODULE_PARM_DESC(hpsa_allow_any,
78edd16368SStephen M. Cameron 		"Allow hpsa driver to access unknown HP Smart Array hardware");
7902ec19c8SStephen M. Cameron static int hpsa_simple_mode;
8002ec19c8SStephen M. Cameron module_param(hpsa_simple_mode, int, S_IRUGO|S_IWUSR);
8102ec19c8SStephen M. Cameron MODULE_PARM_DESC(hpsa_simple_mode,
8202ec19c8SStephen M. Cameron 	"Use 'simple mode' rather than 'performant mode'");
83edd16368SStephen M. Cameron 
84edd16368SStephen M. Cameron /* define the PCI info for the cards we can control */
85edd16368SStephen M. Cameron static const struct pci_device_id hpsa_pci_device_id[] = {
86edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3241},
87edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3243},
88edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3245},
89edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3247},
90edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3249},
91163dbcd8SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x324A},
92163dbcd8SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x324B},
93f8b01eb9SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSE,     0x103C, 0x3233},
949143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3350},
959143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3351},
969143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3352},
979143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3353},
989143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3354},
999143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3355},
1009143a961Sscameron@beardog.cce.hp.com 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSF,     0x103C, 0x3356},
101fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1921},
102fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1922},
103fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1923},
104fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1924},
105fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1925},
106fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1926},
107fe0c9610SMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1928},
10897b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSH,     0x103C, 0x1929},
10997b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21BD},
11097b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21BE},
11197b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21BF},
11297b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C0},
11397b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C1},
11497b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C2},
11597b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C3},
11697b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C4},
11797b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C5},
11897b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C7},
11997b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C8},
12097b9f53dSMike Miller 	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSI,     0x103C, 0x21C9},
121edd16368SStephen M. Cameron 	{PCI_VENDOR_ID_HP,     PCI_ANY_ID,	PCI_ANY_ID, PCI_ANY_ID,
122edd16368SStephen M. Cameron 		PCI_CLASS_STORAGE_RAID << 8, 0xffff << 8, 0},
123edd16368SStephen M. Cameron 	{0,}
124edd16368SStephen M. Cameron };
125edd16368SStephen M. Cameron 
126edd16368SStephen M. Cameron MODULE_DEVICE_TABLE(pci, hpsa_pci_device_id);
127edd16368SStephen M. Cameron 
128edd16368SStephen M. Cameron /*  board_id = Subsystem Device ID & Vendor ID
129edd16368SStephen M. Cameron  *  product = Marketing Name for the board
130edd16368SStephen M. Cameron  *  access = Address of the struct of function pointers
131edd16368SStephen M. Cameron  */
132edd16368SStephen M. Cameron static struct board_type products[] = {
133edd16368SStephen M. Cameron 	{0x3241103C, "Smart Array P212", &SA5_access},
134edd16368SStephen M. Cameron 	{0x3243103C, "Smart Array P410", &SA5_access},
135edd16368SStephen M. Cameron 	{0x3245103C, "Smart Array P410i", &SA5_access},
136edd16368SStephen M. Cameron 	{0x3247103C, "Smart Array P411", &SA5_access},
137edd16368SStephen M. Cameron 	{0x3249103C, "Smart Array P812", &SA5_access},
138163dbcd8SMike Miller 	{0x324A103C, "Smart Array P712m", &SA5_access},
139163dbcd8SMike Miller 	{0x324B103C, "Smart Array P711m", &SA5_access},
140fe0c9610SMike Miller 	{0x3350103C, "Smart Array P222", &SA5_access},
141fe0c9610SMike Miller 	{0x3351103C, "Smart Array P420", &SA5_access},
142fe0c9610SMike Miller 	{0x3352103C, "Smart Array P421", &SA5_access},
143fe0c9610SMike Miller 	{0x3353103C, "Smart Array P822", &SA5_access},
144fe0c9610SMike Miller 	{0x3354103C, "Smart Array P420i", &SA5_access},
145fe0c9610SMike Miller 	{0x3355103C, "Smart Array P220i", &SA5_access},
146fe0c9610SMike Miller 	{0x3356103C, "Smart Array P721m", &SA5_access},
1471fd6c8e3SMike Miller 	{0x1921103C, "Smart Array P830i", &SA5_access},
1481fd6c8e3SMike Miller 	{0x1922103C, "Smart Array P430", &SA5_access},
1491fd6c8e3SMike Miller 	{0x1923103C, "Smart Array P431", &SA5_access},
1501fd6c8e3SMike Miller 	{0x1924103C, "Smart Array P830", &SA5_access},
1511fd6c8e3SMike Miller 	{0x1926103C, "Smart Array P731m", &SA5_access},
1521fd6c8e3SMike Miller 	{0x1928103C, "Smart Array P230i", &SA5_access},
1531fd6c8e3SMike Miller 	{0x1929103C, "Smart Array P530", &SA5_access},
15497b9f53dSMike Miller 	{0x21BD103C, "Smart Array", &SA5_access},
15597b9f53dSMike Miller 	{0x21BE103C, "Smart Array", &SA5_access},
15697b9f53dSMike Miller 	{0x21BF103C, "Smart Array", &SA5_access},
15797b9f53dSMike Miller 	{0x21C0103C, "Smart Array", &SA5_access},
15897b9f53dSMike Miller 	{0x21C1103C, "Smart Array", &SA5_access},
15997b9f53dSMike Miller 	{0x21C2103C, "Smart Array", &SA5_access},
16097b9f53dSMike Miller 	{0x21C3103C, "Smart Array", &SA5_access},
16197b9f53dSMike Miller 	{0x21C4103C, "Smart Array", &SA5_access},
16297b9f53dSMike Miller 	{0x21C5103C, "Smart Array", &SA5_access},
16397b9f53dSMike Miller 	{0x21C7103C, "Smart Array", &SA5_access},
16497b9f53dSMike Miller 	{0x21C8103C, "Smart Array", &SA5_access},
16597b9f53dSMike Miller 	{0x21C9103C, "Smart Array", &SA5_access},
166edd16368SStephen M. Cameron 	{0xFFFF103C, "Unknown Smart Array", &SA5_access},
167edd16368SStephen M. Cameron };
168edd16368SStephen M. Cameron 
169edd16368SStephen M. Cameron static int number_of_controllers;
170edd16368SStephen M. Cameron 
17110f66018SStephen M. Cameron static irqreturn_t do_hpsa_intr_intx(int irq, void *dev_id);
17210f66018SStephen M. Cameron static irqreturn_t do_hpsa_intr_msi(int irq, void *dev_id);
173edd16368SStephen M. Cameron static int hpsa_ioctl(struct scsi_device *dev, int cmd, void *arg);
174edd16368SStephen M. Cameron static void start_io(struct ctlr_info *h);
175edd16368SStephen M. Cameron 
176edd16368SStephen M. Cameron #ifdef CONFIG_COMPAT
177edd16368SStephen M. Cameron static int hpsa_compat_ioctl(struct scsi_device *dev, int cmd, void *arg);
178edd16368SStephen M. Cameron #endif
179edd16368SStephen M. Cameron 
180edd16368SStephen M. Cameron static void cmd_free(struct ctlr_info *h, struct CommandList *c);
181edd16368SStephen M. Cameron static void cmd_special_free(struct ctlr_info *h, struct CommandList *c);
182edd16368SStephen M. Cameron static struct CommandList *cmd_alloc(struct ctlr_info *h);
183edd16368SStephen M. Cameron static struct CommandList *cmd_special_alloc(struct ctlr_info *h);
184a2dac136SStephen M. Cameron static int fill_cmd(struct CommandList *c, u8 cmd, struct ctlr_info *h,
18501a02ffcSStephen M. Cameron 	void *buff, size_t size, u8 page_code, unsigned char *scsi3addr,
186edd16368SStephen M. Cameron 	int cmd_type);
187edd16368SStephen M. Cameron 
188f281233dSJeff Garzik static int hpsa_scsi_queue_command(struct Scsi_Host *h, struct scsi_cmnd *cmd);
189a08a8471SStephen M. Cameron static void hpsa_scan_start(struct Scsi_Host *);
190a08a8471SStephen M. Cameron static int hpsa_scan_finished(struct Scsi_Host *sh,
191a08a8471SStephen M. Cameron 	unsigned long elapsed_time);
192667e23d4SStephen M. Cameron static int hpsa_change_queue_depth(struct scsi_device *sdev,
193667e23d4SStephen M. Cameron 	int qdepth, int reason);
194edd16368SStephen M. Cameron 
195edd16368SStephen M. Cameron static int hpsa_eh_device_reset_handler(struct scsi_cmnd *scsicmd);
19675167d2cSStephen M. Cameron static int hpsa_eh_abort_handler(struct scsi_cmnd *scsicmd);
197edd16368SStephen M. Cameron static int hpsa_slave_alloc(struct scsi_device *sdev);
198edd16368SStephen M. Cameron static void hpsa_slave_destroy(struct scsi_device *sdev);
199edd16368SStephen M. Cameron 
200edd16368SStephen M. Cameron static void hpsa_update_scsi_devices(struct ctlr_info *h, int hostno);
201edd16368SStephen M. Cameron static int check_for_unit_attention(struct ctlr_info *h,
202edd16368SStephen M. Cameron 	struct CommandList *c);
203edd16368SStephen M. Cameron static void check_ioctl_unit_attention(struct ctlr_info *h,
204edd16368SStephen M. Cameron 	struct CommandList *c);
205303932fdSDon Brace /* performant mode helper functions */
206303932fdSDon Brace static void calc_bucket_map(int *bucket, int num_buckets,
207303932fdSDon Brace 	int nsgs, int *bucket_map);
2086f039790SGreg Kroah-Hartman static void hpsa_put_ctlr_into_performant_mode(struct ctlr_info *h);
209254f796bSMatt Gates static inline u32 next_command(struct ctlr_info *h, u8 q);
2106f039790SGreg Kroah-Hartman static int hpsa_find_cfg_addrs(struct pci_dev *pdev, void __iomem *vaddr,
2116f039790SGreg Kroah-Hartman 			       u32 *cfg_base_addr, u64 *cfg_base_addr_index,
2121df8552aSStephen M. Cameron 			       u64 *cfg_offset);
2136f039790SGreg Kroah-Hartman static int hpsa_pci_find_memory_BAR(struct pci_dev *pdev,
2141df8552aSStephen M. Cameron 				    unsigned long *memory_bar);
2156f039790SGreg Kroah-Hartman static int hpsa_lookup_board_id(struct pci_dev *pdev, u32 *board_id);
2166f039790SGreg Kroah-Hartman static int hpsa_wait_for_board_state(struct pci_dev *pdev, void __iomem *vaddr,
2176f039790SGreg Kroah-Hartman 				     int wait_for_ready);
21875167d2cSStephen M. Cameron static inline void finish_cmd(struct CommandList *c);
219fe5389c8SStephen M. Cameron #define BOARD_NOT_READY 0
220fe5389c8SStephen M. Cameron #define BOARD_READY 1
221edd16368SStephen M. Cameron 
222edd16368SStephen M. Cameron static inline struct ctlr_info *sdev_to_hba(struct scsi_device *sdev)
223edd16368SStephen M. Cameron {
224edd16368SStephen M. Cameron 	unsigned long *priv = shost_priv(sdev->host);
225edd16368SStephen M. Cameron 	return (struct ctlr_info *) *priv;
226edd16368SStephen M. Cameron }
227edd16368SStephen M. Cameron 
228a23513e8SStephen M. Cameron static inline struct ctlr_info *shost_to_hba(struct Scsi_Host *sh)
229a23513e8SStephen M. Cameron {
230a23513e8SStephen M. Cameron 	unsigned long *priv = shost_priv(sh);
231a23513e8SStephen M. Cameron 	return (struct ctlr_info *) *priv;
232a23513e8SStephen M. Cameron }
233a23513e8SStephen M. Cameron 
234edd16368SStephen M. Cameron static int check_for_unit_attention(struct ctlr_info *h,
235edd16368SStephen M. Cameron 	struct CommandList *c)
236edd16368SStephen M. Cameron {
237edd16368SStephen M. Cameron 	if (c->err_info->SenseInfo[2] != UNIT_ATTENTION)
238edd16368SStephen M. Cameron 		return 0;
239edd16368SStephen M. Cameron 
240edd16368SStephen M. Cameron 	switch (c->err_info->SenseInfo[12]) {
241edd16368SStephen M. Cameron 	case STATE_CHANGED:
242f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: a state change "
243edd16368SStephen M. Cameron 			"detected, command retried\n", h->ctlr);
244edd16368SStephen M. Cameron 		break;
245edd16368SStephen M. Cameron 	case LUN_FAILED:
246f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: LUN failure "
247edd16368SStephen M. Cameron 			"detected, action required\n", h->ctlr);
248edd16368SStephen M. Cameron 		break;
249edd16368SStephen M. Cameron 	case REPORT_LUNS_CHANGED:
250f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: report LUN data "
25131468401SMike Miller 			"changed, action required\n", h->ctlr);
252edd16368SStephen M. Cameron 	/*
2534f4eb9f1SScott Teel 	 * Note: this REPORT_LUNS_CHANGED condition only occurs on the external
2544f4eb9f1SScott Teel 	 * target (array) devices.
255edd16368SStephen M. Cameron 	 */
256edd16368SStephen M. Cameron 		break;
257edd16368SStephen M. Cameron 	case POWER_OR_RESET:
258f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: a power on "
259edd16368SStephen M. Cameron 			"or device reset detected\n", h->ctlr);
260edd16368SStephen M. Cameron 		break;
261edd16368SStephen M. Cameron 	case UNIT_ATTENTION_CLEARED:
262f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: unit attention "
263edd16368SStephen M. Cameron 		    "cleared by another initiator\n", h->ctlr);
264edd16368SStephen M. Cameron 		break;
265edd16368SStephen M. Cameron 	default:
266f79cfec6SStephen M. Cameron 		dev_warn(&h->pdev->dev, HPSA "%d: unknown "
267edd16368SStephen M. Cameron 			"unit attention detected\n", h->ctlr);
268edd16368SStephen M. Cameron 		break;
269edd16368SStephen M. Cameron 	}
270edd16368SStephen M. Cameron 	return 1;
271edd16368SStephen M. Cameron }
272edd16368SStephen M. Cameron 
273852af20aSMatt Bondurant static int check_for_busy(struct ctlr_info *h, struct CommandList *c)
274852af20aSMatt Bondurant {
275852af20aSMatt Bondurant 	if (c->err_info->CommandStatus != CMD_TARGET_STATUS ||
276852af20aSMatt Bondurant 		(c->err_info->ScsiStatus != SAM_STAT_BUSY &&
277852af20aSMatt Bondurant 		 c->err_info->ScsiStatus != SAM_STAT_TASK_SET_FULL))
278852af20aSMatt Bondurant 		return 0;
279852af20aSMatt Bondurant 	dev_warn(&h->pdev->dev, HPSA "device busy");
280852af20aSMatt Bondurant 	return 1;
281852af20aSMatt Bondurant }
282852af20aSMatt Bondurant 
283edd16368SStephen M. Cameron static ssize_t host_store_rescan(struct device *dev,
284edd16368SStephen M. Cameron 				 struct device_attribute *attr,
285edd16368SStephen M. Cameron 				 const char *buf, size_t count)
286edd16368SStephen M. Cameron {
287edd16368SStephen M. Cameron 	struct ctlr_info *h;
288edd16368SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
289a23513e8SStephen M. Cameron 	h = shost_to_hba(shost);
29031468401SMike Miller 	hpsa_scan_start(h->scsi_host);
291edd16368SStephen M. Cameron 	return count;
292edd16368SStephen M. Cameron }
293edd16368SStephen M. Cameron 
294d28ce020SStephen M. Cameron static ssize_t host_show_firmware_revision(struct device *dev,
295d28ce020SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
296d28ce020SStephen M. Cameron {
297d28ce020SStephen M. Cameron 	struct ctlr_info *h;
298d28ce020SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
299d28ce020SStephen M. Cameron 	unsigned char *fwrev;
300d28ce020SStephen M. Cameron 
301d28ce020SStephen M. Cameron 	h = shost_to_hba(shost);
302d28ce020SStephen M. Cameron 	if (!h->hba_inquiry_data)
303d28ce020SStephen M. Cameron 		return 0;
304d28ce020SStephen M. Cameron 	fwrev = &h->hba_inquiry_data[32];
305d28ce020SStephen M. Cameron 	return snprintf(buf, 20, "%c%c%c%c\n",
306d28ce020SStephen M. Cameron 		fwrev[0], fwrev[1], fwrev[2], fwrev[3]);
307d28ce020SStephen M. Cameron }
308d28ce020SStephen M. Cameron 
30994a13649SStephen M. Cameron static ssize_t host_show_commands_outstanding(struct device *dev,
31094a13649SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
31194a13649SStephen M. Cameron {
31294a13649SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
31394a13649SStephen M. Cameron 	struct ctlr_info *h = shost_to_hba(shost);
31494a13649SStephen M. Cameron 
31594a13649SStephen M. Cameron 	return snprintf(buf, 20, "%d\n", h->commands_outstanding);
31694a13649SStephen M. Cameron }
31794a13649SStephen M. Cameron 
318745a7a25SStephen M. Cameron static ssize_t host_show_transport_mode(struct device *dev,
319745a7a25SStephen M. Cameron 	struct device_attribute *attr, char *buf)
320745a7a25SStephen M. Cameron {
321745a7a25SStephen M. Cameron 	struct ctlr_info *h;
322745a7a25SStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
323745a7a25SStephen M. Cameron 
324745a7a25SStephen M. Cameron 	h = shost_to_hba(shost);
325745a7a25SStephen M. Cameron 	return snprintf(buf, 20, "%s\n",
326960a30e7SStephen M. Cameron 		h->transMethod & CFGTBL_Trans_Performant ?
327745a7a25SStephen M. Cameron 			"performant" : "simple");
328745a7a25SStephen M. Cameron }
329745a7a25SStephen M. Cameron 
33046380786SStephen M. Cameron /* List of controllers which cannot be hard reset on kexec with reset_devices */
331941b1cdaSStephen M. Cameron static u32 unresettable_controller[] = {
332941b1cdaSStephen M. Cameron 	0x324a103C, /* Smart Array P712m */
333941b1cdaSStephen M. Cameron 	0x324b103C, /* SmartArray P711m */
334941b1cdaSStephen M. Cameron 	0x3223103C, /* Smart Array P800 */
335941b1cdaSStephen M. Cameron 	0x3234103C, /* Smart Array P400 */
336941b1cdaSStephen M. Cameron 	0x3235103C, /* Smart Array P400i */
337941b1cdaSStephen M. Cameron 	0x3211103C, /* Smart Array E200i */
338941b1cdaSStephen M. Cameron 	0x3212103C, /* Smart Array E200 */
339941b1cdaSStephen M. Cameron 	0x3213103C, /* Smart Array E200i */
340941b1cdaSStephen M. Cameron 	0x3214103C, /* Smart Array E200i */
341941b1cdaSStephen M. Cameron 	0x3215103C, /* Smart Array E200i */
342941b1cdaSStephen M. Cameron 	0x3237103C, /* Smart Array E500 */
343941b1cdaSStephen M. Cameron 	0x323D103C, /* Smart Array P700m */
3447af0abbcSTomas Henzl 	0x40800E11, /* Smart Array 5i */
345941b1cdaSStephen M. Cameron 	0x409C0E11, /* Smart Array 6400 */
346941b1cdaSStephen M. Cameron 	0x409D0E11, /* Smart Array 6400 EM */
3475a4f934eSTomas Henzl 	0x40700E11, /* Smart Array 5300 */
3485a4f934eSTomas Henzl 	0x40820E11, /* Smart Array 532 */
3495a4f934eSTomas Henzl 	0x40830E11, /* Smart Array 5312 */
3505a4f934eSTomas Henzl 	0x409A0E11, /* Smart Array 641 */
3515a4f934eSTomas Henzl 	0x409B0E11, /* Smart Array 642 */
3525a4f934eSTomas Henzl 	0x40910E11, /* Smart Array 6i */
353941b1cdaSStephen M. Cameron };
354941b1cdaSStephen M. Cameron 
35546380786SStephen M. Cameron /* List of controllers which cannot even be soft reset */
35646380786SStephen M. Cameron static u32 soft_unresettable_controller[] = {
3577af0abbcSTomas Henzl 	0x40800E11, /* Smart Array 5i */
3585a4f934eSTomas Henzl 	0x40700E11, /* Smart Array 5300 */
3595a4f934eSTomas Henzl 	0x40820E11, /* Smart Array 532 */
3605a4f934eSTomas Henzl 	0x40830E11, /* Smart Array 5312 */
3615a4f934eSTomas Henzl 	0x409A0E11, /* Smart Array 641 */
3625a4f934eSTomas Henzl 	0x409B0E11, /* Smart Array 642 */
3635a4f934eSTomas Henzl 	0x40910E11, /* Smart Array 6i */
36446380786SStephen M. Cameron 	/* Exclude 640x boards.  These are two pci devices in one slot
36546380786SStephen M. Cameron 	 * which share a battery backed cache module.  One controls the
36646380786SStephen M. Cameron 	 * cache, the other accesses the cache through the one that controls
36746380786SStephen M. Cameron 	 * it.  If we reset the one controlling the cache, the other will
36846380786SStephen M. Cameron 	 * likely not be happy.  Just forbid resetting this conjoined mess.
36946380786SStephen M. Cameron 	 * The 640x isn't really supported by hpsa anyway.
37046380786SStephen M. Cameron 	 */
37146380786SStephen M. Cameron 	0x409C0E11, /* Smart Array 6400 */
37246380786SStephen M. Cameron 	0x409D0E11, /* Smart Array 6400 EM */
37346380786SStephen M. Cameron };
37446380786SStephen M. Cameron 
37546380786SStephen M. Cameron static int ctlr_is_hard_resettable(u32 board_id)
376941b1cdaSStephen M. Cameron {
377941b1cdaSStephen M. Cameron 	int i;
378941b1cdaSStephen M. Cameron 
379941b1cdaSStephen M. Cameron 	for (i = 0; i < ARRAY_SIZE(unresettable_controller); i++)
38046380786SStephen M. Cameron 		if (unresettable_controller[i] == board_id)
381941b1cdaSStephen M. Cameron 			return 0;
382941b1cdaSStephen M. Cameron 	return 1;
383941b1cdaSStephen M. Cameron }
384941b1cdaSStephen M. Cameron 
38546380786SStephen M. Cameron static int ctlr_is_soft_resettable(u32 board_id)
38646380786SStephen M. Cameron {
38746380786SStephen M. Cameron 	int i;
38846380786SStephen M. Cameron 
38946380786SStephen M. Cameron 	for (i = 0; i < ARRAY_SIZE(soft_unresettable_controller); i++)
39046380786SStephen M. Cameron 		if (soft_unresettable_controller[i] == board_id)
39146380786SStephen M. Cameron 			return 0;
39246380786SStephen M. Cameron 	return 1;
39346380786SStephen M. Cameron }
39446380786SStephen M. Cameron 
39546380786SStephen M. Cameron static int ctlr_is_resettable(u32 board_id)
39646380786SStephen M. Cameron {
39746380786SStephen M. Cameron 	return ctlr_is_hard_resettable(board_id) ||
39846380786SStephen M. Cameron 		ctlr_is_soft_resettable(board_id);
39946380786SStephen M. Cameron }
40046380786SStephen M. Cameron 
401941b1cdaSStephen M. Cameron static ssize_t host_show_resettable(struct device *dev,
402941b1cdaSStephen M. Cameron 	struct device_attribute *attr, char *buf)
403941b1cdaSStephen M. Cameron {
404941b1cdaSStephen M. Cameron 	struct ctlr_info *h;
405941b1cdaSStephen M. Cameron 	struct Scsi_Host *shost = class_to_shost(dev);
406941b1cdaSStephen M. Cameron 
407941b1cdaSStephen M. Cameron 	h = shost_to_hba(shost);
40846380786SStephen M. Cameron 	return snprintf(buf, 20, "%d\n", ctlr_is_resettable(h->board_id));
409941b1cdaSStephen M. Cameron }
410941b1cdaSStephen M. Cameron 
411edd16368SStephen M. Cameron static inline int is_logical_dev_addr_mode(unsigned char scsi3addr[])
412edd16368SStephen M. Cameron {
413edd16368SStephen M. Cameron 	return (scsi3addr[3] & 0xC0) == 0x40;
414edd16368SStephen M. Cameron }
415edd16368SStephen M. Cameron 
416edd16368SStephen M. Cameron static const char *raid_label[] = { "0", "4", "1(1+0)", "5", "5+1", "ADG",
417d82357eaSMike Miller 	"1(ADM)", "UNKNOWN"
418edd16368SStephen M. Cameron };
419edd16368SStephen M. Cameron #define RAID_UNKNOWN (ARRAY_SIZE(raid_label) - 1)
420edd16368SStephen M. Cameron 
421edd16368SStephen M. Cameron static ssize_t raid_level_show(struct device *dev,
422edd16368SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
423edd16368SStephen M. Cameron {
424edd16368SStephen M. Cameron 	ssize_t l = 0;
42582a72c0aSStephen M. Cameron 	unsigned char rlevel;
426edd16368SStephen M. Cameron 	struct ctlr_info *h;
427edd16368SStephen M. Cameron 	struct scsi_device *sdev;
428edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *hdev;
429edd16368SStephen M. Cameron 	unsigned long flags;
430edd16368SStephen M. Cameron 
431edd16368SStephen M. Cameron 	sdev = to_scsi_device(dev);
432edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
433edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
434edd16368SStephen M. Cameron 	hdev = sdev->hostdata;
435edd16368SStephen M. Cameron 	if (!hdev) {
436edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
437edd16368SStephen M. Cameron 		return -ENODEV;
438edd16368SStephen M. Cameron 	}
439edd16368SStephen M. Cameron 
440edd16368SStephen M. Cameron 	/* Is this even a logical drive? */
441edd16368SStephen M. Cameron 	if (!is_logical_dev_addr_mode(hdev->scsi3addr)) {
442edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
443edd16368SStephen M. Cameron 		l = snprintf(buf, PAGE_SIZE, "N/A\n");
444edd16368SStephen M. Cameron 		return l;
445edd16368SStephen M. Cameron 	}
446edd16368SStephen M. Cameron 
447edd16368SStephen M. Cameron 	rlevel = hdev->raid_level;
448edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
44982a72c0aSStephen M. Cameron 	if (rlevel > RAID_UNKNOWN)
450edd16368SStephen M. Cameron 		rlevel = RAID_UNKNOWN;
451edd16368SStephen M. Cameron 	l = snprintf(buf, PAGE_SIZE, "RAID %s\n", raid_label[rlevel]);
452edd16368SStephen M. Cameron 	return l;
453edd16368SStephen M. Cameron }
454edd16368SStephen M. Cameron 
455edd16368SStephen M. Cameron static ssize_t lunid_show(struct device *dev,
456edd16368SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
457edd16368SStephen M. Cameron {
458edd16368SStephen M. Cameron 	struct ctlr_info *h;
459edd16368SStephen M. Cameron 	struct scsi_device *sdev;
460edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *hdev;
461edd16368SStephen M. Cameron 	unsigned long flags;
462edd16368SStephen M. Cameron 	unsigned char lunid[8];
463edd16368SStephen M. Cameron 
464edd16368SStephen M. Cameron 	sdev = to_scsi_device(dev);
465edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
466edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
467edd16368SStephen M. Cameron 	hdev = sdev->hostdata;
468edd16368SStephen M. Cameron 	if (!hdev) {
469edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
470edd16368SStephen M. Cameron 		return -ENODEV;
471edd16368SStephen M. Cameron 	}
472edd16368SStephen M. Cameron 	memcpy(lunid, hdev->scsi3addr, sizeof(lunid));
473edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
474edd16368SStephen M. Cameron 	return snprintf(buf, 20, "0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
475edd16368SStephen M. Cameron 		lunid[0], lunid[1], lunid[2], lunid[3],
476edd16368SStephen M. Cameron 		lunid[4], lunid[5], lunid[6], lunid[7]);
477edd16368SStephen M. Cameron }
478edd16368SStephen M. Cameron 
479edd16368SStephen M. Cameron static ssize_t unique_id_show(struct device *dev,
480edd16368SStephen M. Cameron 	     struct device_attribute *attr, char *buf)
481edd16368SStephen M. Cameron {
482edd16368SStephen M. Cameron 	struct ctlr_info *h;
483edd16368SStephen M. Cameron 	struct scsi_device *sdev;
484edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *hdev;
485edd16368SStephen M. Cameron 	unsigned long flags;
486edd16368SStephen M. Cameron 	unsigned char sn[16];
487edd16368SStephen M. Cameron 
488edd16368SStephen M. Cameron 	sdev = to_scsi_device(dev);
489edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
490edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
491edd16368SStephen M. Cameron 	hdev = sdev->hostdata;
492edd16368SStephen M. Cameron 	if (!hdev) {
493edd16368SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
494edd16368SStephen M. Cameron 		return -ENODEV;
495edd16368SStephen M. Cameron 	}
496edd16368SStephen M. Cameron 	memcpy(sn, hdev->device_id, sizeof(sn));
497edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
498edd16368SStephen M. Cameron 	return snprintf(buf, 16 * 2 + 2,
499edd16368SStephen M. Cameron 			"%02X%02X%02X%02X%02X%02X%02X%02X"
500edd16368SStephen M. Cameron 			"%02X%02X%02X%02X%02X%02X%02X%02X\n",
501edd16368SStephen M. Cameron 			sn[0], sn[1], sn[2], sn[3],
502edd16368SStephen M. Cameron 			sn[4], sn[5], sn[6], sn[7],
503edd16368SStephen M. Cameron 			sn[8], sn[9], sn[10], sn[11],
504edd16368SStephen M. Cameron 			sn[12], sn[13], sn[14], sn[15]);
505edd16368SStephen M. Cameron }
506edd16368SStephen M. Cameron 
5073f5eac3aSStephen M. Cameron static DEVICE_ATTR(raid_level, S_IRUGO, raid_level_show, NULL);
5083f5eac3aSStephen M. Cameron static DEVICE_ATTR(lunid, S_IRUGO, lunid_show, NULL);
5093f5eac3aSStephen M. Cameron static DEVICE_ATTR(unique_id, S_IRUGO, unique_id_show, NULL);
5103f5eac3aSStephen M. Cameron static DEVICE_ATTR(rescan, S_IWUSR, NULL, host_store_rescan);
5113f5eac3aSStephen M. Cameron static DEVICE_ATTR(firmware_revision, S_IRUGO,
5123f5eac3aSStephen M. Cameron 	host_show_firmware_revision, NULL);
5133f5eac3aSStephen M. Cameron static DEVICE_ATTR(commands_outstanding, S_IRUGO,
5143f5eac3aSStephen M. Cameron 	host_show_commands_outstanding, NULL);
5153f5eac3aSStephen M. Cameron static DEVICE_ATTR(transport_mode, S_IRUGO,
5163f5eac3aSStephen M. Cameron 	host_show_transport_mode, NULL);
517941b1cdaSStephen M. Cameron static DEVICE_ATTR(resettable, S_IRUGO,
518941b1cdaSStephen M. Cameron 	host_show_resettable, NULL);
5193f5eac3aSStephen M. Cameron 
5203f5eac3aSStephen M. Cameron static struct device_attribute *hpsa_sdev_attrs[] = {
5213f5eac3aSStephen M. Cameron 	&dev_attr_raid_level,
5223f5eac3aSStephen M. Cameron 	&dev_attr_lunid,
5233f5eac3aSStephen M. Cameron 	&dev_attr_unique_id,
5243f5eac3aSStephen M. Cameron 	NULL,
5253f5eac3aSStephen M. Cameron };
5263f5eac3aSStephen M. Cameron 
5273f5eac3aSStephen M. Cameron static struct device_attribute *hpsa_shost_attrs[] = {
5283f5eac3aSStephen M. Cameron 	&dev_attr_rescan,
5293f5eac3aSStephen M. Cameron 	&dev_attr_firmware_revision,
5303f5eac3aSStephen M. Cameron 	&dev_attr_commands_outstanding,
5313f5eac3aSStephen M. Cameron 	&dev_attr_transport_mode,
532941b1cdaSStephen M. Cameron 	&dev_attr_resettable,
5333f5eac3aSStephen M. Cameron 	NULL,
5343f5eac3aSStephen M. Cameron };
5353f5eac3aSStephen M. Cameron 
5363f5eac3aSStephen M. Cameron static struct scsi_host_template hpsa_driver_template = {
5373f5eac3aSStephen M. Cameron 	.module			= THIS_MODULE,
538f79cfec6SStephen M. Cameron 	.name			= HPSA,
539f79cfec6SStephen M. Cameron 	.proc_name		= HPSA,
5403f5eac3aSStephen M. Cameron 	.queuecommand		= hpsa_scsi_queue_command,
5413f5eac3aSStephen M. Cameron 	.scan_start		= hpsa_scan_start,
5423f5eac3aSStephen M. Cameron 	.scan_finished		= hpsa_scan_finished,
5433f5eac3aSStephen M. Cameron 	.change_queue_depth	= hpsa_change_queue_depth,
5443f5eac3aSStephen M. Cameron 	.this_id		= -1,
5453f5eac3aSStephen M. Cameron 	.use_clustering		= ENABLE_CLUSTERING,
54675167d2cSStephen M. Cameron 	.eh_abort_handler	= hpsa_eh_abort_handler,
5473f5eac3aSStephen M. Cameron 	.eh_device_reset_handler = hpsa_eh_device_reset_handler,
5483f5eac3aSStephen M. Cameron 	.ioctl			= hpsa_ioctl,
5493f5eac3aSStephen M. Cameron 	.slave_alloc		= hpsa_slave_alloc,
5503f5eac3aSStephen M. Cameron 	.slave_destroy		= hpsa_slave_destroy,
5513f5eac3aSStephen M. Cameron #ifdef CONFIG_COMPAT
5523f5eac3aSStephen M. Cameron 	.compat_ioctl		= hpsa_compat_ioctl,
5533f5eac3aSStephen M. Cameron #endif
5543f5eac3aSStephen M. Cameron 	.sdev_attrs = hpsa_sdev_attrs,
5553f5eac3aSStephen M. Cameron 	.shost_attrs = hpsa_shost_attrs,
556c0d6a4d1SStephen M. Cameron 	.max_sectors = 8192,
55754b2b50cSMartin K. Petersen 	.no_write_same = 1,
5583f5eac3aSStephen M. Cameron };
5593f5eac3aSStephen M. Cameron 
5603f5eac3aSStephen M. Cameron 
5613f5eac3aSStephen M. Cameron /* Enqueuing and dequeuing functions for cmdlists. */
5623f5eac3aSStephen M. Cameron static inline void addQ(struct list_head *list, struct CommandList *c)
5633f5eac3aSStephen M. Cameron {
5643f5eac3aSStephen M. Cameron 	list_add_tail(&c->list, list);
5653f5eac3aSStephen M. Cameron }
5663f5eac3aSStephen M. Cameron 
567254f796bSMatt Gates static inline u32 next_command(struct ctlr_info *h, u8 q)
5683f5eac3aSStephen M. Cameron {
5693f5eac3aSStephen M. Cameron 	u32 a;
570254f796bSMatt Gates 	struct reply_pool *rq = &h->reply_queue[q];
571e16a33adSMatt Gates 	unsigned long flags;
5723f5eac3aSStephen M. Cameron 
5733f5eac3aSStephen M. Cameron 	if (unlikely(!(h->transMethod & CFGTBL_Trans_Performant)))
574254f796bSMatt Gates 		return h->access.command_completed(h, q);
5753f5eac3aSStephen M. Cameron 
576254f796bSMatt Gates 	if ((rq->head[rq->current_entry] & 1) == rq->wraparound) {
577254f796bSMatt Gates 		a = rq->head[rq->current_entry];
578254f796bSMatt Gates 		rq->current_entry++;
579e16a33adSMatt Gates 		spin_lock_irqsave(&h->lock, flags);
5803f5eac3aSStephen M. Cameron 		h->commands_outstanding--;
581e16a33adSMatt Gates 		spin_unlock_irqrestore(&h->lock, flags);
5823f5eac3aSStephen M. Cameron 	} else {
5833f5eac3aSStephen M. Cameron 		a = FIFO_EMPTY;
5843f5eac3aSStephen M. Cameron 	}
5853f5eac3aSStephen M. Cameron 	/* Check for wraparound */
586254f796bSMatt Gates 	if (rq->current_entry == h->max_commands) {
587254f796bSMatt Gates 		rq->current_entry = 0;
588254f796bSMatt Gates 		rq->wraparound ^= 1;
5893f5eac3aSStephen M. Cameron 	}
5903f5eac3aSStephen M. Cameron 	return a;
5913f5eac3aSStephen M. Cameron }
5923f5eac3aSStephen M. Cameron 
5933f5eac3aSStephen M. Cameron /* set_performant_mode: Modify the tag for cciss performant
5943f5eac3aSStephen M. Cameron  * set bit 0 for pull model, bits 3-1 for block fetch
5953f5eac3aSStephen M. Cameron  * register number
5963f5eac3aSStephen M. Cameron  */
5973f5eac3aSStephen M. Cameron static void set_performant_mode(struct ctlr_info *h, struct CommandList *c)
5983f5eac3aSStephen M. Cameron {
599254f796bSMatt Gates 	if (likely(h->transMethod & CFGTBL_Trans_Performant)) {
6003f5eac3aSStephen M. Cameron 		c->busaddr |= 1 | (h->blockFetchTable[c->Header.SGList] << 1);
601254f796bSMatt Gates 		if (likely(h->msix_vector))
602254f796bSMatt Gates 			c->Header.ReplyQueue =
603804a5cb5SJohn Kacur 				raw_smp_processor_id() % h->nreply_queues;
604254f796bSMatt Gates 	}
6053f5eac3aSStephen M. Cameron }
6063f5eac3aSStephen M. Cameron 
607e85c5974SStephen M. Cameron static int is_firmware_flash_cmd(u8 *cdb)
608e85c5974SStephen M. Cameron {
609e85c5974SStephen M. Cameron 	return cdb[0] == BMIC_WRITE && cdb[6] == BMIC_FLASH_FIRMWARE;
610e85c5974SStephen M. Cameron }
611e85c5974SStephen M. Cameron 
612e85c5974SStephen M. Cameron /*
613e85c5974SStephen M. Cameron  * During firmware flash, the heartbeat register may not update as frequently
614e85c5974SStephen M. Cameron  * as it should.  So we dial down lockup detection during firmware flash. and
615e85c5974SStephen M. Cameron  * dial it back up when firmware flash completes.
616e85c5974SStephen M. Cameron  */
617e85c5974SStephen M. Cameron #define HEARTBEAT_SAMPLE_INTERVAL_DURING_FLASH (240 * HZ)
618e85c5974SStephen M. Cameron #define HEARTBEAT_SAMPLE_INTERVAL (30 * HZ)
619e85c5974SStephen M. Cameron static void dial_down_lockup_detection_during_fw_flash(struct ctlr_info *h,
620e85c5974SStephen M. Cameron 		struct CommandList *c)
621e85c5974SStephen M. Cameron {
622e85c5974SStephen M. Cameron 	if (!is_firmware_flash_cmd(c->Request.CDB))
623e85c5974SStephen M. Cameron 		return;
624e85c5974SStephen M. Cameron 	atomic_inc(&h->firmware_flash_in_progress);
625e85c5974SStephen M. Cameron 	h->heartbeat_sample_interval = HEARTBEAT_SAMPLE_INTERVAL_DURING_FLASH;
626e85c5974SStephen M. Cameron }
627e85c5974SStephen M. Cameron 
628e85c5974SStephen M. Cameron static void dial_up_lockup_detection_on_fw_flash_complete(struct ctlr_info *h,
629e85c5974SStephen M. Cameron 		struct CommandList *c)
630e85c5974SStephen M. Cameron {
631e85c5974SStephen M. Cameron 	if (is_firmware_flash_cmd(c->Request.CDB) &&
632e85c5974SStephen M. Cameron 		atomic_dec_and_test(&h->firmware_flash_in_progress))
633e85c5974SStephen M. Cameron 		h->heartbeat_sample_interval = HEARTBEAT_SAMPLE_INTERVAL;
634e85c5974SStephen M. Cameron }
635e85c5974SStephen M. Cameron 
6363f5eac3aSStephen M. Cameron static void enqueue_cmd_and_start_io(struct ctlr_info *h,
6373f5eac3aSStephen M. Cameron 	struct CommandList *c)
6383f5eac3aSStephen M. Cameron {
6393f5eac3aSStephen M. Cameron 	unsigned long flags;
6403f5eac3aSStephen M. Cameron 
6413f5eac3aSStephen M. Cameron 	set_performant_mode(h, c);
642e85c5974SStephen M. Cameron 	dial_down_lockup_detection_during_fw_flash(h, c);
6433f5eac3aSStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
6443f5eac3aSStephen M. Cameron 	addQ(&h->reqQ, c);
6453f5eac3aSStephen M. Cameron 	h->Qdepth++;
6463f5eac3aSStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
647e16a33adSMatt Gates 	start_io(h);
6483f5eac3aSStephen M. Cameron }
6493f5eac3aSStephen M. Cameron 
6503f5eac3aSStephen M. Cameron static inline void removeQ(struct CommandList *c)
6513f5eac3aSStephen M. Cameron {
6523f5eac3aSStephen M. Cameron 	if (WARN_ON(list_empty(&c->list)))
6533f5eac3aSStephen M. Cameron 		return;
6543f5eac3aSStephen M. Cameron 	list_del_init(&c->list);
6553f5eac3aSStephen M. Cameron }
6563f5eac3aSStephen M. Cameron 
6573f5eac3aSStephen M. Cameron static inline int is_hba_lunid(unsigned char scsi3addr[])
6583f5eac3aSStephen M. Cameron {
6593f5eac3aSStephen M. Cameron 	return memcmp(scsi3addr, RAID_CTLR_LUNID, 8) == 0;
6603f5eac3aSStephen M. Cameron }
6613f5eac3aSStephen M. Cameron 
6623f5eac3aSStephen M. Cameron static inline int is_scsi_rev_5(struct ctlr_info *h)
6633f5eac3aSStephen M. Cameron {
6643f5eac3aSStephen M. Cameron 	if (!h->hba_inquiry_data)
6653f5eac3aSStephen M. Cameron 		return 0;
6663f5eac3aSStephen M. Cameron 	if ((h->hba_inquiry_data[2] & 0x07) == 5)
6673f5eac3aSStephen M. Cameron 		return 1;
6683f5eac3aSStephen M. Cameron 	return 0;
6693f5eac3aSStephen M. Cameron }
6703f5eac3aSStephen M. Cameron 
671edd16368SStephen M. Cameron static int hpsa_find_target_lun(struct ctlr_info *h,
672edd16368SStephen M. Cameron 	unsigned char scsi3addr[], int bus, int *target, int *lun)
673edd16368SStephen M. Cameron {
674edd16368SStephen M. Cameron 	/* finds an unused bus, target, lun for a new physical device
675edd16368SStephen M. Cameron 	 * assumes h->devlock is held
676edd16368SStephen M. Cameron 	 */
677edd16368SStephen M. Cameron 	int i, found = 0;
678cfe5badcSScott Teel 	DECLARE_BITMAP(lun_taken, HPSA_MAX_DEVICES);
679edd16368SStephen M. Cameron 
680263d9401SAkinobu Mita 	bitmap_zero(lun_taken, HPSA_MAX_DEVICES);
681edd16368SStephen M. Cameron 
682edd16368SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++) {
683edd16368SStephen M. Cameron 		if (h->dev[i]->bus == bus && h->dev[i]->target != -1)
684263d9401SAkinobu Mita 			__set_bit(h->dev[i]->target, lun_taken);
685edd16368SStephen M. Cameron 	}
686edd16368SStephen M. Cameron 
687263d9401SAkinobu Mita 	i = find_first_zero_bit(lun_taken, HPSA_MAX_DEVICES);
688263d9401SAkinobu Mita 	if (i < HPSA_MAX_DEVICES) {
689edd16368SStephen M. Cameron 		/* *bus = 1; */
690edd16368SStephen M. Cameron 		*target = i;
691edd16368SStephen M. Cameron 		*lun = 0;
692edd16368SStephen M. Cameron 		found = 1;
693edd16368SStephen M. Cameron 	}
694edd16368SStephen M. Cameron 	return !found;
695edd16368SStephen M. Cameron }
696edd16368SStephen M. Cameron 
697edd16368SStephen M. Cameron /* Add an entry into h->dev[] array. */
698edd16368SStephen M. Cameron static int hpsa_scsi_add_entry(struct ctlr_info *h, int hostno,
699edd16368SStephen M. Cameron 		struct hpsa_scsi_dev_t *device,
700edd16368SStephen M. Cameron 		struct hpsa_scsi_dev_t *added[], int *nadded)
701edd16368SStephen M. Cameron {
702edd16368SStephen M. Cameron 	/* assumes h->devlock is held */
703edd16368SStephen M. Cameron 	int n = h->ndevices;
704edd16368SStephen M. Cameron 	int i;
705edd16368SStephen M. Cameron 	unsigned char addr1[8], addr2[8];
706edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
707edd16368SStephen M. Cameron 
708cfe5badcSScott Teel 	if (n >= HPSA_MAX_DEVICES) {
709edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "too many devices, some will be "
710edd16368SStephen M. Cameron 			"inaccessible.\n");
711edd16368SStephen M. Cameron 		return -1;
712edd16368SStephen M. Cameron 	}
713edd16368SStephen M. Cameron 
714edd16368SStephen M. Cameron 	/* physical devices do not have lun or target assigned until now. */
715edd16368SStephen M. Cameron 	if (device->lun != -1)
716edd16368SStephen M. Cameron 		/* Logical device, lun is already assigned. */
717edd16368SStephen M. Cameron 		goto lun_assigned;
718edd16368SStephen M. Cameron 
719edd16368SStephen M. Cameron 	/* If this device a non-zero lun of a multi-lun device
720edd16368SStephen M. Cameron 	 * byte 4 of the 8-byte LUN addr will contain the logical
721edd16368SStephen M. Cameron 	 * unit no, zero otherise.
722edd16368SStephen M. Cameron 	 */
723edd16368SStephen M. Cameron 	if (device->scsi3addr[4] == 0) {
724edd16368SStephen M. Cameron 		/* This is not a non-zero lun of a multi-lun device */
725edd16368SStephen M. Cameron 		if (hpsa_find_target_lun(h, device->scsi3addr,
726edd16368SStephen M. Cameron 			device->bus, &device->target, &device->lun) != 0)
727edd16368SStephen M. Cameron 			return -1;
728edd16368SStephen M. Cameron 		goto lun_assigned;
729edd16368SStephen M. Cameron 	}
730edd16368SStephen M. Cameron 
731edd16368SStephen M. Cameron 	/* This is a non-zero lun of a multi-lun device.
732edd16368SStephen M. Cameron 	 * Search through our list and find the device which
733edd16368SStephen M. Cameron 	 * has the same 8 byte LUN address, excepting byte 4.
734edd16368SStephen M. Cameron 	 * Assign the same bus and target for this new LUN.
735edd16368SStephen M. Cameron 	 * Use the logical unit number from the firmware.
736edd16368SStephen M. Cameron 	 */
737edd16368SStephen M. Cameron 	memcpy(addr1, device->scsi3addr, 8);
738edd16368SStephen M. Cameron 	addr1[4] = 0;
739edd16368SStephen M. Cameron 	for (i = 0; i < n; i++) {
740edd16368SStephen M. Cameron 		sd = h->dev[i];
741edd16368SStephen M. Cameron 		memcpy(addr2, sd->scsi3addr, 8);
742edd16368SStephen M. Cameron 		addr2[4] = 0;
743edd16368SStephen M. Cameron 		/* differ only in byte 4? */
744edd16368SStephen M. Cameron 		if (memcmp(addr1, addr2, 8) == 0) {
745edd16368SStephen M. Cameron 			device->bus = sd->bus;
746edd16368SStephen M. Cameron 			device->target = sd->target;
747edd16368SStephen M. Cameron 			device->lun = device->scsi3addr[4];
748edd16368SStephen M. Cameron 			break;
749edd16368SStephen M. Cameron 		}
750edd16368SStephen M. Cameron 	}
751edd16368SStephen M. Cameron 	if (device->lun == -1) {
752edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "physical device with no LUN=0,"
753edd16368SStephen M. Cameron 			" suspect firmware bug or unsupported hardware "
754edd16368SStephen M. Cameron 			"configuration.\n");
755edd16368SStephen M. Cameron 			return -1;
756edd16368SStephen M. Cameron 	}
757edd16368SStephen M. Cameron 
758edd16368SStephen M. Cameron lun_assigned:
759edd16368SStephen M. Cameron 
760edd16368SStephen M. Cameron 	h->dev[n] = device;
761edd16368SStephen M. Cameron 	h->ndevices++;
762edd16368SStephen M. Cameron 	added[*nadded] = device;
763edd16368SStephen M. Cameron 	(*nadded)++;
764edd16368SStephen M. Cameron 
765edd16368SStephen M. Cameron 	/* initially, (before registering with scsi layer) we don't
766edd16368SStephen M. Cameron 	 * know our hostno and we don't want to print anything first
767edd16368SStephen M. Cameron 	 * time anyway (the scsi layer's inquiries will show that info)
768edd16368SStephen M. Cameron 	 */
769edd16368SStephen M. Cameron 	/* if (hostno != -1) */
770edd16368SStephen M. Cameron 		dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d added.\n",
771edd16368SStephen M. Cameron 			scsi_device_type(device->devtype), hostno,
772edd16368SStephen M. Cameron 			device->bus, device->target, device->lun);
773edd16368SStephen M. Cameron 	return 0;
774edd16368SStephen M. Cameron }
775edd16368SStephen M. Cameron 
776bd9244f7SScott Teel /* Update an entry in h->dev[] array. */
777bd9244f7SScott Teel static void hpsa_scsi_update_entry(struct ctlr_info *h, int hostno,
778bd9244f7SScott Teel 	int entry, struct hpsa_scsi_dev_t *new_entry)
779bd9244f7SScott Teel {
780bd9244f7SScott Teel 	/* assumes h->devlock is held */
781bd9244f7SScott Teel 	BUG_ON(entry < 0 || entry >= HPSA_MAX_DEVICES);
782bd9244f7SScott Teel 
783bd9244f7SScott Teel 	/* Raid level changed. */
784bd9244f7SScott Teel 	h->dev[entry]->raid_level = new_entry->raid_level;
785bd9244f7SScott Teel 	dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d updated.\n",
786bd9244f7SScott Teel 		scsi_device_type(new_entry->devtype), hostno, new_entry->bus,
787bd9244f7SScott Teel 		new_entry->target, new_entry->lun);
788bd9244f7SScott Teel }
789bd9244f7SScott Teel 
7902a8ccf31SStephen M. Cameron /* Replace an entry from h->dev[] array. */
7912a8ccf31SStephen M. Cameron static void hpsa_scsi_replace_entry(struct ctlr_info *h, int hostno,
7922a8ccf31SStephen M. Cameron 	int entry, struct hpsa_scsi_dev_t *new_entry,
7932a8ccf31SStephen M. Cameron 	struct hpsa_scsi_dev_t *added[], int *nadded,
7942a8ccf31SStephen M. Cameron 	struct hpsa_scsi_dev_t *removed[], int *nremoved)
7952a8ccf31SStephen M. Cameron {
7962a8ccf31SStephen M. Cameron 	/* assumes h->devlock is held */
797cfe5badcSScott Teel 	BUG_ON(entry < 0 || entry >= HPSA_MAX_DEVICES);
7982a8ccf31SStephen M. Cameron 	removed[*nremoved] = h->dev[entry];
7992a8ccf31SStephen M. Cameron 	(*nremoved)++;
80001350d05SStephen M. Cameron 
80101350d05SStephen M. Cameron 	/*
80201350d05SStephen M. Cameron 	 * New physical devices won't have target/lun assigned yet
80301350d05SStephen M. Cameron 	 * so we need to preserve the values in the slot we are replacing.
80401350d05SStephen M. Cameron 	 */
80501350d05SStephen M. Cameron 	if (new_entry->target == -1) {
80601350d05SStephen M. Cameron 		new_entry->target = h->dev[entry]->target;
80701350d05SStephen M. Cameron 		new_entry->lun = h->dev[entry]->lun;
80801350d05SStephen M. Cameron 	}
80901350d05SStephen M. Cameron 
8102a8ccf31SStephen M. Cameron 	h->dev[entry] = new_entry;
8112a8ccf31SStephen M. Cameron 	added[*nadded] = new_entry;
8122a8ccf31SStephen M. Cameron 	(*nadded)++;
8132a8ccf31SStephen M. Cameron 	dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d changed.\n",
8142a8ccf31SStephen M. Cameron 		scsi_device_type(new_entry->devtype), hostno, new_entry->bus,
8152a8ccf31SStephen M. Cameron 			new_entry->target, new_entry->lun);
8162a8ccf31SStephen M. Cameron }
8172a8ccf31SStephen M. Cameron 
818edd16368SStephen M. Cameron /* Remove an entry from h->dev[] array. */
819edd16368SStephen M. Cameron static void hpsa_scsi_remove_entry(struct ctlr_info *h, int hostno, int entry,
820edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *removed[], int *nremoved)
821edd16368SStephen M. Cameron {
822edd16368SStephen M. Cameron 	/* assumes h->devlock is held */
823edd16368SStephen M. Cameron 	int i;
824edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
825edd16368SStephen M. Cameron 
826cfe5badcSScott Teel 	BUG_ON(entry < 0 || entry >= HPSA_MAX_DEVICES);
827edd16368SStephen M. Cameron 
828edd16368SStephen M. Cameron 	sd = h->dev[entry];
829edd16368SStephen M. Cameron 	removed[*nremoved] = h->dev[entry];
830edd16368SStephen M. Cameron 	(*nremoved)++;
831edd16368SStephen M. Cameron 
832edd16368SStephen M. Cameron 	for (i = entry; i < h->ndevices-1; i++)
833edd16368SStephen M. Cameron 		h->dev[i] = h->dev[i+1];
834edd16368SStephen M. Cameron 	h->ndevices--;
835edd16368SStephen M. Cameron 	dev_info(&h->pdev->dev, "%s device c%db%dt%dl%d removed.\n",
836edd16368SStephen M. Cameron 		scsi_device_type(sd->devtype), hostno, sd->bus, sd->target,
837edd16368SStephen M. Cameron 		sd->lun);
838edd16368SStephen M. Cameron }
839edd16368SStephen M. Cameron 
840edd16368SStephen M. Cameron #define SCSI3ADDR_EQ(a, b) ( \
841edd16368SStephen M. Cameron 	(a)[7] == (b)[7] && \
842edd16368SStephen M. Cameron 	(a)[6] == (b)[6] && \
843edd16368SStephen M. Cameron 	(a)[5] == (b)[5] && \
844edd16368SStephen M. Cameron 	(a)[4] == (b)[4] && \
845edd16368SStephen M. Cameron 	(a)[3] == (b)[3] && \
846edd16368SStephen M. Cameron 	(a)[2] == (b)[2] && \
847edd16368SStephen M. Cameron 	(a)[1] == (b)[1] && \
848edd16368SStephen M. Cameron 	(a)[0] == (b)[0])
849edd16368SStephen M. Cameron 
850edd16368SStephen M. Cameron static void fixup_botched_add(struct ctlr_info *h,
851edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *added)
852edd16368SStephen M. Cameron {
853edd16368SStephen M. Cameron 	/* called when scsi_add_device fails in order to re-adjust
854edd16368SStephen M. Cameron 	 * h->dev[] to match the mid layer's view.
855edd16368SStephen M. Cameron 	 */
856edd16368SStephen M. Cameron 	unsigned long flags;
857edd16368SStephen M. Cameron 	int i, j;
858edd16368SStephen M. Cameron 
859edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
860edd16368SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++) {
861edd16368SStephen M. Cameron 		if (h->dev[i] == added) {
862edd16368SStephen M. Cameron 			for (j = i; j < h->ndevices-1; j++)
863edd16368SStephen M. Cameron 				h->dev[j] = h->dev[j+1];
864edd16368SStephen M. Cameron 			h->ndevices--;
865edd16368SStephen M. Cameron 			break;
866edd16368SStephen M. Cameron 		}
867edd16368SStephen M. Cameron 	}
868edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
869edd16368SStephen M. Cameron 	kfree(added);
870edd16368SStephen M. Cameron }
871edd16368SStephen M. Cameron 
872edd16368SStephen M. Cameron static inline int device_is_the_same(struct hpsa_scsi_dev_t *dev1,
873edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *dev2)
874edd16368SStephen M. Cameron {
875edd16368SStephen M. Cameron 	/* we compare everything except lun and target as these
876edd16368SStephen M. Cameron 	 * are not yet assigned.  Compare parts likely
877edd16368SStephen M. Cameron 	 * to differ first
878edd16368SStephen M. Cameron 	 */
879edd16368SStephen M. Cameron 	if (memcmp(dev1->scsi3addr, dev2->scsi3addr,
880edd16368SStephen M. Cameron 		sizeof(dev1->scsi3addr)) != 0)
881edd16368SStephen M. Cameron 		return 0;
882edd16368SStephen M. Cameron 	if (memcmp(dev1->device_id, dev2->device_id,
883edd16368SStephen M. Cameron 		sizeof(dev1->device_id)) != 0)
884edd16368SStephen M. Cameron 		return 0;
885edd16368SStephen M. Cameron 	if (memcmp(dev1->model, dev2->model, sizeof(dev1->model)) != 0)
886edd16368SStephen M. Cameron 		return 0;
887edd16368SStephen M. Cameron 	if (memcmp(dev1->vendor, dev2->vendor, sizeof(dev1->vendor)) != 0)
888edd16368SStephen M. Cameron 		return 0;
889edd16368SStephen M. Cameron 	if (dev1->devtype != dev2->devtype)
890edd16368SStephen M. Cameron 		return 0;
891edd16368SStephen M. Cameron 	if (dev1->bus != dev2->bus)
892edd16368SStephen M. Cameron 		return 0;
893edd16368SStephen M. Cameron 	return 1;
894edd16368SStephen M. Cameron }
895edd16368SStephen M. Cameron 
896bd9244f7SScott Teel static inline int device_updated(struct hpsa_scsi_dev_t *dev1,
897bd9244f7SScott Teel 	struct hpsa_scsi_dev_t *dev2)
898bd9244f7SScott Teel {
899bd9244f7SScott Teel 	/* Device attributes that can change, but don't mean
900bd9244f7SScott Teel 	 * that the device is a different device, nor that the OS
901bd9244f7SScott Teel 	 * needs to be told anything about the change.
902bd9244f7SScott Teel 	 */
903bd9244f7SScott Teel 	if (dev1->raid_level != dev2->raid_level)
904bd9244f7SScott Teel 		return 1;
905bd9244f7SScott Teel 	return 0;
906bd9244f7SScott Teel }
907bd9244f7SScott Teel 
908edd16368SStephen M. Cameron /* Find needle in haystack.  If exact match found, return DEVICE_SAME,
909edd16368SStephen M. Cameron  * and return needle location in *index.  If scsi3addr matches, but not
910edd16368SStephen M. Cameron  * vendor, model, serial num, etc. return DEVICE_CHANGED, and return needle
911bd9244f7SScott Teel  * location in *index.
912bd9244f7SScott Teel  * In the case of a minor device attribute change, such as RAID level, just
913bd9244f7SScott Teel  * return DEVICE_UPDATED, along with the updated device's location in index.
914bd9244f7SScott Teel  * If needle not found, return DEVICE_NOT_FOUND.
915edd16368SStephen M. Cameron  */
916edd16368SStephen M. Cameron static int hpsa_scsi_find_entry(struct hpsa_scsi_dev_t *needle,
917edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *haystack[], int haystack_size,
918edd16368SStephen M. Cameron 	int *index)
919edd16368SStephen M. Cameron {
920edd16368SStephen M. Cameron 	int i;
921edd16368SStephen M. Cameron #define DEVICE_NOT_FOUND 0
922edd16368SStephen M. Cameron #define DEVICE_CHANGED 1
923edd16368SStephen M. Cameron #define DEVICE_SAME 2
924bd9244f7SScott Teel #define DEVICE_UPDATED 3
925edd16368SStephen M. Cameron 	for (i = 0; i < haystack_size; i++) {
92623231048SStephen M. Cameron 		if (haystack[i] == NULL) /* previously removed. */
92723231048SStephen M. Cameron 			continue;
928edd16368SStephen M. Cameron 		if (SCSI3ADDR_EQ(needle->scsi3addr, haystack[i]->scsi3addr)) {
929edd16368SStephen M. Cameron 			*index = i;
930bd9244f7SScott Teel 			if (device_is_the_same(needle, haystack[i])) {
931bd9244f7SScott Teel 				if (device_updated(needle, haystack[i]))
932bd9244f7SScott Teel 					return DEVICE_UPDATED;
933edd16368SStephen M. Cameron 				return DEVICE_SAME;
934bd9244f7SScott Teel 			} else {
935edd16368SStephen M. Cameron 				return DEVICE_CHANGED;
936edd16368SStephen M. Cameron 			}
937edd16368SStephen M. Cameron 		}
938bd9244f7SScott Teel 	}
939edd16368SStephen M. Cameron 	*index = -1;
940edd16368SStephen M. Cameron 	return DEVICE_NOT_FOUND;
941edd16368SStephen M. Cameron }
942edd16368SStephen M. Cameron 
9434967bd3eSStephen M. Cameron static void adjust_hpsa_scsi_table(struct ctlr_info *h, int hostno,
944edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd[], int nsds)
945edd16368SStephen M. Cameron {
946edd16368SStephen M. Cameron 	/* sd contains scsi3 addresses and devtypes, and inquiry
947edd16368SStephen M. Cameron 	 * data.  This function takes what's in sd to be the current
948edd16368SStephen M. Cameron 	 * reality and updates h->dev[] to reflect that reality.
949edd16368SStephen M. Cameron 	 */
950edd16368SStephen M. Cameron 	int i, entry, device_change, changes = 0;
951edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *csd;
952edd16368SStephen M. Cameron 	unsigned long flags;
953edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t **added, **removed;
954edd16368SStephen M. Cameron 	int nadded, nremoved;
955edd16368SStephen M. Cameron 	struct Scsi_Host *sh = NULL;
956edd16368SStephen M. Cameron 
957cfe5badcSScott Teel 	added = kzalloc(sizeof(*added) * HPSA_MAX_DEVICES, GFP_KERNEL);
958cfe5badcSScott Teel 	removed = kzalloc(sizeof(*removed) * HPSA_MAX_DEVICES, GFP_KERNEL);
959edd16368SStephen M. Cameron 
960edd16368SStephen M. Cameron 	if (!added || !removed) {
961edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "out of memory in "
962edd16368SStephen M. Cameron 			"adjust_hpsa_scsi_table\n");
963edd16368SStephen M. Cameron 		goto free_and_out;
964edd16368SStephen M. Cameron 	}
965edd16368SStephen M. Cameron 
966edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->devlock, flags);
967edd16368SStephen M. Cameron 
968edd16368SStephen M. Cameron 	/* find any devices in h->dev[] that are not in
969edd16368SStephen M. Cameron 	 * sd[] and remove them from h->dev[], and for any
970edd16368SStephen M. Cameron 	 * devices which have changed, remove the old device
971edd16368SStephen M. Cameron 	 * info and add the new device info.
972bd9244f7SScott Teel 	 * If minor device attributes change, just update
973bd9244f7SScott Teel 	 * the existing device structure.
974edd16368SStephen M. Cameron 	 */
975edd16368SStephen M. Cameron 	i = 0;
976edd16368SStephen M. Cameron 	nremoved = 0;
977edd16368SStephen M. Cameron 	nadded = 0;
978edd16368SStephen M. Cameron 	while (i < h->ndevices) {
979edd16368SStephen M. Cameron 		csd = h->dev[i];
980edd16368SStephen M. Cameron 		device_change = hpsa_scsi_find_entry(csd, sd, nsds, &entry);
981edd16368SStephen M. Cameron 		if (device_change == DEVICE_NOT_FOUND) {
982edd16368SStephen M. Cameron 			changes++;
983edd16368SStephen M. Cameron 			hpsa_scsi_remove_entry(h, hostno, i,
984edd16368SStephen M. Cameron 				removed, &nremoved);
985edd16368SStephen M. Cameron 			continue; /* remove ^^^, hence i not incremented */
986edd16368SStephen M. Cameron 		} else if (device_change == DEVICE_CHANGED) {
987edd16368SStephen M. Cameron 			changes++;
9882a8ccf31SStephen M. Cameron 			hpsa_scsi_replace_entry(h, hostno, i, sd[entry],
9892a8ccf31SStephen M. Cameron 				added, &nadded, removed, &nremoved);
990c7f172dcSStephen M. Cameron 			/* Set it to NULL to prevent it from being freed
991c7f172dcSStephen M. Cameron 			 * at the bottom of hpsa_update_scsi_devices()
992c7f172dcSStephen M. Cameron 			 */
993c7f172dcSStephen M. Cameron 			sd[entry] = NULL;
994bd9244f7SScott Teel 		} else if (device_change == DEVICE_UPDATED) {
995bd9244f7SScott Teel 			hpsa_scsi_update_entry(h, hostno, i, sd[entry]);
996edd16368SStephen M. Cameron 		}
997edd16368SStephen M. Cameron 		i++;
998edd16368SStephen M. Cameron 	}
999edd16368SStephen M. Cameron 
1000edd16368SStephen M. Cameron 	/* Now, make sure every device listed in sd[] is also
1001edd16368SStephen M. Cameron 	 * listed in h->dev[], adding them if they aren't found
1002edd16368SStephen M. Cameron 	 */
1003edd16368SStephen M. Cameron 
1004edd16368SStephen M. Cameron 	for (i = 0; i < nsds; i++) {
1005edd16368SStephen M. Cameron 		if (!sd[i]) /* if already added above. */
1006edd16368SStephen M. Cameron 			continue;
1007edd16368SStephen M. Cameron 		device_change = hpsa_scsi_find_entry(sd[i], h->dev,
1008edd16368SStephen M. Cameron 					h->ndevices, &entry);
1009edd16368SStephen M. Cameron 		if (device_change == DEVICE_NOT_FOUND) {
1010edd16368SStephen M. Cameron 			changes++;
1011edd16368SStephen M. Cameron 			if (hpsa_scsi_add_entry(h, hostno, sd[i],
1012edd16368SStephen M. Cameron 				added, &nadded) != 0)
1013edd16368SStephen M. Cameron 				break;
1014edd16368SStephen M. Cameron 			sd[i] = NULL; /* prevent from being freed later. */
1015edd16368SStephen M. Cameron 		} else if (device_change == DEVICE_CHANGED) {
1016edd16368SStephen M. Cameron 			/* should never happen... */
1017edd16368SStephen M. Cameron 			changes++;
1018edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev,
1019edd16368SStephen M. Cameron 				"device unexpectedly changed.\n");
1020edd16368SStephen M. Cameron 			/* but if it does happen, we just ignore that device */
1021edd16368SStephen M. Cameron 		}
1022edd16368SStephen M. Cameron 	}
1023edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->devlock, flags);
1024edd16368SStephen M. Cameron 
1025edd16368SStephen M. Cameron 	/* Don't notify scsi mid layer of any changes the first time through
1026edd16368SStephen M. Cameron 	 * (or if there are no changes) scsi_scan_host will do it later the
1027edd16368SStephen M. Cameron 	 * first time through.
1028edd16368SStephen M. Cameron 	 */
1029edd16368SStephen M. Cameron 	if (hostno == -1 || !changes)
1030edd16368SStephen M. Cameron 		goto free_and_out;
1031edd16368SStephen M. Cameron 
1032edd16368SStephen M. Cameron 	sh = h->scsi_host;
1033edd16368SStephen M. Cameron 	/* Notify scsi mid layer of any removed devices */
1034edd16368SStephen M. Cameron 	for (i = 0; i < nremoved; i++) {
1035edd16368SStephen M. Cameron 		struct scsi_device *sdev =
1036edd16368SStephen M. Cameron 			scsi_device_lookup(sh, removed[i]->bus,
1037edd16368SStephen M. Cameron 				removed[i]->target, removed[i]->lun);
1038edd16368SStephen M. Cameron 		if (sdev != NULL) {
1039edd16368SStephen M. Cameron 			scsi_remove_device(sdev);
1040edd16368SStephen M. Cameron 			scsi_device_put(sdev);
1041edd16368SStephen M. Cameron 		} else {
1042edd16368SStephen M. Cameron 			/* We don't expect to get here.
1043edd16368SStephen M. Cameron 			 * future cmds to this device will get selection
1044edd16368SStephen M. Cameron 			 * timeout as if the device was gone.
1045edd16368SStephen M. Cameron 			 */
1046edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "didn't find c%db%dt%dl%d "
1047edd16368SStephen M. Cameron 				" for removal.", hostno, removed[i]->bus,
1048edd16368SStephen M. Cameron 				removed[i]->target, removed[i]->lun);
1049edd16368SStephen M. Cameron 		}
1050edd16368SStephen M. Cameron 		kfree(removed[i]);
1051edd16368SStephen M. Cameron 		removed[i] = NULL;
1052edd16368SStephen M. Cameron 	}
1053edd16368SStephen M. Cameron 
1054edd16368SStephen M. Cameron 	/* Notify scsi mid layer of any added devices */
1055edd16368SStephen M. Cameron 	for (i = 0; i < nadded; i++) {
1056edd16368SStephen M. Cameron 		if (scsi_add_device(sh, added[i]->bus,
1057edd16368SStephen M. Cameron 			added[i]->target, added[i]->lun) == 0)
1058edd16368SStephen M. Cameron 			continue;
1059edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "scsi_add_device c%db%dt%dl%d failed, "
1060edd16368SStephen M. Cameron 			"device not added.\n", hostno, added[i]->bus,
1061edd16368SStephen M. Cameron 			added[i]->target, added[i]->lun);
1062edd16368SStephen M. Cameron 		/* now we have to remove it from h->dev,
1063edd16368SStephen M. Cameron 		 * since it didn't get added to scsi mid layer
1064edd16368SStephen M. Cameron 		 */
1065edd16368SStephen M. Cameron 		fixup_botched_add(h, added[i]);
1066edd16368SStephen M. Cameron 	}
1067edd16368SStephen M. Cameron 
1068edd16368SStephen M. Cameron free_and_out:
1069edd16368SStephen M. Cameron 	kfree(added);
1070edd16368SStephen M. Cameron 	kfree(removed);
1071edd16368SStephen M. Cameron }
1072edd16368SStephen M. Cameron 
1073edd16368SStephen M. Cameron /*
10749e03aa2fSJoe Perches  * Lookup bus/target/lun and return corresponding struct hpsa_scsi_dev_t *
1075edd16368SStephen M. Cameron  * Assume's h->devlock is held.
1076edd16368SStephen M. Cameron  */
1077edd16368SStephen M. Cameron static struct hpsa_scsi_dev_t *lookup_hpsa_scsi_dev(struct ctlr_info *h,
1078edd16368SStephen M. Cameron 	int bus, int target, int lun)
1079edd16368SStephen M. Cameron {
1080edd16368SStephen M. Cameron 	int i;
1081edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
1082edd16368SStephen M. Cameron 
1083edd16368SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++) {
1084edd16368SStephen M. Cameron 		sd = h->dev[i];
1085edd16368SStephen M. Cameron 		if (sd->bus == bus && sd->target == target && sd->lun == lun)
1086edd16368SStephen M. Cameron 			return sd;
1087edd16368SStephen M. Cameron 	}
1088edd16368SStephen M. Cameron 	return NULL;
1089edd16368SStephen M. Cameron }
1090edd16368SStephen M. Cameron 
1091edd16368SStephen M. Cameron /* link sdev->hostdata to our per-device structure. */
1092edd16368SStephen M. Cameron static int hpsa_slave_alloc(struct scsi_device *sdev)
1093edd16368SStephen M. Cameron {
1094edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *sd;
1095edd16368SStephen M. Cameron 	unsigned long flags;
1096edd16368SStephen M. Cameron 	struct ctlr_info *h;
1097edd16368SStephen M. Cameron 
1098edd16368SStephen M. Cameron 	h = sdev_to_hba(sdev);
1099edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->devlock, flags);
1100edd16368SStephen M. Cameron 	sd = lookup_hpsa_scsi_dev(h, sdev_channel(sdev),
1101edd16368SStephen M. Cameron 		sdev_id(sdev), sdev->lun);
1102edd16368SStephen M. Cameron 	if (sd != NULL)
1103edd16368SStephen M. Cameron 		sdev->hostdata = sd;
1104edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->devlock, flags);
1105edd16368SStephen M. Cameron 	return 0;
1106edd16368SStephen M. Cameron }
1107edd16368SStephen M. Cameron 
1108edd16368SStephen M. Cameron static void hpsa_slave_destroy(struct scsi_device *sdev)
1109edd16368SStephen M. Cameron {
1110bcc44255SStephen M. Cameron 	/* nothing to do. */
1111edd16368SStephen M. Cameron }
1112edd16368SStephen M. Cameron 
111333a2ffceSStephen M. Cameron static void hpsa_free_sg_chain_blocks(struct ctlr_info *h)
111433a2ffceSStephen M. Cameron {
111533a2ffceSStephen M. Cameron 	int i;
111633a2ffceSStephen M. Cameron 
111733a2ffceSStephen M. Cameron 	if (!h->cmd_sg_list)
111833a2ffceSStephen M. Cameron 		return;
111933a2ffceSStephen M. Cameron 	for (i = 0; i < h->nr_cmds; i++) {
112033a2ffceSStephen M. Cameron 		kfree(h->cmd_sg_list[i]);
112133a2ffceSStephen M. Cameron 		h->cmd_sg_list[i] = NULL;
112233a2ffceSStephen M. Cameron 	}
112333a2ffceSStephen M. Cameron 	kfree(h->cmd_sg_list);
112433a2ffceSStephen M. Cameron 	h->cmd_sg_list = NULL;
112533a2ffceSStephen M. Cameron }
112633a2ffceSStephen M. Cameron 
112733a2ffceSStephen M. Cameron static int hpsa_allocate_sg_chain_blocks(struct ctlr_info *h)
112833a2ffceSStephen M. Cameron {
112933a2ffceSStephen M. Cameron 	int i;
113033a2ffceSStephen M. Cameron 
113133a2ffceSStephen M. Cameron 	if (h->chainsize <= 0)
113233a2ffceSStephen M. Cameron 		return 0;
113333a2ffceSStephen M. Cameron 
113433a2ffceSStephen M. Cameron 	h->cmd_sg_list = kzalloc(sizeof(*h->cmd_sg_list) * h->nr_cmds,
113533a2ffceSStephen M. Cameron 				GFP_KERNEL);
113633a2ffceSStephen M. Cameron 	if (!h->cmd_sg_list)
113733a2ffceSStephen M. Cameron 		return -ENOMEM;
113833a2ffceSStephen M. Cameron 	for (i = 0; i < h->nr_cmds; i++) {
113933a2ffceSStephen M. Cameron 		h->cmd_sg_list[i] = kmalloc(sizeof(*h->cmd_sg_list[i]) *
114033a2ffceSStephen M. Cameron 						h->chainsize, GFP_KERNEL);
114133a2ffceSStephen M. Cameron 		if (!h->cmd_sg_list[i])
114233a2ffceSStephen M. Cameron 			goto clean;
114333a2ffceSStephen M. Cameron 	}
114433a2ffceSStephen M. Cameron 	return 0;
114533a2ffceSStephen M. Cameron 
114633a2ffceSStephen M. Cameron clean:
114733a2ffceSStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
114833a2ffceSStephen M. Cameron 	return -ENOMEM;
114933a2ffceSStephen M. Cameron }
115033a2ffceSStephen M. Cameron 
1151e2bea6dfSStephen M. Cameron static int hpsa_map_sg_chain_block(struct ctlr_info *h,
115233a2ffceSStephen M. Cameron 	struct CommandList *c)
115333a2ffceSStephen M. Cameron {
115433a2ffceSStephen M. Cameron 	struct SGDescriptor *chain_sg, *chain_block;
115533a2ffceSStephen M. Cameron 	u64 temp64;
115633a2ffceSStephen M. Cameron 
115733a2ffceSStephen M. Cameron 	chain_sg = &c->SG[h->max_cmd_sg_entries - 1];
115833a2ffceSStephen M. Cameron 	chain_block = h->cmd_sg_list[c->cmdindex];
115933a2ffceSStephen M. Cameron 	chain_sg->Ext = HPSA_SG_CHAIN;
116033a2ffceSStephen M. Cameron 	chain_sg->Len = sizeof(*chain_sg) *
116133a2ffceSStephen M. Cameron 		(c->Header.SGTotal - h->max_cmd_sg_entries);
116233a2ffceSStephen M. Cameron 	temp64 = pci_map_single(h->pdev, chain_block, chain_sg->Len,
116333a2ffceSStephen M. Cameron 				PCI_DMA_TODEVICE);
1164e2bea6dfSStephen M. Cameron 	if (dma_mapping_error(&h->pdev->dev, temp64)) {
1165e2bea6dfSStephen M. Cameron 		/* prevent subsequent unmapping */
1166e2bea6dfSStephen M. Cameron 		chain_sg->Addr.lower = 0;
1167e2bea6dfSStephen M. Cameron 		chain_sg->Addr.upper = 0;
1168e2bea6dfSStephen M. Cameron 		return -1;
1169e2bea6dfSStephen M. Cameron 	}
117033a2ffceSStephen M. Cameron 	chain_sg->Addr.lower = (u32) (temp64 & 0x0FFFFFFFFULL);
117133a2ffceSStephen M. Cameron 	chain_sg->Addr.upper = (u32) ((temp64 >> 32) & 0x0FFFFFFFFULL);
1172e2bea6dfSStephen M. Cameron 	return 0;
117333a2ffceSStephen M. Cameron }
117433a2ffceSStephen M. Cameron 
117533a2ffceSStephen M. Cameron static void hpsa_unmap_sg_chain_block(struct ctlr_info *h,
117633a2ffceSStephen M. Cameron 	struct CommandList *c)
117733a2ffceSStephen M. Cameron {
117833a2ffceSStephen M. Cameron 	struct SGDescriptor *chain_sg;
117933a2ffceSStephen M. Cameron 	union u64bit temp64;
118033a2ffceSStephen M. Cameron 
118133a2ffceSStephen M. Cameron 	if (c->Header.SGTotal <= h->max_cmd_sg_entries)
118233a2ffceSStephen M. Cameron 		return;
118333a2ffceSStephen M. Cameron 
118433a2ffceSStephen M. Cameron 	chain_sg = &c->SG[h->max_cmd_sg_entries - 1];
118533a2ffceSStephen M. Cameron 	temp64.val32.lower = chain_sg->Addr.lower;
118633a2ffceSStephen M. Cameron 	temp64.val32.upper = chain_sg->Addr.upper;
118733a2ffceSStephen M. Cameron 	pci_unmap_single(h->pdev, temp64.val, chain_sg->Len, PCI_DMA_TODEVICE);
118833a2ffceSStephen M. Cameron }
118933a2ffceSStephen M. Cameron 
11901fb011fbSStephen M. Cameron static void complete_scsi_command(struct CommandList *cp)
1191edd16368SStephen M. Cameron {
1192edd16368SStephen M. Cameron 	struct scsi_cmnd *cmd;
1193edd16368SStephen M. Cameron 	struct ctlr_info *h;
1194edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
1195edd16368SStephen M. Cameron 
1196edd16368SStephen M. Cameron 	unsigned char sense_key;
1197edd16368SStephen M. Cameron 	unsigned char asc;      /* additional sense code */
1198edd16368SStephen M. Cameron 	unsigned char ascq;     /* additional sense code qualifier */
1199db111e18SStephen M. Cameron 	unsigned long sense_data_size;
1200edd16368SStephen M. Cameron 
1201edd16368SStephen M. Cameron 	ei = cp->err_info;
1202edd16368SStephen M. Cameron 	cmd = (struct scsi_cmnd *) cp->scsi_cmd;
1203edd16368SStephen M. Cameron 	h = cp->h;
1204edd16368SStephen M. Cameron 
1205edd16368SStephen M. Cameron 	scsi_dma_unmap(cmd); /* undo the DMA mappings */
120633a2ffceSStephen M. Cameron 	if (cp->Header.SGTotal > h->max_cmd_sg_entries)
120733a2ffceSStephen M. Cameron 		hpsa_unmap_sg_chain_block(h, cp);
1208edd16368SStephen M. Cameron 
1209edd16368SStephen M. Cameron 	cmd->result = (DID_OK << 16); 		/* host byte */
1210edd16368SStephen M. Cameron 	cmd->result |= (COMMAND_COMPLETE << 8);	/* msg byte */
12115512672fSStephen M. Cameron 	cmd->result |= ei->ScsiStatus;
1212edd16368SStephen M. Cameron 
1213edd16368SStephen M. Cameron 	/* copy the sense data whether we need to or not. */
1214db111e18SStephen M. Cameron 	if (SCSI_SENSE_BUFFERSIZE < sizeof(ei->SenseInfo))
1215db111e18SStephen M. Cameron 		sense_data_size = SCSI_SENSE_BUFFERSIZE;
1216db111e18SStephen M. Cameron 	else
1217db111e18SStephen M. Cameron 		sense_data_size = sizeof(ei->SenseInfo);
1218db111e18SStephen M. Cameron 	if (ei->SenseLen < sense_data_size)
1219db111e18SStephen M. Cameron 		sense_data_size = ei->SenseLen;
1220db111e18SStephen M. Cameron 
1221db111e18SStephen M. Cameron 	memcpy(cmd->sense_buffer, ei->SenseInfo, sense_data_size);
1222edd16368SStephen M. Cameron 	scsi_set_resid(cmd, ei->ResidualCnt);
1223edd16368SStephen M. Cameron 
1224edd16368SStephen M. Cameron 	if (ei->CommandStatus == 0) {
1225edd16368SStephen M. Cameron 		cmd_free(h, cp);
12262cc5bfafSTomas Henzl 		cmd->scsi_done(cmd);
1227edd16368SStephen M. Cameron 		return;
1228edd16368SStephen M. Cameron 	}
1229edd16368SStephen M. Cameron 
1230edd16368SStephen M. Cameron 	/* an error has occurred */
1231edd16368SStephen M. Cameron 	switch (ei->CommandStatus) {
1232edd16368SStephen M. Cameron 
1233edd16368SStephen M. Cameron 	case CMD_TARGET_STATUS:
1234edd16368SStephen M. Cameron 		if (ei->ScsiStatus) {
1235edd16368SStephen M. Cameron 			/* Get sense key */
1236edd16368SStephen M. Cameron 			sense_key = 0xf & ei->SenseInfo[2];
1237edd16368SStephen M. Cameron 			/* Get additional sense code */
1238edd16368SStephen M. Cameron 			asc = ei->SenseInfo[12];
1239edd16368SStephen M. Cameron 			/* Get addition sense code qualifier */
1240edd16368SStephen M. Cameron 			ascq = ei->SenseInfo[13];
1241edd16368SStephen M. Cameron 		}
1242edd16368SStephen M. Cameron 
1243edd16368SStephen M. Cameron 		if (ei->ScsiStatus == SAM_STAT_CHECK_CONDITION) {
1244*3ce438dfSMatt Gates 			if (check_for_unit_attention(h, cp))
1245edd16368SStephen M. Cameron 				break;
1246edd16368SStephen M. Cameron 			if (sense_key == ILLEGAL_REQUEST) {
1247edd16368SStephen M. Cameron 				/*
1248edd16368SStephen M. Cameron 				 * SCSI REPORT_LUNS is commonly unsupported on
1249edd16368SStephen M. Cameron 				 * Smart Array.  Suppress noisy complaint.
1250edd16368SStephen M. Cameron 				 */
1251edd16368SStephen M. Cameron 				if (cp->Request.CDB[0] == REPORT_LUNS)
1252edd16368SStephen M. Cameron 					break;
1253edd16368SStephen M. Cameron 
1254edd16368SStephen M. Cameron 				/* If ASC/ASCQ indicate Logical Unit
1255edd16368SStephen M. Cameron 				 * Not Supported condition,
1256edd16368SStephen M. Cameron 				 */
1257edd16368SStephen M. Cameron 				if ((asc == 0x25) && (ascq == 0x0)) {
1258edd16368SStephen M. Cameron 					dev_warn(&h->pdev->dev, "cp %p "
1259edd16368SStephen M. Cameron 						"has check condition\n", cp);
1260edd16368SStephen M. Cameron 					break;
1261edd16368SStephen M. Cameron 				}
1262edd16368SStephen M. Cameron 			}
1263edd16368SStephen M. Cameron 
1264edd16368SStephen M. Cameron 			if (sense_key == NOT_READY) {
1265edd16368SStephen M. Cameron 				/* If Sense is Not Ready, Logical Unit
1266edd16368SStephen M. Cameron 				 * Not ready, Manual Intervention
1267edd16368SStephen M. Cameron 				 * required
1268edd16368SStephen M. Cameron 				 */
1269edd16368SStephen M. Cameron 				if ((asc == 0x04) && (ascq == 0x03)) {
1270edd16368SStephen M. Cameron 					dev_warn(&h->pdev->dev, "cp %p "
1271edd16368SStephen M. Cameron 						"has check condition: unit "
1272edd16368SStephen M. Cameron 						"not ready, manual "
1273edd16368SStephen M. Cameron 						"intervention required\n", cp);
1274edd16368SStephen M. Cameron 					break;
1275edd16368SStephen M. Cameron 				}
1276edd16368SStephen M. Cameron 			}
12771d3b3609SMatt Gates 			if (sense_key == ABORTED_COMMAND) {
12781d3b3609SMatt Gates 				/* Aborted command is retryable */
12791d3b3609SMatt Gates 				dev_warn(&h->pdev->dev, "cp %p "
12801d3b3609SMatt Gates 					"has check condition: aborted command: "
12811d3b3609SMatt Gates 					"ASC: 0x%x, ASCQ: 0x%x\n",
12821d3b3609SMatt Gates 					cp, asc, ascq);
12832e311fbaSStephen M. Cameron 				cmd->result |= DID_SOFT_ERROR << 16;
12841d3b3609SMatt Gates 				break;
12851d3b3609SMatt Gates 			}
1286edd16368SStephen M. Cameron 			/* Must be some other type of check condition */
128721b8e4efSStephen M. Cameron 			dev_dbg(&h->pdev->dev, "cp %p has check condition: "
1288edd16368SStephen M. Cameron 					"unknown type: "
1289edd16368SStephen M. Cameron 					"Sense: 0x%x, ASC: 0x%x, ASCQ: 0x%x, "
1290edd16368SStephen M. Cameron 					"Returning result: 0x%x, "
1291edd16368SStephen M. Cameron 					"cmd=[%02x %02x %02x %02x %02x "
1292807be732SMike Miller 					"%02x %02x %02x %02x %02x %02x "
1293edd16368SStephen M. Cameron 					"%02x %02x %02x %02x %02x]\n",
1294edd16368SStephen M. Cameron 					cp, sense_key, asc, ascq,
1295edd16368SStephen M. Cameron 					cmd->result,
1296edd16368SStephen M. Cameron 					cmd->cmnd[0], cmd->cmnd[1],
1297edd16368SStephen M. Cameron 					cmd->cmnd[2], cmd->cmnd[3],
1298edd16368SStephen M. Cameron 					cmd->cmnd[4], cmd->cmnd[5],
1299edd16368SStephen M. Cameron 					cmd->cmnd[6], cmd->cmnd[7],
1300807be732SMike Miller 					cmd->cmnd[8], cmd->cmnd[9],
1301807be732SMike Miller 					cmd->cmnd[10], cmd->cmnd[11],
1302807be732SMike Miller 					cmd->cmnd[12], cmd->cmnd[13],
1303807be732SMike Miller 					cmd->cmnd[14], cmd->cmnd[15]);
1304edd16368SStephen M. Cameron 			break;
1305edd16368SStephen M. Cameron 		}
1306edd16368SStephen M. Cameron 
1307edd16368SStephen M. Cameron 
1308edd16368SStephen M. Cameron 		/* Problem was not a check condition
1309edd16368SStephen M. Cameron 		 * Pass it up to the upper layers...
1310edd16368SStephen M. Cameron 		 */
1311edd16368SStephen M. Cameron 		if (ei->ScsiStatus) {
1312edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "cp %p has status 0x%x "
1313edd16368SStephen M. Cameron 				"Sense: 0x%x, ASC: 0x%x, ASCQ: 0x%x, "
1314edd16368SStephen M. Cameron 				"Returning result: 0x%x\n",
1315edd16368SStephen M. Cameron 				cp, ei->ScsiStatus,
1316edd16368SStephen M. Cameron 				sense_key, asc, ascq,
1317edd16368SStephen M. Cameron 				cmd->result);
1318edd16368SStephen M. Cameron 		} else {  /* scsi status is zero??? How??? */
1319edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "cp %p SCSI status was 0. "
1320edd16368SStephen M. Cameron 				"Returning no connection.\n", cp),
1321edd16368SStephen M. Cameron 
1322edd16368SStephen M. Cameron 			/* Ordinarily, this case should never happen,
1323edd16368SStephen M. Cameron 			 * but there is a bug in some released firmware
1324edd16368SStephen M. Cameron 			 * revisions that allows it to happen if, for
1325edd16368SStephen M. Cameron 			 * example, a 4100 backplane loses power and
1326edd16368SStephen M. Cameron 			 * the tape drive is in it.  We assume that
1327edd16368SStephen M. Cameron 			 * it's a fatal error of some kind because we
1328edd16368SStephen M. Cameron 			 * can't show that it wasn't. We will make it
1329edd16368SStephen M. Cameron 			 * look like selection timeout since that is
1330edd16368SStephen M. Cameron 			 * the most common reason for this to occur,
1331edd16368SStephen M. Cameron 			 * and it's severe enough.
1332edd16368SStephen M. Cameron 			 */
1333edd16368SStephen M. Cameron 
1334edd16368SStephen M. Cameron 			cmd->result = DID_NO_CONNECT << 16;
1335edd16368SStephen M. Cameron 		}
1336edd16368SStephen M. Cameron 		break;
1337edd16368SStephen M. Cameron 
1338edd16368SStephen M. Cameron 	case CMD_DATA_UNDERRUN: /* let mid layer handle it. */
1339edd16368SStephen M. Cameron 		break;
1340edd16368SStephen M. Cameron 	case CMD_DATA_OVERRUN:
1341edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p has"
1342edd16368SStephen M. Cameron 			" completed with data overrun "
1343edd16368SStephen M. Cameron 			"reported\n", cp);
1344edd16368SStephen M. Cameron 		break;
1345edd16368SStephen M. Cameron 	case CMD_INVALID: {
1346edd16368SStephen M. Cameron 		/* print_bytes(cp, sizeof(*cp), 1, 0);
1347edd16368SStephen M. Cameron 		print_cmd(cp); */
1348edd16368SStephen M. Cameron 		/* We get CMD_INVALID if you address a non-existent device
1349edd16368SStephen M. Cameron 		 * instead of a selection timeout (no response).  You will
1350edd16368SStephen M. Cameron 		 * see this if you yank out a drive, then try to access it.
1351edd16368SStephen M. Cameron 		 * This is kind of a shame because it means that any other
1352edd16368SStephen M. Cameron 		 * CMD_INVALID (e.g. driver bug) will get interpreted as a
1353edd16368SStephen M. Cameron 		 * missing target. */
1354edd16368SStephen M. Cameron 		cmd->result = DID_NO_CONNECT << 16;
1355edd16368SStephen M. Cameron 	}
1356edd16368SStephen M. Cameron 		break;
1357edd16368SStephen M. Cameron 	case CMD_PROTOCOL_ERR:
1358256d0eaaSStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1359edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p has "
1360edd16368SStephen M. Cameron 			"protocol error\n", cp);
1361edd16368SStephen M. Cameron 		break;
1362edd16368SStephen M. Cameron 	case CMD_HARDWARE_ERR:
1363edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1364edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p had  hardware error\n", cp);
1365edd16368SStephen M. Cameron 		break;
1366edd16368SStephen M. Cameron 	case CMD_CONNECTION_LOST:
1367edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1368edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p had connection lost\n", cp);
1369edd16368SStephen M. Cameron 		break;
1370edd16368SStephen M. Cameron 	case CMD_ABORTED:
1371edd16368SStephen M. Cameron 		cmd->result = DID_ABORT << 16;
1372edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p was aborted with status 0x%x\n",
1373edd16368SStephen M. Cameron 				cp, ei->ScsiStatus);
1374edd16368SStephen M. Cameron 		break;
1375edd16368SStephen M. Cameron 	case CMD_ABORT_FAILED:
1376edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1377edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p reports abort failed\n", cp);
1378edd16368SStephen M. Cameron 		break;
1379edd16368SStephen M. Cameron 	case CMD_UNSOLICITED_ABORT:
1380f6e76055SStephen M. Cameron 		cmd->result = DID_SOFT_ERROR << 16; /* retry the command */
1381f6e76055SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p aborted due to an unsolicited "
1382edd16368SStephen M. Cameron 			"abort\n", cp);
1383edd16368SStephen M. Cameron 		break;
1384edd16368SStephen M. Cameron 	case CMD_TIMEOUT:
1385edd16368SStephen M. Cameron 		cmd->result = DID_TIME_OUT << 16;
1386edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p timedout\n", cp);
1387edd16368SStephen M. Cameron 		break;
13881d5e2ed0SStephen M. Cameron 	case CMD_UNABORTABLE:
13891d5e2ed0SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
13901d5e2ed0SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Command unabortable\n");
13911d5e2ed0SStephen M. Cameron 		break;
1392edd16368SStephen M. Cameron 	default:
1393edd16368SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
1394edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cp %p returned unknown status %x\n",
1395edd16368SStephen M. Cameron 				cp, ei->CommandStatus);
1396edd16368SStephen M. Cameron 	}
1397edd16368SStephen M. Cameron 	cmd_free(h, cp);
13982cc5bfafSTomas Henzl 	cmd->scsi_done(cmd);
1399edd16368SStephen M. Cameron }
1400edd16368SStephen M. Cameron 
1401edd16368SStephen M. Cameron static void hpsa_pci_unmap(struct pci_dev *pdev,
1402edd16368SStephen M. Cameron 	struct CommandList *c, int sg_used, int data_direction)
1403edd16368SStephen M. Cameron {
1404edd16368SStephen M. Cameron 	int i;
1405edd16368SStephen M. Cameron 	union u64bit addr64;
1406edd16368SStephen M. Cameron 
1407edd16368SStephen M. Cameron 	for (i = 0; i < sg_used; i++) {
1408edd16368SStephen M. Cameron 		addr64.val32.lower = c->SG[i].Addr.lower;
1409edd16368SStephen M. Cameron 		addr64.val32.upper = c->SG[i].Addr.upper;
1410edd16368SStephen M. Cameron 		pci_unmap_single(pdev, (dma_addr_t) addr64.val, c->SG[i].Len,
1411edd16368SStephen M. Cameron 			data_direction);
1412edd16368SStephen M. Cameron 	}
1413edd16368SStephen M. Cameron }
1414edd16368SStephen M. Cameron 
1415a2dac136SStephen M. Cameron static int hpsa_map_one(struct pci_dev *pdev,
1416edd16368SStephen M. Cameron 		struct CommandList *cp,
1417edd16368SStephen M. Cameron 		unsigned char *buf,
1418edd16368SStephen M. Cameron 		size_t buflen,
1419edd16368SStephen M. Cameron 		int data_direction)
1420edd16368SStephen M. Cameron {
142101a02ffcSStephen M. Cameron 	u64 addr64;
1422edd16368SStephen M. Cameron 
1423edd16368SStephen M. Cameron 	if (buflen == 0 || data_direction == PCI_DMA_NONE) {
1424edd16368SStephen M. Cameron 		cp->Header.SGList = 0;
1425edd16368SStephen M. Cameron 		cp->Header.SGTotal = 0;
1426a2dac136SStephen M. Cameron 		return 0;
1427edd16368SStephen M. Cameron 	}
1428edd16368SStephen M. Cameron 
142901a02ffcSStephen M. Cameron 	addr64 = (u64) pci_map_single(pdev, buf, buflen, data_direction);
1430eceaae18SShuah Khan 	if (dma_mapping_error(&pdev->dev, addr64)) {
1431a2dac136SStephen M. Cameron 		/* Prevent subsequent unmap of something never mapped */
1432eceaae18SShuah Khan 		cp->Header.SGList = 0;
1433eceaae18SShuah Khan 		cp->Header.SGTotal = 0;
1434a2dac136SStephen M. Cameron 		return -1;
1435eceaae18SShuah Khan 	}
1436edd16368SStephen M. Cameron 	cp->SG[0].Addr.lower =
143701a02ffcSStephen M. Cameron 	  (u32) (addr64 & (u64) 0x00000000FFFFFFFF);
1438edd16368SStephen M. Cameron 	cp->SG[0].Addr.upper =
143901a02ffcSStephen M. Cameron 	  (u32) ((addr64 >> 32) & (u64) 0x00000000FFFFFFFF);
1440edd16368SStephen M. Cameron 	cp->SG[0].Len = buflen;
144101a02ffcSStephen M. Cameron 	cp->Header.SGList = (u8) 1;   /* no. SGs contig in this cmd */
144201a02ffcSStephen M. Cameron 	cp->Header.SGTotal = (u16) 1; /* total sgs in this cmd list */
1443a2dac136SStephen M. Cameron 	return 0;
1444edd16368SStephen M. Cameron }
1445edd16368SStephen M. Cameron 
1446edd16368SStephen M. Cameron static inline void hpsa_scsi_do_simple_cmd_core(struct ctlr_info *h,
1447edd16368SStephen M. Cameron 	struct CommandList *c)
1448edd16368SStephen M. Cameron {
1449edd16368SStephen M. Cameron 	DECLARE_COMPLETION_ONSTACK(wait);
1450edd16368SStephen M. Cameron 
1451edd16368SStephen M. Cameron 	c->waiting = &wait;
1452edd16368SStephen M. Cameron 	enqueue_cmd_and_start_io(h, c);
1453edd16368SStephen M. Cameron 	wait_for_completion(&wait);
1454edd16368SStephen M. Cameron }
1455edd16368SStephen M. Cameron 
1456a0c12413SStephen M. Cameron static void hpsa_scsi_do_simple_cmd_core_if_no_lockup(struct ctlr_info *h,
1457a0c12413SStephen M. Cameron 	struct CommandList *c)
1458a0c12413SStephen M. Cameron {
1459a0c12413SStephen M. Cameron 	unsigned long flags;
1460a0c12413SStephen M. Cameron 
1461a0c12413SStephen M. Cameron 	/* If controller lockup detected, fake a hardware error. */
1462a0c12413SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
1463a0c12413SStephen M. Cameron 	if (unlikely(h->lockup_detected)) {
1464a0c12413SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
1465a0c12413SStephen M. Cameron 		c->err_info->CommandStatus = CMD_HARDWARE_ERR;
1466a0c12413SStephen M. Cameron 	} else {
1467a0c12413SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
1468a0c12413SStephen M. Cameron 		hpsa_scsi_do_simple_cmd_core(h, c);
1469a0c12413SStephen M. Cameron 	}
1470a0c12413SStephen M. Cameron }
1471a0c12413SStephen M. Cameron 
14729c2fc160SStephen M. Cameron #define MAX_DRIVER_CMD_RETRIES 25
1473edd16368SStephen M. Cameron static void hpsa_scsi_do_simple_cmd_with_retry(struct ctlr_info *h,
1474edd16368SStephen M. Cameron 	struct CommandList *c, int data_direction)
1475edd16368SStephen M. Cameron {
14769c2fc160SStephen M. Cameron 	int backoff_time = 10, retry_count = 0;
1477edd16368SStephen M. Cameron 
1478edd16368SStephen M. Cameron 	do {
14797630abd0SJoe Perches 		memset(c->err_info, 0, sizeof(*c->err_info));
1480edd16368SStephen M. Cameron 		hpsa_scsi_do_simple_cmd_core(h, c);
1481edd16368SStephen M. Cameron 		retry_count++;
14829c2fc160SStephen M. Cameron 		if (retry_count > 3) {
14839c2fc160SStephen M. Cameron 			msleep(backoff_time);
14849c2fc160SStephen M. Cameron 			if (backoff_time < 1000)
14859c2fc160SStephen M. Cameron 				backoff_time *= 2;
14869c2fc160SStephen M. Cameron 		}
1487852af20aSMatt Bondurant 	} while ((check_for_unit_attention(h, c) ||
14889c2fc160SStephen M. Cameron 			check_for_busy(h, c)) &&
14899c2fc160SStephen M. Cameron 			retry_count <= MAX_DRIVER_CMD_RETRIES);
1490edd16368SStephen M. Cameron 	hpsa_pci_unmap(h->pdev, c, 1, data_direction);
1491edd16368SStephen M. Cameron }
1492edd16368SStephen M. Cameron 
1493edd16368SStephen M. Cameron static void hpsa_scsi_interpret_error(struct CommandList *cp)
1494edd16368SStephen M. Cameron {
1495edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
1496edd16368SStephen M. Cameron 	struct device *d = &cp->h->pdev->dev;
1497edd16368SStephen M. Cameron 
1498edd16368SStephen M. Cameron 	ei = cp->err_info;
1499edd16368SStephen M. Cameron 	switch (ei->CommandStatus) {
1500edd16368SStephen M. Cameron 	case CMD_TARGET_STATUS:
1501edd16368SStephen M. Cameron 		dev_warn(d, "cmd %p has completed with errors\n", cp);
1502edd16368SStephen M. Cameron 		dev_warn(d, "cmd %p has SCSI Status = %x\n", cp,
1503edd16368SStephen M. Cameron 				ei->ScsiStatus);
1504edd16368SStephen M. Cameron 		if (ei->ScsiStatus == 0)
1505edd16368SStephen M. Cameron 			dev_warn(d, "SCSI status is abnormally zero.  "
1506edd16368SStephen M. Cameron 			"(probably indicates selection timeout "
1507edd16368SStephen M. Cameron 			"reported incorrectly due to a known "
1508edd16368SStephen M. Cameron 			"firmware bug, circa July, 2001.)\n");
1509edd16368SStephen M. Cameron 		break;
1510edd16368SStephen M. Cameron 	case CMD_DATA_UNDERRUN: /* let mid layer handle it. */
1511edd16368SStephen M. Cameron 			dev_info(d, "UNDERRUN\n");
1512edd16368SStephen M. Cameron 		break;
1513edd16368SStephen M. Cameron 	case CMD_DATA_OVERRUN:
1514edd16368SStephen M. Cameron 		dev_warn(d, "cp %p has completed with data overrun\n", cp);
1515edd16368SStephen M. Cameron 		break;
1516edd16368SStephen M. Cameron 	case CMD_INVALID: {
1517edd16368SStephen M. Cameron 		/* controller unfortunately reports SCSI passthru's
1518edd16368SStephen M. Cameron 		 * to non-existent targets as invalid commands.
1519edd16368SStephen M. Cameron 		 */
1520edd16368SStephen M. Cameron 		dev_warn(d, "cp %p is reported invalid (probably means "
1521edd16368SStephen M. Cameron 			"target device no longer present)\n", cp);
1522edd16368SStephen M. Cameron 		/* print_bytes((unsigned char *) cp, sizeof(*cp), 1, 0);
1523edd16368SStephen M. Cameron 		print_cmd(cp);  */
1524edd16368SStephen M. Cameron 		}
1525edd16368SStephen M. Cameron 		break;
1526edd16368SStephen M. Cameron 	case CMD_PROTOCOL_ERR:
1527edd16368SStephen M. Cameron 		dev_warn(d, "cp %p has protocol error \n", cp);
1528edd16368SStephen M. Cameron 		break;
1529edd16368SStephen M. Cameron 	case CMD_HARDWARE_ERR:
1530edd16368SStephen M. Cameron 		/* cmd->result = DID_ERROR << 16; */
1531edd16368SStephen M. Cameron 		dev_warn(d, "cp %p had hardware error\n", cp);
1532edd16368SStephen M. Cameron 		break;
1533edd16368SStephen M. Cameron 	case CMD_CONNECTION_LOST:
1534edd16368SStephen M. Cameron 		dev_warn(d, "cp %p had connection lost\n", cp);
1535edd16368SStephen M. Cameron 		break;
1536edd16368SStephen M. Cameron 	case CMD_ABORTED:
1537edd16368SStephen M. Cameron 		dev_warn(d, "cp %p was aborted\n", cp);
1538edd16368SStephen M. Cameron 		break;
1539edd16368SStephen M. Cameron 	case CMD_ABORT_FAILED:
1540edd16368SStephen M. Cameron 		dev_warn(d, "cp %p reports abort failed\n", cp);
1541edd16368SStephen M. Cameron 		break;
1542edd16368SStephen M. Cameron 	case CMD_UNSOLICITED_ABORT:
1543edd16368SStephen M. Cameron 		dev_warn(d, "cp %p aborted due to an unsolicited abort\n", cp);
1544edd16368SStephen M. Cameron 		break;
1545edd16368SStephen M. Cameron 	case CMD_TIMEOUT:
1546edd16368SStephen M. Cameron 		dev_warn(d, "cp %p timed out\n", cp);
1547edd16368SStephen M. Cameron 		break;
15481d5e2ed0SStephen M. Cameron 	case CMD_UNABORTABLE:
15491d5e2ed0SStephen M. Cameron 		dev_warn(d, "Command unabortable\n");
15501d5e2ed0SStephen M. Cameron 		break;
1551edd16368SStephen M. Cameron 	default:
1552edd16368SStephen M. Cameron 		dev_warn(d, "cp %p returned unknown status %x\n", cp,
1553edd16368SStephen M. Cameron 				ei->CommandStatus);
1554edd16368SStephen M. Cameron 	}
1555edd16368SStephen M. Cameron }
1556edd16368SStephen M. Cameron 
1557edd16368SStephen M. Cameron static int hpsa_scsi_do_inquiry(struct ctlr_info *h, unsigned char *scsi3addr,
1558edd16368SStephen M. Cameron 			unsigned char page, unsigned char *buf,
1559edd16368SStephen M. Cameron 			unsigned char bufsize)
1560edd16368SStephen M. Cameron {
1561edd16368SStephen M. Cameron 	int rc = IO_OK;
1562edd16368SStephen M. Cameron 	struct CommandList *c;
1563edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
1564edd16368SStephen M. Cameron 
1565edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
1566edd16368SStephen M. Cameron 
1567edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
1568edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
1569ecd9aad4SStephen M. Cameron 		return -ENOMEM;
1570edd16368SStephen M. Cameron 	}
1571edd16368SStephen M. Cameron 
1572a2dac136SStephen M. Cameron 	if (fill_cmd(c, HPSA_INQUIRY, h, buf, bufsize,
1573a2dac136SStephen M. Cameron 			page, scsi3addr, TYPE_CMD)) {
1574a2dac136SStephen M. Cameron 		rc = -1;
1575a2dac136SStephen M. Cameron 		goto out;
1576a2dac136SStephen M. Cameron 	}
1577edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_FROMDEVICE);
1578edd16368SStephen M. Cameron 	ei = c->err_info;
1579edd16368SStephen M. Cameron 	if (ei->CommandStatus != 0 && ei->CommandStatus != CMD_DATA_UNDERRUN) {
1580edd16368SStephen M. Cameron 		hpsa_scsi_interpret_error(c);
1581edd16368SStephen M. Cameron 		rc = -1;
1582edd16368SStephen M. Cameron 	}
1583a2dac136SStephen M. Cameron out:
1584edd16368SStephen M. Cameron 	cmd_special_free(h, c);
1585edd16368SStephen M. Cameron 	return rc;
1586edd16368SStephen M. Cameron }
1587edd16368SStephen M. Cameron 
1588edd16368SStephen M. Cameron static int hpsa_send_reset(struct ctlr_info *h, unsigned char *scsi3addr)
1589edd16368SStephen M. Cameron {
1590edd16368SStephen M. Cameron 	int rc = IO_OK;
1591edd16368SStephen M. Cameron 	struct CommandList *c;
1592edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
1593edd16368SStephen M. Cameron 
1594edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
1595edd16368SStephen M. Cameron 
1596edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
1597edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
1598e9ea04a6SStephen M. Cameron 		return -ENOMEM;
1599edd16368SStephen M. Cameron 	}
1600edd16368SStephen M. Cameron 
1601a2dac136SStephen M. Cameron 	/* fill_cmd can't fail here, no data buffer to map. */
1602a2dac136SStephen M. Cameron 	(void) fill_cmd(c, HPSA_DEVICE_RESET_MSG, h,
1603a2dac136SStephen M. Cameron 			NULL, 0, 0, scsi3addr, TYPE_MSG);
1604edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core(h, c);
1605edd16368SStephen M. Cameron 	/* no unmap needed here because no data xfer. */
1606edd16368SStephen M. Cameron 
1607edd16368SStephen M. Cameron 	ei = c->err_info;
1608edd16368SStephen M. Cameron 	if (ei->CommandStatus != 0) {
1609edd16368SStephen M. Cameron 		hpsa_scsi_interpret_error(c);
1610edd16368SStephen M. Cameron 		rc = -1;
1611edd16368SStephen M. Cameron 	}
1612edd16368SStephen M. Cameron 	cmd_special_free(h, c);
1613edd16368SStephen M. Cameron 	return rc;
1614edd16368SStephen M. Cameron }
1615edd16368SStephen M. Cameron 
1616edd16368SStephen M. Cameron static void hpsa_get_raid_level(struct ctlr_info *h,
1617edd16368SStephen M. Cameron 	unsigned char *scsi3addr, unsigned char *raid_level)
1618edd16368SStephen M. Cameron {
1619edd16368SStephen M. Cameron 	int rc;
1620edd16368SStephen M. Cameron 	unsigned char *buf;
1621edd16368SStephen M. Cameron 
1622edd16368SStephen M. Cameron 	*raid_level = RAID_UNKNOWN;
1623edd16368SStephen M. Cameron 	buf = kzalloc(64, GFP_KERNEL);
1624edd16368SStephen M. Cameron 	if (!buf)
1625edd16368SStephen M. Cameron 		return;
1626edd16368SStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr, 0xC1, buf, 64);
1627edd16368SStephen M. Cameron 	if (rc == 0)
1628edd16368SStephen M. Cameron 		*raid_level = buf[8];
1629edd16368SStephen M. Cameron 	if (*raid_level > RAID_UNKNOWN)
1630edd16368SStephen M. Cameron 		*raid_level = RAID_UNKNOWN;
1631edd16368SStephen M. Cameron 	kfree(buf);
1632edd16368SStephen M. Cameron 	return;
1633edd16368SStephen M. Cameron }
1634edd16368SStephen M. Cameron 
1635edd16368SStephen M. Cameron /* Get the device id from inquiry page 0x83 */
1636edd16368SStephen M. Cameron static int hpsa_get_device_id(struct ctlr_info *h, unsigned char *scsi3addr,
1637edd16368SStephen M. Cameron 	unsigned char *device_id, int buflen)
1638edd16368SStephen M. Cameron {
1639edd16368SStephen M. Cameron 	int rc;
1640edd16368SStephen M. Cameron 	unsigned char *buf;
1641edd16368SStephen M. Cameron 
1642edd16368SStephen M. Cameron 	if (buflen > 16)
1643edd16368SStephen M. Cameron 		buflen = 16;
1644edd16368SStephen M. Cameron 	buf = kzalloc(64, GFP_KERNEL);
1645edd16368SStephen M. Cameron 	if (!buf)
1646edd16368SStephen M. Cameron 		return -1;
1647edd16368SStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, scsi3addr, 0x83, buf, 64);
1648edd16368SStephen M. Cameron 	if (rc == 0)
1649edd16368SStephen M. Cameron 		memcpy(device_id, &buf[8], buflen);
1650edd16368SStephen M. Cameron 	kfree(buf);
1651edd16368SStephen M. Cameron 	return rc != 0;
1652edd16368SStephen M. Cameron }
1653edd16368SStephen M. Cameron 
1654edd16368SStephen M. Cameron static int hpsa_scsi_do_report_luns(struct ctlr_info *h, int logical,
1655edd16368SStephen M. Cameron 		struct ReportLUNdata *buf, int bufsize,
1656edd16368SStephen M. Cameron 		int extended_response)
1657edd16368SStephen M. Cameron {
1658edd16368SStephen M. Cameron 	int rc = IO_OK;
1659edd16368SStephen M. Cameron 	struct CommandList *c;
1660edd16368SStephen M. Cameron 	unsigned char scsi3addr[8];
1661edd16368SStephen M. Cameron 	struct ErrorInfo *ei;
1662edd16368SStephen M. Cameron 
1663edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
1664edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
1665edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
1666edd16368SStephen M. Cameron 		return -1;
1667edd16368SStephen M. Cameron 	}
1668e89c0ae7SStephen M. Cameron 	/* address the controller */
1669e89c0ae7SStephen M. Cameron 	memset(scsi3addr, 0, sizeof(scsi3addr));
1670a2dac136SStephen M. Cameron 	if (fill_cmd(c, logical ? HPSA_REPORT_LOG : HPSA_REPORT_PHYS, h,
1671a2dac136SStephen M. Cameron 		buf, bufsize, 0, scsi3addr, TYPE_CMD)) {
1672a2dac136SStephen M. Cameron 		rc = -1;
1673a2dac136SStephen M. Cameron 		goto out;
1674a2dac136SStephen M. Cameron 	}
1675edd16368SStephen M. Cameron 	if (extended_response)
1676edd16368SStephen M. Cameron 		c->Request.CDB[1] = extended_response;
1677edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_FROMDEVICE);
1678edd16368SStephen M. Cameron 	ei = c->err_info;
1679edd16368SStephen M. Cameron 	if (ei->CommandStatus != 0 &&
1680edd16368SStephen M. Cameron 	    ei->CommandStatus != CMD_DATA_UNDERRUN) {
1681edd16368SStephen M. Cameron 		hpsa_scsi_interpret_error(c);
1682edd16368SStephen M. Cameron 		rc = -1;
1683edd16368SStephen M. Cameron 	}
1684a2dac136SStephen M. Cameron out:
1685edd16368SStephen M. Cameron 	cmd_special_free(h, c);
1686edd16368SStephen M. Cameron 	return rc;
1687edd16368SStephen M. Cameron }
1688edd16368SStephen M. Cameron 
1689edd16368SStephen M. Cameron static inline int hpsa_scsi_do_report_phys_luns(struct ctlr_info *h,
1690edd16368SStephen M. Cameron 		struct ReportLUNdata *buf,
1691edd16368SStephen M. Cameron 		int bufsize, int extended_response)
1692edd16368SStephen M. Cameron {
1693edd16368SStephen M. Cameron 	return hpsa_scsi_do_report_luns(h, 0, buf, bufsize, extended_response);
1694edd16368SStephen M. Cameron }
1695edd16368SStephen M. Cameron 
1696edd16368SStephen M. Cameron static inline int hpsa_scsi_do_report_log_luns(struct ctlr_info *h,
1697edd16368SStephen M. Cameron 		struct ReportLUNdata *buf, int bufsize)
1698edd16368SStephen M. Cameron {
1699edd16368SStephen M. Cameron 	return hpsa_scsi_do_report_luns(h, 1, buf, bufsize, 0);
1700edd16368SStephen M. Cameron }
1701edd16368SStephen M. Cameron 
1702edd16368SStephen M. Cameron static inline void hpsa_set_bus_target_lun(struct hpsa_scsi_dev_t *device,
1703edd16368SStephen M. Cameron 	int bus, int target, int lun)
1704edd16368SStephen M. Cameron {
1705edd16368SStephen M. Cameron 	device->bus = bus;
1706edd16368SStephen M. Cameron 	device->target = target;
1707edd16368SStephen M. Cameron 	device->lun = lun;
1708edd16368SStephen M. Cameron }
1709edd16368SStephen M. Cameron 
1710edd16368SStephen M. Cameron static int hpsa_update_device_info(struct ctlr_info *h,
17110b0e1d6cSStephen M. Cameron 	unsigned char scsi3addr[], struct hpsa_scsi_dev_t *this_device,
17120b0e1d6cSStephen M. Cameron 	unsigned char *is_OBDR_device)
1713edd16368SStephen M. Cameron {
17140b0e1d6cSStephen M. Cameron 
17150b0e1d6cSStephen M. Cameron #define OBDR_SIG_OFFSET 43
17160b0e1d6cSStephen M. Cameron #define OBDR_TAPE_SIG "$DR-10"
17170b0e1d6cSStephen M. Cameron #define OBDR_SIG_LEN (sizeof(OBDR_TAPE_SIG) - 1)
17180b0e1d6cSStephen M. Cameron #define OBDR_TAPE_INQ_SIZE (OBDR_SIG_OFFSET + OBDR_SIG_LEN)
17190b0e1d6cSStephen M. Cameron 
1720ea6d3bc3SStephen M. Cameron 	unsigned char *inq_buff;
17210b0e1d6cSStephen M. Cameron 	unsigned char *obdr_sig;
1722edd16368SStephen M. Cameron 
1723ea6d3bc3SStephen M. Cameron 	inq_buff = kzalloc(OBDR_TAPE_INQ_SIZE, GFP_KERNEL);
1724edd16368SStephen M. Cameron 	if (!inq_buff)
1725edd16368SStephen M. Cameron 		goto bail_out;
1726edd16368SStephen M. Cameron 
1727edd16368SStephen M. Cameron 	/* Do an inquiry to the device to see what it is. */
1728edd16368SStephen M. Cameron 	if (hpsa_scsi_do_inquiry(h, scsi3addr, 0, inq_buff,
1729edd16368SStephen M. Cameron 		(unsigned char) OBDR_TAPE_INQ_SIZE) != 0) {
1730edd16368SStephen M. Cameron 		/* Inquiry failed (msg printed already) */
1731edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev,
1732edd16368SStephen M. Cameron 			"hpsa_update_device_info: inquiry failed\n");
1733edd16368SStephen M. Cameron 		goto bail_out;
1734edd16368SStephen M. Cameron 	}
1735edd16368SStephen M. Cameron 
1736edd16368SStephen M. Cameron 	this_device->devtype = (inq_buff[0] & 0x1f);
1737edd16368SStephen M. Cameron 	memcpy(this_device->scsi3addr, scsi3addr, 8);
1738edd16368SStephen M. Cameron 	memcpy(this_device->vendor, &inq_buff[8],
1739edd16368SStephen M. Cameron 		sizeof(this_device->vendor));
1740edd16368SStephen M. Cameron 	memcpy(this_device->model, &inq_buff[16],
1741edd16368SStephen M. Cameron 		sizeof(this_device->model));
1742edd16368SStephen M. Cameron 	memset(this_device->device_id, 0,
1743edd16368SStephen M. Cameron 		sizeof(this_device->device_id));
1744edd16368SStephen M. Cameron 	hpsa_get_device_id(h, scsi3addr, this_device->device_id,
1745edd16368SStephen M. Cameron 		sizeof(this_device->device_id));
1746edd16368SStephen M. Cameron 
1747edd16368SStephen M. Cameron 	if (this_device->devtype == TYPE_DISK &&
1748edd16368SStephen M. Cameron 		is_logical_dev_addr_mode(scsi3addr))
1749edd16368SStephen M. Cameron 		hpsa_get_raid_level(h, scsi3addr, &this_device->raid_level);
1750edd16368SStephen M. Cameron 	else
1751edd16368SStephen M. Cameron 		this_device->raid_level = RAID_UNKNOWN;
1752edd16368SStephen M. Cameron 
17530b0e1d6cSStephen M. Cameron 	if (is_OBDR_device) {
17540b0e1d6cSStephen M. Cameron 		/* See if this is a One-Button-Disaster-Recovery device
17550b0e1d6cSStephen M. Cameron 		 * by looking for "$DR-10" at offset 43 in inquiry data.
17560b0e1d6cSStephen M. Cameron 		 */
17570b0e1d6cSStephen M. Cameron 		obdr_sig = &inq_buff[OBDR_SIG_OFFSET];
17580b0e1d6cSStephen M. Cameron 		*is_OBDR_device = (this_device->devtype == TYPE_ROM &&
17590b0e1d6cSStephen M. Cameron 					strncmp(obdr_sig, OBDR_TAPE_SIG,
17600b0e1d6cSStephen M. Cameron 						OBDR_SIG_LEN) == 0);
17610b0e1d6cSStephen M. Cameron 	}
17620b0e1d6cSStephen M. Cameron 
1763edd16368SStephen M. Cameron 	kfree(inq_buff);
1764edd16368SStephen M. Cameron 	return 0;
1765edd16368SStephen M. Cameron 
1766edd16368SStephen M. Cameron bail_out:
1767edd16368SStephen M. Cameron 	kfree(inq_buff);
1768edd16368SStephen M. Cameron 	return 1;
1769edd16368SStephen M. Cameron }
1770edd16368SStephen M. Cameron 
17714f4eb9f1SScott Teel static unsigned char *ext_target_model[] = {
1772edd16368SStephen M. Cameron 	"MSA2012",
1773edd16368SStephen M. Cameron 	"MSA2024",
1774edd16368SStephen M. Cameron 	"MSA2312",
1775edd16368SStephen M. Cameron 	"MSA2324",
1776fda38518SStephen M. Cameron 	"P2000 G3 SAS",
1777e06c8e5cSStephen M. Cameron 	"MSA 2040 SAS",
1778edd16368SStephen M. Cameron 	NULL,
1779edd16368SStephen M. Cameron };
1780edd16368SStephen M. Cameron 
17814f4eb9f1SScott Teel static int is_ext_target(struct ctlr_info *h, struct hpsa_scsi_dev_t *device)
1782edd16368SStephen M. Cameron {
1783edd16368SStephen M. Cameron 	int i;
1784edd16368SStephen M. Cameron 
17854f4eb9f1SScott Teel 	for (i = 0; ext_target_model[i]; i++)
17864f4eb9f1SScott Teel 		if (strncmp(device->model, ext_target_model[i],
17874f4eb9f1SScott Teel 			strlen(ext_target_model[i])) == 0)
1788edd16368SStephen M. Cameron 			return 1;
1789edd16368SStephen M. Cameron 	return 0;
1790edd16368SStephen M. Cameron }
1791edd16368SStephen M. Cameron 
1792edd16368SStephen M. Cameron /* Helper function to assign bus, target, lun mapping of devices.
17934f4eb9f1SScott Teel  * Puts non-external target logical volumes on bus 0, external target logical
1794edd16368SStephen M. Cameron  * volumes on bus 1, physical devices on bus 2. and the hba on bus 3.
1795edd16368SStephen M. Cameron  * Logical drive target and lun are assigned at this time, but
1796edd16368SStephen M. Cameron  * physical device lun and target assignment are deferred (assigned
1797edd16368SStephen M. Cameron  * in hpsa_find_target_lun, called by hpsa_scsi_add_entry.)
1798edd16368SStephen M. Cameron  */
1799edd16368SStephen M. Cameron static void figure_bus_target_lun(struct ctlr_info *h,
18001f310bdeSStephen M. Cameron 	u8 *lunaddrbytes, struct hpsa_scsi_dev_t *device)
1801edd16368SStephen M. Cameron {
18021f310bdeSStephen M. Cameron 	u32 lunid = le32_to_cpu(*((__le32 *) lunaddrbytes));
1803edd16368SStephen M. Cameron 
18041f310bdeSStephen M. Cameron 	if (!is_logical_dev_addr_mode(lunaddrbytes)) {
18051f310bdeSStephen M. Cameron 		/* physical device, target and lun filled in later */
18061f310bdeSStephen M. Cameron 		if (is_hba_lunid(lunaddrbytes))
18071f310bdeSStephen M. Cameron 			hpsa_set_bus_target_lun(device, 3, 0, lunid & 0x3fff);
18081f310bdeSStephen M. Cameron 		else
18091f310bdeSStephen M. Cameron 			/* defer target, lun assignment for physical devices */
18101f310bdeSStephen M. Cameron 			hpsa_set_bus_target_lun(device, 2, -1, -1);
18111f310bdeSStephen M. Cameron 		return;
18121f310bdeSStephen M. Cameron 	}
18131f310bdeSStephen M. Cameron 	/* It's a logical device */
18144f4eb9f1SScott Teel 	if (is_ext_target(h, device)) {
18154f4eb9f1SScott Teel 		/* external target way, put logicals on bus 1
1816339b2b14SStephen M. Cameron 		 * and match target/lun numbers box
18171f310bdeSStephen M. Cameron 		 * reports, other smart array, bus 0, target 0, match lunid
1818339b2b14SStephen M. Cameron 		 */
18191f310bdeSStephen M. Cameron 		hpsa_set_bus_target_lun(device,
18201f310bdeSStephen M. Cameron 			1, (lunid >> 16) & 0x3fff, lunid & 0x00ff);
18211f310bdeSStephen M. Cameron 		return;
1822339b2b14SStephen M. Cameron 	}
18231f310bdeSStephen M. Cameron 	hpsa_set_bus_target_lun(device, 0, 0, lunid & 0x3fff);
1824edd16368SStephen M. Cameron }
1825edd16368SStephen M. Cameron 
1826edd16368SStephen M. Cameron /*
1827edd16368SStephen M. Cameron  * If there is no lun 0 on a target, linux won't find any devices.
18284f4eb9f1SScott Teel  * For the external targets (arrays), we have to manually detect the enclosure
1829edd16368SStephen M. Cameron  * which is at lun zero, as CCISS_REPORT_PHYSICAL_LUNS doesn't report
1830edd16368SStephen M. Cameron  * it for some reason.  *tmpdevice is the target we're adding,
1831edd16368SStephen M. Cameron  * this_device is a pointer into the current element of currentsd[]
1832edd16368SStephen M. Cameron  * that we're building up in update_scsi_devices(), below.
1833edd16368SStephen M. Cameron  * lunzerobits is a bitmap that tracks which targets already have a
1834edd16368SStephen M. Cameron  * lun 0 assigned.
1835edd16368SStephen M. Cameron  * Returns 1 if an enclosure was added, 0 if not.
1836edd16368SStephen M. Cameron  */
18374f4eb9f1SScott Teel static int add_ext_target_dev(struct ctlr_info *h,
1838edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *tmpdevice,
183901a02ffcSStephen M. Cameron 	struct hpsa_scsi_dev_t *this_device, u8 *lunaddrbytes,
18404f4eb9f1SScott Teel 	unsigned long lunzerobits[], int *n_ext_target_devs)
1841edd16368SStephen M. Cameron {
1842edd16368SStephen M. Cameron 	unsigned char scsi3addr[8];
1843edd16368SStephen M. Cameron 
18441f310bdeSStephen M. Cameron 	if (test_bit(tmpdevice->target, lunzerobits))
1845edd16368SStephen M. Cameron 		return 0; /* There is already a lun 0 on this target. */
1846edd16368SStephen M. Cameron 
1847edd16368SStephen M. Cameron 	if (!is_logical_dev_addr_mode(lunaddrbytes))
1848edd16368SStephen M. Cameron 		return 0; /* It's the logical targets that may lack lun 0. */
1849edd16368SStephen M. Cameron 
18504f4eb9f1SScott Teel 	if (!is_ext_target(h, tmpdevice))
18514f4eb9f1SScott Teel 		return 0; /* Only external target devices have this problem. */
1852edd16368SStephen M. Cameron 
18531f310bdeSStephen M. Cameron 	if (tmpdevice->lun == 0) /* if lun is 0, then we have a lun 0. */
1854edd16368SStephen M. Cameron 		return 0;
1855edd16368SStephen M. Cameron 
1856c4f8a299SStephen M. Cameron 	memset(scsi3addr, 0, 8);
18571f310bdeSStephen M. Cameron 	scsi3addr[3] = tmpdevice->target;
1858edd16368SStephen M. Cameron 	if (is_hba_lunid(scsi3addr))
1859edd16368SStephen M. Cameron 		return 0; /* Don't add the RAID controller here. */
1860edd16368SStephen M. Cameron 
1861339b2b14SStephen M. Cameron 	if (is_scsi_rev_5(h))
1862339b2b14SStephen M. Cameron 		return 0; /* p1210m doesn't need to do this. */
1863339b2b14SStephen M. Cameron 
18644f4eb9f1SScott Teel 	if (*n_ext_target_devs >= MAX_EXT_TARGETS) {
1865aca4a520SScott Teel 		dev_warn(&h->pdev->dev, "Maximum number of external "
1866aca4a520SScott Teel 			"target devices exceeded.  Check your hardware "
1867edd16368SStephen M. Cameron 			"configuration.");
1868edd16368SStephen M. Cameron 		return 0;
1869edd16368SStephen M. Cameron 	}
1870edd16368SStephen M. Cameron 
18710b0e1d6cSStephen M. Cameron 	if (hpsa_update_device_info(h, scsi3addr, this_device, NULL))
1872edd16368SStephen M. Cameron 		return 0;
18734f4eb9f1SScott Teel 	(*n_ext_target_devs)++;
18741f310bdeSStephen M. Cameron 	hpsa_set_bus_target_lun(this_device,
18751f310bdeSStephen M. Cameron 				tmpdevice->bus, tmpdevice->target, 0);
18761f310bdeSStephen M. Cameron 	set_bit(tmpdevice->target, lunzerobits);
1877edd16368SStephen M. Cameron 	return 1;
1878edd16368SStephen M. Cameron }
1879edd16368SStephen M. Cameron 
1880edd16368SStephen M. Cameron /*
1881edd16368SStephen M. Cameron  * Do CISS_REPORT_PHYS and CISS_REPORT_LOG.  Data is returned in physdev,
1882edd16368SStephen M. Cameron  * logdev.  The number of luns in physdev and logdev are returned in
1883edd16368SStephen M. Cameron  * *nphysicals and *nlogicals, respectively.
1884edd16368SStephen M. Cameron  * Returns 0 on success, -1 otherwise.
1885edd16368SStephen M. Cameron  */
1886edd16368SStephen M. Cameron static int hpsa_gather_lun_info(struct ctlr_info *h,
1887edd16368SStephen M. Cameron 	int reportlunsize,
188801a02ffcSStephen M. Cameron 	struct ReportLUNdata *physdev, u32 *nphysicals,
188901a02ffcSStephen M. Cameron 	struct ReportLUNdata *logdev, u32 *nlogicals)
1890edd16368SStephen M. Cameron {
1891edd16368SStephen M. Cameron 	if (hpsa_scsi_do_report_phys_luns(h, physdev, reportlunsize, 0)) {
1892edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "report physical LUNs failed.\n");
1893edd16368SStephen M. Cameron 		return -1;
1894edd16368SStephen M. Cameron 	}
18956df1e954SStephen M. Cameron 	*nphysicals = be32_to_cpu(*((__be32 *)physdev->LUNListLength)) / 8;
1896edd16368SStephen M. Cameron 	if (*nphysicals > HPSA_MAX_PHYS_LUN) {
1897edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "maximum physical LUNs (%d) exceeded."
1898edd16368SStephen M. Cameron 			"  %d LUNs ignored.\n", HPSA_MAX_PHYS_LUN,
1899edd16368SStephen M. Cameron 			*nphysicals - HPSA_MAX_PHYS_LUN);
1900edd16368SStephen M. Cameron 		*nphysicals = HPSA_MAX_PHYS_LUN;
1901edd16368SStephen M. Cameron 	}
1902edd16368SStephen M. Cameron 	if (hpsa_scsi_do_report_log_luns(h, logdev, reportlunsize)) {
1903edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "report logical LUNs failed.\n");
1904edd16368SStephen M. Cameron 		return -1;
1905edd16368SStephen M. Cameron 	}
19066df1e954SStephen M. Cameron 	*nlogicals = be32_to_cpu(*((__be32 *) logdev->LUNListLength)) / 8;
1907edd16368SStephen M. Cameron 	/* Reject Logicals in excess of our max capability. */
1908edd16368SStephen M. Cameron 	if (*nlogicals > HPSA_MAX_LUN) {
1909edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev,
1910edd16368SStephen M. Cameron 			"maximum logical LUNs (%d) exceeded.  "
1911edd16368SStephen M. Cameron 			"%d LUNs ignored.\n", HPSA_MAX_LUN,
1912edd16368SStephen M. Cameron 			*nlogicals - HPSA_MAX_LUN);
1913edd16368SStephen M. Cameron 			*nlogicals = HPSA_MAX_LUN;
1914edd16368SStephen M. Cameron 	}
1915edd16368SStephen M. Cameron 	if (*nlogicals + *nphysicals > HPSA_MAX_PHYS_LUN) {
1916edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev,
1917edd16368SStephen M. Cameron 			"maximum logical + physical LUNs (%d) exceeded. "
1918edd16368SStephen M. Cameron 			"%d LUNs ignored.\n", HPSA_MAX_PHYS_LUN,
1919edd16368SStephen M. Cameron 			*nphysicals + *nlogicals - HPSA_MAX_PHYS_LUN);
1920edd16368SStephen M. Cameron 		*nlogicals = HPSA_MAX_PHYS_LUN - *nphysicals;
1921edd16368SStephen M. Cameron 	}
1922edd16368SStephen M. Cameron 	return 0;
1923edd16368SStephen M. Cameron }
1924edd16368SStephen M. Cameron 
1925339b2b14SStephen M. Cameron u8 *figure_lunaddrbytes(struct ctlr_info *h, int raid_ctlr_position, int i,
1926339b2b14SStephen M. Cameron 	int nphysicals, int nlogicals, struct ReportLUNdata *physdev_list,
1927339b2b14SStephen M. Cameron 	struct ReportLUNdata *logdev_list)
1928339b2b14SStephen M. Cameron {
1929339b2b14SStephen M. Cameron 	/* Helper function, figure out where the LUN ID info is coming from
1930339b2b14SStephen M. Cameron 	 * given index i, lists of physical and logical devices, where in
1931339b2b14SStephen M. Cameron 	 * the list the raid controller is supposed to appear (first or last)
1932339b2b14SStephen M. Cameron 	 */
1933339b2b14SStephen M. Cameron 
1934339b2b14SStephen M. Cameron 	int logicals_start = nphysicals + (raid_ctlr_position == 0);
1935339b2b14SStephen M. Cameron 	int last_device = nphysicals + nlogicals + (raid_ctlr_position == 0);
1936339b2b14SStephen M. Cameron 
1937339b2b14SStephen M. Cameron 	if (i == raid_ctlr_position)
1938339b2b14SStephen M. Cameron 		return RAID_CTLR_LUNID;
1939339b2b14SStephen M. Cameron 
1940339b2b14SStephen M. Cameron 	if (i < logicals_start)
1941339b2b14SStephen M. Cameron 		return &physdev_list->LUN[i - (raid_ctlr_position == 0)][0];
1942339b2b14SStephen M. Cameron 
1943339b2b14SStephen M. Cameron 	if (i < last_device)
1944339b2b14SStephen M. Cameron 		return &logdev_list->LUN[i - nphysicals -
1945339b2b14SStephen M. Cameron 			(raid_ctlr_position == 0)][0];
1946339b2b14SStephen M. Cameron 	BUG();
1947339b2b14SStephen M. Cameron 	return NULL;
1948339b2b14SStephen M. Cameron }
1949339b2b14SStephen M. Cameron 
1950edd16368SStephen M. Cameron static void hpsa_update_scsi_devices(struct ctlr_info *h, int hostno)
1951edd16368SStephen M. Cameron {
1952edd16368SStephen M. Cameron 	/* the idea here is we could get notified
1953edd16368SStephen M. Cameron 	 * that some devices have changed, so we do a report
1954edd16368SStephen M. Cameron 	 * physical luns and report logical luns cmd, and adjust
1955edd16368SStephen M. Cameron 	 * our list of devices accordingly.
1956edd16368SStephen M. Cameron 	 *
1957edd16368SStephen M. Cameron 	 * The scsi3addr's of devices won't change so long as the
1958edd16368SStephen M. Cameron 	 * adapter is not reset.  That means we can rescan and
1959edd16368SStephen M. Cameron 	 * tell which devices we already know about, vs. new
1960edd16368SStephen M. Cameron 	 * devices, vs.  disappearing devices.
1961edd16368SStephen M. Cameron 	 */
1962edd16368SStephen M. Cameron 	struct ReportLUNdata *physdev_list = NULL;
1963edd16368SStephen M. Cameron 	struct ReportLUNdata *logdev_list = NULL;
196401a02ffcSStephen M. Cameron 	u32 nphysicals = 0;
196501a02ffcSStephen M. Cameron 	u32 nlogicals = 0;
196601a02ffcSStephen M. Cameron 	u32 ndev_allocated = 0;
1967edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t **currentsd, *this_device, *tmpdevice;
1968edd16368SStephen M. Cameron 	int ncurrent = 0;
1969edd16368SStephen M. Cameron 	int reportlunsize = sizeof(*physdev_list) + HPSA_MAX_PHYS_LUN * 8;
19704f4eb9f1SScott Teel 	int i, n_ext_target_devs, ndevs_to_allocate;
1971339b2b14SStephen M. Cameron 	int raid_ctlr_position;
1972aca4a520SScott Teel 	DECLARE_BITMAP(lunzerobits, MAX_EXT_TARGETS);
1973edd16368SStephen M. Cameron 
1974cfe5badcSScott Teel 	currentsd = kzalloc(sizeof(*currentsd) * HPSA_MAX_DEVICES, GFP_KERNEL);
1975edd16368SStephen M. Cameron 	physdev_list = kzalloc(reportlunsize, GFP_KERNEL);
1976edd16368SStephen M. Cameron 	logdev_list = kzalloc(reportlunsize, GFP_KERNEL);
1977edd16368SStephen M. Cameron 	tmpdevice = kzalloc(sizeof(*tmpdevice), GFP_KERNEL);
1978edd16368SStephen M. Cameron 
19790b0e1d6cSStephen M. Cameron 	if (!currentsd || !physdev_list || !logdev_list || !tmpdevice) {
1980edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "out of memory\n");
1981edd16368SStephen M. Cameron 		goto out;
1982edd16368SStephen M. Cameron 	}
1983edd16368SStephen M. Cameron 	memset(lunzerobits, 0, sizeof(lunzerobits));
1984edd16368SStephen M. Cameron 
1985edd16368SStephen M. Cameron 	if (hpsa_gather_lun_info(h, reportlunsize, physdev_list, &nphysicals,
1986edd16368SStephen M. Cameron 			logdev_list, &nlogicals))
1987edd16368SStephen M. Cameron 		goto out;
1988edd16368SStephen M. Cameron 
1989aca4a520SScott Teel 	/* We might see up to the maximum number of logical and physical disks
1990aca4a520SScott Teel 	 * plus external target devices, and a device for the local RAID
1991aca4a520SScott Teel 	 * controller.
1992edd16368SStephen M. Cameron 	 */
1993aca4a520SScott Teel 	ndevs_to_allocate = nphysicals + nlogicals + MAX_EXT_TARGETS + 1;
1994edd16368SStephen M. Cameron 
1995edd16368SStephen M. Cameron 	/* Allocate the per device structures */
1996edd16368SStephen M. Cameron 	for (i = 0; i < ndevs_to_allocate; i++) {
1997b7ec021fSScott Teel 		if (i >= HPSA_MAX_DEVICES) {
1998b7ec021fSScott Teel 			dev_warn(&h->pdev->dev, "maximum devices (%d) exceeded."
1999b7ec021fSScott Teel 				"  %d devices ignored.\n", HPSA_MAX_DEVICES,
2000b7ec021fSScott Teel 				ndevs_to_allocate - HPSA_MAX_DEVICES);
2001b7ec021fSScott Teel 			break;
2002b7ec021fSScott Teel 		}
2003b7ec021fSScott Teel 
2004edd16368SStephen M. Cameron 		currentsd[i] = kzalloc(sizeof(*currentsd[i]), GFP_KERNEL);
2005edd16368SStephen M. Cameron 		if (!currentsd[i]) {
2006edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "out of memory at %s:%d\n",
2007edd16368SStephen M. Cameron 				__FILE__, __LINE__);
2008edd16368SStephen M. Cameron 			goto out;
2009edd16368SStephen M. Cameron 		}
2010edd16368SStephen M. Cameron 		ndev_allocated++;
2011edd16368SStephen M. Cameron 	}
2012edd16368SStephen M. Cameron 
2013339b2b14SStephen M. Cameron 	if (unlikely(is_scsi_rev_5(h)))
2014339b2b14SStephen M. Cameron 		raid_ctlr_position = 0;
2015339b2b14SStephen M. Cameron 	else
2016339b2b14SStephen M. Cameron 		raid_ctlr_position = nphysicals + nlogicals;
2017339b2b14SStephen M. Cameron 
2018edd16368SStephen M. Cameron 	/* adjust our table of devices */
20194f4eb9f1SScott Teel 	n_ext_target_devs = 0;
2020edd16368SStephen M. Cameron 	for (i = 0; i < nphysicals + nlogicals + 1; i++) {
20210b0e1d6cSStephen M. Cameron 		u8 *lunaddrbytes, is_OBDR = 0;
2022edd16368SStephen M. Cameron 
2023edd16368SStephen M. Cameron 		/* Figure out where the LUN ID info is coming from */
2024339b2b14SStephen M. Cameron 		lunaddrbytes = figure_lunaddrbytes(h, raid_ctlr_position,
2025339b2b14SStephen M. Cameron 			i, nphysicals, nlogicals, physdev_list, logdev_list);
2026edd16368SStephen M. Cameron 		/* skip masked physical devices. */
2027339b2b14SStephen M. Cameron 		if (lunaddrbytes[3] & 0xC0 &&
2028339b2b14SStephen M. Cameron 			i < nphysicals + (raid_ctlr_position == 0))
2029edd16368SStephen M. Cameron 			continue;
2030edd16368SStephen M. Cameron 
2031edd16368SStephen M. Cameron 		/* Get device type, vendor, model, device id */
20320b0e1d6cSStephen M. Cameron 		if (hpsa_update_device_info(h, lunaddrbytes, tmpdevice,
20330b0e1d6cSStephen M. Cameron 							&is_OBDR))
2034edd16368SStephen M. Cameron 			continue; /* skip it if we can't talk to it. */
20351f310bdeSStephen M. Cameron 		figure_bus_target_lun(h, lunaddrbytes, tmpdevice);
2036edd16368SStephen M. Cameron 		this_device = currentsd[ncurrent];
2037edd16368SStephen M. Cameron 
2038edd16368SStephen M. Cameron 		/*
20394f4eb9f1SScott Teel 		 * For external target devices, we have to insert a LUN 0 which
2040edd16368SStephen M. Cameron 		 * doesn't show up in CCISS_REPORT_PHYSICAL data, but there
2041edd16368SStephen M. Cameron 		 * is nonetheless an enclosure device there.  We have to
2042edd16368SStephen M. Cameron 		 * present that otherwise linux won't find anything if
2043edd16368SStephen M. Cameron 		 * there is no lun 0.
2044edd16368SStephen M. Cameron 		 */
20454f4eb9f1SScott Teel 		if (add_ext_target_dev(h, tmpdevice, this_device,
20461f310bdeSStephen M. Cameron 				lunaddrbytes, lunzerobits,
20474f4eb9f1SScott Teel 				&n_ext_target_devs)) {
2048edd16368SStephen M. Cameron 			ncurrent++;
2049edd16368SStephen M. Cameron 			this_device = currentsd[ncurrent];
2050edd16368SStephen M. Cameron 		}
2051edd16368SStephen M. Cameron 
2052edd16368SStephen M. Cameron 		*this_device = *tmpdevice;
2053edd16368SStephen M. Cameron 
2054edd16368SStephen M. Cameron 		switch (this_device->devtype) {
20550b0e1d6cSStephen M. Cameron 		case TYPE_ROM:
2056edd16368SStephen M. Cameron 			/* We don't *really* support actual CD-ROM devices,
2057edd16368SStephen M. Cameron 			 * just "One Button Disaster Recovery" tape drive
2058edd16368SStephen M. Cameron 			 * which temporarily pretends to be a CD-ROM drive.
2059edd16368SStephen M. Cameron 			 * So we check that the device is really an OBDR tape
2060edd16368SStephen M. Cameron 			 * device by checking for "$DR-10" in bytes 43-48 of
2061edd16368SStephen M. Cameron 			 * the inquiry data.
2062edd16368SStephen M. Cameron 			 */
20630b0e1d6cSStephen M. Cameron 			if (is_OBDR)
2064edd16368SStephen M. Cameron 				ncurrent++;
2065edd16368SStephen M. Cameron 			break;
2066edd16368SStephen M. Cameron 		case TYPE_DISK:
2067edd16368SStephen M. Cameron 			if (i < nphysicals)
2068edd16368SStephen M. Cameron 				break;
2069edd16368SStephen M. Cameron 			ncurrent++;
2070edd16368SStephen M. Cameron 			break;
2071edd16368SStephen M. Cameron 		case TYPE_TAPE:
2072edd16368SStephen M. Cameron 		case TYPE_MEDIUM_CHANGER:
2073edd16368SStephen M. Cameron 			ncurrent++;
2074edd16368SStephen M. Cameron 			break;
2075edd16368SStephen M. Cameron 		case TYPE_RAID:
2076edd16368SStephen M. Cameron 			/* Only present the Smartarray HBA as a RAID controller.
2077edd16368SStephen M. Cameron 			 * If it's a RAID controller other than the HBA itself
2078edd16368SStephen M. Cameron 			 * (an external RAID controller, MSA500 or similar)
2079edd16368SStephen M. Cameron 			 * don't present it.
2080edd16368SStephen M. Cameron 			 */
2081edd16368SStephen M. Cameron 			if (!is_hba_lunid(lunaddrbytes))
2082edd16368SStephen M. Cameron 				break;
2083edd16368SStephen M. Cameron 			ncurrent++;
2084edd16368SStephen M. Cameron 			break;
2085edd16368SStephen M. Cameron 		default:
2086edd16368SStephen M. Cameron 			break;
2087edd16368SStephen M. Cameron 		}
2088cfe5badcSScott Teel 		if (ncurrent >= HPSA_MAX_DEVICES)
2089edd16368SStephen M. Cameron 			break;
2090edd16368SStephen M. Cameron 	}
2091edd16368SStephen M. Cameron 	adjust_hpsa_scsi_table(h, hostno, currentsd, ncurrent);
2092edd16368SStephen M. Cameron out:
2093edd16368SStephen M. Cameron 	kfree(tmpdevice);
2094edd16368SStephen M. Cameron 	for (i = 0; i < ndev_allocated; i++)
2095edd16368SStephen M. Cameron 		kfree(currentsd[i]);
2096edd16368SStephen M. Cameron 	kfree(currentsd);
2097edd16368SStephen M. Cameron 	kfree(physdev_list);
2098edd16368SStephen M. Cameron 	kfree(logdev_list);
2099edd16368SStephen M. Cameron }
2100edd16368SStephen M. Cameron 
2101edd16368SStephen M. Cameron /* hpsa_scatter_gather takes a struct scsi_cmnd, (cmd), and does the pci
2102edd16368SStephen M. Cameron  * dma mapping  and fills in the scatter gather entries of the
2103edd16368SStephen M. Cameron  * hpsa command, cp.
2104edd16368SStephen M. Cameron  */
210533a2ffceSStephen M. Cameron static int hpsa_scatter_gather(struct ctlr_info *h,
2106edd16368SStephen M. Cameron 		struct CommandList *cp,
2107edd16368SStephen M. Cameron 		struct scsi_cmnd *cmd)
2108edd16368SStephen M. Cameron {
2109edd16368SStephen M. Cameron 	unsigned int len;
2110edd16368SStephen M. Cameron 	struct scatterlist *sg;
211101a02ffcSStephen M. Cameron 	u64 addr64;
211233a2ffceSStephen M. Cameron 	int use_sg, i, sg_index, chained;
211333a2ffceSStephen M. Cameron 	struct SGDescriptor *curr_sg;
2114edd16368SStephen M. Cameron 
211533a2ffceSStephen M. Cameron 	BUG_ON(scsi_sg_count(cmd) > h->maxsgentries);
2116edd16368SStephen M. Cameron 
2117edd16368SStephen M. Cameron 	use_sg = scsi_dma_map(cmd);
2118edd16368SStephen M. Cameron 	if (use_sg < 0)
2119edd16368SStephen M. Cameron 		return use_sg;
2120edd16368SStephen M. Cameron 
2121edd16368SStephen M. Cameron 	if (!use_sg)
2122edd16368SStephen M. Cameron 		goto sglist_finished;
2123edd16368SStephen M. Cameron 
212433a2ffceSStephen M. Cameron 	curr_sg = cp->SG;
212533a2ffceSStephen M. Cameron 	chained = 0;
212633a2ffceSStephen M. Cameron 	sg_index = 0;
2127edd16368SStephen M. Cameron 	scsi_for_each_sg(cmd, sg, use_sg, i) {
212833a2ffceSStephen M. Cameron 		if (i == h->max_cmd_sg_entries - 1 &&
212933a2ffceSStephen M. Cameron 			use_sg > h->max_cmd_sg_entries) {
213033a2ffceSStephen M. Cameron 			chained = 1;
213133a2ffceSStephen M. Cameron 			curr_sg = h->cmd_sg_list[cp->cmdindex];
213233a2ffceSStephen M. Cameron 			sg_index = 0;
213333a2ffceSStephen M. Cameron 		}
213401a02ffcSStephen M. Cameron 		addr64 = (u64) sg_dma_address(sg);
2135edd16368SStephen M. Cameron 		len  = sg_dma_len(sg);
213633a2ffceSStephen M. Cameron 		curr_sg->Addr.lower = (u32) (addr64 & 0x0FFFFFFFFULL);
213733a2ffceSStephen M. Cameron 		curr_sg->Addr.upper = (u32) ((addr64 >> 32) & 0x0FFFFFFFFULL);
213833a2ffceSStephen M. Cameron 		curr_sg->Len = len;
213933a2ffceSStephen M. Cameron 		curr_sg->Ext = 0;  /* we are not chaining */
214033a2ffceSStephen M. Cameron 		curr_sg++;
214133a2ffceSStephen M. Cameron 	}
214233a2ffceSStephen M. Cameron 
214333a2ffceSStephen M. Cameron 	if (use_sg + chained > h->maxSG)
214433a2ffceSStephen M. Cameron 		h->maxSG = use_sg + chained;
214533a2ffceSStephen M. Cameron 
214633a2ffceSStephen M. Cameron 	if (chained) {
214733a2ffceSStephen M. Cameron 		cp->Header.SGList = h->max_cmd_sg_entries;
214833a2ffceSStephen M. Cameron 		cp->Header.SGTotal = (u16) (use_sg + 1);
2149e2bea6dfSStephen M. Cameron 		if (hpsa_map_sg_chain_block(h, cp)) {
2150e2bea6dfSStephen M. Cameron 			scsi_dma_unmap(cmd);
2151e2bea6dfSStephen M. Cameron 			return -1;
2152e2bea6dfSStephen M. Cameron 		}
215333a2ffceSStephen M. Cameron 		return 0;
2154edd16368SStephen M. Cameron 	}
2155edd16368SStephen M. Cameron 
2156edd16368SStephen M. Cameron sglist_finished:
2157edd16368SStephen M. Cameron 
215801a02ffcSStephen M. Cameron 	cp->Header.SGList = (u8) use_sg;   /* no. SGs contig in this cmd */
215901a02ffcSStephen M. Cameron 	cp->Header.SGTotal = (u16) use_sg; /* total sgs in this cmd list */
2160edd16368SStephen M. Cameron 	return 0;
2161edd16368SStephen M. Cameron }
2162edd16368SStephen M. Cameron 
2163edd16368SStephen M. Cameron 
2164f281233dSJeff Garzik static int hpsa_scsi_queue_command_lck(struct scsi_cmnd *cmd,
2165edd16368SStephen M. Cameron 	void (*done)(struct scsi_cmnd *))
2166edd16368SStephen M. Cameron {
2167edd16368SStephen M. Cameron 	struct ctlr_info *h;
2168edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *dev;
2169edd16368SStephen M. Cameron 	unsigned char scsi3addr[8];
2170edd16368SStephen M. Cameron 	struct CommandList *c;
2171edd16368SStephen M. Cameron 	unsigned long flags;
2172edd16368SStephen M. Cameron 
2173edd16368SStephen M. Cameron 	/* Get the ptr to our adapter structure out of cmd->host. */
2174edd16368SStephen M. Cameron 	h = sdev_to_hba(cmd->device);
2175edd16368SStephen M. Cameron 	dev = cmd->device->hostdata;
2176edd16368SStephen M. Cameron 	if (!dev) {
2177edd16368SStephen M. Cameron 		cmd->result = DID_NO_CONNECT << 16;
2178edd16368SStephen M. Cameron 		done(cmd);
2179edd16368SStephen M. Cameron 		return 0;
2180edd16368SStephen M. Cameron 	}
2181edd16368SStephen M. Cameron 	memcpy(scsi3addr, dev->scsi3addr, sizeof(scsi3addr));
2182edd16368SStephen M. Cameron 
2183edd16368SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
2184a0c12413SStephen M. Cameron 	if (unlikely(h->lockup_detected)) {
2185a0c12413SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
2186a0c12413SStephen M. Cameron 		cmd->result = DID_ERROR << 16;
2187a0c12413SStephen M. Cameron 		done(cmd);
2188a0c12413SStephen M. Cameron 		return 0;
2189a0c12413SStephen M. Cameron 	}
2190edd16368SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
2191e16a33adSMatt Gates 	c = cmd_alloc(h);
2192edd16368SStephen M. Cameron 	if (c == NULL) {			/* trouble... */
2193edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "cmd_alloc returned NULL!\n");
2194edd16368SStephen M. Cameron 		return SCSI_MLQUEUE_HOST_BUSY;
2195edd16368SStephen M. Cameron 	}
2196edd16368SStephen M. Cameron 
2197edd16368SStephen M. Cameron 	/* Fill in the command list header */
2198edd16368SStephen M. Cameron 
2199edd16368SStephen M. Cameron 	cmd->scsi_done = done;    /* save this for use by completion code */
2200edd16368SStephen M. Cameron 
2201edd16368SStephen M. Cameron 	/* save c in case we have to abort it  */
2202edd16368SStephen M. Cameron 	cmd->host_scribble = (unsigned char *) c;
2203edd16368SStephen M. Cameron 
2204edd16368SStephen M. Cameron 	c->cmd_type = CMD_SCSI;
2205edd16368SStephen M. Cameron 	c->scsi_cmd = cmd;
2206edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0;  /* unused in simple mode */
2207edd16368SStephen M. Cameron 	memcpy(&c->Header.LUN.LunAddrBytes[0], &scsi3addr[0], 8);
2208303932fdSDon Brace 	c->Header.Tag.lower = (c->cmdindex << DIRECT_LOOKUP_SHIFT);
2209303932fdSDon Brace 	c->Header.Tag.lower |= DIRECT_LOOKUP_BIT;
2210edd16368SStephen M. Cameron 
2211edd16368SStephen M. Cameron 	/* Fill in the request block... */
2212edd16368SStephen M. Cameron 
2213edd16368SStephen M. Cameron 	c->Request.Timeout = 0;
2214edd16368SStephen M. Cameron 	memset(c->Request.CDB, 0, sizeof(c->Request.CDB));
2215edd16368SStephen M. Cameron 	BUG_ON(cmd->cmd_len > sizeof(c->Request.CDB));
2216edd16368SStephen M. Cameron 	c->Request.CDBLen = cmd->cmd_len;
2217edd16368SStephen M. Cameron 	memcpy(c->Request.CDB, cmd->cmnd, cmd->cmd_len);
2218edd16368SStephen M. Cameron 	c->Request.Type.Type = TYPE_CMD;
2219edd16368SStephen M. Cameron 	c->Request.Type.Attribute = ATTR_SIMPLE;
2220edd16368SStephen M. Cameron 	switch (cmd->sc_data_direction) {
2221edd16368SStephen M. Cameron 	case DMA_TO_DEVICE:
2222edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_WRITE;
2223edd16368SStephen M. Cameron 		break;
2224edd16368SStephen M. Cameron 	case DMA_FROM_DEVICE:
2225edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_READ;
2226edd16368SStephen M. Cameron 		break;
2227edd16368SStephen M. Cameron 	case DMA_NONE:
2228edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_NONE;
2229edd16368SStephen M. Cameron 		break;
2230edd16368SStephen M. Cameron 	case DMA_BIDIRECTIONAL:
2231edd16368SStephen M. Cameron 		/* This can happen if a buggy application does a scsi passthru
2232edd16368SStephen M. Cameron 		 * and sets both inlen and outlen to non-zero. ( see
2233edd16368SStephen M. Cameron 		 * ../scsi/scsi_ioctl.c:scsi_ioctl_send_command() )
2234edd16368SStephen M. Cameron 		 */
2235edd16368SStephen M. Cameron 
2236edd16368SStephen M. Cameron 		c->Request.Type.Direction = XFER_RSVD;
2237edd16368SStephen M. Cameron 		/* This is technically wrong, and hpsa controllers should
2238edd16368SStephen M. Cameron 		 * reject it with CMD_INVALID, which is the most correct
2239edd16368SStephen M. Cameron 		 * response, but non-fibre backends appear to let it
2240edd16368SStephen M. Cameron 		 * slide by, and give the same results as if this field
2241edd16368SStephen M. Cameron 		 * were set correctly.  Either way is acceptable for
2242edd16368SStephen M. Cameron 		 * our purposes here.
2243edd16368SStephen M. Cameron 		 */
2244edd16368SStephen M. Cameron 
2245edd16368SStephen M. Cameron 		break;
2246edd16368SStephen M. Cameron 
2247edd16368SStephen M. Cameron 	default:
2248edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "unknown data direction: %d\n",
2249edd16368SStephen M. Cameron 			cmd->sc_data_direction);
2250edd16368SStephen M. Cameron 		BUG();
2251edd16368SStephen M. Cameron 		break;
2252edd16368SStephen M. Cameron 	}
2253edd16368SStephen M. Cameron 
225433a2ffceSStephen M. Cameron 	if (hpsa_scatter_gather(h, c, cmd) < 0) { /* Fill SG list */
2255edd16368SStephen M. Cameron 		cmd_free(h, c);
2256edd16368SStephen M. Cameron 		return SCSI_MLQUEUE_HOST_BUSY;
2257edd16368SStephen M. Cameron 	}
2258edd16368SStephen M. Cameron 	enqueue_cmd_and_start_io(h, c);
2259edd16368SStephen M. Cameron 	/* the cmd'll come back via intr handler in complete_scsi_command()  */
2260edd16368SStephen M. Cameron 	return 0;
2261edd16368SStephen M. Cameron }
2262edd16368SStephen M. Cameron 
2263f281233dSJeff Garzik static DEF_SCSI_QCMD(hpsa_scsi_queue_command)
2264f281233dSJeff Garzik 
2265a08a8471SStephen M. Cameron static void hpsa_scan_start(struct Scsi_Host *sh)
2266a08a8471SStephen M. Cameron {
2267a08a8471SStephen M. Cameron 	struct ctlr_info *h = shost_to_hba(sh);
2268a08a8471SStephen M. Cameron 	unsigned long flags;
2269a08a8471SStephen M. Cameron 
2270a08a8471SStephen M. Cameron 	/* wait until any scan already in progress is finished. */
2271a08a8471SStephen M. Cameron 	while (1) {
2272a08a8471SStephen M. Cameron 		spin_lock_irqsave(&h->scan_lock, flags);
2273a08a8471SStephen M. Cameron 		if (h->scan_finished)
2274a08a8471SStephen M. Cameron 			break;
2275a08a8471SStephen M. Cameron 		spin_unlock_irqrestore(&h->scan_lock, flags);
2276a08a8471SStephen M. Cameron 		wait_event(h->scan_wait_queue, h->scan_finished);
2277a08a8471SStephen M. Cameron 		/* Note: We don't need to worry about a race between this
2278a08a8471SStephen M. Cameron 		 * thread and driver unload because the midlayer will
2279a08a8471SStephen M. Cameron 		 * have incremented the reference count, so unload won't
2280a08a8471SStephen M. Cameron 		 * happen if we're in here.
2281a08a8471SStephen M. Cameron 		 */
2282a08a8471SStephen M. Cameron 	}
2283a08a8471SStephen M. Cameron 	h->scan_finished = 0; /* mark scan as in progress */
2284a08a8471SStephen M. Cameron 	spin_unlock_irqrestore(&h->scan_lock, flags);
2285a08a8471SStephen M. Cameron 
2286a08a8471SStephen M. Cameron 	hpsa_update_scsi_devices(h, h->scsi_host->host_no);
2287a08a8471SStephen M. Cameron 
2288a08a8471SStephen M. Cameron 	spin_lock_irqsave(&h->scan_lock, flags);
2289a08a8471SStephen M. Cameron 	h->scan_finished = 1; /* mark scan as finished. */
2290a08a8471SStephen M. Cameron 	wake_up_all(&h->scan_wait_queue);
2291a08a8471SStephen M. Cameron 	spin_unlock_irqrestore(&h->scan_lock, flags);
2292a08a8471SStephen M. Cameron }
2293a08a8471SStephen M. Cameron 
2294a08a8471SStephen M. Cameron static int hpsa_scan_finished(struct Scsi_Host *sh,
2295a08a8471SStephen M. Cameron 	unsigned long elapsed_time)
2296a08a8471SStephen M. Cameron {
2297a08a8471SStephen M. Cameron 	struct ctlr_info *h = shost_to_hba(sh);
2298a08a8471SStephen M. Cameron 	unsigned long flags;
2299a08a8471SStephen M. Cameron 	int finished;
2300a08a8471SStephen M. Cameron 
2301a08a8471SStephen M. Cameron 	spin_lock_irqsave(&h->scan_lock, flags);
2302a08a8471SStephen M. Cameron 	finished = h->scan_finished;
2303a08a8471SStephen M. Cameron 	spin_unlock_irqrestore(&h->scan_lock, flags);
2304a08a8471SStephen M. Cameron 	return finished;
2305a08a8471SStephen M. Cameron }
2306a08a8471SStephen M. Cameron 
2307667e23d4SStephen M. Cameron static int hpsa_change_queue_depth(struct scsi_device *sdev,
2308667e23d4SStephen M. Cameron 	int qdepth, int reason)
2309667e23d4SStephen M. Cameron {
2310667e23d4SStephen M. Cameron 	struct ctlr_info *h = sdev_to_hba(sdev);
2311667e23d4SStephen M. Cameron 
2312667e23d4SStephen M. Cameron 	if (reason != SCSI_QDEPTH_DEFAULT)
2313667e23d4SStephen M. Cameron 		return -ENOTSUPP;
2314667e23d4SStephen M. Cameron 
2315667e23d4SStephen M. Cameron 	if (qdepth < 1)
2316667e23d4SStephen M. Cameron 		qdepth = 1;
2317667e23d4SStephen M. Cameron 	else
2318667e23d4SStephen M. Cameron 		if (qdepth > h->nr_cmds)
2319667e23d4SStephen M. Cameron 			qdepth = h->nr_cmds;
2320667e23d4SStephen M. Cameron 	scsi_adjust_queue_depth(sdev, scsi_get_tag_type(sdev), qdepth);
2321667e23d4SStephen M. Cameron 	return sdev->queue_depth;
2322667e23d4SStephen M. Cameron }
2323667e23d4SStephen M. Cameron 
2324edd16368SStephen M. Cameron static void hpsa_unregister_scsi(struct ctlr_info *h)
2325edd16368SStephen M. Cameron {
2326edd16368SStephen M. Cameron 	/* we are being forcibly unloaded, and may not refuse. */
2327edd16368SStephen M. Cameron 	scsi_remove_host(h->scsi_host);
2328edd16368SStephen M. Cameron 	scsi_host_put(h->scsi_host);
2329edd16368SStephen M. Cameron 	h->scsi_host = NULL;
2330edd16368SStephen M. Cameron }
2331edd16368SStephen M. Cameron 
2332edd16368SStephen M. Cameron static int hpsa_register_scsi(struct ctlr_info *h)
2333edd16368SStephen M. Cameron {
2334b705690dSStephen M. Cameron 	struct Scsi_Host *sh;
2335b705690dSStephen M. Cameron 	int error;
2336edd16368SStephen M. Cameron 
2337b705690dSStephen M. Cameron 	sh = scsi_host_alloc(&hpsa_driver_template, sizeof(h));
2338b705690dSStephen M. Cameron 	if (sh == NULL)
2339b705690dSStephen M. Cameron 		goto fail;
2340b705690dSStephen M. Cameron 
2341b705690dSStephen M. Cameron 	sh->io_port = 0;
2342b705690dSStephen M. Cameron 	sh->n_io_port = 0;
2343b705690dSStephen M. Cameron 	sh->this_id = -1;
2344b705690dSStephen M. Cameron 	sh->max_channel = 3;
2345b705690dSStephen M. Cameron 	sh->max_cmd_len = MAX_COMMAND_SIZE;
2346b705690dSStephen M. Cameron 	sh->max_lun = HPSA_MAX_LUN;
2347b705690dSStephen M. Cameron 	sh->max_id = HPSA_MAX_LUN;
2348b705690dSStephen M. Cameron 	sh->can_queue = h->nr_cmds;
2349b705690dSStephen M. Cameron 	sh->cmd_per_lun = h->nr_cmds;
2350b705690dSStephen M. Cameron 	sh->sg_tablesize = h->maxsgentries;
2351b705690dSStephen M. Cameron 	h->scsi_host = sh;
2352b705690dSStephen M. Cameron 	sh->hostdata[0] = (unsigned long) h;
2353b705690dSStephen M. Cameron 	sh->irq = h->intr[h->intr_mode];
2354b705690dSStephen M. Cameron 	sh->unique_id = sh->irq;
2355b705690dSStephen M. Cameron 	error = scsi_add_host(sh, &h->pdev->dev);
2356b705690dSStephen M. Cameron 	if (error)
2357b705690dSStephen M. Cameron 		goto fail_host_put;
2358b705690dSStephen M. Cameron 	scsi_scan_host(sh);
2359b705690dSStephen M. Cameron 	return 0;
2360b705690dSStephen M. Cameron 
2361b705690dSStephen M. Cameron  fail_host_put:
2362b705690dSStephen M. Cameron 	dev_err(&h->pdev->dev, "%s: scsi_add_host"
2363b705690dSStephen M. Cameron 		" failed for controller %d\n", __func__, h->ctlr);
2364b705690dSStephen M. Cameron 	scsi_host_put(sh);
2365b705690dSStephen M. Cameron 	return error;
2366b705690dSStephen M. Cameron  fail:
2367b705690dSStephen M. Cameron 	dev_err(&h->pdev->dev, "%s: scsi_host_alloc"
2368b705690dSStephen M. Cameron 		" failed for controller %d\n", __func__, h->ctlr);
2369b705690dSStephen M. Cameron 	return -ENOMEM;
2370edd16368SStephen M. Cameron }
2371edd16368SStephen M. Cameron 
2372edd16368SStephen M. Cameron static int wait_for_device_to_become_ready(struct ctlr_info *h,
2373edd16368SStephen M. Cameron 	unsigned char lunaddr[])
2374edd16368SStephen M. Cameron {
2375edd16368SStephen M. Cameron 	int rc = 0;
2376edd16368SStephen M. Cameron 	int count = 0;
2377edd16368SStephen M. Cameron 	int waittime = 1; /* seconds */
2378edd16368SStephen M. Cameron 	struct CommandList *c;
2379edd16368SStephen M. Cameron 
2380edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
2381edd16368SStephen M. Cameron 	if (!c) {
2382edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "out of memory in "
2383edd16368SStephen M. Cameron 			"wait_for_device_to_become_ready.\n");
2384edd16368SStephen M. Cameron 		return IO_ERROR;
2385edd16368SStephen M. Cameron 	}
2386edd16368SStephen M. Cameron 
2387edd16368SStephen M. Cameron 	/* Send test unit ready until device ready, or give up. */
2388edd16368SStephen M. Cameron 	while (count < HPSA_TUR_RETRY_LIMIT) {
2389edd16368SStephen M. Cameron 
2390edd16368SStephen M. Cameron 		/* Wait for a bit.  do this first, because if we send
2391edd16368SStephen M. Cameron 		 * the TUR right away, the reset will just abort it.
2392edd16368SStephen M. Cameron 		 */
2393edd16368SStephen M. Cameron 		msleep(1000 * waittime);
2394edd16368SStephen M. Cameron 		count++;
2395edd16368SStephen M. Cameron 
2396edd16368SStephen M. Cameron 		/* Increase wait time with each try, up to a point. */
2397edd16368SStephen M. Cameron 		if (waittime < HPSA_MAX_WAIT_INTERVAL_SECS)
2398edd16368SStephen M. Cameron 			waittime = waittime * 2;
2399edd16368SStephen M. Cameron 
2400a2dac136SStephen M. Cameron 		/* Send the Test Unit Ready, fill_cmd can't fail, no mapping */
2401a2dac136SStephen M. Cameron 		(void) fill_cmd(c, TEST_UNIT_READY, h,
2402a2dac136SStephen M. Cameron 				NULL, 0, 0, lunaddr, TYPE_CMD);
2403edd16368SStephen M. Cameron 		hpsa_scsi_do_simple_cmd_core(h, c);
2404edd16368SStephen M. Cameron 		/* no unmap needed here because no data xfer. */
2405edd16368SStephen M. Cameron 
2406edd16368SStephen M. Cameron 		if (c->err_info->CommandStatus == CMD_SUCCESS)
2407edd16368SStephen M. Cameron 			break;
2408edd16368SStephen M. Cameron 
2409edd16368SStephen M. Cameron 		if (c->err_info->CommandStatus == CMD_TARGET_STATUS &&
2410edd16368SStephen M. Cameron 			c->err_info->ScsiStatus == SAM_STAT_CHECK_CONDITION &&
2411edd16368SStephen M. Cameron 			(c->err_info->SenseInfo[2] == NO_SENSE ||
2412edd16368SStephen M. Cameron 			c->err_info->SenseInfo[2] == UNIT_ATTENTION))
2413edd16368SStephen M. Cameron 			break;
2414edd16368SStephen M. Cameron 
2415edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "waiting %d secs "
2416edd16368SStephen M. Cameron 			"for device to become ready.\n", waittime);
2417edd16368SStephen M. Cameron 		rc = 1; /* device not ready. */
2418edd16368SStephen M. Cameron 	}
2419edd16368SStephen M. Cameron 
2420edd16368SStephen M. Cameron 	if (rc)
2421edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "giving up on device.\n");
2422edd16368SStephen M. Cameron 	else
2423edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "device is ready.\n");
2424edd16368SStephen M. Cameron 
2425edd16368SStephen M. Cameron 	cmd_special_free(h, c);
2426edd16368SStephen M. Cameron 	return rc;
2427edd16368SStephen M. Cameron }
2428edd16368SStephen M. Cameron 
2429edd16368SStephen M. Cameron /* Need at least one of these error handlers to keep ../scsi/hosts.c from
2430edd16368SStephen M. Cameron  * complaining.  Doing a host- or bus-reset can't do anything good here.
2431edd16368SStephen M. Cameron  */
2432edd16368SStephen M. Cameron static int hpsa_eh_device_reset_handler(struct scsi_cmnd *scsicmd)
2433edd16368SStephen M. Cameron {
2434edd16368SStephen M. Cameron 	int rc;
2435edd16368SStephen M. Cameron 	struct ctlr_info *h;
2436edd16368SStephen M. Cameron 	struct hpsa_scsi_dev_t *dev;
2437edd16368SStephen M. Cameron 
2438edd16368SStephen M. Cameron 	/* find the controller to which the command to be aborted was sent */
2439edd16368SStephen M. Cameron 	h = sdev_to_hba(scsicmd->device);
2440edd16368SStephen M. Cameron 	if (h == NULL) /* paranoia */
2441edd16368SStephen M. Cameron 		return FAILED;
2442edd16368SStephen M. Cameron 	dev = scsicmd->device->hostdata;
2443edd16368SStephen M. Cameron 	if (!dev) {
2444edd16368SStephen M. Cameron 		dev_err(&h->pdev->dev, "hpsa_eh_device_reset_handler: "
2445edd16368SStephen M. Cameron 			"device lookup failed.\n");
2446edd16368SStephen M. Cameron 		return FAILED;
2447edd16368SStephen M. Cameron 	}
2448d416b0c7SStephen M. Cameron 	dev_warn(&h->pdev->dev, "resetting device %d:%d:%d:%d\n",
2449d416b0c7SStephen M. Cameron 		h->scsi_host->host_no, dev->bus, dev->target, dev->lun);
2450edd16368SStephen M. Cameron 	/* send a reset to the SCSI LUN which the command was sent to */
2451edd16368SStephen M. Cameron 	rc = hpsa_send_reset(h, dev->scsi3addr);
2452edd16368SStephen M. Cameron 	if (rc == 0 && wait_for_device_to_become_ready(h, dev->scsi3addr) == 0)
2453edd16368SStephen M. Cameron 		return SUCCESS;
2454edd16368SStephen M. Cameron 
2455edd16368SStephen M. Cameron 	dev_warn(&h->pdev->dev, "resetting device failed.\n");
2456edd16368SStephen M. Cameron 	return FAILED;
2457edd16368SStephen M. Cameron }
2458edd16368SStephen M. Cameron 
24596cba3f19SStephen M. Cameron static void swizzle_abort_tag(u8 *tag)
24606cba3f19SStephen M. Cameron {
24616cba3f19SStephen M. Cameron 	u8 original_tag[8];
24626cba3f19SStephen M. Cameron 
24636cba3f19SStephen M. Cameron 	memcpy(original_tag, tag, 8);
24646cba3f19SStephen M. Cameron 	tag[0] = original_tag[3];
24656cba3f19SStephen M. Cameron 	tag[1] = original_tag[2];
24666cba3f19SStephen M. Cameron 	tag[2] = original_tag[1];
24676cba3f19SStephen M. Cameron 	tag[3] = original_tag[0];
24686cba3f19SStephen M. Cameron 	tag[4] = original_tag[7];
24696cba3f19SStephen M. Cameron 	tag[5] = original_tag[6];
24706cba3f19SStephen M. Cameron 	tag[6] = original_tag[5];
24716cba3f19SStephen M. Cameron 	tag[7] = original_tag[4];
24726cba3f19SStephen M. Cameron }
24736cba3f19SStephen M. Cameron 
247475167d2cSStephen M. Cameron static int hpsa_send_abort(struct ctlr_info *h, unsigned char *scsi3addr,
24756cba3f19SStephen M. Cameron 	struct CommandList *abort, int swizzle)
247675167d2cSStephen M. Cameron {
247775167d2cSStephen M. Cameron 	int rc = IO_OK;
247875167d2cSStephen M. Cameron 	struct CommandList *c;
247975167d2cSStephen M. Cameron 	struct ErrorInfo *ei;
248075167d2cSStephen M. Cameron 
248175167d2cSStephen M. Cameron 	c = cmd_special_alloc(h);
248275167d2cSStephen M. Cameron 	if (c == NULL) {	/* trouble... */
248375167d2cSStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
248475167d2cSStephen M. Cameron 		return -ENOMEM;
248575167d2cSStephen M. Cameron 	}
248675167d2cSStephen M. Cameron 
2487a2dac136SStephen M. Cameron 	/* fill_cmd can't fail here, no buffer to map */
2488a2dac136SStephen M. Cameron 	(void) fill_cmd(c, HPSA_ABORT_MSG, h, abort,
2489a2dac136SStephen M. Cameron 		0, 0, scsi3addr, TYPE_MSG);
24906cba3f19SStephen M. Cameron 	if (swizzle)
24916cba3f19SStephen M. Cameron 		swizzle_abort_tag(&c->Request.CDB[4]);
249275167d2cSStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core(h, c);
249375167d2cSStephen M. Cameron 	dev_dbg(&h->pdev->dev, "%s: Tag:0x%08x:%08x: do_simple_cmd_core completed.\n",
249475167d2cSStephen M. Cameron 		__func__, abort->Header.Tag.upper, abort->Header.Tag.lower);
249575167d2cSStephen M. Cameron 	/* no unmap needed here because no data xfer. */
249675167d2cSStephen M. Cameron 
249775167d2cSStephen M. Cameron 	ei = c->err_info;
249875167d2cSStephen M. Cameron 	switch (ei->CommandStatus) {
249975167d2cSStephen M. Cameron 	case CMD_SUCCESS:
250075167d2cSStephen M. Cameron 		break;
250175167d2cSStephen M. Cameron 	case CMD_UNABORTABLE: /* Very common, don't make noise. */
250275167d2cSStephen M. Cameron 		rc = -1;
250375167d2cSStephen M. Cameron 		break;
250475167d2cSStephen M. Cameron 	default:
250575167d2cSStephen M. Cameron 		dev_dbg(&h->pdev->dev, "%s: Tag:0x%08x:%08x: interpreting error.\n",
250675167d2cSStephen M. Cameron 			__func__, abort->Header.Tag.upper,
250775167d2cSStephen M. Cameron 			abort->Header.Tag.lower);
250875167d2cSStephen M. Cameron 		hpsa_scsi_interpret_error(c);
250975167d2cSStephen M. Cameron 		rc = -1;
251075167d2cSStephen M. Cameron 		break;
251175167d2cSStephen M. Cameron 	}
251275167d2cSStephen M. Cameron 	cmd_special_free(h, c);
251375167d2cSStephen M. Cameron 	dev_dbg(&h->pdev->dev, "%s: Tag:0x%08x:%08x: Finished.\n", __func__,
251475167d2cSStephen M. Cameron 		abort->Header.Tag.upper, abort->Header.Tag.lower);
251575167d2cSStephen M. Cameron 	return rc;
251675167d2cSStephen M. Cameron }
251775167d2cSStephen M. Cameron 
251875167d2cSStephen M. Cameron /*
251975167d2cSStephen M. Cameron  * hpsa_find_cmd_in_queue
252075167d2cSStephen M. Cameron  *
252175167d2cSStephen M. Cameron  * Used to determine whether a command (find) is still present
252275167d2cSStephen M. Cameron  * in queue_head.   Optionally excludes the last element of queue_head.
252375167d2cSStephen M. Cameron  *
252475167d2cSStephen M. Cameron  * This is used to avoid unnecessary aborts.  Commands in h->reqQ have
252575167d2cSStephen M. Cameron  * not yet been submitted, and so can be aborted by the driver without
252675167d2cSStephen M. Cameron  * sending an abort to the hardware.
252775167d2cSStephen M. Cameron  *
252875167d2cSStephen M. Cameron  * Returns pointer to command if found in queue, NULL otherwise.
252975167d2cSStephen M. Cameron  */
253075167d2cSStephen M. Cameron static struct CommandList *hpsa_find_cmd_in_queue(struct ctlr_info *h,
253175167d2cSStephen M. Cameron 			struct scsi_cmnd *find, struct list_head *queue_head)
253275167d2cSStephen M. Cameron {
253375167d2cSStephen M. Cameron 	unsigned long flags;
253475167d2cSStephen M. Cameron 	struct CommandList *c = NULL;	/* ptr into cmpQ */
253575167d2cSStephen M. Cameron 
253675167d2cSStephen M. Cameron 	if (!find)
253775167d2cSStephen M. Cameron 		return 0;
253875167d2cSStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
253975167d2cSStephen M. Cameron 	list_for_each_entry(c, queue_head, list) {
254075167d2cSStephen M. Cameron 		if (c->scsi_cmd == NULL) /* e.g.: passthru ioctl */
254175167d2cSStephen M. Cameron 			continue;
254275167d2cSStephen M. Cameron 		if (c->scsi_cmd == find) {
254375167d2cSStephen M. Cameron 			spin_unlock_irqrestore(&h->lock, flags);
254475167d2cSStephen M. Cameron 			return c;
254575167d2cSStephen M. Cameron 		}
254675167d2cSStephen M. Cameron 	}
254775167d2cSStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
254875167d2cSStephen M. Cameron 	return NULL;
254975167d2cSStephen M. Cameron }
255075167d2cSStephen M. Cameron 
25516cba3f19SStephen M. Cameron static struct CommandList *hpsa_find_cmd_in_queue_by_tag(struct ctlr_info *h,
25526cba3f19SStephen M. Cameron 					u8 *tag, struct list_head *queue_head)
25536cba3f19SStephen M. Cameron {
25546cba3f19SStephen M. Cameron 	unsigned long flags;
25556cba3f19SStephen M. Cameron 	struct CommandList *c;
25566cba3f19SStephen M. Cameron 
25576cba3f19SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
25586cba3f19SStephen M. Cameron 	list_for_each_entry(c, queue_head, list) {
25596cba3f19SStephen M. Cameron 		if (memcmp(&c->Header.Tag, tag, 8) != 0)
25606cba3f19SStephen M. Cameron 			continue;
25616cba3f19SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
25626cba3f19SStephen M. Cameron 		return c;
25636cba3f19SStephen M. Cameron 	}
25646cba3f19SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
25656cba3f19SStephen M. Cameron 	return NULL;
25666cba3f19SStephen M. Cameron }
25676cba3f19SStephen M. Cameron 
25686cba3f19SStephen M. Cameron /* Some Smart Arrays need the abort tag swizzled, and some don't.  It's hard to
25696cba3f19SStephen M. Cameron  * tell which kind we're dealing with, so we send the abort both ways.  There
25706cba3f19SStephen M. Cameron  * shouldn't be any collisions between swizzled and unswizzled tags due to the
25716cba3f19SStephen M. Cameron  * way we construct our tags but we check anyway in case the assumptions which
25726cba3f19SStephen M. Cameron  * make this true someday become false.
25736cba3f19SStephen M. Cameron  */
25746cba3f19SStephen M. Cameron static int hpsa_send_abort_both_ways(struct ctlr_info *h,
25756cba3f19SStephen M. Cameron 	unsigned char *scsi3addr, struct CommandList *abort)
25766cba3f19SStephen M. Cameron {
25776cba3f19SStephen M. Cameron 	u8 swizzled_tag[8];
25786cba3f19SStephen M. Cameron 	struct CommandList *c;
25796cba3f19SStephen M. Cameron 	int rc = 0, rc2 = 0;
25806cba3f19SStephen M. Cameron 
25816cba3f19SStephen M. Cameron 	/* we do not expect to find the swizzled tag in our queue, but
25826cba3f19SStephen M. Cameron 	 * check anyway just to be sure the assumptions which make this
25836cba3f19SStephen M. Cameron 	 * the case haven't become wrong.
25846cba3f19SStephen M. Cameron 	 */
25856cba3f19SStephen M. Cameron 	memcpy(swizzled_tag, &abort->Request.CDB[4], 8);
25866cba3f19SStephen M. Cameron 	swizzle_abort_tag(swizzled_tag);
25876cba3f19SStephen M. Cameron 	c = hpsa_find_cmd_in_queue_by_tag(h, swizzled_tag, &h->cmpQ);
25886cba3f19SStephen M. Cameron 	if (c != NULL) {
25896cba3f19SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Unexpectedly found byte-swapped tag in completion queue.\n");
25906cba3f19SStephen M. Cameron 		return hpsa_send_abort(h, scsi3addr, abort, 0);
25916cba3f19SStephen M. Cameron 	}
25926cba3f19SStephen M. Cameron 	rc = hpsa_send_abort(h, scsi3addr, abort, 0);
25936cba3f19SStephen M. Cameron 
25946cba3f19SStephen M. Cameron 	/* if the command is still in our queue, we can't conclude that it was
25956cba3f19SStephen M. Cameron 	 * aborted (it might have just completed normally) but in any case
25966cba3f19SStephen M. Cameron 	 * we don't need to try to abort it another way.
25976cba3f19SStephen M. Cameron 	 */
25986cba3f19SStephen M. Cameron 	c = hpsa_find_cmd_in_queue(h, abort->scsi_cmd, &h->cmpQ);
25996cba3f19SStephen M. Cameron 	if (c)
26006cba3f19SStephen M. Cameron 		rc2 = hpsa_send_abort(h, scsi3addr, abort, 1);
26016cba3f19SStephen M. Cameron 	return rc && rc2;
26026cba3f19SStephen M. Cameron }
26036cba3f19SStephen M. Cameron 
260475167d2cSStephen M. Cameron /* Send an abort for the specified command.
260575167d2cSStephen M. Cameron  *	If the device and controller support it,
260675167d2cSStephen M. Cameron  *		send a task abort request.
260775167d2cSStephen M. Cameron  */
260875167d2cSStephen M. Cameron static int hpsa_eh_abort_handler(struct scsi_cmnd *sc)
260975167d2cSStephen M. Cameron {
261075167d2cSStephen M. Cameron 
261175167d2cSStephen M. Cameron 	int i, rc;
261275167d2cSStephen M. Cameron 	struct ctlr_info *h;
261375167d2cSStephen M. Cameron 	struct hpsa_scsi_dev_t *dev;
261475167d2cSStephen M. Cameron 	struct CommandList *abort; /* pointer to command to be aborted */
261575167d2cSStephen M. Cameron 	struct CommandList *found;
261675167d2cSStephen M. Cameron 	struct scsi_cmnd *as;	/* ptr to scsi cmd inside aborted command. */
261775167d2cSStephen M. Cameron 	char msg[256];		/* For debug messaging. */
261875167d2cSStephen M. Cameron 	int ml = 0;
261975167d2cSStephen M. Cameron 
262075167d2cSStephen M. Cameron 	/* Find the controller of the command to be aborted */
262175167d2cSStephen M. Cameron 	h = sdev_to_hba(sc->device);
262275167d2cSStephen M. Cameron 	if (WARN(h == NULL,
262375167d2cSStephen M. Cameron 			"ABORT REQUEST FAILED, Controller lookup failed.\n"))
262475167d2cSStephen M. Cameron 		return FAILED;
262575167d2cSStephen M. Cameron 
262675167d2cSStephen M. Cameron 	/* Check that controller supports some kind of task abort */
262775167d2cSStephen M. Cameron 	if (!(HPSATMF_PHYS_TASK_ABORT & h->TMFSupportFlags) &&
262875167d2cSStephen M. Cameron 		!(HPSATMF_LOG_TASK_ABORT & h->TMFSupportFlags))
262975167d2cSStephen M. Cameron 		return FAILED;
263075167d2cSStephen M. Cameron 
263175167d2cSStephen M. Cameron 	memset(msg, 0, sizeof(msg));
263275167d2cSStephen M. Cameron 	ml += sprintf(msg+ml, "ABORT REQUEST on C%d:B%d:T%d:L%d ",
263375167d2cSStephen M. Cameron 		h->scsi_host->host_no, sc->device->channel,
263475167d2cSStephen M. Cameron 		sc->device->id, sc->device->lun);
263575167d2cSStephen M. Cameron 
263675167d2cSStephen M. Cameron 	/* Find the device of the command to be aborted */
263775167d2cSStephen M. Cameron 	dev = sc->device->hostdata;
263875167d2cSStephen M. Cameron 	if (!dev) {
263975167d2cSStephen M. Cameron 		dev_err(&h->pdev->dev, "%s FAILED, Device lookup failed.\n",
264075167d2cSStephen M. Cameron 				msg);
264175167d2cSStephen M. Cameron 		return FAILED;
264275167d2cSStephen M. Cameron 	}
264375167d2cSStephen M. Cameron 
264475167d2cSStephen M. Cameron 	/* Get SCSI command to be aborted */
264575167d2cSStephen M. Cameron 	abort = (struct CommandList *) sc->host_scribble;
264675167d2cSStephen M. Cameron 	if (abort == NULL) {
264775167d2cSStephen M. Cameron 		dev_err(&h->pdev->dev, "%s FAILED, Command to abort is NULL.\n",
264875167d2cSStephen M. Cameron 				msg);
264975167d2cSStephen M. Cameron 		return FAILED;
265075167d2cSStephen M. Cameron 	}
265175167d2cSStephen M. Cameron 
265275167d2cSStephen M. Cameron 	ml += sprintf(msg+ml, "Tag:0x%08x:%08x ",
265375167d2cSStephen M. Cameron 		abort->Header.Tag.upper, abort->Header.Tag.lower);
265475167d2cSStephen M. Cameron 	as  = (struct scsi_cmnd *) abort->scsi_cmd;
265575167d2cSStephen M. Cameron 	if (as != NULL)
265675167d2cSStephen M. Cameron 		ml += sprintf(msg+ml, "Command:0x%x SN:0x%lx ",
265775167d2cSStephen M. Cameron 			as->cmnd[0], as->serial_number);
265875167d2cSStephen M. Cameron 	dev_dbg(&h->pdev->dev, "%s\n", msg);
265975167d2cSStephen M. Cameron 	dev_warn(&h->pdev->dev, "Abort request on C%d:B%d:T%d:L%d\n",
266075167d2cSStephen M. Cameron 		h->scsi_host->host_no, dev->bus, dev->target, dev->lun);
266175167d2cSStephen M. Cameron 
266275167d2cSStephen M. Cameron 	/* Search reqQ to See if command is queued but not submitted,
266375167d2cSStephen M. Cameron 	 * if so, complete the command with aborted status and remove
266475167d2cSStephen M. Cameron 	 * it from the reqQ.
266575167d2cSStephen M. Cameron 	 */
266675167d2cSStephen M. Cameron 	found = hpsa_find_cmd_in_queue(h, sc, &h->reqQ);
266775167d2cSStephen M. Cameron 	if (found) {
266875167d2cSStephen M. Cameron 		found->err_info->CommandStatus = CMD_ABORTED;
266975167d2cSStephen M. Cameron 		finish_cmd(found);
267075167d2cSStephen M. Cameron 		dev_info(&h->pdev->dev, "%s Request SUCCEEDED (driver queue).\n",
267175167d2cSStephen M. Cameron 				msg);
267275167d2cSStephen M. Cameron 		return SUCCESS;
267375167d2cSStephen M. Cameron 	}
267475167d2cSStephen M. Cameron 
267575167d2cSStephen M. Cameron 	/* not in reqQ, if also not in cmpQ, must have already completed */
267675167d2cSStephen M. Cameron 	found = hpsa_find_cmd_in_queue(h, sc, &h->cmpQ);
267775167d2cSStephen M. Cameron 	if (!found)  {
2678d6ebd0f7SStephen M. Cameron 		dev_dbg(&h->pdev->dev, "%s Request SUCCEEDED (not known to driver).\n",
267975167d2cSStephen M. Cameron 				msg);
268075167d2cSStephen M. Cameron 		return SUCCESS;
268175167d2cSStephen M. Cameron 	}
268275167d2cSStephen M. Cameron 
268375167d2cSStephen M. Cameron 	/*
268475167d2cSStephen M. Cameron 	 * Command is in flight, or possibly already completed
268575167d2cSStephen M. Cameron 	 * by the firmware (but not to the scsi mid layer) but we can't
268675167d2cSStephen M. Cameron 	 * distinguish which.  Send the abort down.
268775167d2cSStephen M. Cameron 	 */
26886cba3f19SStephen M. Cameron 	rc = hpsa_send_abort_both_ways(h, dev->scsi3addr, abort);
268975167d2cSStephen M. Cameron 	if (rc != 0) {
269075167d2cSStephen M. Cameron 		dev_dbg(&h->pdev->dev, "%s Request FAILED.\n", msg);
269175167d2cSStephen M. Cameron 		dev_warn(&h->pdev->dev, "FAILED abort on device C%d:B%d:T%d:L%d\n",
269275167d2cSStephen M. Cameron 			h->scsi_host->host_no,
269375167d2cSStephen M. Cameron 			dev->bus, dev->target, dev->lun);
269475167d2cSStephen M. Cameron 		return FAILED;
269575167d2cSStephen M. Cameron 	}
269675167d2cSStephen M. Cameron 	dev_info(&h->pdev->dev, "%s REQUEST SUCCEEDED.\n", msg);
269775167d2cSStephen M. Cameron 
269875167d2cSStephen M. Cameron 	/* If the abort(s) above completed and actually aborted the
269975167d2cSStephen M. Cameron 	 * command, then the command to be aborted should already be
270075167d2cSStephen M. Cameron 	 * completed.  If not, wait around a bit more to see if they
270175167d2cSStephen M. Cameron 	 * manage to complete normally.
270275167d2cSStephen M. Cameron 	 */
270375167d2cSStephen M. Cameron #define ABORT_COMPLETE_WAIT_SECS 30
270475167d2cSStephen M. Cameron 	for (i = 0; i < ABORT_COMPLETE_WAIT_SECS * 10; i++) {
270575167d2cSStephen M. Cameron 		found = hpsa_find_cmd_in_queue(h, sc, &h->cmpQ);
270675167d2cSStephen M. Cameron 		if (!found)
270775167d2cSStephen M. Cameron 			return SUCCESS;
270875167d2cSStephen M. Cameron 		msleep(100);
270975167d2cSStephen M. Cameron 	}
271075167d2cSStephen M. Cameron 	dev_warn(&h->pdev->dev, "%s FAILED. Aborted command has not completed after %d seconds.\n",
271175167d2cSStephen M. Cameron 		msg, ABORT_COMPLETE_WAIT_SECS);
271275167d2cSStephen M. Cameron 	return FAILED;
271375167d2cSStephen M. Cameron }
271475167d2cSStephen M. Cameron 
271575167d2cSStephen M. Cameron 
2716edd16368SStephen M. Cameron /*
2717edd16368SStephen M. Cameron  * For operations that cannot sleep, a command block is allocated at init,
2718edd16368SStephen M. Cameron  * and managed by cmd_alloc() and cmd_free() using a simple bitmap to track
2719edd16368SStephen M. Cameron  * which ones are free or in use.  Lock must be held when calling this.
2720edd16368SStephen M. Cameron  * cmd_free() is the complement.
2721edd16368SStephen M. Cameron  */
2722edd16368SStephen M. Cameron static struct CommandList *cmd_alloc(struct ctlr_info *h)
2723edd16368SStephen M. Cameron {
2724edd16368SStephen M. Cameron 	struct CommandList *c;
2725edd16368SStephen M. Cameron 	int i;
2726edd16368SStephen M. Cameron 	union u64bit temp64;
2727edd16368SStephen M. Cameron 	dma_addr_t cmd_dma_handle, err_dma_handle;
2728e16a33adSMatt Gates 	unsigned long flags;
2729edd16368SStephen M. Cameron 
2730e16a33adSMatt Gates 	spin_lock_irqsave(&h->lock, flags);
2731edd16368SStephen M. Cameron 	do {
2732edd16368SStephen M. Cameron 		i = find_first_zero_bit(h->cmd_pool_bits, h->nr_cmds);
2733e16a33adSMatt Gates 		if (i == h->nr_cmds) {
2734e16a33adSMatt Gates 			spin_unlock_irqrestore(&h->lock, flags);
2735edd16368SStephen M. Cameron 			return NULL;
2736e16a33adSMatt Gates 		}
2737edd16368SStephen M. Cameron 	} while (test_and_set_bit
2738edd16368SStephen M. Cameron 		 (i & (BITS_PER_LONG - 1),
2739edd16368SStephen M. Cameron 		  h->cmd_pool_bits + (i / BITS_PER_LONG)) != 0);
2740e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
2741e16a33adSMatt Gates 
2742edd16368SStephen M. Cameron 	c = h->cmd_pool + i;
2743edd16368SStephen M. Cameron 	memset(c, 0, sizeof(*c));
2744edd16368SStephen M. Cameron 	cmd_dma_handle = h->cmd_pool_dhandle
2745edd16368SStephen M. Cameron 	    + i * sizeof(*c);
2746edd16368SStephen M. Cameron 	c->err_info = h->errinfo_pool + i;
2747edd16368SStephen M. Cameron 	memset(c->err_info, 0, sizeof(*c->err_info));
2748edd16368SStephen M. Cameron 	err_dma_handle = h->errinfo_pool_dhandle
2749edd16368SStephen M. Cameron 	    + i * sizeof(*c->err_info);
2750edd16368SStephen M. Cameron 
2751edd16368SStephen M. Cameron 	c->cmdindex = i;
2752edd16368SStephen M. Cameron 
27539e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&c->list);
275401a02ffcSStephen M. Cameron 	c->busaddr = (u32) cmd_dma_handle;
275501a02ffcSStephen M. Cameron 	temp64.val = (u64) err_dma_handle;
2756edd16368SStephen M. Cameron 	c->ErrDesc.Addr.lower = temp64.val32.lower;
2757edd16368SStephen M. Cameron 	c->ErrDesc.Addr.upper = temp64.val32.upper;
2758edd16368SStephen M. Cameron 	c->ErrDesc.Len = sizeof(*c->err_info);
2759edd16368SStephen M. Cameron 
2760edd16368SStephen M. Cameron 	c->h = h;
2761edd16368SStephen M. Cameron 	return c;
2762edd16368SStephen M. Cameron }
2763edd16368SStephen M. Cameron 
2764edd16368SStephen M. Cameron /* For operations that can wait for kmalloc to possibly sleep,
2765edd16368SStephen M. Cameron  * this routine can be called. Lock need not be held to call
2766edd16368SStephen M. Cameron  * cmd_special_alloc. cmd_special_free() is the complement.
2767edd16368SStephen M. Cameron  */
2768edd16368SStephen M. Cameron static struct CommandList *cmd_special_alloc(struct ctlr_info *h)
2769edd16368SStephen M. Cameron {
2770edd16368SStephen M. Cameron 	struct CommandList *c;
2771edd16368SStephen M. Cameron 	union u64bit temp64;
2772edd16368SStephen M. Cameron 	dma_addr_t cmd_dma_handle, err_dma_handle;
2773edd16368SStephen M. Cameron 
2774edd16368SStephen M. Cameron 	c = pci_alloc_consistent(h->pdev, sizeof(*c), &cmd_dma_handle);
2775edd16368SStephen M. Cameron 	if (c == NULL)
2776edd16368SStephen M. Cameron 		return NULL;
2777edd16368SStephen M. Cameron 	memset(c, 0, sizeof(*c));
2778edd16368SStephen M. Cameron 
2779edd16368SStephen M. Cameron 	c->cmdindex = -1;
2780edd16368SStephen M. Cameron 
2781edd16368SStephen M. Cameron 	c->err_info = pci_alloc_consistent(h->pdev, sizeof(*c->err_info),
2782edd16368SStephen M. Cameron 		    &err_dma_handle);
2783edd16368SStephen M. Cameron 
2784edd16368SStephen M. Cameron 	if (c->err_info == NULL) {
2785edd16368SStephen M. Cameron 		pci_free_consistent(h->pdev,
2786edd16368SStephen M. Cameron 			sizeof(*c), c, cmd_dma_handle);
2787edd16368SStephen M. Cameron 		return NULL;
2788edd16368SStephen M. Cameron 	}
2789edd16368SStephen M. Cameron 	memset(c->err_info, 0, sizeof(*c->err_info));
2790edd16368SStephen M. Cameron 
27919e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&c->list);
279201a02ffcSStephen M. Cameron 	c->busaddr = (u32) cmd_dma_handle;
279301a02ffcSStephen M. Cameron 	temp64.val = (u64) err_dma_handle;
2794edd16368SStephen M. Cameron 	c->ErrDesc.Addr.lower = temp64.val32.lower;
2795edd16368SStephen M. Cameron 	c->ErrDesc.Addr.upper = temp64.val32.upper;
2796edd16368SStephen M. Cameron 	c->ErrDesc.Len = sizeof(*c->err_info);
2797edd16368SStephen M. Cameron 
2798edd16368SStephen M. Cameron 	c->h = h;
2799edd16368SStephen M. Cameron 	return c;
2800edd16368SStephen M. Cameron }
2801edd16368SStephen M. Cameron 
2802edd16368SStephen M. Cameron static void cmd_free(struct ctlr_info *h, struct CommandList *c)
2803edd16368SStephen M. Cameron {
2804edd16368SStephen M. Cameron 	int i;
2805e16a33adSMatt Gates 	unsigned long flags;
2806edd16368SStephen M. Cameron 
2807edd16368SStephen M. Cameron 	i = c - h->cmd_pool;
2808e16a33adSMatt Gates 	spin_lock_irqsave(&h->lock, flags);
2809edd16368SStephen M. Cameron 	clear_bit(i & (BITS_PER_LONG - 1),
2810edd16368SStephen M. Cameron 		  h->cmd_pool_bits + (i / BITS_PER_LONG));
2811e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
2812edd16368SStephen M. Cameron }
2813edd16368SStephen M. Cameron 
2814edd16368SStephen M. Cameron static void cmd_special_free(struct ctlr_info *h, struct CommandList *c)
2815edd16368SStephen M. Cameron {
2816edd16368SStephen M. Cameron 	union u64bit temp64;
2817edd16368SStephen M. Cameron 
2818edd16368SStephen M. Cameron 	temp64.val32.lower = c->ErrDesc.Addr.lower;
2819edd16368SStephen M. Cameron 	temp64.val32.upper = c->ErrDesc.Addr.upper;
2820edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev, sizeof(*c->err_info),
2821edd16368SStephen M. Cameron 			    c->err_info, (dma_addr_t) temp64.val);
2822edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev, sizeof(*c),
2823d896f3f3SStephen M. Cameron 			    c, (dma_addr_t) (c->busaddr & DIRECT_LOOKUP_MASK));
2824edd16368SStephen M. Cameron }
2825edd16368SStephen M. Cameron 
2826edd16368SStephen M. Cameron #ifdef CONFIG_COMPAT
2827edd16368SStephen M. Cameron 
2828edd16368SStephen M. Cameron static int hpsa_ioctl32_passthru(struct scsi_device *dev, int cmd, void *arg)
2829edd16368SStephen M. Cameron {
2830edd16368SStephen M. Cameron 	IOCTL32_Command_struct __user *arg32 =
2831edd16368SStephen M. Cameron 	    (IOCTL32_Command_struct __user *) arg;
2832edd16368SStephen M. Cameron 	IOCTL_Command_struct arg64;
2833edd16368SStephen M. Cameron 	IOCTL_Command_struct __user *p = compat_alloc_user_space(sizeof(arg64));
2834edd16368SStephen M. Cameron 	int err;
2835edd16368SStephen M. Cameron 	u32 cp;
2836edd16368SStephen M. Cameron 
2837938abd84SVasiliy Kulikov 	memset(&arg64, 0, sizeof(arg64));
2838edd16368SStephen M. Cameron 	err = 0;
2839edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.LUN_info, &arg32->LUN_info,
2840edd16368SStephen M. Cameron 			   sizeof(arg64.LUN_info));
2841edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.Request, &arg32->Request,
2842edd16368SStephen M. Cameron 			   sizeof(arg64.Request));
2843edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.error_info, &arg32->error_info,
2844edd16368SStephen M. Cameron 			   sizeof(arg64.error_info));
2845edd16368SStephen M. Cameron 	err |= get_user(arg64.buf_size, &arg32->buf_size);
2846edd16368SStephen M. Cameron 	err |= get_user(cp, &arg32->buf);
2847edd16368SStephen M. Cameron 	arg64.buf = compat_ptr(cp);
2848edd16368SStephen M. Cameron 	err |= copy_to_user(p, &arg64, sizeof(arg64));
2849edd16368SStephen M. Cameron 
2850edd16368SStephen M. Cameron 	if (err)
2851edd16368SStephen M. Cameron 		return -EFAULT;
2852edd16368SStephen M. Cameron 
2853e39eeaedSStephen M. Cameron 	err = hpsa_ioctl(dev, CCISS_PASSTHRU, (void *)p);
2854edd16368SStephen M. Cameron 	if (err)
2855edd16368SStephen M. Cameron 		return err;
2856edd16368SStephen M. Cameron 	err |= copy_in_user(&arg32->error_info, &p->error_info,
2857edd16368SStephen M. Cameron 			 sizeof(arg32->error_info));
2858edd16368SStephen M. Cameron 	if (err)
2859edd16368SStephen M. Cameron 		return -EFAULT;
2860edd16368SStephen M. Cameron 	return err;
2861edd16368SStephen M. Cameron }
2862edd16368SStephen M. Cameron 
2863edd16368SStephen M. Cameron static int hpsa_ioctl32_big_passthru(struct scsi_device *dev,
2864edd16368SStephen M. Cameron 	int cmd, void *arg)
2865edd16368SStephen M. Cameron {
2866edd16368SStephen M. Cameron 	BIG_IOCTL32_Command_struct __user *arg32 =
2867edd16368SStephen M. Cameron 	    (BIG_IOCTL32_Command_struct __user *) arg;
2868edd16368SStephen M. Cameron 	BIG_IOCTL_Command_struct arg64;
2869edd16368SStephen M. Cameron 	BIG_IOCTL_Command_struct __user *p =
2870edd16368SStephen M. Cameron 	    compat_alloc_user_space(sizeof(arg64));
2871edd16368SStephen M. Cameron 	int err;
2872edd16368SStephen M. Cameron 	u32 cp;
2873edd16368SStephen M. Cameron 
2874938abd84SVasiliy Kulikov 	memset(&arg64, 0, sizeof(arg64));
2875edd16368SStephen M. Cameron 	err = 0;
2876edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.LUN_info, &arg32->LUN_info,
2877edd16368SStephen M. Cameron 			   sizeof(arg64.LUN_info));
2878edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.Request, &arg32->Request,
2879edd16368SStephen M. Cameron 			   sizeof(arg64.Request));
2880edd16368SStephen M. Cameron 	err |= copy_from_user(&arg64.error_info, &arg32->error_info,
2881edd16368SStephen M. Cameron 			   sizeof(arg64.error_info));
2882edd16368SStephen M. Cameron 	err |= get_user(arg64.buf_size, &arg32->buf_size);
2883edd16368SStephen M. Cameron 	err |= get_user(arg64.malloc_size, &arg32->malloc_size);
2884edd16368SStephen M. Cameron 	err |= get_user(cp, &arg32->buf);
2885edd16368SStephen M. Cameron 	arg64.buf = compat_ptr(cp);
2886edd16368SStephen M. Cameron 	err |= copy_to_user(p, &arg64, sizeof(arg64));
2887edd16368SStephen M. Cameron 
2888edd16368SStephen M. Cameron 	if (err)
2889edd16368SStephen M. Cameron 		return -EFAULT;
2890edd16368SStephen M. Cameron 
2891e39eeaedSStephen M. Cameron 	err = hpsa_ioctl(dev, CCISS_BIG_PASSTHRU, (void *)p);
2892edd16368SStephen M. Cameron 	if (err)
2893edd16368SStephen M. Cameron 		return err;
2894edd16368SStephen M. Cameron 	err |= copy_in_user(&arg32->error_info, &p->error_info,
2895edd16368SStephen M. Cameron 			 sizeof(arg32->error_info));
2896edd16368SStephen M. Cameron 	if (err)
2897edd16368SStephen M. Cameron 		return -EFAULT;
2898edd16368SStephen M. Cameron 	return err;
2899edd16368SStephen M. Cameron }
290071fe75a7SStephen M. Cameron 
290171fe75a7SStephen M. Cameron static int hpsa_compat_ioctl(struct scsi_device *dev, int cmd, void *arg)
290271fe75a7SStephen M. Cameron {
290371fe75a7SStephen M. Cameron 	switch (cmd) {
290471fe75a7SStephen M. Cameron 	case CCISS_GETPCIINFO:
290571fe75a7SStephen M. Cameron 	case CCISS_GETINTINFO:
290671fe75a7SStephen M. Cameron 	case CCISS_SETINTINFO:
290771fe75a7SStephen M. Cameron 	case CCISS_GETNODENAME:
290871fe75a7SStephen M. Cameron 	case CCISS_SETNODENAME:
290971fe75a7SStephen M. Cameron 	case CCISS_GETHEARTBEAT:
291071fe75a7SStephen M. Cameron 	case CCISS_GETBUSTYPES:
291171fe75a7SStephen M. Cameron 	case CCISS_GETFIRMVER:
291271fe75a7SStephen M. Cameron 	case CCISS_GETDRIVVER:
291371fe75a7SStephen M. Cameron 	case CCISS_REVALIDVOLS:
291471fe75a7SStephen M. Cameron 	case CCISS_DEREGDISK:
291571fe75a7SStephen M. Cameron 	case CCISS_REGNEWDISK:
291671fe75a7SStephen M. Cameron 	case CCISS_REGNEWD:
291771fe75a7SStephen M. Cameron 	case CCISS_RESCANDISK:
291871fe75a7SStephen M. Cameron 	case CCISS_GETLUNINFO:
291971fe75a7SStephen M. Cameron 		return hpsa_ioctl(dev, cmd, arg);
292071fe75a7SStephen M. Cameron 
292171fe75a7SStephen M. Cameron 	case CCISS_PASSTHRU32:
292271fe75a7SStephen M. Cameron 		return hpsa_ioctl32_passthru(dev, cmd, arg);
292371fe75a7SStephen M. Cameron 	case CCISS_BIG_PASSTHRU32:
292471fe75a7SStephen M. Cameron 		return hpsa_ioctl32_big_passthru(dev, cmd, arg);
292571fe75a7SStephen M. Cameron 
292671fe75a7SStephen M. Cameron 	default:
292771fe75a7SStephen M. Cameron 		return -ENOIOCTLCMD;
292871fe75a7SStephen M. Cameron 	}
292971fe75a7SStephen M. Cameron }
2930edd16368SStephen M. Cameron #endif
2931edd16368SStephen M. Cameron 
2932edd16368SStephen M. Cameron static int hpsa_getpciinfo_ioctl(struct ctlr_info *h, void __user *argp)
2933edd16368SStephen M. Cameron {
2934edd16368SStephen M. Cameron 	struct hpsa_pci_info pciinfo;
2935edd16368SStephen M. Cameron 
2936edd16368SStephen M. Cameron 	if (!argp)
2937edd16368SStephen M. Cameron 		return -EINVAL;
2938edd16368SStephen M. Cameron 	pciinfo.domain = pci_domain_nr(h->pdev->bus);
2939edd16368SStephen M. Cameron 	pciinfo.bus = h->pdev->bus->number;
2940edd16368SStephen M. Cameron 	pciinfo.dev_fn = h->pdev->devfn;
2941edd16368SStephen M. Cameron 	pciinfo.board_id = h->board_id;
2942edd16368SStephen M. Cameron 	if (copy_to_user(argp, &pciinfo, sizeof(pciinfo)))
2943edd16368SStephen M. Cameron 		return -EFAULT;
2944edd16368SStephen M. Cameron 	return 0;
2945edd16368SStephen M. Cameron }
2946edd16368SStephen M. Cameron 
2947edd16368SStephen M. Cameron static int hpsa_getdrivver_ioctl(struct ctlr_info *h, void __user *argp)
2948edd16368SStephen M. Cameron {
2949edd16368SStephen M. Cameron 	DriverVer_type DriverVer;
2950edd16368SStephen M. Cameron 	unsigned char vmaj, vmin, vsubmin;
2951edd16368SStephen M. Cameron 	int rc;
2952edd16368SStephen M. Cameron 
2953edd16368SStephen M. Cameron 	rc = sscanf(HPSA_DRIVER_VERSION, "%hhu.%hhu.%hhu",
2954edd16368SStephen M. Cameron 		&vmaj, &vmin, &vsubmin);
2955edd16368SStephen M. Cameron 	if (rc != 3) {
2956edd16368SStephen M. Cameron 		dev_info(&h->pdev->dev, "driver version string '%s' "
2957edd16368SStephen M. Cameron 			"unrecognized.", HPSA_DRIVER_VERSION);
2958edd16368SStephen M. Cameron 		vmaj = 0;
2959edd16368SStephen M. Cameron 		vmin = 0;
2960edd16368SStephen M. Cameron 		vsubmin = 0;
2961edd16368SStephen M. Cameron 	}
2962edd16368SStephen M. Cameron 	DriverVer = (vmaj << 16) | (vmin << 8) | vsubmin;
2963edd16368SStephen M. Cameron 	if (!argp)
2964edd16368SStephen M. Cameron 		return -EINVAL;
2965edd16368SStephen M. Cameron 	if (copy_to_user(argp, &DriverVer, sizeof(DriverVer_type)))
2966edd16368SStephen M. Cameron 		return -EFAULT;
2967edd16368SStephen M. Cameron 	return 0;
2968edd16368SStephen M. Cameron }
2969edd16368SStephen M. Cameron 
2970edd16368SStephen M. Cameron static int hpsa_passthru_ioctl(struct ctlr_info *h, void __user *argp)
2971edd16368SStephen M. Cameron {
2972edd16368SStephen M. Cameron 	IOCTL_Command_struct iocommand;
2973edd16368SStephen M. Cameron 	struct CommandList *c;
2974edd16368SStephen M. Cameron 	char *buff = NULL;
2975edd16368SStephen M. Cameron 	union u64bit temp64;
2976c1f63c8fSStephen M. Cameron 	int rc = 0;
2977edd16368SStephen M. Cameron 
2978edd16368SStephen M. Cameron 	if (!argp)
2979edd16368SStephen M. Cameron 		return -EINVAL;
2980edd16368SStephen M. Cameron 	if (!capable(CAP_SYS_RAWIO))
2981edd16368SStephen M. Cameron 		return -EPERM;
2982edd16368SStephen M. Cameron 	if (copy_from_user(&iocommand, argp, sizeof(iocommand)))
2983edd16368SStephen M. Cameron 		return -EFAULT;
2984edd16368SStephen M. Cameron 	if ((iocommand.buf_size < 1) &&
2985edd16368SStephen M. Cameron 	    (iocommand.Request.Type.Direction != XFER_NONE)) {
2986edd16368SStephen M. Cameron 		return -EINVAL;
2987edd16368SStephen M. Cameron 	}
2988edd16368SStephen M. Cameron 	if (iocommand.buf_size > 0) {
2989edd16368SStephen M. Cameron 		buff = kmalloc(iocommand.buf_size, GFP_KERNEL);
2990edd16368SStephen M. Cameron 		if (buff == NULL)
2991edd16368SStephen M. Cameron 			return -EFAULT;
2992edd16368SStephen M. Cameron 		if (iocommand.Request.Type.Direction == XFER_WRITE) {
2993edd16368SStephen M. Cameron 			/* Copy the data into the buffer we created */
2994b03a7771SStephen M. Cameron 			if (copy_from_user(buff, iocommand.buf,
2995b03a7771SStephen M. Cameron 				iocommand.buf_size)) {
2996c1f63c8fSStephen M. Cameron 				rc = -EFAULT;
2997c1f63c8fSStephen M. Cameron 				goto out_kfree;
2998edd16368SStephen M. Cameron 			}
2999b03a7771SStephen M. Cameron 		} else {
3000edd16368SStephen M. Cameron 			memset(buff, 0, iocommand.buf_size);
3001b03a7771SStephen M. Cameron 		}
3002b03a7771SStephen M. Cameron 	}
3003edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
3004edd16368SStephen M. Cameron 	if (c == NULL) {
3005c1f63c8fSStephen M. Cameron 		rc = -ENOMEM;
3006c1f63c8fSStephen M. Cameron 		goto out_kfree;
3007edd16368SStephen M. Cameron 	}
3008edd16368SStephen M. Cameron 	/* Fill in the command type */
3009edd16368SStephen M. Cameron 	c->cmd_type = CMD_IOCTL_PEND;
3010edd16368SStephen M. Cameron 	/* Fill in Command Header */
3011edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0; /* unused in simple mode */
3012edd16368SStephen M. Cameron 	if (iocommand.buf_size > 0) {	/* buffer to fill */
3013edd16368SStephen M. Cameron 		c->Header.SGList = 1;
3014edd16368SStephen M. Cameron 		c->Header.SGTotal = 1;
3015edd16368SStephen M. Cameron 	} else	{ /* no buffers to fill */
3016edd16368SStephen M. Cameron 		c->Header.SGList = 0;
3017edd16368SStephen M. Cameron 		c->Header.SGTotal = 0;
3018edd16368SStephen M. Cameron 	}
3019edd16368SStephen M. Cameron 	memcpy(&c->Header.LUN, &iocommand.LUN_info, sizeof(c->Header.LUN));
3020edd16368SStephen M. Cameron 	/* use the kernel address the cmd block for tag */
3021edd16368SStephen M. Cameron 	c->Header.Tag.lower = c->busaddr;
3022edd16368SStephen M. Cameron 
3023edd16368SStephen M. Cameron 	/* Fill in Request block */
3024edd16368SStephen M. Cameron 	memcpy(&c->Request, &iocommand.Request,
3025edd16368SStephen M. Cameron 		sizeof(c->Request));
3026edd16368SStephen M. Cameron 
3027edd16368SStephen M. Cameron 	/* Fill in the scatter gather information */
3028edd16368SStephen M. Cameron 	if (iocommand.buf_size > 0) {
3029edd16368SStephen M. Cameron 		temp64.val = pci_map_single(h->pdev, buff,
3030edd16368SStephen M. Cameron 			iocommand.buf_size, PCI_DMA_BIDIRECTIONAL);
3031bcc48ffaSStephen M. Cameron 		if (dma_mapping_error(&h->pdev->dev, temp64.val)) {
3032bcc48ffaSStephen M. Cameron 			c->SG[0].Addr.lower = 0;
3033bcc48ffaSStephen M. Cameron 			c->SG[0].Addr.upper = 0;
3034bcc48ffaSStephen M. Cameron 			c->SG[0].Len = 0;
3035bcc48ffaSStephen M. Cameron 			rc = -ENOMEM;
3036bcc48ffaSStephen M. Cameron 			goto out;
3037bcc48ffaSStephen M. Cameron 		}
3038edd16368SStephen M. Cameron 		c->SG[0].Addr.lower = temp64.val32.lower;
3039edd16368SStephen M. Cameron 		c->SG[0].Addr.upper = temp64.val32.upper;
3040edd16368SStephen M. Cameron 		c->SG[0].Len = iocommand.buf_size;
3041edd16368SStephen M. Cameron 		c->SG[0].Ext = 0; /* we are not chaining*/
3042edd16368SStephen M. Cameron 	}
3043a0c12413SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core_if_no_lockup(h, c);
3044c2dd32e0SStephen M. Cameron 	if (iocommand.buf_size > 0)
3045edd16368SStephen M. Cameron 		hpsa_pci_unmap(h->pdev, c, 1, PCI_DMA_BIDIRECTIONAL);
3046edd16368SStephen M. Cameron 	check_ioctl_unit_attention(h, c);
3047edd16368SStephen M. Cameron 
3048edd16368SStephen M. Cameron 	/* Copy the error information out */
3049edd16368SStephen M. Cameron 	memcpy(&iocommand.error_info, c->err_info,
3050edd16368SStephen M. Cameron 		sizeof(iocommand.error_info));
3051edd16368SStephen M. Cameron 	if (copy_to_user(argp, &iocommand, sizeof(iocommand))) {
3052c1f63c8fSStephen M. Cameron 		rc = -EFAULT;
3053c1f63c8fSStephen M. Cameron 		goto out;
3054edd16368SStephen M. Cameron 	}
3055b03a7771SStephen M. Cameron 	if (iocommand.Request.Type.Direction == XFER_READ &&
3056b03a7771SStephen M. Cameron 		iocommand.buf_size > 0) {
3057edd16368SStephen M. Cameron 		/* Copy the data out of the buffer we created */
3058edd16368SStephen M. Cameron 		if (copy_to_user(iocommand.buf, buff, iocommand.buf_size)) {
3059c1f63c8fSStephen M. Cameron 			rc = -EFAULT;
3060c1f63c8fSStephen M. Cameron 			goto out;
3061edd16368SStephen M. Cameron 		}
3062edd16368SStephen M. Cameron 	}
3063c1f63c8fSStephen M. Cameron out:
3064edd16368SStephen M. Cameron 	cmd_special_free(h, c);
3065c1f63c8fSStephen M. Cameron out_kfree:
3066c1f63c8fSStephen M. Cameron 	kfree(buff);
3067c1f63c8fSStephen M. Cameron 	return rc;
3068edd16368SStephen M. Cameron }
3069edd16368SStephen M. Cameron 
3070edd16368SStephen M. Cameron static int hpsa_big_passthru_ioctl(struct ctlr_info *h, void __user *argp)
3071edd16368SStephen M. Cameron {
3072edd16368SStephen M. Cameron 	BIG_IOCTL_Command_struct *ioc;
3073edd16368SStephen M. Cameron 	struct CommandList *c;
3074edd16368SStephen M. Cameron 	unsigned char **buff = NULL;
3075edd16368SStephen M. Cameron 	int *buff_size = NULL;
3076edd16368SStephen M. Cameron 	union u64bit temp64;
3077edd16368SStephen M. Cameron 	BYTE sg_used = 0;
3078edd16368SStephen M. Cameron 	int status = 0;
3079edd16368SStephen M. Cameron 	int i;
308001a02ffcSStephen M. Cameron 	u32 left;
308101a02ffcSStephen M. Cameron 	u32 sz;
3082edd16368SStephen M. Cameron 	BYTE __user *data_ptr;
3083edd16368SStephen M. Cameron 
3084edd16368SStephen M. Cameron 	if (!argp)
3085edd16368SStephen M. Cameron 		return -EINVAL;
3086edd16368SStephen M. Cameron 	if (!capable(CAP_SYS_RAWIO))
3087edd16368SStephen M. Cameron 		return -EPERM;
3088edd16368SStephen M. Cameron 	ioc = (BIG_IOCTL_Command_struct *)
3089edd16368SStephen M. Cameron 	    kmalloc(sizeof(*ioc), GFP_KERNEL);
3090edd16368SStephen M. Cameron 	if (!ioc) {
3091edd16368SStephen M. Cameron 		status = -ENOMEM;
3092edd16368SStephen M. Cameron 		goto cleanup1;
3093edd16368SStephen M. Cameron 	}
3094edd16368SStephen M. Cameron 	if (copy_from_user(ioc, argp, sizeof(*ioc))) {
3095edd16368SStephen M. Cameron 		status = -EFAULT;
3096edd16368SStephen M. Cameron 		goto cleanup1;
3097edd16368SStephen M. Cameron 	}
3098edd16368SStephen M. Cameron 	if ((ioc->buf_size < 1) &&
3099edd16368SStephen M. Cameron 	    (ioc->Request.Type.Direction != XFER_NONE)) {
3100edd16368SStephen M. Cameron 		status = -EINVAL;
3101edd16368SStephen M. Cameron 		goto cleanup1;
3102edd16368SStephen M. Cameron 	}
3103edd16368SStephen M. Cameron 	/* Check kmalloc limits  using all SGs */
3104edd16368SStephen M. Cameron 	if (ioc->malloc_size > MAX_KMALLOC_SIZE) {
3105edd16368SStephen M. Cameron 		status = -EINVAL;
3106edd16368SStephen M. Cameron 		goto cleanup1;
3107edd16368SStephen M. Cameron 	}
3108d66ae08bSStephen M. Cameron 	if (ioc->buf_size > ioc->malloc_size * SG_ENTRIES_IN_CMD) {
3109edd16368SStephen M. Cameron 		status = -EINVAL;
3110edd16368SStephen M. Cameron 		goto cleanup1;
3111edd16368SStephen M. Cameron 	}
3112d66ae08bSStephen M. Cameron 	buff = kzalloc(SG_ENTRIES_IN_CMD * sizeof(char *), GFP_KERNEL);
3113edd16368SStephen M. Cameron 	if (!buff) {
3114edd16368SStephen M. Cameron 		status = -ENOMEM;
3115edd16368SStephen M. Cameron 		goto cleanup1;
3116edd16368SStephen M. Cameron 	}
3117d66ae08bSStephen M. Cameron 	buff_size = kmalloc(SG_ENTRIES_IN_CMD * sizeof(int), GFP_KERNEL);
3118edd16368SStephen M. Cameron 	if (!buff_size) {
3119edd16368SStephen M. Cameron 		status = -ENOMEM;
3120edd16368SStephen M. Cameron 		goto cleanup1;
3121edd16368SStephen M. Cameron 	}
3122edd16368SStephen M. Cameron 	left = ioc->buf_size;
3123edd16368SStephen M. Cameron 	data_ptr = ioc->buf;
3124edd16368SStephen M. Cameron 	while (left) {
3125edd16368SStephen M. Cameron 		sz = (left > ioc->malloc_size) ? ioc->malloc_size : left;
3126edd16368SStephen M. Cameron 		buff_size[sg_used] = sz;
3127edd16368SStephen M. Cameron 		buff[sg_used] = kmalloc(sz, GFP_KERNEL);
3128edd16368SStephen M. Cameron 		if (buff[sg_used] == NULL) {
3129edd16368SStephen M. Cameron 			status = -ENOMEM;
3130edd16368SStephen M. Cameron 			goto cleanup1;
3131edd16368SStephen M. Cameron 		}
3132edd16368SStephen M. Cameron 		if (ioc->Request.Type.Direction == XFER_WRITE) {
3133edd16368SStephen M. Cameron 			if (copy_from_user(buff[sg_used], data_ptr, sz)) {
3134edd16368SStephen M. Cameron 				status = -ENOMEM;
3135edd16368SStephen M. Cameron 				goto cleanup1;
3136edd16368SStephen M. Cameron 			}
3137edd16368SStephen M. Cameron 		} else
3138edd16368SStephen M. Cameron 			memset(buff[sg_used], 0, sz);
3139edd16368SStephen M. Cameron 		left -= sz;
3140edd16368SStephen M. Cameron 		data_ptr += sz;
3141edd16368SStephen M. Cameron 		sg_used++;
3142edd16368SStephen M. Cameron 	}
3143edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
3144edd16368SStephen M. Cameron 	if (c == NULL) {
3145edd16368SStephen M. Cameron 		status = -ENOMEM;
3146edd16368SStephen M. Cameron 		goto cleanup1;
3147edd16368SStephen M. Cameron 	}
3148edd16368SStephen M. Cameron 	c->cmd_type = CMD_IOCTL_PEND;
3149edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0;
3150b03a7771SStephen M. Cameron 	c->Header.SGList = c->Header.SGTotal = sg_used;
3151edd16368SStephen M. Cameron 	memcpy(&c->Header.LUN, &ioc->LUN_info, sizeof(c->Header.LUN));
3152edd16368SStephen M. Cameron 	c->Header.Tag.lower = c->busaddr;
3153edd16368SStephen M. Cameron 	memcpy(&c->Request, &ioc->Request, sizeof(c->Request));
3154edd16368SStephen M. Cameron 	if (ioc->buf_size > 0) {
3155edd16368SStephen M. Cameron 		int i;
3156edd16368SStephen M. Cameron 		for (i = 0; i < sg_used; i++) {
3157edd16368SStephen M. Cameron 			temp64.val = pci_map_single(h->pdev, buff[i],
3158edd16368SStephen M. Cameron 				    buff_size[i], PCI_DMA_BIDIRECTIONAL);
3159bcc48ffaSStephen M. Cameron 			if (dma_mapping_error(&h->pdev->dev, temp64.val)) {
3160bcc48ffaSStephen M. Cameron 				c->SG[i].Addr.lower = 0;
3161bcc48ffaSStephen M. Cameron 				c->SG[i].Addr.upper = 0;
3162bcc48ffaSStephen M. Cameron 				c->SG[i].Len = 0;
3163bcc48ffaSStephen M. Cameron 				hpsa_pci_unmap(h->pdev, c, i,
3164bcc48ffaSStephen M. Cameron 					PCI_DMA_BIDIRECTIONAL);
3165bcc48ffaSStephen M. Cameron 				status = -ENOMEM;
3166e2d4a1f6SStephen M. Cameron 				goto cleanup0;
3167bcc48ffaSStephen M. Cameron 			}
3168edd16368SStephen M. Cameron 			c->SG[i].Addr.lower = temp64.val32.lower;
3169edd16368SStephen M. Cameron 			c->SG[i].Addr.upper = temp64.val32.upper;
3170edd16368SStephen M. Cameron 			c->SG[i].Len = buff_size[i];
3171edd16368SStephen M. Cameron 			/* we are not chaining */
3172edd16368SStephen M. Cameron 			c->SG[i].Ext = 0;
3173edd16368SStephen M. Cameron 		}
3174edd16368SStephen M. Cameron 	}
3175a0c12413SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_core_if_no_lockup(h, c);
3176b03a7771SStephen M. Cameron 	if (sg_used)
3177edd16368SStephen M. Cameron 		hpsa_pci_unmap(h->pdev, c, sg_used, PCI_DMA_BIDIRECTIONAL);
3178edd16368SStephen M. Cameron 	check_ioctl_unit_attention(h, c);
3179edd16368SStephen M. Cameron 	/* Copy the error information out */
3180edd16368SStephen M. Cameron 	memcpy(&ioc->error_info, c->err_info, sizeof(ioc->error_info));
3181edd16368SStephen M. Cameron 	if (copy_to_user(argp, ioc, sizeof(*ioc))) {
3182edd16368SStephen M. Cameron 		status = -EFAULT;
3183e2d4a1f6SStephen M. Cameron 		goto cleanup0;
3184edd16368SStephen M. Cameron 	}
3185b03a7771SStephen M. Cameron 	if (ioc->Request.Type.Direction == XFER_READ && ioc->buf_size > 0) {
3186edd16368SStephen M. Cameron 		/* Copy the data out of the buffer we created */
3187edd16368SStephen M. Cameron 		BYTE __user *ptr = ioc->buf;
3188edd16368SStephen M. Cameron 		for (i = 0; i < sg_used; i++) {
3189edd16368SStephen M. Cameron 			if (copy_to_user(ptr, buff[i], buff_size[i])) {
3190edd16368SStephen M. Cameron 				status = -EFAULT;
3191e2d4a1f6SStephen M. Cameron 				goto cleanup0;
3192edd16368SStephen M. Cameron 			}
3193edd16368SStephen M. Cameron 			ptr += buff_size[i];
3194edd16368SStephen M. Cameron 		}
3195edd16368SStephen M. Cameron 	}
3196edd16368SStephen M. Cameron 	status = 0;
3197e2d4a1f6SStephen M. Cameron cleanup0:
3198e2d4a1f6SStephen M. Cameron 	cmd_special_free(h, c);
3199edd16368SStephen M. Cameron cleanup1:
3200edd16368SStephen M. Cameron 	if (buff) {
3201edd16368SStephen M. Cameron 		for (i = 0; i < sg_used; i++)
3202edd16368SStephen M. Cameron 			kfree(buff[i]);
3203edd16368SStephen M. Cameron 		kfree(buff);
3204edd16368SStephen M. Cameron 	}
3205edd16368SStephen M. Cameron 	kfree(buff_size);
3206edd16368SStephen M. Cameron 	kfree(ioc);
3207edd16368SStephen M. Cameron 	return status;
3208edd16368SStephen M. Cameron }
3209edd16368SStephen M. Cameron 
3210edd16368SStephen M. Cameron static void check_ioctl_unit_attention(struct ctlr_info *h,
3211edd16368SStephen M. Cameron 	struct CommandList *c)
3212edd16368SStephen M. Cameron {
3213edd16368SStephen M. Cameron 	if (c->err_info->CommandStatus == CMD_TARGET_STATUS &&
3214edd16368SStephen M. Cameron 			c->err_info->ScsiStatus != SAM_STAT_CHECK_CONDITION)
3215edd16368SStephen M. Cameron 		(void) check_for_unit_attention(h, c);
3216edd16368SStephen M. Cameron }
32170390f0c0SStephen M. Cameron 
32180390f0c0SStephen M. Cameron static int increment_passthru_count(struct ctlr_info *h)
32190390f0c0SStephen M. Cameron {
32200390f0c0SStephen M. Cameron 	unsigned long flags;
32210390f0c0SStephen M. Cameron 
32220390f0c0SStephen M. Cameron 	spin_lock_irqsave(&h->passthru_count_lock, flags);
32230390f0c0SStephen M. Cameron 	if (h->passthru_count >= HPSA_MAX_CONCURRENT_PASSTHRUS) {
32240390f0c0SStephen M. Cameron 		spin_unlock_irqrestore(&h->passthru_count_lock, flags);
32250390f0c0SStephen M. Cameron 		return -1;
32260390f0c0SStephen M. Cameron 	}
32270390f0c0SStephen M. Cameron 	h->passthru_count++;
32280390f0c0SStephen M. Cameron 	spin_unlock_irqrestore(&h->passthru_count_lock, flags);
32290390f0c0SStephen M. Cameron 	return 0;
32300390f0c0SStephen M. Cameron }
32310390f0c0SStephen M. Cameron 
32320390f0c0SStephen M. Cameron static void decrement_passthru_count(struct ctlr_info *h)
32330390f0c0SStephen M. Cameron {
32340390f0c0SStephen M. Cameron 	unsigned long flags;
32350390f0c0SStephen M. Cameron 
32360390f0c0SStephen M. Cameron 	spin_lock_irqsave(&h->passthru_count_lock, flags);
32370390f0c0SStephen M. Cameron 	if (h->passthru_count <= 0) {
32380390f0c0SStephen M. Cameron 		spin_unlock_irqrestore(&h->passthru_count_lock, flags);
32390390f0c0SStephen M. Cameron 		/* not expecting to get here. */
32400390f0c0SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Bug detected, passthru_count seems to be incorrect.\n");
32410390f0c0SStephen M. Cameron 		return;
32420390f0c0SStephen M. Cameron 	}
32430390f0c0SStephen M. Cameron 	h->passthru_count--;
32440390f0c0SStephen M. Cameron 	spin_unlock_irqrestore(&h->passthru_count_lock, flags);
32450390f0c0SStephen M. Cameron }
32460390f0c0SStephen M. Cameron 
3247edd16368SStephen M. Cameron /*
3248edd16368SStephen M. Cameron  * ioctl
3249edd16368SStephen M. Cameron  */
3250edd16368SStephen M. Cameron static int hpsa_ioctl(struct scsi_device *dev, int cmd, void *arg)
3251edd16368SStephen M. Cameron {
3252edd16368SStephen M. Cameron 	struct ctlr_info *h;
3253edd16368SStephen M. Cameron 	void __user *argp = (void __user *)arg;
32540390f0c0SStephen M. Cameron 	int rc;
3255edd16368SStephen M. Cameron 
3256edd16368SStephen M. Cameron 	h = sdev_to_hba(dev);
3257edd16368SStephen M. Cameron 
3258edd16368SStephen M. Cameron 	switch (cmd) {
3259edd16368SStephen M. Cameron 	case CCISS_DEREGDISK:
3260edd16368SStephen M. Cameron 	case CCISS_REGNEWDISK:
3261edd16368SStephen M. Cameron 	case CCISS_REGNEWD:
3262a08a8471SStephen M. Cameron 		hpsa_scan_start(h->scsi_host);
3263edd16368SStephen M. Cameron 		return 0;
3264edd16368SStephen M. Cameron 	case CCISS_GETPCIINFO:
3265edd16368SStephen M. Cameron 		return hpsa_getpciinfo_ioctl(h, argp);
3266edd16368SStephen M. Cameron 	case CCISS_GETDRIVVER:
3267edd16368SStephen M. Cameron 		return hpsa_getdrivver_ioctl(h, argp);
3268edd16368SStephen M. Cameron 	case CCISS_PASSTHRU:
32690390f0c0SStephen M. Cameron 		if (increment_passthru_count(h))
32700390f0c0SStephen M. Cameron 			return -EAGAIN;
32710390f0c0SStephen M. Cameron 		rc = hpsa_passthru_ioctl(h, argp);
32720390f0c0SStephen M. Cameron 		decrement_passthru_count(h);
32730390f0c0SStephen M. Cameron 		return rc;
3274edd16368SStephen M. Cameron 	case CCISS_BIG_PASSTHRU:
32750390f0c0SStephen M. Cameron 		if (increment_passthru_count(h))
32760390f0c0SStephen M. Cameron 			return -EAGAIN;
32770390f0c0SStephen M. Cameron 		rc = hpsa_big_passthru_ioctl(h, argp);
32780390f0c0SStephen M. Cameron 		decrement_passthru_count(h);
32790390f0c0SStephen M. Cameron 		return rc;
3280edd16368SStephen M. Cameron 	default:
3281edd16368SStephen M. Cameron 		return -ENOTTY;
3282edd16368SStephen M. Cameron 	}
3283edd16368SStephen M. Cameron }
3284edd16368SStephen M. Cameron 
32856f039790SGreg Kroah-Hartman static int hpsa_send_host_reset(struct ctlr_info *h, unsigned char *scsi3addr,
32866f039790SGreg Kroah-Hartman 				u8 reset_type)
328764670ac8SStephen M. Cameron {
328864670ac8SStephen M. Cameron 	struct CommandList *c;
328964670ac8SStephen M. Cameron 
329064670ac8SStephen M. Cameron 	c = cmd_alloc(h);
329164670ac8SStephen M. Cameron 	if (!c)
329264670ac8SStephen M. Cameron 		return -ENOMEM;
3293a2dac136SStephen M. Cameron 	/* fill_cmd can't fail here, no data buffer to map */
3294a2dac136SStephen M. Cameron 	(void) fill_cmd(c, HPSA_DEVICE_RESET_MSG, h, NULL, 0, 0,
329564670ac8SStephen M. Cameron 		RAID_CTLR_LUNID, TYPE_MSG);
329664670ac8SStephen M. Cameron 	c->Request.CDB[1] = reset_type; /* fill_cmd defaults to target reset */
329764670ac8SStephen M. Cameron 	c->waiting = NULL;
329864670ac8SStephen M. Cameron 	enqueue_cmd_and_start_io(h, c);
329964670ac8SStephen M. Cameron 	/* Don't wait for completion, the reset won't complete.  Don't free
330064670ac8SStephen M. Cameron 	 * the command either.  This is the last command we will send before
330164670ac8SStephen M. Cameron 	 * re-initializing everything, so it doesn't matter and won't leak.
330264670ac8SStephen M. Cameron 	 */
330364670ac8SStephen M. Cameron 	return 0;
330464670ac8SStephen M. Cameron }
330564670ac8SStephen M. Cameron 
3306a2dac136SStephen M. Cameron static int fill_cmd(struct CommandList *c, u8 cmd, struct ctlr_info *h,
330701a02ffcSStephen M. Cameron 	void *buff, size_t size, u8 page_code, unsigned char *scsi3addr,
3308edd16368SStephen M. Cameron 	int cmd_type)
3309edd16368SStephen M. Cameron {
3310edd16368SStephen M. Cameron 	int pci_dir = XFER_NONE;
331175167d2cSStephen M. Cameron 	struct CommandList *a; /* for commands to be aborted */
3312edd16368SStephen M. Cameron 
3313edd16368SStephen M. Cameron 	c->cmd_type = CMD_IOCTL_PEND;
3314edd16368SStephen M. Cameron 	c->Header.ReplyQueue = 0;
3315edd16368SStephen M. Cameron 	if (buff != NULL && size > 0) {
3316edd16368SStephen M. Cameron 		c->Header.SGList = 1;
3317edd16368SStephen M. Cameron 		c->Header.SGTotal = 1;
3318edd16368SStephen M. Cameron 	} else {
3319edd16368SStephen M. Cameron 		c->Header.SGList = 0;
3320edd16368SStephen M. Cameron 		c->Header.SGTotal = 0;
3321edd16368SStephen M. Cameron 	}
3322edd16368SStephen M. Cameron 	c->Header.Tag.lower = c->busaddr;
3323edd16368SStephen M. Cameron 	memcpy(c->Header.LUN.LunAddrBytes, scsi3addr, 8);
3324edd16368SStephen M. Cameron 
3325edd16368SStephen M. Cameron 	c->Request.Type.Type = cmd_type;
3326edd16368SStephen M. Cameron 	if (cmd_type == TYPE_CMD) {
3327edd16368SStephen M. Cameron 		switch (cmd) {
3328edd16368SStephen M. Cameron 		case HPSA_INQUIRY:
3329edd16368SStephen M. Cameron 			/* are we trying to read a vital product page */
3330edd16368SStephen M. Cameron 			if (page_code != 0) {
3331edd16368SStephen M. Cameron 				c->Request.CDB[1] = 0x01;
3332edd16368SStephen M. Cameron 				c->Request.CDB[2] = page_code;
3333edd16368SStephen M. Cameron 			}
3334edd16368SStephen M. Cameron 			c->Request.CDBLen = 6;
3335edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
3336edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_READ;
3337edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
3338edd16368SStephen M. Cameron 			c->Request.CDB[0] = HPSA_INQUIRY;
3339edd16368SStephen M. Cameron 			c->Request.CDB[4] = size & 0xFF;
3340edd16368SStephen M. Cameron 			break;
3341edd16368SStephen M. Cameron 		case HPSA_REPORT_LOG:
3342edd16368SStephen M. Cameron 		case HPSA_REPORT_PHYS:
3343edd16368SStephen M. Cameron 			/* Talking to controller so It's a physical command
3344edd16368SStephen M. Cameron 			   mode = 00 target = 0.  Nothing to write.
3345edd16368SStephen M. Cameron 			 */
3346edd16368SStephen M. Cameron 			c->Request.CDBLen = 12;
3347edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
3348edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_READ;
3349edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
3350edd16368SStephen M. Cameron 			c->Request.CDB[0] = cmd;
3351edd16368SStephen M. Cameron 			c->Request.CDB[6] = (size >> 24) & 0xFF; /* MSB */
3352edd16368SStephen M. Cameron 			c->Request.CDB[7] = (size >> 16) & 0xFF;
3353edd16368SStephen M. Cameron 			c->Request.CDB[8] = (size >> 8) & 0xFF;
3354edd16368SStephen M. Cameron 			c->Request.CDB[9] = size & 0xFF;
3355edd16368SStephen M. Cameron 			break;
3356edd16368SStephen M. Cameron 		case HPSA_CACHE_FLUSH:
3357edd16368SStephen M. Cameron 			c->Request.CDBLen = 12;
3358edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
3359edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_WRITE;
3360edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
3361edd16368SStephen M. Cameron 			c->Request.CDB[0] = BMIC_WRITE;
3362edd16368SStephen M. Cameron 			c->Request.CDB[6] = BMIC_CACHE_FLUSH;
3363bb158eabSStephen M. Cameron 			c->Request.CDB[7] = (size >> 8) & 0xFF;
3364bb158eabSStephen M. Cameron 			c->Request.CDB[8] = size & 0xFF;
3365edd16368SStephen M. Cameron 			break;
3366edd16368SStephen M. Cameron 		case TEST_UNIT_READY:
3367edd16368SStephen M. Cameron 			c->Request.CDBLen = 6;
3368edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
3369edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_NONE;
3370edd16368SStephen M. Cameron 			c->Request.Timeout = 0;
3371edd16368SStephen M. Cameron 			break;
3372edd16368SStephen M. Cameron 		default:
3373edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "unknown command 0x%c\n", cmd);
3374edd16368SStephen M. Cameron 			BUG();
3375a2dac136SStephen M. Cameron 			return -1;
3376edd16368SStephen M. Cameron 		}
3377edd16368SStephen M. Cameron 	} else if (cmd_type == TYPE_MSG) {
3378edd16368SStephen M. Cameron 		switch (cmd) {
3379edd16368SStephen M. Cameron 
3380edd16368SStephen M. Cameron 		case  HPSA_DEVICE_RESET_MSG:
3381edd16368SStephen M. Cameron 			c->Request.CDBLen = 16;
3382edd16368SStephen M. Cameron 			c->Request.Type.Type =  1; /* It is a MSG not a CMD */
3383edd16368SStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
3384edd16368SStephen M. Cameron 			c->Request.Type.Direction = XFER_NONE;
3385edd16368SStephen M. Cameron 			c->Request.Timeout = 0; /* Don't time out */
338664670ac8SStephen M. Cameron 			memset(&c->Request.CDB[0], 0, sizeof(c->Request.CDB));
338764670ac8SStephen M. Cameron 			c->Request.CDB[0] =  cmd;
338821e89afdSStephen M. Cameron 			c->Request.CDB[1] = HPSA_RESET_TYPE_LUN;
3389edd16368SStephen M. Cameron 			/* If bytes 4-7 are zero, it means reset the */
3390edd16368SStephen M. Cameron 			/* LunID device */
3391edd16368SStephen M. Cameron 			c->Request.CDB[4] = 0x00;
3392edd16368SStephen M. Cameron 			c->Request.CDB[5] = 0x00;
3393edd16368SStephen M. Cameron 			c->Request.CDB[6] = 0x00;
3394edd16368SStephen M. Cameron 			c->Request.CDB[7] = 0x00;
3395edd16368SStephen M. Cameron 			break;
339675167d2cSStephen M. Cameron 		case  HPSA_ABORT_MSG:
339775167d2cSStephen M. Cameron 			a = buff;       /* point to command to be aborted */
339875167d2cSStephen M. Cameron 			dev_dbg(&h->pdev->dev, "Abort Tag:0x%08x:%08x using request Tag:0x%08x:%08x\n",
339975167d2cSStephen M. Cameron 				a->Header.Tag.upper, a->Header.Tag.lower,
340075167d2cSStephen M. Cameron 				c->Header.Tag.upper, c->Header.Tag.lower);
340175167d2cSStephen M. Cameron 			c->Request.CDBLen = 16;
340275167d2cSStephen M. Cameron 			c->Request.Type.Type = TYPE_MSG;
340375167d2cSStephen M. Cameron 			c->Request.Type.Attribute = ATTR_SIMPLE;
340475167d2cSStephen M. Cameron 			c->Request.Type.Direction = XFER_WRITE;
340575167d2cSStephen M. Cameron 			c->Request.Timeout = 0; /* Don't time out */
340675167d2cSStephen M. Cameron 			c->Request.CDB[0] = HPSA_TASK_MANAGEMENT;
340775167d2cSStephen M. Cameron 			c->Request.CDB[1] = HPSA_TMF_ABORT_TASK;
340875167d2cSStephen M. Cameron 			c->Request.CDB[2] = 0x00; /* reserved */
340975167d2cSStephen M. Cameron 			c->Request.CDB[3] = 0x00; /* reserved */
341075167d2cSStephen M. Cameron 			/* Tag to abort goes in CDB[4]-CDB[11] */
341175167d2cSStephen M. Cameron 			c->Request.CDB[4] = a->Header.Tag.lower & 0xFF;
341275167d2cSStephen M. Cameron 			c->Request.CDB[5] = (a->Header.Tag.lower >> 8) & 0xFF;
341375167d2cSStephen M. Cameron 			c->Request.CDB[6] = (a->Header.Tag.lower >> 16) & 0xFF;
341475167d2cSStephen M. Cameron 			c->Request.CDB[7] = (a->Header.Tag.lower >> 24) & 0xFF;
341575167d2cSStephen M. Cameron 			c->Request.CDB[8] = a->Header.Tag.upper & 0xFF;
341675167d2cSStephen M. Cameron 			c->Request.CDB[9] = (a->Header.Tag.upper >> 8) & 0xFF;
341775167d2cSStephen M. Cameron 			c->Request.CDB[10] = (a->Header.Tag.upper >> 16) & 0xFF;
341875167d2cSStephen M. Cameron 			c->Request.CDB[11] = (a->Header.Tag.upper >> 24) & 0xFF;
341975167d2cSStephen M. Cameron 			c->Request.CDB[12] = 0x00; /* reserved */
342075167d2cSStephen M. Cameron 			c->Request.CDB[13] = 0x00; /* reserved */
342175167d2cSStephen M. Cameron 			c->Request.CDB[14] = 0x00; /* reserved */
342275167d2cSStephen M. Cameron 			c->Request.CDB[15] = 0x00; /* reserved */
342375167d2cSStephen M. Cameron 		break;
3424edd16368SStephen M. Cameron 		default:
3425edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "unknown message type %d\n",
3426edd16368SStephen M. Cameron 				cmd);
3427edd16368SStephen M. Cameron 			BUG();
3428edd16368SStephen M. Cameron 		}
3429edd16368SStephen M. Cameron 	} else {
3430edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "unknown command type %d\n", cmd_type);
3431edd16368SStephen M. Cameron 		BUG();
3432edd16368SStephen M. Cameron 	}
3433edd16368SStephen M. Cameron 
3434edd16368SStephen M. Cameron 	switch (c->Request.Type.Direction) {
3435edd16368SStephen M. Cameron 	case XFER_READ:
3436edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_FROMDEVICE;
3437edd16368SStephen M. Cameron 		break;
3438edd16368SStephen M. Cameron 	case XFER_WRITE:
3439edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_TODEVICE;
3440edd16368SStephen M. Cameron 		break;
3441edd16368SStephen M. Cameron 	case XFER_NONE:
3442edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_NONE;
3443edd16368SStephen M. Cameron 		break;
3444edd16368SStephen M. Cameron 	default:
3445edd16368SStephen M. Cameron 		pci_dir = PCI_DMA_BIDIRECTIONAL;
3446edd16368SStephen M. Cameron 	}
3447a2dac136SStephen M. Cameron 	if (hpsa_map_one(h->pdev, c, buff, size, pci_dir))
3448a2dac136SStephen M. Cameron 		return -1;
3449a2dac136SStephen M. Cameron 	return 0;
3450edd16368SStephen M. Cameron }
3451edd16368SStephen M. Cameron 
3452edd16368SStephen M. Cameron /*
3453edd16368SStephen M. Cameron  * Map (physical) PCI mem into (virtual) kernel space
3454edd16368SStephen M. Cameron  */
3455edd16368SStephen M. Cameron static void __iomem *remap_pci_mem(ulong base, ulong size)
3456edd16368SStephen M. Cameron {
3457edd16368SStephen M. Cameron 	ulong page_base = ((ulong) base) & PAGE_MASK;
3458edd16368SStephen M. Cameron 	ulong page_offs = ((ulong) base) - page_base;
3459088ba34cSStephen M. Cameron 	void __iomem *page_remapped = ioremap_nocache(page_base,
3460088ba34cSStephen M. Cameron 		page_offs + size);
3461edd16368SStephen M. Cameron 
3462edd16368SStephen M. Cameron 	return page_remapped ? (page_remapped + page_offs) : NULL;
3463edd16368SStephen M. Cameron }
3464edd16368SStephen M. Cameron 
3465edd16368SStephen M. Cameron /* Takes cmds off the submission queue and sends them to the hardware,
3466edd16368SStephen M. Cameron  * then puts them on the queue of cmds waiting for completion.
3467edd16368SStephen M. Cameron  */
3468edd16368SStephen M. Cameron static void start_io(struct ctlr_info *h)
3469edd16368SStephen M. Cameron {
3470edd16368SStephen M. Cameron 	struct CommandList *c;
3471e16a33adSMatt Gates 	unsigned long flags;
3472edd16368SStephen M. Cameron 
3473e16a33adSMatt Gates 	spin_lock_irqsave(&h->lock, flags);
34749e0fc764SStephen M. Cameron 	while (!list_empty(&h->reqQ)) {
34759e0fc764SStephen M. Cameron 		c = list_entry(h->reqQ.next, struct CommandList, list);
3476edd16368SStephen M. Cameron 		/* can't do anything if fifo is full */
3477edd16368SStephen M. Cameron 		if ((h->access.fifo_full(h))) {
3478396883e2SStephen M. Cameron 			h->fifo_recently_full = 1;
3479edd16368SStephen M. Cameron 			dev_warn(&h->pdev->dev, "fifo full\n");
3480edd16368SStephen M. Cameron 			break;
3481edd16368SStephen M. Cameron 		}
3482396883e2SStephen M. Cameron 		h->fifo_recently_full = 0;
3483edd16368SStephen M. Cameron 
3484edd16368SStephen M. Cameron 		/* Get the first entry from the Request Q */
3485edd16368SStephen M. Cameron 		removeQ(c);
3486edd16368SStephen M. Cameron 		h->Qdepth--;
3487edd16368SStephen M. Cameron 
3488edd16368SStephen M. Cameron 		/* Put job onto the completed Q */
3489edd16368SStephen M. Cameron 		addQ(&h->cmpQ, c);
3490e16a33adSMatt Gates 
3491e16a33adSMatt Gates 		/* Must increment commands_outstanding before unlocking
3492e16a33adSMatt Gates 		 * and submitting to avoid race checking for fifo full
3493e16a33adSMatt Gates 		 * condition.
3494e16a33adSMatt Gates 		 */
3495e16a33adSMatt Gates 		h->commands_outstanding++;
3496e16a33adSMatt Gates 		if (h->commands_outstanding > h->max_outstanding)
3497e16a33adSMatt Gates 			h->max_outstanding = h->commands_outstanding;
3498e16a33adSMatt Gates 
3499e16a33adSMatt Gates 		/* Tell the controller execute command */
3500e16a33adSMatt Gates 		spin_unlock_irqrestore(&h->lock, flags);
3501e16a33adSMatt Gates 		h->access.submit_command(h, c);
3502e16a33adSMatt Gates 		spin_lock_irqsave(&h->lock, flags);
3503edd16368SStephen M. Cameron 	}
3504e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
3505edd16368SStephen M. Cameron }
3506edd16368SStephen M. Cameron 
3507254f796bSMatt Gates static inline unsigned long get_next_completion(struct ctlr_info *h, u8 q)
3508edd16368SStephen M. Cameron {
3509254f796bSMatt Gates 	return h->access.command_completed(h, q);
3510edd16368SStephen M. Cameron }
3511edd16368SStephen M. Cameron 
3512900c5440SStephen M. Cameron static inline bool interrupt_pending(struct ctlr_info *h)
3513edd16368SStephen M. Cameron {
3514edd16368SStephen M. Cameron 	return h->access.intr_pending(h);
3515edd16368SStephen M. Cameron }
3516edd16368SStephen M. Cameron 
3517edd16368SStephen M. Cameron static inline long interrupt_not_for_us(struct ctlr_info *h)
3518edd16368SStephen M. Cameron {
351910f66018SStephen M. Cameron 	return (h->access.intr_pending(h) == 0) ||
352010f66018SStephen M. Cameron 		(h->interrupts_enabled == 0);
3521edd16368SStephen M. Cameron }
3522edd16368SStephen M. Cameron 
352301a02ffcSStephen M. Cameron static inline int bad_tag(struct ctlr_info *h, u32 tag_index,
352401a02ffcSStephen M. Cameron 	u32 raw_tag)
3525edd16368SStephen M. Cameron {
3526edd16368SStephen M. Cameron 	if (unlikely(tag_index >= h->nr_cmds)) {
3527edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "bad tag 0x%08x ignored.\n", raw_tag);
3528edd16368SStephen M. Cameron 		return 1;
3529edd16368SStephen M. Cameron 	}
3530edd16368SStephen M. Cameron 	return 0;
3531edd16368SStephen M. Cameron }
3532edd16368SStephen M. Cameron 
35335a3d16f5SStephen M. Cameron static inline void finish_cmd(struct CommandList *c)
3534edd16368SStephen M. Cameron {
3535e16a33adSMatt Gates 	unsigned long flags;
3536396883e2SStephen M. Cameron 	int io_may_be_stalled = 0;
3537396883e2SStephen M. Cameron 	struct ctlr_info *h = c->h;
3538e16a33adSMatt Gates 
3539396883e2SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
3540edd16368SStephen M. Cameron 	removeQ(c);
3541396883e2SStephen M. Cameron 
3542396883e2SStephen M. Cameron 	/*
3543396883e2SStephen M. Cameron 	 * Check for possibly stalled i/o.
3544396883e2SStephen M. Cameron 	 *
3545396883e2SStephen M. Cameron 	 * If a fifo_full condition is encountered, requests will back up
3546396883e2SStephen M. Cameron 	 * in h->reqQ.  This queue is only emptied out by start_io which is
3547396883e2SStephen M. Cameron 	 * only called when a new i/o request comes in.  If no i/o's are
3548396883e2SStephen M. Cameron 	 * forthcoming, the i/o's in h->reqQ can get stuck.  So we call
3549396883e2SStephen M. Cameron 	 * start_io from here if we detect such a danger.
3550396883e2SStephen M. Cameron 	 *
3551396883e2SStephen M. Cameron 	 * Normally, we shouldn't hit this case, but pounding on the
3552396883e2SStephen M. Cameron 	 * CCISS_PASSTHRU ioctl can provoke it.  Only call start_io if
3553396883e2SStephen M. Cameron 	 * commands_outstanding is low.  We want to avoid calling
3554396883e2SStephen M. Cameron 	 * start_io from in here as much as possible, and esp. don't
3555396883e2SStephen M. Cameron 	 * want to get in a cycle where we call start_io every time
3556396883e2SStephen M. Cameron 	 * through here.
3557396883e2SStephen M. Cameron 	 */
3558396883e2SStephen M. Cameron 	if (unlikely(h->fifo_recently_full) &&
3559396883e2SStephen M. Cameron 		h->commands_outstanding < 5)
3560396883e2SStephen M. Cameron 		io_may_be_stalled = 1;
3561396883e2SStephen M. Cameron 
3562396883e2SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
3563396883e2SStephen M. Cameron 
3564e85c5974SStephen M. Cameron 	dial_up_lockup_detection_on_fw_flash_complete(c->h, c);
3565edd16368SStephen M. Cameron 	if (likely(c->cmd_type == CMD_SCSI))
35661fb011fbSStephen M. Cameron 		complete_scsi_command(c);
3567edd16368SStephen M. Cameron 	else if (c->cmd_type == CMD_IOCTL_PEND)
3568edd16368SStephen M. Cameron 		complete(c->waiting);
3569396883e2SStephen M. Cameron 	if (unlikely(io_may_be_stalled))
3570396883e2SStephen M. Cameron 		start_io(h);
3571edd16368SStephen M. Cameron }
3572edd16368SStephen M. Cameron 
3573a104c99fSStephen M. Cameron static inline u32 hpsa_tag_contains_index(u32 tag)
3574a104c99fSStephen M. Cameron {
3575a104c99fSStephen M. Cameron 	return tag & DIRECT_LOOKUP_BIT;
3576a104c99fSStephen M. Cameron }
3577a104c99fSStephen M. Cameron 
3578a104c99fSStephen M. Cameron static inline u32 hpsa_tag_to_index(u32 tag)
3579a104c99fSStephen M. Cameron {
3580a104c99fSStephen M. Cameron 	return tag >> DIRECT_LOOKUP_SHIFT;
3581a104c99fSStephen M. Cameron }
3582a104c99fSStephen M. Cameron 
3583a9a3a273SStephen M. Cameron 
3584a9a3a273SStephen M. Cameron static inline u32 hpsa_tag_discard_error_bits(struct ctlr_info *h, u32 tag)
3585a104c99fSStephen M. Cameron {
3586a9a3a273SStephen M. Cameron #define HPSA_PERF_ERROR_BITS ((1 << DIRECT_LOOKUP_SHIFT) - 1)
3587a9a3a273SStephen M. Cameron #define HPSA_SIMPLE_ERROR_BITS 0x03
3588960a30e7SStephen M. Cameron 	if (unlikely(!(h->transMethod & CFGTBL_Trans_Performant)))
3589a9a3a273SStephen M. Cameron 		return tag & ~HPSA_SIMPLE_ERROR_BITS;
3590a9a3a273SStephen M. Cameron 	return tag & ~HPSA_PERF_ERROR_BITS;
3591a104c99fSStephen M. Cameron }
3592a104c99fSStephen M. Cameron 
3593303932fdSDon Brace /* process completion of an indexed ("direct lookup") command */
35941d94f94dSStephen M. Cameron static inline void process_indexed_cmd(struct ctlr_info *h,
3595303932fdSDon Brace 	u32 raw_tag)
3596303932fdSDon Brace {
3597303932fdSDon Brace 	u32 tag_index;
3598303932fdSDon Brace 	struct CommandList *c;
3599303932fdSDon Brace 
3600303932fdSDon Brace 	tag_index = hpsa_tag_to_index(raw_tag);
36011d94f94dSStephen M. Cameron 	if (!bad_tag(h, tag_index, raw_tag)) {
3602303932fdSDon Brace 		c = h->cmd_pool + tag_index;
36035a3d16f5SStephen M. Cameron 		finish_cmd(c);
36041d94f94dSStephen M. Cameron 	}
3605303932fdSDon Brace }
3606303932fdSDon Brace 
3607303932fdSDon Brace /* process completion of a non-indexed command */
36081d94f94dSStephen M. Cameron static inline void process_nonindexed_cmd(struct ctlr_info *h,
3609303932fdSDon Brace 	u32 raw_tag)
3610303932fdSDon Brace {
3611303932fdSDon Brace 	u32 tag;
3612303932fdSDon Brace 	struct CommandList *c = NULL;
3613e16a33adSMatt Gates 	unsigned long flags;
3614303932fdSDon Brace 
3615a9a3a273SStephen M. Cameron 	tag = hpsa_tag_discard_error_bits(h, raw_tag);
3616e16a33adSMatt Gates 	spin_lock_irqsave(&h->lock, flags);
36179e0fc764SStephen M. Cameron 	list_for_each_entry(c, &h->cmpQ, list) {
3618303932fdSDon Brace 		if ((c->busaddr & 0xFFFFFFE0) == (tag & 0xFFFFFFE0)) {
3619e16a33adSMatt Gates 			spin_unlock_irqrestore(&h->lock, flags);
36205a3d16f5SStephen M. Cameron 			finish_cmd(c);
36211d94f94dSStephen M. Cameron 			return;
3622303932fdSDon Brace 		}
3623303932fdSDon Brace 	}
3624e16a33adSMatt Gates 	spin_unlock_irqrestore(&h->lock, flags);
3625303932fdSDon Brace 	bad_tag(h, h->nr_cmds + 1, raw_tag);
3626303932fdSDon Brace }
3627303932fdSDon Brace 
362864670ac8SStephen M. Cameron /* Some controllers, like p400, will give us one interrupt
362964670ac8SStephen M. Cameron  * after a soft reset, even if we turned interrupts off.
363064670ac8SStephen M. Cameron  * Only need to check for this in the hpsa_xxx_discard_completions
363164670ac8SStephen M. Cameron  * functions.
363264670ac8SStephen M. Cameron  */
363364670ac8SStephen M. Cameron static int ignore_bogus_interrupt(struct ctlr_info *h)
363464670ac8SStephen M. Cameron {
363564670ac8SStephen M. Cameron 	if (likely(!reset_devices))
363664670ac8SStephen M. Cameron 		return 0;
363764670ac8SStephen M. Cameron 
363864670ac8SStephen M. Cameron 	if (likely(h->interrupts_enabled))
363964670ac8SStephen M. Cameron 		return 0;
364064670ac8SStephen M. Cameron 
364164670ac8SStephen M. Cameron 	dev_info(&h->pdev->dev, "Received interrupt while interrupts disabled "
364264670ac8SStephen M. Cameron 		"(known firmware bug.)  Ignoring.\n");
364364670ac8SStephen M. Cameron 
364464670ac8SStephen M. Cameron 	return 1;
364564670ac8SStephen M. Cameron }
364664670ac8SStephen M. Cameron 
3647254f796bSMatt Gates /*
3648254f796bSMatt Gates  * Convert &h->q[x] (passed to interrupt handlers) back to h.
3649254f796bSMatt Gates  * Relies on (h-q[x] == x) being true for x such that
3650254f796bSMatt Gates  * 0 <= x < MAX_REPLY_QUEUES.
3651254f796bSMatt Gates  */
3652254f796bSMatt Gates static struct ctlr_info *queue_to_hba(u8 *queue)
365364670ac8SStephen M. Cameron {
3654254f796bSMatt Gates 	return container_of((queue - *queue), struct ctlr_info, q[0]);
3655254f796bSMatt Gates }
3656254f796bSMatt Gates 
3657254f796bSMatt Gates static irqreturn_t hpsa_intx_discard_completions(int irq, void *queue)
3658254f796bSMatt Gates {
3659254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba(queue);
3660254f796bSMatt Gates 	u8 q = *(u8 *) queue;
366164670ac8SStephen M. Cameron 	u32 raw_tag;
366264670ac8SStephen M. Cameron 
366364670ac8SStephen M. Cameron 	if (ignore_bogus_interrupt(h))
366464670ac8SStephen M. Cameron 		return IRQ_NONE;
366564670ac8SStephen M. Cameron 
366664670ac8SStephen M. Cameron 	if (interrupt_not_for_us(h))
366764670ac8SStephen M. Cameron 		return IRQ_NONE;
3668a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
366964670ac8SStephen M. Cameron 	while (interrupt_pending(h)) {
3670254f796bSMatt Gates 		raw_tag = get_next_completion(h, q);
367164670ac8SStephen M. Cameron 		while (raw_tag != FIFO_EMPTY)
3672254f796bSMatt Gates 			raw_tag = next_command(h, q);
367364670ac8SStephen M. Cameron 	}
367464670ac8SStephen M. Cameron 	return IRQ_HANDLED;
367564670ac8SStephen M. Cameron }
367664670ac8SStephen M. Cameron 
3677254f796bSMatt Gates static irqreturn_t hpsa_msix_discard_completions(int irq, void *queue)
367864670ac8SStephen M. Cameron {
3679254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba(queue);
368064670ac8SStephen M. Cameron 	u32 raw_tag;
3681254f796bSMatt Gates 	u8 q = *(u8 *) queue;
368264670ac8SStephen M. Cameron 
368364670ac8SStephen M. Cameron 	if (ignore_bogus_interrupt(h))
368464670ac8SStephen M. Cameron 		return IRQ_NONE;
368564670ac8SStephen M. Cameron 
3686a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
3687254f796bSMatt Gates 	raw_tag = get_next_completion(h, q);
368864670ac8SStephen M. Cameron 	while (raw_tag != FIFO_EMPTY)
3689254f796bSMatt Gates 		raw_tag = next_command(h, q);
369064670ac8SStephen M. Cameron 	return IRQ_HANDLED;
369164670ac8SStephen M. Cameron }
369264670ac8SStephen M. Cameron 
3693254f796bSMatt Gates static irqreturn_t do_hpsa_intr_intx(int irq, void *queue)
3694edd16368SStephen M. Cameron {
3695254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba((u8 *) queue);
3696303932fdSDon Brace 	u32 raw_tag;
3697254f796bSMatt Gates 	u8 q = *(u8 *) queue;
3698edd16368SStephen M. Cameron 
3699edd16368SStephen M. Cameron 	if (interrupt_not_for_us(h))
3700edd16368SStephen M. Cameron 		return IRQ_NONE;
3701a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
370210f66018SStephen M. Cameron 	while (interrupt_pending(h)) {
3703254f796bSMatt Gates 		raw_tag = get_next_completion(h, q);
370410f66018SStephen M. Cameron 		while (raw_tag != FIFO_EMPTY) {
37051d94f94dSStephen M. Cameron 			if (likely(hpsa_tag_contains_index(raw_tag)))
37061d94f94dSStephen M. Cameron 				process_indexed_cmd(h, raw_tag);
370710f66018SStephen M. Cameron 			else
37081d94f94dSStephen M. Cameron 				process_nonindexed_cmd(h, raw_tag);
3709254f796bSMatt Gates 			raw_tag = next_command(h, q);
371010f66018SStephen M. Cameron 		}
371110f66018SStephen M. Cameron 	}
371210f66018SStephen M. Cameron 	return IRQ_HANDLED;
371310f66018SStephen M. Cameron }
371410f66018SStephen M. Cameron 
3715254f796bSMatt Gates static irqreturn_t do_hpsa_intr_msi(int irq, void *queue)
371610f66018SStephen M. Cameron {
3717254f796bSMatt Gates 	struct ctlr_info *h = queue_to_hba(queue);
371810f66018SStephen M. Cameron 	u32 raw_tag;
3719254f796bSMatt Gates 	u8 q = *(u8 *) queue;
372010f66018SStephen M. Cameron 
3721a0c12413SStephen M. Cameron 	h->last_intr_timestamp = get_jiffies_64();
3722254f796bSMatt Gates 	raw_tag = get_next_completion(h, q);
3723303932fdSDon Brace 	while (raw_tag != FIFO_EMPTY) {
37241d94f94dSStephen M. Cameron 		if (likely(hpsa_tag_contains_index(raw_tag)))
37251d94f94dSStephen M. Cameron 			process_indexed_cmd(h, raw_tag);
3726303932fdSDon Brace 		else
37271d94f94dSStephen M. Cameron 			process_nonindexed_cmd(h, raw_tag);
3728254f796bSMatt Gates 		raw_tag = next_command(h, q);
3729edd16368SStephen M. Cameron 	}
3730edd16368SStephen M. Cameron 	return IRQ_HANDLED;
3731edd16368SStephen M. Cameron }
3732edd16368SStephen M. Cameron 
3733a9a3a273SStephen M. Cameron /* Send a message CDB to the firmware. Careful, this only works
3734a9a3a273SStephen M. Cameron  * in simple mode, not performant mode due to the tag lookup.
3735a9a3a273SStephen M. Cameron  * We only ever use this immediately after a controller reset.
3736a9a3a273SStephen M. Cameron  */
37376f039790SGreg Kroah-Hartman static int hpsa_message(struct pci_dev *pdev, unsigned char opcode,
3738edd16368SStephen M. Cameron 			unsigned char type)
3739edd16368SStephen M. Cameron {
3740edd16368SStephen M. Cameron 	struct Command {
3741edd16368SStephen M. Cameron 		struct CommandListHeader CommandHeader;
3742edd16368SStephen M. Cameron 		struct RequestBlock Request;
3743edd16368SStephen M. Cameron 		struct ErrDescriptor ErrorDescriptor;
3744edd16368SStephen M. Cameron 	};
3745edd16368SStephen M. Cameron 	struct Command *cmd;
3746edd16368SStephen M. Cameron 	static const size_t cmd_sz = sizeof(*cmd) +
3747edd16368SStephen M. Cameron 					sizeof(cmd->ErrorDescriptor);
3748edd16368SStephen M. Cameron 	dma_addr_t paddr64;
3749edd16368SStephen M. Cameron 	uint32_t paddr32, tag;
3750edd16368SStephen M. Cameron 	void __iomem *vaddr;
3751edd16368SStephen M. Cameron 	int i, err;
3752edd16368SStephen M. Cameron 
3753edd16368SStephen M. Cameron 	vaddr = pci_ioremap_bar(pdev, 0);
3754edd16368SStephen M. Cameron 	if (vaddr == NULL)
3755edd16368SStephen M. Cameron 		return -ENOMEM;
3756edd16368SStephen M. Cameron 
3757edd16368SStephen M. Cameron 	/* The Inbound Post Queue only accepts 32-bit physical addresses for the
3758edd16368SStephen M. Cameron 	 * CCISS commands, so they must be allocated from the lower 4GiB of
3759edd16368SStephen M. Cameron 	 * memory.
3760edd16368SStephen M. Cameron 	 */
3761edd16368SStephen M. Cameron 	err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
3762edd16368SStephen M. Cameron 	if (err) {
3763edd16368SStephen M. Cameron 		iounmap(vaddr);
3764edd16368SStephen M. Cameron 		return -ENOMEM;
3765edd16368SStephen M. Cameron 	}
3766edd16368SStephen M. Cameron 
3767edd16368SStephen M. Cameron 	cmd = pci_alloc_consistent(pdev, cmd_sz, &paddr64);
3768edd16368SStephen M. Cameron 	if (cmd == NULL) {
3769edd16368SStephen M. Cameron 		iounmap(vaddr);
3770edd16368SStephen M. Cameron 		return -ENOMEM;
3771edd16368SStephen M. Cameron 	}
3772edd16368SStephen M. Cameron 
3773edd16368SStephen M. Cameron 	/* This must fit, because of the 32-bit consistent DMA mask.  Also,
3774edd16368SStephen M. Cameron 	 * although there's no guarantee, we assume that the address is at
3775edd16368SStephen M. Cameron 	 * least 4-byte aligned (most likely, it's page-aligned).
3776edd16368SStephen M. Cameron 	 */
3777edd16368SStephen M. Cameron 	paddr32 = paddr64;
3778edd16368SStephen M. Cameron 
3779edd16368SStephen M. Cameron 	cmd->CommandHeader.ReplyQueue = 0;
3780edd16368SStephen M. Cameron 	cmd->CommandHeader.SGList = 0;
3781edd16368SStephen M. Cameron 	cmd->CommandHeader.SGTotal = 0;
3782edd16368SStephen M. Cameron 	cmd->CommandHeader.Tag.lower = paddr32;
3783edd16368SStephen M. Cameron 	cmd->CommandHeader.Tag.upper = 0;
3784edd16368SStephen M. Cameron 	memset(&cmd->CommandHeader.LUN.LunAddrBytes, 0, 8);
3785edd16368SStephen M. Cameron 
3786edd16368SStephen M. Cameron 	cmd->Request.CDBLen = 16;
3787edd16368SStephen M. Cameron 	cmd->Request.Type.Type = TYPE_MSG;
3788edd16368SStephen M. Cameron 	cmd->Request.Type.Attribute = ATTR_HEADOFQUEUE;
3789edd16368SStephen M. Cameron 	cmd->Request.Type.Direction = XFER_NONE;
3790edd16368SStephen M. Cameron 	cmd->Request.Timeout = 0; /* Don't time out */
3791edd16368SStephen M. Cameron 	cmd->Request.CDB[0] = opcode;
3792edd16368SStephen M. Cameron 	cmd->Request.CDB[1] = type;
3793edd16368SStephen M. Cameron 	memset(&cmd->Request.CDB[2], 0, 14); /* rest of the CDB is reserved */
3794edd16368SStephen M. Cameron 	cmd->ErrorDescriptor.Addr.lower = paddr32 + sizeof(*cmd);
3795edd16368SStephen M. Cameron 	cmd->ErrorDescriptor.Addr.upper = 0;
3796edd16368SStephen M. Cameron 	cmd->ErrorDescriptor.Len = sizeof(struct ErrorInfo);
3797edd16368SStephen M. Cameron 
3798edd16368SStephen M. Cameron 	writel(paddr32, vaddr + SA5_REQUEST_PORT_OFFSET);
3799edd16368SStephen M. Cameron 
3800edd16368SStephen M. Cameron 	for (i = 0; i < HPSA_MSG_SEND_RETRY_LIMIT; i++) {
3801edd16368SStephen M. Cameron 		tag = readl(vaddr + SA5_REPLY_PORT_OFFSET);
3802a9a3a273SStephen M. Cameron 		if ((tag & ~HPSA_SIMPLE_ERROR_BITS) == paddr32)
3803edd16368SStephen M. Cameron 			break;
3804edd16368SStephen M. Cameron 		msleep(HPSA_MSG_SEND_RETRY_INTERVAL_MSECS);
3805edd16368SStephen M. Cameron 	}
3806edd16368SStephen M. Cameron 
3807edd16368SStephen M. Cameron 	iounmap(vaddr);
3808edd16368SStephen M. Cameron 
3809edd16368SStephen M. Cameron 	/* we leak the DMA buffer here ... no choice since the controller could
3810edd16368SStephen M. Cameron 	 *  still complete the command.
3811edd16368SStephen M. Cameron 	 */
3812edd16368SStephen M. Cameron 	if (i == HPSA_MSG_SEND_RETRY_LIMIT) {
3813edd16368SStephen M. Cameron 		dev_err(&pdev->dev, "controller message %02x:%02x timed out\n",
3814edd16368SStephen M. Cameron 			opcode, type);
3815edd16368SStephen M. Cameron 		return -ETIMEDOUT;
3816edd16368SStephen M. Cameron 	}
3817edd16368SStephen M. Cameron 
3818edd16368SStephen M. Cameron 	pci_free_consistent(pdev, cmd_sz, cmd, paddr64);
3819edd16368SStephen M. Cameron 
3820edd16368SStephen M. Cameron 	if (tag & HPSA_ERROR_BIT) {
3821edd16368SStephen M. Cameron 		dev_err(&pdev->dev, "controller message %02x:%02x failed\n",
3822edd16368SStephen M. Cameron 			opcode, type);
3823edd16368SStephen M. Cameron 		return -EIO;
3824edd16368SStephen M. Cameron 	}
3825edd16368SStephen M. Cameron 
3826edd16368SStephen M. Cameron 	dev_info(&pdev->dev, "controller message %02x:%02x succeeded\n",
3827edd16368SStephen M. Cameron 		opcode, type);
3828edd16368SStephen M. Cameron 	return 0;
3829edd16368SStephen M. Cameron }
3830edd16368SStephen M. Cameron 
3831edd16368SStephen M. Cameron #define hpsa_noop(p) hpsa_message(p, 3, 0)
3832edd16368SStephen M. Cameron 
38331df8552aSStephen M. Cameron static int hpsa_controller_hard_reset(struct pci_dev *pdev,
3834cf0b08d0SStephen M. Cameron 	void * __iomem vaddr, u32 use_doorbell)
3835edd16368SStephen M. Cameron {
38361df8552aSStephen M. Cameron 	u16 pmcsr;
38371df8552aSStephen M. Cameron 	int pos;
3838edd16368SStephen M. Cameron 
38391df8552aSStephen M. Cameron 	if (use_doorbell) {
38401df8552aSStephen M. Cameron 		/* For everything after the P600, the PCI power state method
38411df8552aSStephen M. Cameron 		 * of resetting the controller doesn't work, so we have this
38421df8552aSStephen M. Cameron 		 * other way using the doorbell register.
3843edd16368SStephen M. Cameron 		 */
38441df8552aSStephen M. Cameron 		dev_info(&pdev->dev, "using doorbell to reset controller\n");
3845cf0b08d0SStephen M. Cameron 		writel(use_doorbell, vaddr + SA5_DOORBELL);
384685009239SStephen M. Cameron 
384785009239SStephen M. Cameron 		/* PMC hardware guys tell us we need a 5 second delay after
384885009239SStephen M. Cameron 		 * doorbell reset and before any attempt to talk to the board
384985009239SStephen M. Cameron 		 * at all to ensure that this actually works and doesn't fall
385085009239SStephen M. Cameron 		 * over in some weird corner cases.
385185009239SStephen M. Cameron 		 */
385285009239SStephen M. Cameron 		msleep(5000);
38531df8552aSStephen M. Cameron 	} else { /* Try to do it the PCI power state way */
3854edd16368SStephen M. Cameron 
3855edd16368SStephen M. Cameron 		/* Quoting from the Open CISS Specification: "The Power
3856edd16368SStephen M. Cameron 		 * Management Control/Status Register (CSR) controls the power
3857edd16368SStephen M. Cameron 		 * state of the device.  The normal operating state is D0,
3858edd16368SStephen M. Cameron 		 * CSR=00h.  The software off state is D3, CSR=03h.  To reset
38591df8552aSStephen M. Cameron 		 * the controller, place the interface device in D3 then to D0,
38601df8552aSStephen M. Cameron 		 * this causes a secondary PCI reset which will reset the
38611df8552aSStephen M. Cameron 		 * controller." */
3862edd16368SStephen M. Cameron 
38631df8552aSStephen M. Cameron 		pos = pci_find_capability(pdev, PCI_CAP_ID_PM);
38641df8552aSStephen M. Cameron 		if (pos == 0) {
38651df8552aSStephen M. Cameron 			dev_err(&pdev->dev,
38661df8552aSStephen M. Cameron 				"hpsa_reset_controller: "
38671df8552aSStephen M. Cameron 				"PCI PM not supported\n");
38681df8552aSStephen M. Cameron 			return -ENODEV;
38691df8552aSStephen M. Cameron 		}
38701df8552aSStephen M. Cameron 		dev_info(&pdev->dev, "using PCI PM to reset controller\n");
3871edd16368SStephen M. Cameron 		/* enter the D3hot power management state */
3872edd16368SStephen M. Cameron 		pci_read_config_word(pdev, pos + PCI_PM_CTRL, &pmcsr);
3873edd16368SStephen M. Cameron 		pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
3874edd16368SStephen M. Cameron 		pmcsr |= PCI_D3hot;
3875edd16368SStephen M. Cameron 		pci_write_config_word(pdev, pos + PCI_PM_CTRL, pmcsr);
3876edd16368SStephen M. Cameron 
3877edd16368SStephen M. Cameron 		msleep(500);
3878edd16368SStephen M. Cameron 
3879edd16368SStephen M. Cameron 		/* enter the D0 power management state */
3880edd16368SStephen M. Cameron 		pmcsr &= ~PCI_PM_CTRL_STATE_MASK;
3881edd16368SStephen M. Cameron 		pmcsr |= PCI_D0;
3882edd16368SStephen M. Cameron 		pci_write_config_word(pdev, pos + PCI_PM_CTRL, pmcsr);
3883c4853efeSMike Miller 
3884c4853efeSMike Miller 		/*
3885c4853efeSMike Miller 		 * The P600 requires a small delay when changing states.
3886c4853efeSMike Miller 		 * Otherwise we may think the board did not reset and we bail.
3887c4853efeSMike Miller 		 * This for kdump only and is particular to the P600.
3888c4853efeSMike Miller 		 */
3889c4853efeSMike Miller 		msleep(500);
38901df8552aSStephen M. Cameron 	}
38911df8552aSStephen M. Cameron 	return 0;
38921df8552aSStephen M. Cameron }
38931df8552aSStephen M. Cameron 
38946f039790SGreg Kroah-Hartman static void init_driver_version(char *driver_version, int len)
3895580ada3cSStephen M. Cameron {
3896580ada3cSStephen M. Cameron 	memset(driver_version, 0, len);
3897f79cfec6SStephen M. Cameron 	strncpy(driver_version, HPSA " " HPSA_DRIVER_VERSION, len - 1);
3898580ada3cSStephen M. Cameron }
3899580ada3cSStephen M. Cameron 
39006f039790SGreg Kroah-Hartman static int write_driver_ver_to_cfgtable(struct CfgTable __iomem *cfgtable)
3901580ada3cSStephen M. Cameron {
3902580ada3cSStephen M. Cameron 	char *driver_version;
3903580ada3cSStephen M. Cameron 	int i, size = sizeof(cfgtable->driver_version);
3904580ada3cSStephen M. Cameron 
3905580ada3cSStephen M. Cameron 	driver_version = kmalloc(size, GFP_KERNEL);
3906580ada3cSStephen M. Cameron 	if (!driver_version)
3907580ada3cSStephen M. Cameron 		return -ENOMEM;
3908580ada3cSStephen M. Cameron 
3909580ada3cSStephen M. Cameron 	init_driver_version(driver_version, size);
3910580ada3cSStephen M. Cameron 	for (i = 0; i < size; i++)
3911580ada3cSStephen M. Cameron 		writeb(driver_version[i], &cfgtable->driver_version[i]);
3912580ada3cSStephen M. Cameron 	kfree(driver_version);
3913580ada3cSStephen M. Cameron 	return 0;
3914580ada3cSStephen M. Cameron }
3915580ada3cSStephen M. Cameron 
39166f039790SGreg Kroah-Hartman static void read_driver_ver_from_cfgtable(struct CfgTable __iomem *cfgtable,
39176f039790SGreg Kroah-Hartman 					  unsigned char *driver_ver)
3918580ada3cSStephen M. Cameron {
3919580ada3cSStephen M. Cameron 	int i;
3920580ada3cSStephen M. Cameron 
3921580ada3cSStephen M. Cameron 	for (i = 0; i < sizeof(cfgtable->driver_version); i++)
3922580ada3cSStephen M. Cameron 		driver_ver[i] = readb(&cfgtable->driver_version[i]);
3923580ada3cSStephen M. Cameron }
3924580ada3cSStephen M. Cameron 
39256f039790SGreg Kroah-Hartman static int controller_reset_failed(struct CfgTable __iomem *cfgtable)
3926580ada3cSStephen M. Cameron {
3927580ada3cSStephen M. Cameron 
3928580ada3cSStephen M. Cameron 	char *driver_ver, *old_driver_ver;
3929580ada3cSStephen M. Cameron 	int rc, size = sizeof(cfgtable->driver_version);
3930580ada3cSStephen M. Cameron 
3931580ada3cSStephen M. Cameron 	old_driver_ver = kmalloc(2 * size, GFP_KERNEL);
3932580ada3cSStephen M. Cameron 	if (!old_driver_ver)
3933580ada3cSStephen M. Cameron 		return -ENOMEM;
3934580ada3cSStephen M. Cameron 	driver_ver = old_driver_ver + size;
3935580ada3cSStephen M. Cameron 
3936580ada3cSStephen M. Cameron 	/* After a reset, the 32 bytes of "driver version" in the cfgtable
3937580ada3cSStephen M. Cameron 	 * should have been changed, otherwise we know the reset failed.
3938580ada3cSStephen M. Cameron 	 */
3939580ada3cSStephen M. Cameron 	init_driver_version(old_driver_ver, size);
3940580ada3cSStephen M. Cameron 	read_driver_ver_from_cfgtable(cfgtable, driver_ver);
3941580ada3cSStephen M. Cameron 	rc = !memcmp(driver_ver, old_driver_ver, size);
3942580ada3cSStephen M. Cameron 	kfree(old_driver_ver);
3943580ada3cSStephen M. Cameron 	return rc;
3944580ada3cSStephen M. Cameron }
39451df8552aSStephen M. Cameron /* This does a hard reset of the controller using PCI power management
39461df8552aSStephen M. Cameron  * states or the using the doorbell register.
39471df8552aSStephen M. Cameron  */
39486f039790SGreg Kroah-Hartman static int hpsa_kdump_hard_reset_controller(struct pci_dev *pdev)
39491df8552aSStephen M. Cameron {
39501df8552aSStephen M. Cameron 	u64 cfg_offset;
39511df8552aSStephen M. Cameron 	u32 cfg_base_addr;
39521df8552aSStephen M. Cameron 	u64 cfg_base_addr_index;
39531df8552aSStephen M. Cameron 	void __iomem *vaddr;
39541df8552aSStephen M. Cameron 	unsigned long paddr;
3955580ada3cSStephen M. Cameron 	u32 misc_fw_support;
3956270d05deSStephen M. Cameron 	int rc;
39571df8552aSStephen M. Cameron 	struct CfgTable __iomem *cfgtable;
3958cf0b08d0SStephen M. Cameron 	u32 use_doorbell;
395918867659SStephen M. Cameron 	u32 board_id;
3960270d05deSStephen M. Cameron 	u16 command_register;
39611df8552aSStephen M. Cameron 
39621df8552aSStephen M. Cameron 	/* For controllers as old as the P600, this is very nearly
39631df8552aSStephen M. Cameron 	 * the same thing as
39641df8552aSStephen M. Cameron 	 *
39651df8552aSStephen M. Cameron 	 * pci_save_state(pci_dev);
39661df8552aSStephen M. Cameron 	 * pci_set_power_state(pci_dev, PCI_D3hot);
39671df8552aSStephen M. Cameron 	 * pci_set_power_state(pci_dev, PCI_D0);
39681df8552aSStephen M. Cameron 	 * pci_restore_state(pci_dev);
39691df8552aSStephen M. Cameron 	 *
39701df8552aSStephen M. Cameron 	 * For controllers newer than the P600, the pci power state
39711df8552aSStephen M. Cameron 	 * method of resetting doesn't work so we have another way
39721df8552aSStephen M. Cameron 	 * using the doorbell register.
39731df8552aSStephen M. Cameron 	 */
397418867659SStephen M. Cameron 
397525c1e56aSStephen M. Cameron 	rc = hpsa_lookup_board_id(pdev, &board_id);
397646380786SStephen M. Cameron 	if (rc < 0 || !ctlr_is_resettable(board_id)) {
397725c1e56aSStephen M. Cameron 		dev_warn(&pdev->dev, "Not resetting device.\n");
397825c1e56aSStephen M. Cameron 		return -ENODEV;
397925c1e56aSStephen M. Cameron 	}
398046380786SStephen M. Cameron 
398146380786SStephen M. Cameron 	/* if controller is soft- but not hard resettable... */
398246380786SStephen M. Cameron 	if (!ctlr_is_hard_resettable(board_id))
398346380786SStephen M. Cameron 		return -ENOTSUPP; /* try soft reset later. */
398418867659SStephen M. Cameron 
3985270d05deSStephen M. Cameron 	/* Save the PCI command register */
3986270d05deSStephen M. Cameron 	pci_read_config_word(pdev, 4, &command_register);
3987270d05deSStephen M. Cameron 	/* Turn the board off.  This is so that later pci_restore_state()
3988270d05deSStephen M. Cameron 	 * won't turn the board on before the rest of config space is ready.
3989270d05deSStephen M. Cameron 	 */
3990270d05deSStephen M. Cameron 	pci_disable_device(pdev);
3991270d05deSStephen M. Cameron 	pci_save_state(pdev);
39921df8552aSStephen M. Cameron 
39931df8552aSStephen M. Cameron 	/* find the first memory BAR, so we can find the cfg table */
39941df8552aSStephen M. Cameron 	rc = hpsa_pci_find_memory_BAR(pdev, &paddr);
39951df8552aSStephen M. Cameron 	if (rc)
39961df8552aSStephen M. Cameron 		return rc;
39971df8552aSStephen M. Cameron 	vaddr = remap_pci_mem(paddr, 0x250);
39981df8552aSStephen M. Cameron 	if (!vaddr)
39991df8552aSStephen M. Cameron 		return -ENOMEM;
40001df8552aSStephen M. Cameron 
40011df8552aSStephen M. Cameron 	/* find cfgtable in order to check if reset via doorbell is supported */
40021df8552aSStephen M. Cameron 	rc = hpsa_find_cfg_addrs(pdev, vaddr, &cfg_base_addr,
40031df8552aSStephen M. Cameron 					&cfg_base_addr_index, &cfg_offset);
40041df8552aSStephen M. Cameron 	if (rc)
40051df8552aSStephen M. Cameron 		goto unmap_vaddr;
40061df8552aSStephen M. Cameron 	cfgtable = remap_pci_mem(pci_resource_start(pdev,
40071df8552aSStephen M. Cameron 		       cfg_base_addr_index) + cfg_offset, sizeof(*cfgtable));
40081df8552aSStephen M. Cameron 	if (!cfgtable) {
40091df8552aSStephen M. Cameron 		rc = -ENOMEM;
40101df8552aSStephen M. Cameron 		goto unmap_vaddr;
40111df8552aSStephen M. Cameron 	}
4012580ada3cSStephen M. Cameron 	rc = write_driver_ver_to_cfgtable(cfgtable);
4013580ada3cSStephen M. Cameron 	if (rc)
4014580ada3cSStephen M. Cameron 		goto unmap_vaddr;
40151df8552aSStephen M. Cameron 
4016cf0b08d0SStephen M. Cameron 	/* If reset via doorbell register is supported, use that.
4017cf0b08d0SStephen M. Cameron 	 * There are two such methods.  Favor the newest method.
4018cf0b08d0SStephen M. Cameron 	 */
40191df8552aSStephen M. Cameron 	misc_fw_support = readl(&cfgtable->misc_fw_support);
4020cf0b08d0SStephen M. Cameron 	use_doorbell = misc_fw_support & MISC_FW_DOORBELL_RESET2;
4021cf0b08d0SStephen M. Cameron 	if (use_doorbell) {
4022cf0b08d0SStephen M. Cameron 		use_doorbell = DOORBELL_CTLR_RESET2;
4023cf0b08d0SStephen M. Cameron 	} else {
40241df8552aSStephen M. Cameron 		use_doorbell = misc_fw_support & MISC_FW_DOORBELL_RESET;
4025cf0b08d0SStephen M. Cameron 		if (use_doorbell) {
4026fba63097SMike Miller 			dev_warn(&pdev->dev, "Soft reset not supported. "
4027fba63097SMike Miller 				"Firmware update is required.\n");
402864670ac8SStephen M. Cameron 			rc = -ENOTSUPP; /* try soft reset */
4029cf0b08d0SStephen M. Cameron 			goto unmap_cfgtable;
4030cf0b08d0SStephen M. Cameron 		}
4031cf0b08d0SStephen M. Cameron 	}
40321df8552aSStephen M. Cameron 
40331df8552aSStephen M. Cameron 	rc = hpsa_controller_hard_reset(pdev, vaddr, use_doorbell);
40341df8552aSStephen M. Cameron 	if (rc)
40351df8552aSStephen M. Cameron 		goto unmap_cfgtable;
4036edd16368SStephen M. Cameron 
4037270d05deSStephen M. Cameron 	pci_restore_state(pdev);
4038270d05deSStephen M. Cameron 	rc = pci_enable_device(pdev);
4039270d05deSStephen M. Cameron 	if (rc) {
4040270d05deSStephen M. Cameron 		dev_warn(&pdev->dev, "failed to enable device.\n");
4041270d05deSStephen M. Cameron 		goto unmap_cfgtable;
4042edd16368SStephen M. Cameron 	}
4043270d05deSStephen M. Cameron 	pci_write_config_word(pdev, 4, command_register);
4044edd16368SStephen M. Cameron 
40451df8552aSStephen M. Cameron 	/* Some devices (notably the HP Smart Array 5i Controller)
40461df8552aSStephen M. Cameron 	   need a little pause here */
40471df8552aSStephen M. Cameron 	msleep(HPSA_POST_RESET_PAUSE_MSECS);
40481df8552aSStephen M. Cameron 
4049fe5389c8SStephen M. Cameron 	rc = hpsa_wait_for_board_state(pdev, vaddr, BOARD_READY);
4050fe5389c8SStephen M. Cameron 	if (rc) {
4051fe5389c8SStephen M. Cameron 		dev_warn(&pdev->dev,
405264670ac8SStephen M. Cameron 			"failed waiting for board to become ready "
405364670ac8SStephen M. Cameron 			"after hard reset\n");
4054fe5389c8SStephen M. Cameron 		goto unmap_cfgtable;
4055fe5389c8SStephen M. Cameron 	}
4056fe5389c8SStephen M. Cameron 
4057580ada3cSStephen M. Cameron 	rc = controller_reset_failed(vaddr);
4058580ada3cSStephen M. Cameron 	if (rc < 0)
4059580ada3cSStephen M. Cameron 		goto unmap_cfgtable;
4060580ada3cSStephen M. Cameron 	if (rc) {
406164670ac8SStephen M. Cameron 		dev_warn(&pdev->dev, "Unable to successfully reset "
406264670ac8SStephen M. Cameron 			"controller. Will try soft reset.\n");
406364670ac8SStephen M. Cameron 		rc = -ENOTSUPP;
4064580ada3cSStephen M. Cameron 	} else {
406564670ac8SStephen M. Cameron 		dev_info(&pdev->dev, "board ready after hard reset.\n");
40661df8552aSStephen M. Cameron 	}
40671df8552aSStephen M. Cameron 
40681df8552aSStephen M. Cameron unmap_cfgtable:
40691df8552aSStephen M. Cameron 	iounmap(cfgtable);
40701df8552aSStephen M. Cameron 
40711df8552aSStephen M. Cameron unmap_vaddr:
40721df8552aSStephen M. Cameron 	iounmap(vaddr);
40731df8552aSStephen M. Cameron 	return rc;
4074edd16368SStephen M. Cameron }
4075edd16368SStephen M. Cameron 
4076edd16368SStephen M. Cameron /*
4077edd16368SStephen M. Cameron  *  We cannot read the structure directly, for portability we must use
4078edd16368SStephen M. Cameron  *   the io functions.
4079edd16368SStephen M. Cameron  *   This is for debug only.
4080edd16368SStephen M. Cameron  */
4081edd16368SStephen M. Cameron static void print_cfg_table(struct device *dev, struct CfgTable *tb)
4082edd16368SStephen M. Cameron {
408358f8665cSStephen M. Cameron #ifdef HPSA_DEBUG
4084edd16368SStephen M. Cameron 	int i;
4085edd16368SStephen M. Cameron 	char temp_name[17];
4086edd16368SStephen M. Cameron 
4087edd16368SStephen M. Cameron 	dev_info(dev, "Controller Configuration information\n");
4088edd16368SStephen M. Cameron 	dev_info(dev, "------------------------------------\n");
4089edd16368SStephen M. Cameron 	for (i = 0; i < 4; i++)
4090edd16368SStephen M. Cameron 		temp_name[i] = readb(&(tb->Signature[i]));
4091edd16368SStephen M. Cameron 	temp_name[4] = '\0';
4092edd16368SStephen M. Cameron 	dev_info(dev, "   Signature = %s\n", temp_name);
4093edd16368SStephen M. Cameron 	dev_info(dev, "   Spec Number = %d\n", readl(&(tb->SpecValence)));
4094edd16368SStephen M. Cameron 	dev_info(dev, "   Transport methods supported = 0x%x\n",
4095edd16368SStephen M. Cameron 	       readl(&(tb->TransportSupport)));
4096edd16368SStephen M. Cameron 	dev_info(dev, "   Transport methods active = 0x%x\n",
4097edd16368SStephen M. Cameron 	       readl(&(tb->TransportActive)));
4098edd16368SStephen M. Cameron 	dev_info(dev, "   Requested transport Method = 0x%x\n",
4099edd16368SStephen M. Cameron 	       readl(&(tb->HostWrite.TransportRequest)));
4100edd16368SStephen M. Cameron 	dev_info(dev, "   Coalesce Interrupt Delay = 0x%x\n",
4101edd16368SStephen M. Cameron 	       readl(&(tb->HostWrite.CoalIntDelay)));
4102edd16368SStephen M. Cameron 	dev_info(dev, "   Coalesce Interrupt Count = 0x%x\n",
4103edd16368SStephen M. Cameron 	       readl(&(tb->HostWrite.CoalIntCount)));
4104edd16368SStephen M. Cameron 	dev_info(dev, "   Max outstanding commands = 0x%d\n",
4105edd16368SStephen M. Cameron 	       readl(&(tb->CmdsOutMax)));
4106edd16368SStephen M. Cameron 	dev_info(dev, "   Bus Types = 0x%x\n", readl(&(tb->BusTypes)));
4107edd16368SStephen M. Cameron 	for (i = 0; i < 16; i++)
4108edd16368SStephen M. Cameron 		temp_name[i] = readb(&(tb->ServerName[i]));
4109edd16368SStephen M. Cameron 	temp_name[16] = '\0';
4110edd16368SStephen M. Cameron 	dev_info(dev, "   Server Name = %s\n", temp_name);
4111edd16368SStephen M. Cameron 	dev_info(dev, "   Heartbeat Counter = 0x%x\n\n\n",
4112edd16368SStephen M. Cameron 		readl(&(tb->HeartBeat)));
4113edd16368SStephen M. Cameron #endif				/* HPSA_DEBUG */
411458f8665cSStephen M. Cameron }
4115edd16368SStephen M. Cameron 
4116edd16368SStephen M. Cameron static int find_PCI_BAR_index(struct pci_dev *pdev, unsigned long pci_bar_addr)
4117edd16368SStephen M. Cameron {
4118edd16368SStephen M. Cameron 	int i, offset, mem_type, bar_type;
4119edd16368SStephen M. Cameron 
4120edd16368SStephen M. Cameron 	if (pci_bar_addr == PCI_BASE_ADDRESS_0)	/* looking for BAR zero? */
4121edd16368SStephen M. Cameron 		return 0;
4122edd16368SStephen M. Cameron 	offset = 0;
4123edd16368SStephen M. Cameron 	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
4124edd16368SStephen M. Cameron 		bar_type = pci_resource_flags(pdev, i) & PCI_BASE_ADDRESS_SPACE;
4125edd16368SStephen M. Cameron 		if (bar_type == PCI_BASE_ADDRESS_SPACE_IO)
4126edd16368SStephen M. Cameron 			offset += 4;
4127edd16368SStephen M. Cameron 		else {
4128edd16368SStephen M. Cameron 			mem_type = pci_resource_flags(pdev, i) &
4129edd16368SStephen M. Cameron 			    PCI_BASE_ADDRESS_MEM_TYPE_MASK;
4130edd16368SStephen M. Cameron 			switch (mem_type) {
4131edd16368SStephen M. Cameron 			case PCI_BASE_ADDRESS_MEM_TYPE_32:
4132edd16368SStephen M. Cameron 			case PCI_BASE_ADDRESS_MEM_TYPE_1M:
4133edd16368SStephen M. Cameron 				offset += 4;	/* 32 bit */
4134edd16368SStephen M. Cameron 				break;
4135edd16368SStephen M. Cameron 			case PCI_BASE_ADDRESS_MEM_TYPE_64:
4136edd16368SStephen M. Cameron 				offset += 8;
4137edd16368SStephen M. Cameron 				break;
4138edd16368SStephen M. Cameron 			default:	/* reserved in PCI 2.2 */
4139edd16368SStephen M. Cameron 				dev_warn(&pdev->dev,
4140edd16368SStephen M. Cameron 				       "base address is invalid\n");
4141edd16368SStephen M. Cameron 				return -1;
4142edd16368SStephen M. Cameron 				break;
4143edd16368SStephen M. Cameron 			}
4144edd16368SStephen M. Cameron 		}
4145edd16368SStephen M. Cameron 		if (offset == pci_bar_addr - PCI_BASE_ADDRESS_0)
4146edd16368SStephen M. Cameron 			return i + 1;
4147edd16368SStephen M. Cameron 	}
4148edd16368SStephen M. Cameron 	return -1;
4149edd16368SStephen M. Cameron }
4150edd16368SStephen M. Cameron 
4151edd16368SStephen M. Cameron /* If MSI/MSI-X is supported by the kernel we will try to enable it on
4152edd16368SStephen M. Cameron  * controllers that are capable. If not, we use IO-APIC mode.
4153edd16368SStephen M. Cameron  */
4154edd16368SStephen M. Cameron 
41556f039790SGreg Kroah-Hartman static void hpsa_interrupt_mode(struct ctlr_info *h)
4156edd16368SStephen M. Cameron {
4157edd16368SStephen M. Cameron #ifdef CONFIG_PCI_MSI
4158254f796bSMatt Gates 	int err, i;
4159254f796bSMatt Gates 	struct msix_entry hpsa_msix_entries[MAX_REPLY_QUEUES];
4160254f796bSMatt Gates 
4161254f796bSMatt Gates 	for (i = 0; i < MAX_REPLY_QUEUES; i++) {
4162254f796bSMatt Gates 		hpsa_msix_entries[i].vector = 0;
4163254f796bSMatt Gates 		hpsa_msix_entries[i].entry = i;
4164254f796bSMatt Gates 	}
4165edd16368SStephen M. Cameron 
4166edd16368SStephen M. Cameron 	/* Some boards advertise MSI but don't really support it */
41676b3f4c52SStephen M. Cameron 	if ((h->board_id == 0x40700E11) || (h->board_id == 0x40800E11) ||
41686b3f4c52SStephen M. Cameron 	    (h->board_id == 0x40820E11) || (h->board_id == 0x40830E11))
4169edd16368SStephen M. Cameron 		goto default_int_mode;
417055c06c71SStephen M. Cameron 	if (pci_find_capability(h->pdev, PCI_CAP_ID_MSIX)) {
417155c06c71SStephen M. Cameron 		dev_info(&h->pdev->dev, "MSIX\n");
4172254f796bSMatt Gates 		err = pci_enable_msix(h->pdev, hpsa_msix_entries,
4173254f796bSMatt Gates 						MAX_REPLY_QUEUES);
4174edd16368SStephen M. Cameron 		if (!err) {
4175254f796bSMatt Gates 			for (i = 0; i < MAX_REPLY_QUEUES; i++)
4176254f796bSMatt Gates 				h->intr[i] = hpsa_msix_entries[i].vector;
4177edd16368SStephen M. Cameron 			h->msix_vector = 1;
4178edd16368SStephen M. Cameron 			return;
4179edd16368SStephen M. Cameron 		}
4180edd16368SStephen M. Cameron 		if (err > 0) {
418155c06c71SStephen M. Cameron 			dev_warn(&h->pdev->dev, "only %d MSI-X vectors "
4182edd16368SStephen M. Cameron 			       "available\n", err);
4183edd16368SStephen M. Cameron 			goto default_int_mode;
4184edd16368SStephen M. Cameron 		} else {
418555c06c71SStephen M. Cameron 			dev_warn(&h->pdev->dev, "MSI-X init failed %d\n",
4186edd16368SStephen M. Cameron 			       err);
4187edd16368SStephen M. Cameron 			goto default_int_mode;
4188edd16368SStephen M. Cameron 		}
4189edd16368SStephen M. Cameron 	}
419055c06c71SStephen M. Cameron 	if (pci_find_capability(h->pdev, PCI_CAP_ID_MSI)) {
419155c06c71SStephen M. Cameron 		dev_info(&h->pdev->dev, "MSI\n");
419255c06c71SStephen M. Cameron 		if (!pci_enable_msi(h->pdev))
4193edd16368SStephen M. Cameron 			h->msi_vector = 1;
4194edd16368SStephen M. Cameron 		else
419555c06c71SStephen M. Cameron 			dev_warn(&h->pdev->dev, "MSI init failed\n");
4196edd16368SStephen M. Cameron 	}
4197edd16368SStephen M. Cameron default_int_mode:
4198edd16368SStephen M. Cameron #endif				/* CONFIG_PCI_MSI */
4199edd16368SStephen M. Cameron 	/* if we get here we're going to use the default interrupt mode */
4200a9a3a273SStephen M. Cameron 	h->intr[h->intr_mode] = h->pdev->irq;
4201edd16368SStephen M. Cameron }
4202edd16368SStephen M. Cameron 
42036f039790SGreg Kroah-Hartman static int hpsa_lookup_board_id(struct pci_dev *pdev, u32 *board_id)
4204e5c880d1SStephen M. Cameron {
4205e5c880d1SStephen M. Cameron 	int i;
4206e5c880d1SStephen M. Cameron 	u32 subsystem_vendor_id, subsystem_device_id;
4207e5c880d1SStephen M. Cameron 
4208e5c880d1SStephen M. Cameron 	subsystem_vendor_id = pdev->subsystem_vendor;
4209e5c880d1SStephen M. Cameron 	subsystem_device_id = pdev->subsystem_device;
4210e5c880d1SStephen M. Cameron 	*board_id = ((subsystem_device_id << 16) & 0xffff0000) |
4211e5c880d1SStephen M. Cameron 		    subsystem_vendor_id;
4212e5c880d1SStephen M. Cameron 
4213e5c880d1SStephen M. Cameron 	for (i = 0; i < ARRAY_SIZE(products); i++)
4214e5c880d1SStephen M. Cameron 		if (*board_id == products[i].board_id)
4215e5c880d1SStephen M. Cameron 			return i;
4216e5c880d1SStephen M. Cameron 
42176798cc0aSStephen M. Cameron 	if ((subsystem_vendor_id != PCI_VENDOR_ID_HP &&
42186798cc0aSStephen M. Cameron 		subsystem_vendor_id != PCI_VENDOR_ID_COMPAQ) ||
42196798cc0aSStephen M. Cameron 		!hpsa_allow_any) {
4220e5c880d1SStephen M. Cameron 		dev_warn(&pdev->dev, "unrecognized board ID: "
4221e5c880d1SStephen M. Cameron 			"0x%08x, ignoring.\n", *board_id);
4222e5c880d1SStephen M. Cameron 			return -ENODEV;
4223e5c880d1SStephen M. Cameron 	}
4224e5c880d1SStephen M. Cameron 	return ARRAY_SIZE(products) - 1; /* generic unknown smart array */
4225e5c880d1SStephen M. Cameron }
4226e5c880d1SStephen M. Cameron 
42276f039790SGreg Kroah-Hartman static int hpsa_pci_find_memory_BAR(struct pci_dev *pdev,
42283a7774ceSStephen M. Cameron 				    unsigned long *memory_bar)
42293a7774ceSStephen M. Cameron {
42303a7774ceSStephen M. Cameron 	int i;
42313a7774ceSStephen M. Cameron 
42323a7774ceSStephen M. Cameron 	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++)
423312d2cd47SStephen M. Cameron 		if (pci_resource_flags(pdev, i) & IORESOURCE_MEM) {
42343a7774ceSStephen M. Cameron 			/* addressing mode bits already removed */
423512d2cd47SStephen M. Cameron 			*memory_bar = pci_resource_start(pdev, i);
423612d2cd47SStephen M. Cameron 			dev_dbg(&pdev->dev, "memory BAR = %lx\n",
42373a7774ceSStephen M. Cameron 				*memory_bar);
42383a7774ceSStephen M. Cameron 			return 0;
42393a7774ceSStephen M. Cameron 		}
424012d2cd47SStephen M. Cameron 	dev_warn(&pdev->dev, "no memory BAR found\n");
42413a7774ceSStephen M. Cameron 	return -ENODEV;
42423a7774ceSStephen M. Cameron }
42433a7774ceSStephen M. Cameron 
42446f039790SGreg Kroah-Hartman static int hpsa_wait_for_board_state(struct pci_dev *pdev, void __iomem *vaddr,
42456f039790SGreg Kroah-Hartman 				     int wait_for_ready)
42462c4c8c8bSStephen M. Cameron {
4247fe5389c8SStephen M. Cameron 	int i, iterations;
42482c4c8c8bSStephen M. Cameron 	u32 scratchpad;
4249fe5389c8SStephen M. Cameron 	if (wait_for_ready)
4250fe5389c8SStephen M. Cameron 		iterations = HPSA_BOARD_READY_ITERATIONS;
4251fe5389c8SStephen M. Cameron 	else
4252fe5389c8SStephen M. Cameron 		iterations = HPSA_BOARD_NOT_READY_ITERATIONS;
42532c4c8c8bSStephen M. Cameron 
4254fe5389c8SStephen M. Cameron 	for (i = 0; i < iterations; i++) {
4255fe5389c8SStephen M. Cameron 		scratchpad = readl(vaddr + SA5_SCRATCHPAD_OFFSET);
4256fe5389c8SStephen M. Cameron 		if (wait_for_ready) {
42572c4c8c8bSStephen M. Cameron 			if (scratchpad == HPSA_FIRMWARE_READY)
42582c4c8c8bSStephen M. Cameron 				return 0;
4259fe5389c8SStephen M. Cameron 		} else {
4260fe5389c8SStephen M. Cameron 			if (scratchpad != HPSA_FIRMWARE_READY)
4261fe5389c8SStephen M. Cameron 				return 0;
4262fe5389c8SStephen M. Cameron 		}
42632c4c8c8bSStephen M. Cameron 		msleep(HPSA_BOARD_READY_POLL_INTERVAL_MSECS);
42642c4c8c8bSStephen M. Cameron 	}
4265fe5389c8SStephen M. Cameron 	dev_warn(&pdev->dev, "board not ready, timed out.\n");
42662c4c8c8bSStephen M. Cameron 	return -ENODEV;
42672c4c8c8bSStephen M. Cameron }
42682c4c8c8bSStephen M. Cameron 
42696f039790SGreg Kroah-Hartman static int hpsa_find_cfg_addrs(struct pci_dev *pdev, void __iomem *vaddr,
42706f039790SGreg Kroah-Hartman 			       u32 *cfg_base_addr, u64 *cfg_base_addr_index,
4271a51fd47fSStephen M. Cameron 			       u64 *cfg_offset)
4272a51fd47fSStephen M. Cameron {
4273a51fd47fSStephen M. Cameron 	*cfg_base_addr = readl(vaddr + SA5_CTCFG_OFFSET);
4274a51fd47fSStephen M. Cameron 	*cfg_offset = readl(vaddr + SA5_CTMEM_OFFSET);
4275a51fd47fSStephen M. Cameron 	*cfg_base_addr &= (u32) 0x0000ffff;
4276a51fd47fSStephen M. Cameron 	*cfg_base_addr_index = find_PCI_BAR_index(pdev, *cfg_base_addr);
4277a51fd47fSStephen M. Cameron 	if (*cfg_base_addr_index == -1) {
4278a51fd47fSStephen M. Cameron 		dev_warn(&pdev->dev, "cannot find cfg_base_addr_index\n");
4279a51fd47fSStephen M. Cameron 		return -ENODEV;
4280a51fd47fSStephen M. Cameron 	}
4281a51fd47fSStephen M. Cameron 	return 0;
4282a51fd47fSStephen M. Cameron }
4283a51fd47fSStephen M. Cameron 
42846f039790SGreg Kroah-Hartman static int hpsa_find_cfgtables(struct ctlr_info *h)
4285edd16368SStephen M. Cameron {
428601a02ffcSStephen M. Cameron 	u64 cfg_offset;
428701a02ffcSStephen M. Cameron 	u32 cfg_base_addr;
428801a02ffcSStephen M. Cameron 	u64 cfg_base_addr_index;
4289303932fdSDon Brace 	u32 trans_offset;
4290a51fd47fSStephen M. Cameron 	int rc;
429177c4495cSStephen M. Cameron 
4292a51fd47fSStephen M. Cameron 	rc = hpsa_find_cfg_addrs(h->pdev, h->vaddr, &cfg_base_addr,
4293a51fd47fSStephen M. Cameron 		&cfg_base_addr_index, &cfg_offset);
4294a51fd47fSStephen M. Cameron 	if (rc)
4295a51fd47fSStephen M. Cameron 		return rc;
429677c4495cSStephen M. Cameron 	h->cfgtable = remap_pci_mem(pci_resource_start(h->pdev,
4297a51fd47fSStephen M. Cameron 		       cfg_base_addr_index) + cfg_offset, sizeof(*h->cfgtable));
429877c4495cSStephen M. Cameron 	if (!h->cfgtable)
429977c4495cSStephen M. Cameron 		return -ENOMEM;
4300580ada3cSStephen M. Cameron 	rc = write_driver_ver_to_cfgtable(h->cfgtable);
4301580ada3cSStephen M. Cameron 	if (rc)
4302580ada3cSStephen M. Cameron 		return rc;
430377c4495cSStephen M. Cameron 	/* Find performant mode table. */
4304a51fd47fSStephen M. Cameron 	trans_offset = readl(&h->cfgtable->TransMethodOffset);
430577c4495cSStephen M. Cameron 	h->transtable = remap_pci_mem(pci_resource_start(h->pdev,
430677c4495cSStephen M. Cameron 				cfg_base_addr_index)+cfg_offset+trans_offset,
430777c4495cSStephen M. Cameron 				sizeof(*h->transtable));
430877c4495cSStephen M. Cameron 	if (!h->transtable)
430977c4495cSStephen M. Cameron 		return -ENOMEM;
431077c4495cSStephen M. Cameron 	return 0;
431177c4495cSStephen M. Cameron }
431277c4495cSStephen M. Cameron 
43136f039790SGreg Kroah-Hartman static void hpsa_get_max_perf_mode_cmds(struct ctlr_info *h)
4314cba3d38bSStephen M. Cameron {
4315cba3d38bSStephen M. Cameron 	h->max_commands = readl(&(h->cfgtable->MaxPerformantModeCommands));
431672ceeaecSStephen M. Cameron 
431772ceeaecSStephen M. Cameron 	/* Limit commands in memory limited kdump scenario. */
431872ceeaecSStephen M. Cameron 	if (reset_devices && h->max_commands > 32)
431972ceeaecSStephen M. Cameron 		h->max_commands = 32;
432072ceeaecSStephen M. Cameron 
4321cba3d38bSStephen M. Cameron 	if (h->max_commands < 16) {
4322cba3d38bSStephen M. Cameron 		dev_warn(&h->pdev->dev, "Controller reports "
4323cba3d38bSStephen M. Cameron 			"max supported commands of %d, an obvious lie. "
4324cba3d38bSStephen M. Cameron 			"Using 16.  Ensure that firmware is up to date.\n",
4325cba3d38bSStephen M. Cameron 			h->max_commands);
4326cba3d38bSStephen M. Cameron 		h->max_commands = 16;
4327cba3d38bSStephen M. Cameron 	}
4328cba3d38bSStephen M. Cameron }
4329cba3d38bSStephen M. Cameron 
4330b93d7536SStephen M. Cameron /* Interrogate the hardware for some limits:
4331b93d7536SStephen M. Cameron  * max commands, max SG elements without chaining, and with chaining,
4332b93d7536SStephen M. Cameron  * SG chain block size, etc.
4333b93d7536SStephen M. Cameron  */
43346f039790SGreg Kroah-Hartman static void hpsa_find_board_params(struct ctlr_info *h)
4335b93d7536SStephen M. Cameron {
4336cba3d38bSStephen M. Cameron 	hpsa_get_max_perf_mode_cmds(h);
4337b93d7536SStephen M. Cameron 	h->nr_cmds = h->max_commands - 4; /* Allow room for some ioctls */
4338b93d7536SStephen M. Cameron 	h->maxsgentries = readl(&(h->cfgtable->MaxScatterGatherElements));
4339b93d7536SStephen M. Cameron 	/*
4340b93d7536SStephen M. Cameron 	 * Limit in-command s/g elements to 32 save dma'able memory.
4341b93d7536SStephen M. Cameron 	 * Howvever spec says if 0, use 31
4342b93d7536SStephen M. Cameron 	 */
4343b93d7536SStephen M. Cameron 	h->max_cmd_sg_entries = 31;
4344b93d7536SStephen M. Cameron 	if (h->maxsgentries > 512) {
4345b93d7536SStephen M. Cameron 		h->max_cmd_sg_entries = 32;
4346b93d7536SStephen M. Cameron 		h->chainsize = h->maxsgentries - h->max_cmd_sg_entries + 1;
4347b93d7536SStephen M. Cameron 		h->maxsgentries--; /* save one for chain pointer */
4348b93d7536SStephen M. Cameron 	} else {
4349b93d7536SStephen M. Cameron 		h->maxsgentries = 31; /* default to traditional values */
4350b93d7536SStephen M. Cameron 		h->chainsize = 0;
4351b93d7536SStephen M. Cameron 	}
435275167d2cSStephen M. Cameron 
435375167d2cSStephen M. Cameron 	/* Find out what task management functions are supported and cache */
435475167d2cSStephen M. Cameron 	h->TMFSupportFlags = readl(&(h->cfgtable->TMFSupportFlags));
4355b93d7536SStephen M. Cameron }
4356b93d7536SStephen M. Cameron 
435776c46e49SStephen M. Cameron static inline bool hpsa_CISS_signature_present(struct ctlr_info *h)
435876c46e49SStephen M. Cameron {
43590fc9fd40SAkinobu Mita 	if (!check_signature(h->cfgtable->Signature, "CISS", 4)) {
436076c46e49SStephen M. Cameron 		dev_warn(&h->pdev->dev, "not a valid CISS config table\n");
436176c46e49SStephen M. Cameron 		return false;
436276c46e49SStephen M. Cameron 	}
436376c46e49SStephen M. Cameron 	return true;
436476c46e49SStephen M. Cameron }
436576c46e49SStephen M. Cameron 
436697a5e98cSStephen M. Cameron static inline void hpsa_set_driver_support_bits(struct ctlr_info *h)
4367f7c39101SStephen M. Cameron {
436897a5e98cSStephen M. Cameron 	u32 driver_support;
4369f7c39101SStephen M. Cameron 
437028e13446SStephen M. Cameron #ifdef CONFIG_X86
437128e13446SStephen M. Cameron 	/* Need to enable prefetch in the SCSI core for 6400 in x86 */
437297a5e98cSStephen M. Cameron 	driver_support = readl(&(h->cfgtable->driver_support));
437397a5e98cSStephen M. Cameron 	driver_support |= ENABLE_SCSI_PREFETCH;
4374f7c39101SStephen M. Cameron #endif
437528e13446SStephen M. Cameron 	driver_support |= ENABLE_UNIT_ATTN;
437628e13446SStephen M. Cameron 	writel(driver_support, &(h->cfgtable->driver_support));
4377f7c39101SStephen M. Cameron }
4378f7c39101SStephen M. Cameron 
43793d0eab67SStephen M. Cameron /* Disable DMA prefetch for the P600.  Otherwise an ASIC bug may result
43803d0eab67SStephen M. Cameron  * in a prefetch beyond physical memory.
43813d0eab67SStephen M. Cameron  */
43823d0eab67SStephen M. Cameron static inline void hpsa_p600_dma_prefetch_quirk(struct ctlr_info *h)
43833d0eab67SStephen M. Cameron {
43843d0eab67SStephen M. Cameron 	u32 dma_prefetch;
43853d0eab67SStephen M. Cameron 
43863d0eab67SStephen M. Cameron 	if (h->board_id != 0x3225103C)
43873d0eab67SStephen M. Cameron 		return;
43883d0eab67SStephen M. Cameron 	dma_prefetch = readl(h->vaddr + I2O_DMA1_CFG);
43893d0eab67SStephen M. Cameron 	dma_prefetch |= 0x8000;
43903d0eab67SStephen M. Cameron 	writel(dma_prefetch, h->vaddr + I2O_DMA1_CFG);
43913d0eab67SStephen M. Cameron }
43923d0eab67SStephen M. Cameron 
43936f039790SGreg Kroah-Hartman static void hpsa_wait_for_mode_change_ack(struct ctlr_info *h)
4394eb6b2ae9SStephen M. Cameron {
4395eb6b2ae9SStephen M. Cameron 	int i;
43966eaf46fdSStephen M. Cameron 	u32 doorbell_value;
43976eaf46fdSStephen M. Cameron 	unsigned long flags;
4398eb6b2ae9SStephen M. Cameron 
4399eb6b2ae9SStephen M. Cameron 	/* under certain very rare conditions, this can take awhile.
4400eb6b2ae9SStephen M. Cameron 	 * (e.g.: hot replace a failed 144GB drive in a RAID 5 set right
4401eb6b2ae9SStephen M. Cameron 	 * as we enter this code.)
4402eb6b2ae9SStephen M. Cameron 	 */
4403eb6b2ae9SStephen M. Cameron 	for (i = 0; i < MAX_CONFIG_WAIT; i++) {
44046eaf46fdSStephen M. Cameron 		spin_lock_irqsave(&h->lock, flags);
44056eaf46fdSStephen M. Cameron 		doorbell_value = readl(h->vaddr + SA5_DOORBELL);
44066eaf46fdSStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
4407382be668SDan Carpenter 		if (!(doorbell_value & CFGTBL_ChangeReq))
4408eb6b2ae9SStephen M. Cameron 			break;
4409eb6b2ae9SStephen M. Cameron 		/* delay and try again */
441060d3f5b0SStephen M. Cameron 		usleep_range(10000, 20000);
4411eb6b2ae9SStephen M. Cameron 	}
44123f4336f3SStephen M. Cameron }
44133f4336f3SStephen M. Cameron 
44146f039790SGreg Kroah-Hartman static int hpsa_enter_simple_mode(struct ctlr_info *h)
44153f4336f3SStephen M. Cameron {
44163f4336f3SStephen M. Cameron 	u32 trans_support;
44173f4336f3SStephen M. Cameron 
44183f4336f3SStephen M. Cameron 	trans_support = readl(&(h->cfgtable->TransportSupport));
44193f4336f3SStephen M. Cameron 	if (!(trans_support & SIMPLE_MODE))
44203f4336f3SStephen M. Cameron 		return -ENOTSUPP;
44213f4336f3SStephen M. Cameron 
44223f4336f3SStephen M. Cameron 	h->max_commands = readl(&(h->cfgtable->CmdsOutMax));
44233f4336f3SStephen M. Cameron 	/* Update the field, and then ring the doorbell */
44243f4336f3SStephen M. Cameron 	writel(CFGTBL_Trans_Simple, &(h->cfgtable->HostWrite.TransportRequest));
44253f4336f3SStephen M. Cameron 	writel(CFGTBL_ChangeReq, h->vaddr + SA5_DOORBELL);
44263f4336f3SStephen M. Cameron 	hpsa_wait_for_mode_change_ack(h);
4427eb6b2ae9SStephen M. Cameron 	print_cfg_table(&h->pdev->dev, h->cfgtable);
4428eb6b2ae9SStephen M. Cameron 	if (!(readl(&(h->cfgtable->TransportActive)) & CFGTBL_Trans_Simple)) {
4429eb6b2ae9SStephen M. Cameron 		dev_warn(&h->pdev->dev,
4430eb6b2ae9SStephen M. Cameron 			"unable to get board into simple mode\n");
4431eb6b2ae9SStephen M. Cameron 		return -ENODEV;
4432eb6b2ae9SStephen M. Cameron 	}
4433960a30e7SStephen M. Cameron 	h->transMethod = CFGTBL_Trans_Simple;
4434eb6b2ae9SStephen M. Cameron 	return 0;
4435eb6b2ae9SStephen M. Cameron }
4436eb6b2ae9SStephen M. Cameron 
44376f039790SGreg Kroah-Hartman static int hpsa_pci_init(struct ctlr_info *h)
443877c4495cSStephen M. Cameron {
4439eb6b2ae9SStephen M. Cameron 	int prod_index, err;
4440edd16368SStephen M. Cameron 
4441e5c880d1SStephen M. Cameron 	prod_index = hpsa_lookup_board_id(h->pdev, &h->board_id);
4442e5c880d1SStephen M. Cameron 	if (prod_index < 0)
4443edd16368SStephen M. Cameron 		return -ENODEV;
4444e5c880d1SStephen M. Cameron 	h->product_name = products[prod_index].product_name;
4445e5c880d1SStephen M. Cameron 	h->access = *(products[prod_index].access);
4446e5c880d1SStephen M. Cameron 
4447e5a44df8SMatthew Garrett 	pci_disable_link_state(h->pdev, PCIE_LINK_STATE_L0S |
4448e5a44df8SMatthew Garrett 			       PCIE_LINK_STATE_L1 | PCIE_LINK_STATE_CLKPM);
4449e5a44df8SMatthew Garrett 
445055c06c71SStephen M. Cameron 	err = pci_enable_device(h->pdev);
4451edd16368SStephen M. Cameron 	if (err) {
445255c06c71SStephen M. Cameron 		dev_warn(&h->pdev->dev, "unable to enable PCI device\n");
4453edd16368SStephen M. Cameron 		return err;
4454edd16368SStephen M. Cameron 	}
4455edd16368SStephen M. Cameron 
44565cb460a6SStephen M. Cameron 	/* Enable bus mastering (pci_disable_device may disable this) */
44575cb460a6SStephen M. Cameron 	pci_set_master(h->pdev);
44585cb460a6SStephen M. Cameron 
4459f79cfec6SStephen M. Cameron 	err = pci_request_regions(h->pdev, HPSA);
4460edd16368SStephen M. Cameron 	if (err) {
446155c06c71SStephen M. Cameron 		dev_err(&h->pdev->dev,
446255c06c71SStephen M. Cameron 			"cannot obtain PCI resources, aborting\n");
4463edd16368SStephen M. Cameron 		return err;
4464edd16368SStephen M. Cameron 	}
44656b3f4c52SStephen M. Cameron 	hpsa_interrupt_mode(h);
446612d2cd47SStephen M. Cameron 	err = hpsa_pci_find_memory_BAR(h->pdev, &h->paddr);
44673a7774ceSStephen M. Cameron 	if (err)
4468edd16368SStephen M. Cameron 		goto err_out_free_res;
4469edd16368SStephen M. Cameron 	h->vaddr = remap_pci_mem(h->paddr, 0x250);
4470204892e9SStephen M. Cameron 	if (!h->vaddr) {
4471204892e9SStephen M. Cameron 		err = -ENOMEM;
4472204892e9SStephen M. Cameron 		goto err_out_free_res;
4473204892e9SStephen M. Cameron 	}
4474fe5389c8SStephen M. Cameron 	err = hpsa_wait_for_board_state(h->pdev, h->vaddr, BOARD_READY);
44752c4c8c8bSStephen M. Cameron 	if (err)
4476edd16368SStephen M. Cameron 		goto err_out_free_res;
447777c4495cSStephen M. Cameron 	err = hpsa_find_cfgtables(h);
447877c4495cSStephen M. Cameron 	if (err)
4479edd16368SStephen M. Cameron 		goto err_out_free_res;
4480b93d7536SStephen M. Cameron 	hpsa_find_board_params(h);
4481edd16368SStephen M. Cameron 
448276c46e49SStephen M. Cameron 	if (!hpsa_CISS_signature_present(h)) {
4483edd16368SStephen M. Cameron 		err = -ENODEV;
4484edd16368SStephen M. Cameron 		goto err_out_free_res;
4485edd16368SStephen M. Cameron 	}
448697a5e98cSStephen M. Cameron 	hpsa_set_driver_support_bits(h);
44873d0eab67SStephen M. Cameron 	hpsa_p600_dma_prefetch_quirk(h);
4488eb6b2ae9SStephen M. Cameron 	err = hpsa_enter_simple_mode(h);
4489eb6b2ae9SStephen M. Cameron 	if (err)
4490edd16368SStephen M. Cameron 		goto err_out_free_res;
4491edd16368SStephen M. Cameron 	return 0;
4492edd16368SStephen M. Cameron 
4493edd16368SStephen M. Cameron err_out_free_res:
4494204892e9SStephen M. Cameron 	if (h->transtable)
4495204892e9SStephen M. Cameron 		iounmap(h->transtable);
4496204892e9SStephen M. Cameron 	if (h->cfgtable)
4497204892e9SStephen M. Cameron 		iounmap(h->cfgtable);
4498204892e9SStephen M. Cameron 	if (h->vaddr)
4499204892e9SStephen M. Cameron 		iounmap(h->vaddr);
4500f0bd0b68SStephen M. Cameron 	pci_disable_device(h->pdev);
450155c06c71SStephen M. Cameron 	pci_release_regions(h->pdev);
4502edd16368SStephen M. Cameron 	return err;
4503edd16368SStephen M. Cameron }
4504edd16368SStephen M. Cameron 
45056f039790SGreg Kroah-Hartman static void hpsa_hba_inquiry(struct ctlr_info *h)
4506339b2b14SStephen M. Cameron {
4507339b2b14SStephen M. Cameron 	int rc;
4508339b2b14SStephen M. Cameron 
4509339b2b14SStephen M. Cameron #define HBA_INQUIRY_BYTE_COUNT 64
4510339b2b14SStephen M. Cameron 	h->hba_inquiry_data = kmalloc(HBA_INQUIRY_BYTE_COUNT, GFP_KERNEL);
4511339b2b14SStephen M. Cameron 	if (!h->hba_inquiry_data)
4512339b2b14SStephen M. Cameron 		return;
4513339b2b14SStephen M. Cameron 	rc = hpsa_scsi_do_inquiry(h, RAID_CTLR_LUNID, 0,
4514339b2b14SStephen M. Cameron 		h->hba_inquiry_data, HBA_INQUIRY_BYTE_COUNT);
4515339b2b14SStephen M. Cameron 	if (rc != 0) {
4516339b2b14SStephen M. Cameron 		kfree(h->hba_inquiry_data);
4517339b2b14SStephen M. Cameron 		h->hba_inquiry_data = NULL;
4518339b2b14SStephen M. Cameron 	}
4519339b2b14SStephen M. Cameron }
4520339b2b14SStephen M. Cameron 
45216f039790SGreg Kroah-Hartman static int hpsa_init_reset_devices(struct pci_dev *pdev)
4522edd16368SStephen M. Cameron {
45231df8552aSStephen M. Cameron 	int rc, i;
4524edd16368SStephen M. Cameron 
45254c2a8c40SStephen M. Cameron 	if (!reset_devices)
45264c2a8c40SStephen M. Cameron 		return 0;
45274c2a8c40SStephen M. Cameron 
45281df8552aSStephen M. Cameron 	/* Reset the controller with a PCI power-cycle or via doorbell */
45291df8552aSStephen M. Cameron 	rc = hpsa_kdump_hard_reset_controller(pdev);
4530edd16368SStephen M. Cameron 
45311df8552aSStephen M. Cameron 	/* -ENOTSUPP here means we cannot reset the controller
45321df8552aSStephen M. Cameron 	 * but it's already (and still) up and running in
453318867659SStephen M. Cameron 	 * "performant mode".  Or, it might be 640x, which can't reset
453418867659SStephen M. Cameron 	 * due to concerns about shared bbwc between 6402/6404 pair.
45351df8552aSStephen M. Cameron 	 */
45361df8552aSStephen M. Cameron 	if (rc == -ENOTSUPP)
453764670ac8SStephen M. Cameron 		return rc; /* just try to do the kdump anyhow. */
45381df8552aSStephen M. Cameron 	if (rc)
45391df8552aSStephen M. Cameron 		return -ENODEV;
4540edd16368SStephen M. Cameron 
4541edd16368SStephen M. Cameron 	/* Now try to get the controller to respond to a no-op */
45422b870cb3SStephen M. Cameron 	dev_warn(&pdev->dev, "Waiting for controller to respond to no-op\n");
4543edd16368SStephen M. Cameron 	for (i = 0; i < HPSA_POST_RESET_NOOP_RETRIES; i++) {
4544edd16368SStephen M. Cameron 		if (hpsa_noop(pdev) == 0)
4545edd16368SStephen M. Cameron 			break;
4546edd16368SStephen M. Cameron 		else
4547edd16368SStephen M. Cameron 			dev_warn(&pdev->dev, "no-op failed%s\n",
4548edd16368SStephen M. Cameron 					(i < 11 ? "; re-trying" : ""));
4549edd16368SStephen M. Cameron 	}
45504c2a8c40SStephen M. Cameron 	return 0;
4551edd16368SStephen M. Cameron }
4552edd16368SStephen M. Cameron 
45536f039790SGreg Kroah-Hartman static int hpsa_allocate_cmd_pool(struct ctlr_info *h)
45542e9d1b36SStephen M. Cameron {
45552e9d1b36SStephen M. Cameron 	h->cmd_pool_bits = kzalloc(
45562e9d1b36SStephen M. Cameron 		DIV_ROUND_UP(h->nr_cmds, BITS_PER_LONG) *
45572e9d1b36SStephen M. Cameron 		sizeof(unsigned long), GFP_KERNEL);
45582e9d1b36SStephen M. Cameron 	h->cmd_pool = pci_alloc_consistent(h->pdev,
45592e9d1b36SStephen M. Cameron 		    h->nr_cmds * sizeof(*h->cmd_pool),
45602e9d1b36SStephen M. Cameron 		    &(h->cmd_pool_dhandle));
45612e9d1b36SStephen M. Cameron 	h->errinfo_pool = pci_alloc_consistent(h->pdev,
45622e9d1b36SStephen M. Cameron 		    h->nr_cmds * sizeof(*h->errinfo_pool),
45632e9d1b36SStephen M. Cameron 		    &(h->errinfo_pool_dhandle));
45642e9d1b36SStephen M. Cameron 	if ((h->cmd_pool_bits == NULL)
45652e9d1b36SStephen M. Cameron 	    || (h->cmd_pool == NULL)
45662e9d1b36SStephen M. Cameron 	    || (h->errinfo_pool == NULL)) {
45672e9d1b36SStephen M. Cameron 		dev_err(&h->pdev->dev, "out of memory in %s", __func__);
45682e9d1b36SStephen M. Cameron 		return -ENOMEM;
45692e9d1b36SStephen M. Cameron 	}
45702e9d1b36SStephen M. Cameron 	return 0;
45712e9d1b36SStephen M. Cameron }
45722e9d1b36SStephen M. Cameron 
45732e9d1b36SStephen M. Cameron static void hpsa_free_cmd_pool(struct ctlr_info *h)
45742e9d1b36SStephen M. Cameron {
45752e9d1b36SStephen M. Cameron 	kfree(h->cmd_pool_bits);
45762e9d1b36SStephen M. Cameron 	if (h->cmd_pool)
45772e9d1b36SStephen M. Cameron 		pci_free_consistent(h->pdev,
45782e9d1b36SStephen M. Cameron 			    h->nr_cmds * sizeof(struct CommandList),
45792e9d1b36SStephen M. Cameron 			    h->cmd_pool, h->cmd_pool_dhandle);
45802e9d1b36SStephen M. Cameron 	if (h->errinfo_pool)
45812e9d1b36SStephen M. Cameron 		pci_free_consistent(h->pdev,
45822e9d1b36SStephen M. Cameron 			    h->nr_cmds * sizeof(struct ErrorInfo),
45832e9d1b36SStephen M. Cameron 			    h->errinfo_pool,
45842e9d1b36SStephen M. Cameron 			    h->errinfo_pool_dhandle);
45852e9d1b36SStephen M. Cameron }
45862e9d1b36SStephen M. Cameron 
45870ae01a32SStephen M. Cameron static int hpsa_request_irq(struct ctlr_info *h,
45880ae01a32SStephen M. Cameron 	irqreturn_t (*msixhandler)(int, void *),
45890ae01a32SStephen M. Cameron 	irqreturn_t (*intxhandler)(int, void *))
45900ae01a32SStephen M. Cameron {
4591254f796bSMatt Gates 	int rc, i;
45920ae01a32SStephen M. Cameron 
4593254f796bSMatt Gates 	/*
4594254f796bSMatt Gates 	 * initialize h->q[x] = x so that interrupt handlers know which
4595254f796bSMatt Gates 	 * queue to process.
4596254f796bSMatt Gates 	 */
4597254f796bSMatt Gates 	for (i = 0; i < MAX_REPLY_QUEUES; i++)
4598254f796bSMatt Gates 		h->q[i] = (u8) i;
4599254f796bSMatt Gates 
4600254f796bSMatt Gates 	if (h->intr_mode == PERF_MODE_INT && h->msix_vector) {
4601254f796bSMatt Gates 		/* If performant mode and MSI-X, use multiple reply queues */
4602254f796bSMatt Gates 		for (i = 0; i < MAX_REPLY_QUEUES; i++)
4603254f796bSMatt Gates 			rc = request_irq(h->intr[i], msixhandler,
4604254f796bSMatt Gates 					0, h->devname,
4605254f796bSMatt Gates 					&h->q[i]);
4606254f796bSMatt Gates 	} else {
4607254f796bSMatt Gates 		/* Use single reply pool */
4608254f796bSMatt Gates 		if (h->msix_vector || h->msi_vector) {
4609254f796bSMatt Gates 			rc = request_irq(h->intr[h->intr_mode],
4610254f796bSMatt Gates 				msixhandler, 0, h->devname,
4611254f796bSMatt Gates 				&h->q[h->intr_mode]);
4612254f796bSMatt Gates 		} else {
4613254f796bSMatt Gates 			rc = request_irq(h->intr[h->intr_mode],
4614254f796bSMatt Gates 				intxhandler, IRQF_SHARED, h->devname,
4615254f796bSMatt Gates 				&h->q[h->intr_mode]);
4616254f796bSMatt Gates 		}
4617254f796bSMatt Gates 	}
46180ae01a32SStephen M. Cameron 	if (rc) {
46190ae01a32SStephen M. Cameron 		dev_err(&h->pdev->dev, "unable to get irq %d for %s\n",
46200ae01a32SStephen M. Cameron 		       h->intr[h->intr_mode], h->devname);
46210ae01a32SStephen M. Cameron 		return -ENODEV;
46220ae01a32SStephen M. Cameron 	}
46230ae01a32SStephen M. Cameron 	return 0;
46240ae01a32SStephen M. Cameron }
46250ae01a32SStephen M. Cameron 
46266f039790SGreg Kroah-Hartman static int hpsa_kdump_soft_reset(struct ctlr_info *h)
462764670ac8SStephen M. Cameron {
462864670ac8SStephen M. Cameron 	if (hpsa_send_host_reset(h, RAID_CTLR_LUNID,
462964670ac8SStephen M. Cameron 		HPSA_RESET_TYPE_CONTROLLER)) {
463064670ac8SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Resetting array controller failed.\n");
463164670ac8SStephen M. Cameron 		return -EIO;
463264670ac8SStephen M. Cameron 	}
463364670ac8SStephen M. Cameron 
463464670ac8SStephen M. Cameron 	dev_info(&h->pdev->dev, "Waiting for board to soft reset.\n");
463564670ac8SStephen M. Cameron 	if (hpsa_wait_for_board_state(h->pdev, h->vaddr, BOARD_NOT_READY)) {
463664670ac8SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Soft reset had no effect.\n");
463764670ac8SStephen M. Cameron 		return -1;
463864670ac8SStephen M. Cameron 	}
463964670ac8SStephen M. Cameron 
464064670ac8SStephen M. Cameron 	dev_info(&h->pdev->dev, "Board reset, awaiting READY status.\n");
464164670ac8SStephen M. Cameron 	if (hpsa_wait_for_board_state(h->pdev, h->vaddr, BOARD_READY)) {
464264670ac8SStephen M. Cameron 		dev_warn(&h->pdev->dev, "Board failed to become ready "
464364670ac8SStephen M. Cameron 			"after soft reset.\n");
464464670ac8SStephen M. Cameron 		return -1;
464564670ac8SStephen M. Cameron 	}
464664670ac8SStephen M. Cameron 
464764670ac8SStephen M. Cameron 	return 0;
464864670ac8SStephen M. Cameron }
464964670ac8SStephen M. Cameron 
4650254f796bSMatt Gates static void free_irqs(struct ctlr_info *h)
4651254f796bSMatt Gates {
4652254f796bSMatt Gates 	int i;
4653254f796bSMatt Gates 
4654254f796bSMatt Gates 	if (!h->msix_vector || h->intr_mode != PERF_MODE_INT) {
4655254f796bSMatt Gates 		/* Single reply queue, only one irq to free */
4656254f796bSMatt Gates 		i = h->intr_mode;
4657254f796bSMatt Gates 		free_irq(h->intr[i], &h->q[i]);
4658254f796bSMatt Gates 		return;
4659254f796bSMatt Gates 	}
4660254f796bSMatt Gates 
4661254f796bSMatt Gates 	for (i = 0; i < MAX_REPLY_QUEUES; i++)
4662254f796bSMatt Gates 		free_irq(h->intr[i], &h->q[i]);
4663254f796bSMatt Gates }
4664254f796bSMatt Gates 
46650097f0f4SStephen M. Cameron static void hpsa_free_irqs_and_disable_msix(struct ctlr_info *h)
466664670ac8SStephen M. Cameron {
4667254f796bSMatt Gates 	free_irqs(h);
466864670ac8SStephen M. Cameron #ifdef CONFIG_PCI_MSI
46690097f0f4SStephen M. Cameron 	if (h->msix_vector) {
46700097f0f4SStephen M. Cameron 		if (h->pdev->msix_enabled)
467164670ac8SStephen M. Cameron 			pci_disable_msix(h->pdev);
46720097f0f4SStephen M. Cameron 	} else if (h->msi_vector) {
46730097f0f4SStephen M. Cameron 		if (h->pdev->msi_enabled)
467464670ac8SStephen M. Cameron 			pci_disable_msi(h->pdev);
46750097f0f4SStephen M. Cameron 	}
467664670ac8SStephen M. Cameron #endif /* CONFIG_PCI_MSI */
46770097f0f4SStephen M. Cameron }
46780097f0f4SStephen M. Cameron 
46790097f0f4SStephen M. Cameron static void hpsa_undo_allocations_after_kdump_soft_reset(struct ctlr_info *h)
46800097f0f4SStephen M. Cameron {
46810097f0f4SStephen M. Cameron 	hpsa_free_irqs_and_disable_msix(h);
468264670ac8SStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
468364670ac8SStephen M. Cameron 	hpsa_free_cmd_pool(h);
468464670ac8SStephen M. Cameron 	kfree(h->blockFetchTable);
468564670ac8SStephen M. Cameron 	pci_free_consistent(h->pdev, h->reply_pool_size,
468664670ac8SStephen M. Cameron 		h->reply_pool, h->reply_pool_dhandle);
468764670ac8SStephen M. Cameron 	if (h->vaddr)
468864670ac8SStephen M. Cameron 		iounmap(h->vaddr);
468964670ac8SStephen M. Cameron 	if (h->transtable)
469064670ac8SStephen M. Cameron 		iounmap(h->transtable);
469164670ac8SStephen M. Cameron 	if (h->cfgtable)
469264670ac8SStephen M. Cameron 		iounmap(h->cfgtable);
469364670ac8SStephen M. Cameron 	pci_release_regions(h->pdev);
469464670ac8SStephen M. Cameron 	kfree(h);
469564670ac8SStephen M. Cameron }
469664670ac8SStephen M. Cameron 
4697a0c12413SStephen M. Cameron /* Called when controller lockup detected. */
4698a0c12413SStephen M. Cameron static void fail_all_cmds_on_list(struct ctlr_info *h, struct list_head *list)
4699a0c12413SStephen M. Cameron {
4700a0c12413SStephen M. Cameron 	struct CommandList *c = NULL;
4701a0c12413SStephen M. Cameron 
4702a0c12413SStephen M. Cameron 	assert_spin_locked(&h->lock);
4703a0c12413SStephen M. Cameron 	/* Mark all outstanding commands as failed and complete them. */
4704a0c12413SStephen M. Cameron 	while (!list_empty(list)) {
4705a0c12413SStephen M. Cameron 		c = list_entry(list->next, struct CommandList, list);
4706a0c12413SStephen M. Cameron 		c->err_info->CommandStatus = CMD_HARDWARE_ERR;
47075a3d16f5SStephen M. Cameron 		finish_cmd(c);
4708a0c12413SStephen M. Cameron 	}
4709a0c12413SStephen M. Cameron }
4710a0c12413SStephen M. Cameron 
4711a0c12413SStephen M. Cameron static void controller_lockup_detected(struct ctlr_info *h)
4712a0c12413SStephen M. Cameron {
4713a0c12413SStephen M. Cameron 	unsigned long flags;
4714a0c12413SStephen M. Cameron 
4715a0c12413SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_OFF);
4716a0c12413SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
4717a0c12413SStephen M. Cameron 	h->lockup_detected = readl(h->vaddr + SA5_SCRATCHPAD_OFFSET);
4718a0c12413SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
4719a0c12413SStephen M. Cameron 	dev_warn(&h->pdev->dev, "Controller lockup detected: 0x%08x\n",
4720a0c12413SStephen M. Cameron 			h->lockup_detected);
4721a0c12413SStephen M. Cameron 	pci_disable_device(h->pdev);
4722a0c12413SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
4723a0c12413SStephen M. Cameron 	fail_all_cmds_on_list(h, &h->cmpQ);
4724a0c12413SStephen M. Cameron 	fail_all_cmds_on_list(h, &h->reqQ);
4725a0c12413SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
4726a0c12413SStephen M. Cameron }
4727a0c12413SStephen M. Cameron 
4728a0c12413SStephen M. Cameron static void detect_controller_lockup(struct ctlr_info *h)
4729a0c12413SStephen M. Cameron {
4730a0c12413SStephen M. Cameron 	u64 now;
4731a0c12413SStephen M. Cameron 	u32 heartbeat;
4732a0c12413SStephen M. Cameron 	unsigned long flags;
4733a0c12413SStephen M. Cameron 
4734a0c12413SStephen M. Cameron 	now = get_jiffies_64();
4735a0c12413SStephen M. Cameron 	/* If we've received an interrupt recently, we're ok. */
4736a0c12413SStephen M. Cameron 	if (time_after64(h->last_intr_timestamp +
4737e85c5974SStephen M. Cameron 				(h->heartbeat_sample_interval), now))
4738a0c12413SStephen M. Cameron 		return;
4739a0c12413SStephen M. Cameron 
4740a0c12413SStephen M. Cameron 	/*
4741a0c12413SStephen M. Cameron 	 * If we've already checked the heartbeat recently, we're ok.
4742a0c12413SStephen M. Cameron 	 * This could happen if someone sends us a signal. We
4743a0c12413SStephen M. Cameron 	 * otherwise don't care about signals in this thread.
4744a0c12413SStephen M. Cameron 	 */
4745a0c12413SStephen M. Cameron 	if (time_after64(h->last_heartbeat_timestamp +
4746e85c5974SStephen M. Cameron 				(h->heartbeat_sample_interval), now))
4747a0c12413SStephen M. Cameron 		return;
4748a0c12413SStephen M. Cameron 
4749a0c12413SStephen M. Cameron 	/* If heartbeat has not changed since we last looked, we're not ok. */
4750a0c12413SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
4751a0c12413SStephen M. Cameron 	heartbeat = readl(&h->cfgtable->HeartBeat);
4752a0c12413SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
4753a0c12413SStephen M. Cameron 	if (h->last_heartbeat == heartbeat) {
4754a0c12413SStephen M. Cameron 		controller_lockup_detected(h);
4755a0c12413SStephen M. Cameron 		return;
4756a0c12413SStephen M. Cameron 	}
4757a0c12413SStephen M. Cameron 
4758a0c12413SStephen M. Cameron 	/* We're ok. */
4759a0c12413SStephen M. Cameron 	h->last_heartbeat = heartbeat;
4760a0c12413SStephen M. Cameron 	h->last_heartbeat_timestamp = now;
4761a0c12413SStephen M. Cameron }
4762a0c12413SStephen M. Cameron 
47638a98db73SStephen M. Cameron static void hpsa_monitor_ctlr_worker(struct work_struct *work)
4764a0c12413SStephen M. Cameron {
4765a0c12413SStephen M. Cameron 	unsigned long flags;
47668a98db73SStephen M. Cameron 	struct ctlr_info *h = container_of(to_delayed_work(work),
47678a98db73SStephen M. Cameron 					struct ctlr_info, monitor_ctlr_work);
4768a0c12413SStephen M. Cameron 	detect_controller_lockup(h);
47698a98db73SStephen M. Cameron 	if (h->lockup_detected)
47708a98db73SStephen M. Cameron 		return;
47718a98db73SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
47728a98db73SStephen M. Cameron 	if (h->remove_in_progress) {
47738a98db73SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
4774a0c12413SStephen M. Cameron 		return;
4775a0c12413SStephen M. Cameron 	}
47768a98db73SStephen M. Cameron 	schedule_delayed_work(&h->monitor_ctlr_work,
47778a98db73SStephen M. Cameron 				h->heartbeat_sample_interval);
47788a98db73SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
4779a0c12413SStephen M. Cameron }
4780a0c12413SStephen M. Cameron 
47816f039790SGreg Kroah-Hartman static int hpsa_init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
47824c2a8c40SStephen M. Cameron {
47834c2a8c40SStephen M. Cameron 	int dac, rc;
47844c2a8c40SStephen M. Cameron 	struct ctlr_info *h;
478564670ac8SStephen M. Cameron 	int try_soft_reset = 0;
478664670ac8SStephen M. Cameron 	unsigned long flags;
47874c2a8c40SStephen M. Cameron 
47884c2a8c40SStephen M. Cameron 	if (number_of_controllers == 0)
47894c2a8c40SStephen M. Cameron 		printk(KERN_INFO DRIVER_NAME "\n");
47904c2a8c40SStephen M. Cameron 
47914c2a8c40SStephen M. Cameron 	rc = hpsa_init_reset_devices(pdev);
479264670ac8SStephen M. Cameron 	if (rc) {
479364670ac8SStephen M. Cameron 		if (rc != -ENOTSUPP)
47944c2a8c40SStephen M. Cameron 			return rc;
479564670ac8SStephen M. Cameron 		/* If the reset fails in a particular way (it has no way to do
479664670ac8SStephen M. Cameron 		 * a proper hard reset, so returns -ENOTSUPP) we can try to do
479764670ac8SStephen M. Cameron 		 * a soft reset once we get the controller configured up to the
479864670ac8SStephen M. Cameron 		 * point that it can accept a command.
479964670ac8SStephen M. Cameron 		 */
480064670ac8SStephen M. Cameron 		try_soft_reset = 1;
480164670ac8SStephen M. Cameron 		rc = 0;
480264670ac8SStephen M. Cameron 	}
480364670ac8SStephen M. Cameron 
480464670ac8SStephen M. Cameron reinit_after_soft_reset:
48054c2a8c40SStephen M. Cameron 
4806303932fdSDon Brace 	/* Command structures must be aligned on a 32-byte boundary because
4807303932fdSDon Brace 	 * the 5 lower bits of the address are used by the hardware. and by
4808303932fdSDon Brace 	 * the driver.  See comments in hpsa.h for more info.
4809303932fdSDon Brace 	 */
4810303932fdSDon Brace #define COMMANDLIST_ALIGNMENT 32
4811303932fdSDon Brace 	BUILD_BUG_ON(sizeof(struct CommandList) % COMMANDLIST_ALIGNMENT);
4812edd16368SStephen M. Cameron 	h = kzalloc(sizeof(*h), GFP_KERNEL);
4813edd16368SStephen M. Cameron 	if (!h)
4814ecd9aad4SStephen M. Cameron 		return -ENOMEM;
4815edd16368SStephen M. Cameron 
481655c06c71SStephen M. Cameron 	h->pdev = pdev;
4817a9a3a273SStephen M. Cameron 	h->intr_mode = hpsa_simple_mode ? SIMPLE_MODE_INT : PERF_MODE_INT;
48189e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&h->cmpQ);
48199e0fc764SStephen M. Cameron 	INIT_LIST_HEAD(&h->reqQ);
48206eaf46fdSStephen M. Cameron 	spin_lock_init(&h->lock);
48216eaf46fdSStephen M. Cameron 	spin_lock_init(&h->scan_lock);
48220390f0c0SStephen M. Cameron 	spin_lock_init(&h->passthru_count_lock);
482355c06c71SStephen M. Cameron 	rc = hpsa_pci_init(h);
4824ecd9aad4SStephen M. Cameron 	if (rc != 0)
4825edd16368SStephen M. Cameron 		goto clean1;
4826edd16368SStephen M. Cameron 
4827f79cfec6SStephen M. Cameron 	sprintf(h->devname, HPSA "%d", number_of_controllers);
4828edd16368SStephen M. Cameron 	h->ctlr = number_of_controllers;
4829edd16368SStephen M. Cameron 	number_of_controllers++;
4830edd16368SStephen M. Cameron 
4831edd16368SStephen M. Cameron 	/* configure PCI DMA stuff */
4832ecd9aad4SStephen M. Cameron 	rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
4833ecd9aad4SStephen M. Cameron 	if (rc == 0) {
4834edd16368SStephen M. Cameron 		dac = 1;
4835ecd9aad4SStephen M. Cameron 	} else {
4836ecd9aad4SStephen M. Cameron 		rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
4837ecd9aad4SStephen M. Cameron 		if (rc == 0) {
4838edd16368SStephen M. Cameron 			dac = 0;
4839ecd9aad4SStephen M. Cameron 		} else {
4840edd16368SStephen M. Cameron 			dev_err(&pdev->dev, "no suitable DMA available\n");
4841edd16368SStephen M. Cameron 			goto clean1;
4842edd16368SStephen M. Cameron 		}
4843ecd9aad4SStephen M. Cameron 	}
4844edd16368SStephen M. Cameron 
4845edd16368SStephen M. Cameron 	/* make sure the board interrupts are off */
4846edd16368SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_OFF);
484710f66018SStephen M. Cameron 
48480ae01a32SStephen M. Cameron 	if (hpsa_request_irq(h, do_hpsa_intr_msi, do_hpsa_intr_intx))
4849edd16368SStephen M. Cameron 		goto clean2;
4850303932fdSDon Brace 	dev_info(&pdev->dev, "%s: <0x%x> at IRQ %d%s using DAC\n",
4851303932fdSDon Brace 	       h->devname, pdev->device,
4852a9a3a273SStephen M. Cameron 	       h->intr[h->intr_mode], dac ? "" : " not");
48532e9d1b36SStephen M. Cameron 	if (hpsa_allocate_cmd_pool(h))
4854edd16368SStephen M. Cameron 		goto clean4;
485533a2ffceSStephen M. Cameron 	if (hpsa_allocate_sg_chain_blocks(h))
485633a2ffceSStephen M. Cameron 		goto clean4;
4857a08a8471SStephen M. Cameron 	init_waitqueue_head(&h->scan_wait_queue);
4858a08a8471SStephen M. Cameron 	h->scan_finished = 1; /* no scan currently in progress */
4859edd16368SStephen M. Cameron 
4860edd16368SStephen M. Cameron 	pci_set_drvdata(pdev, h);
48619a41338eSStephen M. Cameron 	h->ndevices = 0;
48629a41338eSStephen M. Cameron 	h->scsi_host = NULL;
48639a41338eSStephen M. Cameron 	spin_lock_init(&h->devlock);
486464670ac8SStephen M. Cameron 	hpsa_put_ctlr_into_performant_mode(h);
486564670ac8SStephen M. Cameron 
486664670ac8SStephen M. Cameron 	/* At this point, the controller is ready to take commands.
486764670ac8SStephen M. Cameron 	 * Now, if reset_devices and the hard reset didn't work, try
486864670ac8SStephen M. Cameron 	 * the soft reset and see if that works.
486964670ac8SStephen M. Cameron 	 */
487064670ac8SStephen M. Cameron 	if (try_soft_reset) {
487164670ac8SStephen M. Cameron 
487264670ac8SStephen M. Cameron 		/* This is kind of gross.  We may or may not get a completion
487364670ac8SStephen M. Cameron 		 * from the soft reset command, and if we do, then the value
487464670ac8SStephen M. Cameron 		 * from the fifo may or may not be valid.  So, we wait 10 secs
487564670ac8SStephen M. Cameron 		 * after the reset throwing away any completions we get during
487664670ac8SStephen M. Cameron 		 * that time.  Unregister the interrupt handler and register
487764670ac8SStephen M. Cameron 		 * fake ones to scoop up any residual completions.
487864670ac8SStephen M. Cameron 		 */
487964670ac8SStephen M. Cameron 		spin_lock_irqsave(&h->lock, flags);
488064670ac8SStephen M. Cameron 		h->access.set_intr_mask(h, HPSA_INTR_OFF);
488164670ac8SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
4882254f796bSMatt Gates 		free_irqs(h);
488364670ac8SStephen M. Cameron 		rc = hpsa_request_irq(h, hpsa_msix_discard_completions,
488464670ac8SStephen M. Cameron 					hpsa_intx_discard_completions);
488564670ac8SStephen M. Cameron 		if (rc) {
488664670ac8SStephen M. Cameron 			dev_warn(&h->pdev->dev, "Failed to request_irq after "
488764670ac8SStephen M. Cameron 				"soft reset.\n");
488864670ac8SStephen M. Cameron 			goto clean4;
488964670ac8SStephen M. Cameron 		}
489064670ac8SStephen M. Cameron 
489164670ac8SStephen M. Cameron 		rc = hpsa_kdump_soft_reset(h);
489264670ac8SStephen M. Cameron 		if (rc)
489364670ac8SStephen M. Cameron 			/* Neither hard nor soft reset worked, we're hosed. */
489464670ac8SStephen M. Cameron 			goto clean4;
489564670ac8SStephen M. Cameron 
489664670ac8SStephen M. Cameron 		dev_info(&h->pdev->dev, "Board READY.\n");
489764670ac8SStephen M. Cameron 		dev_info(&h->pdev->dev,
489864670ac8SStephen M. Cameron 			"Waiting for stale completions to drain.\n");
489964670ac8SStephen M. Cameron 		h->access.set_intr_mask(h, HPSA_INTR_ON);
490064670ac8SStephen M. Cameron 		msleep(10000);
490164670ac8SStephen M. Cameron 		h->access.set_intr_mask(h, HPSA_INTR_OFF);
490264670ac8SStephen M. Cameron 
490364670ac8SStephen M. Cameron 		rc = controller_reset_failed(h->cfgtable);
490464670ac8SStephen M. Cameron 		if (rc)
490564670ac8SStephen M. Cameron 			dev_info(&h->pdev->dev,
490664670ac8SStephen M. Cameron 				"Soft reset appears to have failed.\n");
490764670ac8SStephen M. Cameron 
490864670ac8SStephen M. Cameron 		/* since the controller's reset, we have to go back and re-init
490964670ac8SStephen M. Cameron 		 * everything.  Easiest to just forget what we've done and do it
491064670ac8SStephen M. Cameron 		 * all over again.
491164670ac8SStephen M. Cameron 		 */
491264670ac8SStephen M. Cameron 		hpsa_undo_allocations_after_kdump_soft_reset(h);
491364670ac8SStephen M. Cameron 		try_soft_reset = 0;
491464670ac8SStephen M. Cameron 		if (rc)
491564670ac8SStephen M. Cameron 			/* don't go to clean4, we already unallocated */
491664670ac8SStephen M. Cameron 			return -ENODEV;
491764670ac8SStephen M. Cameron 
491864670ac8SStephen M. Cameron 		goto reinit_after_soft_reset;
491964670ac8SStephen M. Cameron 	}
4920edd16368SStephen M. Cameron 
4921edd16368SStephen M. Cameron 	/* Turn the interrupts on so we can service requests */
4922edd16368SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_ON);
4923edd16368SStephen M. Cameron 
4924339b2b14SStephen M. Cameron 	hpsa_hba_inquiry(h);
4925edd16368SStephen M. Cameron 	hpsa_register_scsi(h);	/* hook ourselves into SCSI subsystem */
49268a98db73SStephen M. Cameron 
49278a98db73SStephen M. Cameron 	/* Monitor the controller for firmware lockups */
49288a98db73SStephen M. Cameron 	h->heartbeat_sample_interval = HEARTBEAT_SAMPLE_INTERVAL;
49298a98db73SStephen M. Cameron 	INIT_DELAYED_WORK(&h->monitor_ctlr_work, hpsa_monitor_ctlr_worker);
49308a98db73SStephen M. Cameron 	schedule_delayed_work(&h->monitor_ctlr_work,
49318a98db73SStephen M. Cameron 				h->heartbeat_sample_interval);
493288bf6d62SStephen M. Cameron 	return 0;
4933edd16368SStephen M. Cameron 
4934edd16368SStephen M. Cameron clean4:
493533a2ffceSStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
49362e9d1b36SStephen M. Cameron 	hpsa_free_cmd_pool(h);
4937254f796bSMatt Gates 	free_irqs(h);
4938edd16368SStephen M. Cameron clean2:
4939edd16368SStephen M. Cameron clean1:
4940edd16368SStephen M. Cameron 	kfree(h);
4941ecd9aad4SStephen M. Cameron 	return rc;
4942edd16368SStephen M. Cameron }
4943edd16368SStephen M. Cameron 
4944edd16368SStephen M. Cameron static void hpsa_flush_cache(struct ctlr_info *h)
4945edd16368SStephen M. Cameron {
4946edd16368SStephen M. Cameron 	char *flush_buf;
4947edd16368SStephen M. Cameron 	struct CommandList *c;
4948702890e3SStephen M. Cameron 	unsigned long flags;
4949702890e3SStephen M. Cameron 
4950702890e3SStephen M. Cameron 	/* Don't bother trying to flush the cache if locked up */
4951702890e3SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
4952702890e3SStephen M. Cameron 	if (unlikely(h->lockup_detected)) {
4953702890e3SStephen M. Cameron 		spin_unlock_irqrestore(&h->lock, flags);
4954702890e3SStephen M. Cameron 		return;
4955702890e3SStephen M. Cameron 	}
4956702890e3SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
4957edd16368SStephen M. Cameron 
4958edd16368SStephen M. Cameron 	flush_buf = kzalloc(4, GFP_KERNEL);
4959edd16368SStephen M. Cameron 	if (!flush_buf)
4960edd16368SStephen M. Cameron 		return;
4961edd16368SStephen M. Cameron 
4962edd16368SStephen M. Cameron 	c = cmd_special_alloc(h);
4963edd16368SStephen M. Cameron 	if (!c) {
4964edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev, "cmd_special_alloc returned NULL!\n");
4965edd16368SStephen M. Cameron 		goto out_of_memory;
4966edd16368SStephen M. Cameron 	}
4967a2dac136SStephen M. Cameron 	if (fill_cmd(c, HPSA_CACHE_FLUSH, h, flush_buf, 4, 0,
4968a2dac136SStephen M. Cameron 		RAID_CTLR_LUNID, TYPE_CMD)) {
4969a2dac136SStephen M. Cameron 		goto out;
4970a2dac136SStephen M. Cameron 	}
4971edd16368SStephen M. Cameron 	hpsa_scsi_do_simple_cmd_with_retry(h, c, PCI_DMA_TODEVICE);
4972edd16368SStephen M. Cameron 	if (c->err_info->CommandStatus != 0)
4973a2dac136SStephen M. Cameron out:
4974edd16368SStephen M. Cameron 		dev_warn(&h->pdev->dev,
4975edd16368SStephen M. Cameron 			"error flushing cache on controller\n");
4976edd16368SStephen M. Cameron 	cmd_special_free(h, c);
4977edd16368SStephen M. Cameron out_of_memory:
4978edd16368SStephen M. Cameron 	kfree(flush_buf);
4979edd16368SStephen M. Cameron }
4980edd16368SStephen M. Cameron 
4981edd16368SStephen M. Cameron static void hpsa_shutdown(struct pci_dev *pdev)
4982edd16368SStephen M. Cameron {
4983edd16368SStephen M. Cameron 	struct ctlr_info *h;
4984edd16368SStephen M. Cameron 
4985edd16368SStephen M. Cameron 	h = pci_get_drvdata(pdev);
4986edd16368SStephen M. Cameron 	/* Turn board interrupts off  and send the flush cache command
4987edd16368SStephen M. Cameron 	 * sendcmd will turn off interrupt, and send the flush...
4988edd16368SStephen M. Cameron 	 * To write all data in the battery backed cache to disks
4989edd16368SStephen M. Cameron 	 */
4990edd16368SStephen M. Cameron 	hpsa_flush_cache(h);
4991edd16368SStephen M. Cameron 	h->access.set_intr_mask(h, HPSA_INTR_OFF);
49920097f0f4SStephen M. Cameron 	hpsa_free_irqs_and_disable_msix(h);
4993edd16368SStephen M. Cameron }
4994edd16368SStephen M. Cameron 
49956f039790SGreg Kroah-Hartman static void hpsa_free_device_info(struct ctlr_info *h)
499655e14e76SStephen M. Cameron {
499755e14e76SStephen M. Cameron 	int i;
499855e14e76SStephen M. Cameron 
499955e14e76SStephen M. Cameron 	for (i = 0; i < h->ndevices; i++)
500055e14e76SStephen M. Cameron 		kfree(h->dev[i]);
500155e14e76SStephen M. Cameron }
500255e14e76SStephen M. Cameron 
50036f039790SGreg Kroah-Hartman static void hpsa_remove_one(struct pci_dev *pdev)
5004edd16368SStephen M. Cameron {
5005edd16368SStephen M. Cameron 	struct ctlr_info *h;
50068a98db73SStephen M. Cameron 	unsigned long flags;
5007edd16368SStephen M. Cameron 
5008edd16368SStephen M. Cameron 	if (pci_get_drvdata(pdev) == NULL) {
5009edd16368SStephen M. Cameron 		dev_err(&pdev->dev, "unable to remove device\n");
5010edd16368SStephen M. Cameron 		return;
5011edd16368SStephen M. Cameron 	}
5012edd16368SStephen M. Cameron 	h = pci_get_drvdata(pdev);
50138a98db73SStephen M. Cameron 
50148a98db73SStephen M. Cameron 	/* Get rid of any controller monitoring work items */
50158a98db73SStephen M. Cameron 	spin_lock_irqsave(&h->lock, flags);
50168a98db73SStephen M. Cameron 	h->remove_in_progress = 1;
50178a98db73SStephen M. Cameron 	cancel_delayed_work(&h->monitor_ctlr_work);
50188a98db73SStephen M. Cameron 	spin_unlock_irqrestore(&h->lock, flags);
50198a98db73SStephen M. Cameron 
5020edd16368SStephen M. Cameron 	hpsa_unregister_scsi(h);	/* unhook from SCSI subsystem */
5021edd16368SStephen M. Cameron 	hpsa_shutdown(pdev);
5022edd16368SStephen M. Cameron 	iounmap(h->vaddr);
5023204892e9SStephen M. Cameron 	iounmap(h->transtable);
5024204892e9SStephen M. Cameron 	iounmap(h->cfgtable);
502555e14e76SStephen M. Cameron 	hpsa_free_device_info(h);
502633a2ffceSStephen M. Cameron 	hpsa_free_sg_chain_blocks(h);
5027edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev,
5028edd16368SStephen M. Cameron 		h->nr_cmds * sizeof(struct CommandList),
5029edd16368SStephen M. Cameron 		h->cmd_pool, h->cmd_pool_dhandle);
5030edd16368SStephen M. Cameron 	pci_free_consistent(h->pdev,
5031edd16368SStephen M. Cameron 		h->nr_cmds * sizeof(struct ErrorInfo),
5032edd16368SStephen M. Cameron 		h->errinfo_pool, h->errinfo_pool_dhandle);
5033303932fdSDon Brace 	pci_free_consistent(h->pdev, h->reply_pool_size,
5034303932fdSDon Brace 		h->reply_pool, h->reply_pool_dhandle);
5035edd16368SStephen M. Cameron 	kfree(h->cmd_pool_bits);
5036303932fdSDon Brace 	kfree(h->blockFetchTable);
5037339b2b14SStephen M. Cameron 	kfree(h->hba_inquiry_data);
5038f0bd0b68SStephen M. Cameron 	pci_disable_device(pdev);
5039edd16368SStephen M. Cameron 	pci_release_regions(pdev);
5040edd16368SStephen M. Cameron 	kfree(h);
5041edd16368SStephen M. Cameron }
5042edd16368SStephen M. Cameron 
5043edd16368SStephen M. Cameron static int hpsa_suspend(__attribute__((unused)) struct pci_dev *pdev,
5044edd16368SStephen M. Cameron 	__attribute__((unused)) pm_message_t state)
5045edd16368SStephen M. Cameron {
5046edd16368SStephen M. Cameron 	return -ENOSYS;
5047edd16368SStephen M. Cameron }
5048edd16368SStephen M. Cameron 
5049edd16368SStephen M. Cameron static int hpsa_resume(__attribute__((unused)) struct pci_dev *pdev)
5050edd16368SStephen M. Cameron {
5051edd16368SStephen M. Cameron 	return -ENOSYS;
5052edd16368SStephen M. Cameron }
5053edd16368SStephen M. Cameron 
5054edd16368SStephen M. Cameron static struct pci_driver hpsa_pci_driver = {
5055f79cfec6SStephen M. Cameron 	.name = HPSA,
5056edd16368SStephen M. Cameron 	.probe = hpsa_init_one,
50576f039790SGreg Kroah-Hartman 	.remove = hpsa_remove_one,
5058edd16368SStephen M. Cameron 	.id_table = hpsa_pci_device_id,	/* id_table */
5059edd16368SStephen M. Cameron 	.shutdown = hpsa_shutdown,
5060edd16368SStephen M. Cameron 	.suspend = hpsa_suspend,
5061edd16368SStephen M. Cameron 	.resume = hpsa_resume,
5062edd16368SStephen M. Cameron };
5063edd16368SStephen M. Cameron 
5064303932fdSDon Brace /* Fill in bucket_map[], given nsgs (the max number of
5065303932fdSDon Brace  * scatter gather elements supported) and bucket[],
5066303932fdSDon Brace  * which is an array of 8 integers.  The bucket[] array
5067303932fdSDon Brace  * contains 8 different DMA transfer sizes (in 16
5068303932fdSDon Brace  * byte increments) which the controller uses to fetch
5069303932fdSDon Brace  * commands.  This function fills in bucket_map[], which
5070303932fdSDon Brace  * maps a given number of scatter gather elements to one of
5071303932fdSDon Brace  * the 8 DMA transfer sizes.  The point of it is to allow the
5072303932fdSDon Brace  * controller to only do as much DMA as needed to fetch the
5073303932fdSDon Brace  * command, with the DMA transfer size encoded in the lower
5074303932fdSDon Brace  * bits of the command address.
5075303932fdSDon Brace  */
5076303932fdSDon Brace static void  calc_bucket_map(int bucket[], int num_buckets,
5077303932fdSDon Brace 	int nsgs, int *bucket_map)
5078303932fdSDon Brace {
5079303932fdSDon Brace 	int i, j, b, size;
5080303932fdSDon Brace 
5081303932fdSDon Brace 	/* even a command with 0 SGs requires 4 blocks */
5082303932fdSDon Brace #define MINIMUM_TRANSFER_BLOCKS 4
5083303932fdSDon Brace #define NUM_BUCKETS 8
5084303932fdSDon Brace 	/* Note, bucket_map must have nsgs+1 entries. */
5085303932fdSDon Brace 	for (i = 0; i <= nsgs; i++) {
5086303932fdSDon Brace 		/* Compute size of a command with i SG entries */
5087303932fdSDon Brace 		size = i + MINIMUM_TRANSFER_BLOCKS;
5088303932fdSDon Brace 		b = num_buckets; /* Assume the biggest bucket */
5089303932fdSDon Brace 		/* Find the bucket that is just big enough */
5090303932fdSDon Brace 		for (j = 0; j < 8; j++) {
5091303932fdSDon Brace 			if (bucket[j] >= size) {
5092303932fdSDon Brace 				b = j;
5093303932fdSDon Brace 				break;
5094303932fdSDon Brace 			}
5095303932fdSDon Brace 		}
5096303932fdSDon Brace 		/* for a command with i SG entries, use bucket b. */
5097303932fdSDon Brace 		bucket_map[i] = b;
5098303932fdSDon Brace 	}
5099303932fdSDon Brace }
5100303932fdSDon Brace 
51016f039790SGreg Kroah-Hartman static void hpsa_enter_performant_mode(struct ctlr_info *h, u32 use_short_tags)
5102303932fdSDon Brace {
51036c311b57SStephen M. Cameron 	int i;
51046c311b57SStephen M. Cameron 	unsigned long register_value;
5105def342bdSStephen M. Cameron 
5106def342bdSStephen M. Cameron 	/* This is a bit complicated.  There are 8 registers on
5107def342bdSStephen M. Cameron 	 * the controller which we write to to tell it 8 different
5108def342bdSStephen M. Cameron 	 * sizes of commands which there may be.  It's a way of
5109def342bdSStephen M. Cameron 	 * reducing the DMA done to fetch each command.  Encoded into
5110def342bdSStephen M. Cameron 	 * each command's tag are 3 bits which communicate to the controller
5111def342bdSStephen M. Cameron 	 * which of the eight sizes that command fits within.  The size of
5112def342bdSStephen M. Cameron 	 * each command depends on how many scatter gather entries there are.
5113def342bdSStephen M. Cameron 	 * Each SG entry requires 16 bytes.  The eight registers are programmed
5114def342bdSStephen M. Cameron 	 * with the number of 16-byte blocks a command of that size requires.
5115def342bdSStephen M. Cameron 	 * The smallest command possible requires 5 such 16 byte blocks.
5116d66ae08bSStephen M. Cameron 	 * the largest command possible requires SG_ENTRIES_IN_CMD + 4 16-byte
5117def342bdSStephen M. Cameron 	 * blocks.  Note, this only extends to the SG entries contained
5118def342bdSStephen M. Cameron 	 * within the command block, and does not extend to chained blocks
5119def342bdSStephen M. Cameron 	 * of SG elements.   bft[] contains the eight values we write to
5120def342bdSStephen M. Cameron 	 * the registers.  They are not evenly distributed, but have more
5121def342bdSStephen M. Cameron 	 * sizes for small commands, and fewer sizes for larger commands.
5122def342bdSStephen M. Cameron 	 */
5123d66ae08bSStephen M. Cameron 	int bft[8] = {5, 6, 8, 10, 12, 20, 28, SG_ENTRIES_IN_CMD + 4};
5124d66ae08bSStephen M. Cameron 	BUILD_BUG_ON(28 > SG_ENTRIES_IN_CMD + 4);
5125303932fdSDon Brace 	/*  5 = 1 s/g entry or 4k
5126303932fdSDon Brace 	 *  6 = 2 s/g entry or 8k
5127303932fdSDon Brace 	 *  8 = 4 s/g entry or 16k
5128303932fdSDon Brace 	 * 10 = 6 s/g entry or 24k
5129303932fdSDon Brace 	 */
5130303932fdSDon Brace 
5131303932fdSDon Brace 	/* Controller spec: zero out this buffer. */
5132303932fdSDon Brace 	memset(h->reply_pool, 0, h->reply_pool_size);
5133303932fdSDon Brace 
5134d66ae08bSStephen M. Cameron 	bft[7] = SG_ENTRIES_IN_CMD + 4;
5135d66ae08bSStephen M. Cameron 	calc_bucket_map(bft, ARRAY_SIZE(bft),
5136d66ae08bSStephen M. Cameron 				SG_ENTRIES_IN_CMD, h->blockFetchTable);
5137303932fdSDon Brace 	for (i = 0; i < 8; i++)
5138303932fdSDon Brace 		writel(bft[i], &h->transtable->BlockFetch[i]);
5139303932fdSDon Brace 
5140303932fdSDon Brace 	/* size of controller ring buffer */
5141303932fdSDon Brace 	writel(h->max_commands, &h->transtable->RepQSize);
5142254f796bSMatt Gates 	writel(h->nreply_queues, &h->transtable->RepQCount);
5143303932fdSDon Brace 	writel(0, &h->transtable->RepQCtrAddrLow32);
5144303932fdSDon Brace 	writel(0, &h->transtable->RepQCtrAddrHigh32);
5145254f796bSMatt Gates 
5146254f796bSMatt Gates 	for (i = 0; i < h->nreply_queues; i++) {
5147254f796bSMatt Gates 		writel(0, &h->transtable->RepQAddr[i].upper);
5148254f796bSMatt Gates 		writel(h->reply_pool_dhandle +
5149254f796bSMatt Gates 			(h->max_commands * sizeof(u64) * i),
5150254f796bSMatt Gates 			&h->transtable->RepQAddr[i].lower);
5151254f796bSMatt Gates 	}
5152254f796bSMatt Gates 
5153254f796bSMatt Gates 	writel(CFGTBL_Trans_Performant | use_short_tags |
5154254f796bSMatt Gates 		CFGTBL_Trans_enable_directed_msix,
5155303932fdSDon Brace 		&(h->cfgtable->HostWrite.TransportRequest));
5156303932fdSDon Brace 	writel(CFGTBL_ChangeReq, h->vaddr + SA5_DOORBELL);
51573f4336f3SStephen M. Cameron 	hpsa_wait_for_mode_change_ack(h);
5158303932fdSDon Brace 	register_value = readl(&(h->cfgtable->TransportActive));
5159303932fdSDon Brace 	if (!(register_value & CFGTBL_Trans_Performant)) {
5160303932fdSDon Brace 		dev_warn(&h->pdev->dev, "unable to get board into"
5161303932fdSDon Brace 					" performant mode\n");
5162303932fdSDon Brace 		return;
5163303932fdSDon Brace 	}
5164960a30e7SStephen M. Cameron 	/* Change the access methods to the performant access methods */
5165960a30e7SStephen M. Cameron 	h->access = SA5_performant_access;
5166960a30e7SStephen M. Cameron 	h->transMethod = CFGTBL_Trans_Performant;
51676c311b57SStephen M. Cameron }
51686c311b57SStephen M. Cameron 
51696f039790SGreg Kroah-Hartman static void hpsa_put_ctlr_into_performant_mode(struct ctlr_info *h)
51706c311b57SStephen M. Cameron {
51716c311b57SStephen M. Cameron 	u32 trans_support;
5172254f796bSMatt Gates 	int i;
51736c311b57SStephen M. Cameron 
517402ec19c8SStephen M. Cameron 	if (hpsa_simple_mode)
517502ec19c8SStephen M. Cameron 		return;
517602ec19c8SStephen M. Cameron 
51776c311b57SStephen M. Cameron 	trans_support = readl(&(h->cfgtable->TransportSupport));
51786c311b57SStephen M. Cameron 	if (!(trans_support & PERFORMANT_MODE))
51796c311b57SStephen M. Cameron 		return;
51806c311b57SStephen M. Cameron 
5181254f796bSMatt Gates 	h->nreply_queues = h->msix_vector ? MAX_REPLY_QUEUES : 1;
5182cba3d38bSStephen M. Cameron 	hpsa_get_max_perf_mode_cmds(h);
51836c311b57SStephen M. Cameron 	/* Performant mode ring buffer and supporting data structures */
5184254f796bSMatt Gates 	h->reply_pool_size = h->max_commands * sizeof(u64) * h->nreply_queues;
51856c311b57SStephen M. Cameron 	h->reply_pool = pci_alloc_consistent(h->pdev, h->reply_pool_size,
51866c311b57SStephen M. Cameron 				&(h->reply_pool_dhandle));
51876c311b57SStephen M. Cameron 
5188254f796bSMatt Gates 	for (i = 0; i < h->nreply_queues; i++) {
5189254f796bSMatt Gates 		h->reply_queue[i].head = &h->reply_pool[h->max_commands * i];
5190254f796bSMatt Gates 		h->reply_queue[i].size = h->max_commands;
5191254f796bSMatt Gates 		h->reply_queue[i].wraparound = 1;  /* spec: init to 1 */
5192254f796bSMatt Gates 		h->reply_queue[i].current_entry = 0;
5193254f796bSMatt Gates 	}
5194254f796bSMatt Gates 
51956c311b57SStephen M. Cameron 	/* Need a block fetch table for performant mode */
5196d66ae08bSStephen M. Cameron 	h->blockFetchTable = kmalloc(((SG_ENTRIES_IN_CMD + 1) *
51976c311b57SStephen M. Cameron 				sizeof(u32)), GFP_KERNEL);
51986c311b57SStephen M. Cameron 
51996c311b57SStephen M. Cameron 	if ((h->reply_pool == NULL)
52006c311b57SStephen M. Cameron 		|| (h->blockFetchTable == NULL))
52016c311b57SStephen M. Cameron 		goto clean_up;
52026c311b57SStephen M. Cameron 
5203960a30e7SStephen M. Cameron 	hpsa_enter_performant_mode(h,
5204960a30e7SStephen M. Cameron 		trans_support & CFGTBL_Trans_use_short_tags);
5205303932fdSDon Brace 
5206303932fdSDon Brace 	return;
5207303932fdSDon Brace 
5208303932fdSDon Brace clean_up:
5209303932fdSDon Brace 	if (h->reply_pool)
5210303932fdSDon Brace 		pci_free_consistent(h->pdev, h->reply_pool_size,
5211303932fdSDon Brace 			h->reply_pool, h->reply_pool_dhandle);
5212303932fdSDon Brace 	kfree(h->blockFetchTable);
5213303932fdSDon Brace }
5214303932fdSDon Brace 
5215edd16368SStephen M. Cameron /*
5216edd16368SStephen M. Cameron  *  This is it.  Register the PCI driver information for the cards we control
5217edd16368SStephen M. Cameron  *  the OS will call our registered routines when it finds one of our cards.
5218edd16368SStephen M. Cameron  */
5219edd16368SStephen M. Cameron static int __init hpsa_init(void)
5220edd16368SStephen M. Cameron {
522131468401SMike Miller 	return pci_register_driver(&hpsa_pci_driver);
5222edd16368SStephen M. Cameron }
5223edd16368SStephen M. Cameron 
5224edd16368SStephen M. Cameron static void __exit hpsa_cleanup(void)
5225edd16368SStephen M. Cameron {
5226edd16368SStephen M. Cameron 	pci_unregister_driver(&hpsa_pci_driver);
5227edd16368SStephen M. Cameron }
5228edd16368SStephen M. Cameron 
5229edd16368SStephen M. Cameron module_init(hpsa_init);
5230edd16368SStephen M. Cameron module_exit(hpsa_cleanup);
5231