Version:  2.0.40 2.2.26 2.4.37 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17

Linux/drivers/scsi/ipr.c

  1 /*
  2  * ipr.c -- driver for IBM Power Linux RAID adapters
  3  *
  4  * Written By: Brian King <brking@us.ibm.com>, IBM Corporation
  5  *
  6  * Copyright (C) 2003, 2004 IBM Corporation
  7  *
  8  * This program is free software; you can redistribute it and/or modify
  9  * it under the terms of the GNU General Public License as published by
 10  * the Free Software Foundation; either version 2 of the License, or
 11  * (at your option) any later version.
 12  *
 13  * This program is distributed in the hope that it will be useful,
 14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16  * GNU General Public License for more details.
 17  *
 18  * You should have received a copy of the GNU General Public License
 19  * along with this program; if not, write to the Free Software
 20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 21  *
 22  */
 23 
 24 /*
 25  * Notes:
 26  *
 27  * This driver is used to control the following SCSI adapters:
 28  *
 29  * IBM iSeries: 5702, 5703, 2780, 5709, 570A, 570B
 30  *
 31  * IBM pSeries: PCI-X Dual Channel Ultra 320 SCSI RAID Adapter
 32  *              PCI-X Dual Channel Ultra 320 SCSI Adapter
 33  *              PCI-X Dual Channel Ultra 320 SCSI RAID Enablement Card
 34  *              Embedded SCSI adapter on p615 and p655 systems
 35  *
 36  * Supported Hardware Features:
 37  *      - Ultra 320 SCSI controller
 38  *      - PCI-X host interface
 39  *      - Embedded PowerPC RISC Processor and Hardware XOR DMA Engine
 40  *      - Non-Volatile Write Cache
 41  *      - Supports attachment of non-RAID disks, tape, and optical devices
 42  *      - RAID Levels 0, 5, 10
 43  *      - Hot spare
 44  *      - Background Parity Checking
 45  *      - Background Data Scrubbing
 46  *      - Ability to increase the capacity of an existing RAID 5 disk array
 47  *              by adding disks
 48  *
 49  * Driver Features:
 50  *      - Tagged command queuing
 51  *      - Adapter microcode download
 52  *      - PCI hot plug
 53  *      - SCSI device hot plug
 54  *
 55  */
 56 
 57 #include <linux/fs.h>
 58 #include <linux/init.h>
 59 #include <linux/types.h>
 60 #include <linux/errno.h>
 61 #include <linux/kernel.h>
 62 #include <linux/slab.h>
 63 #include <linux/vmalloc.h>
 64 #include <linux/ioport.h>
 65 #include <linux/delay.h>
 66 #include <linux/pci.h>
 67 #include <linux/wait.h>
 68 #include <linux/spinlock.h>
 69 #include <linux/sched.h>
 70 #include <linux/interrupt.h>
 71 #include <linux/blkdev.h>
 72 #include <linux/firmware.h>
 73 #include <linux/module.h>
 74 #include <linux/moduleparam.h>
 75 #include <linux/libata.h>
 76 #include <linux/hdreg.h>
 77 #include <linux/reboot.h>
 78 #include <linux/stringify.h>
 79 #include <asm/io.h>
 80 #include <asm/irq.h>
 81 #include <asm/processor.h>
 82 #include <scsi/scsi.h>
 83 #include <scsi/scsi_host.h>
 84 #include <scsi/scsi_tcq.h>
 85 #include <scsi/scsi_eh.h>
 86 #include <scsi/scsi_cmnd.h>
 87 #include "ipr.h"
 88 
 89 /*
 90  *   Global Data
 91  */
 92 static LIST_HEAD(ipr_ioa_head);
 93 static unsigned int ipr_log_level = IPR_DEFAULT_LOG_LEVEL;
 94 static unsigned int ipr_max_speed = 1;
 95 static int ipr_testmode = 0;
 96 static unsigned int ipr_fastfail = 0;
 97 static unsigned int ipr_transop_timeout = 0;
 98 static unsigned int ipr_debug = 0;
 99 static unsigned int ipr_max_devs = IPR_DEFAULT_SIS64_DEVS;
100 static unsigned int ipr_dual_ioa_raid = 1;
101 static unsigned int ipr_number_of_msix = 2;
102 static DEFINE_SPINLOCK(ipr_driver_lock);
103 
104 /* This table describes the differences between DMA controller chips */
105 static const struct ipr_chip_cfg_t ipr_chip_cfg[] = {
106         { /* Gemstone, Citrine, Obsidian, and Obsidian-E */
107                 .mailbox = 0x0042C,
108                 .max_cmds = 100,
109                 .cache_line_size = 0x20,
110                 .clear_isr = 1,
111                 .iopoll_weight = 0,
112                 {
113                         .set_interrupt_mask_reg = 0x0022C,
114                         .clr_interrupt_mask_reg = 0x00230,
115                         .clr_interrupt_mask_reg32 = 0x00230,
116                         .sense_interrupt_mask_reg = 0x0022C,
117                         .sense_interrupt_mask_reg32 = 0x0022C,
118                         .clr_interrupt_reg = 0x00228,
119                         .clr_interrupt_reg32 = 0x00228,
120                         .sense_interrupt_reg = 0x00224,
121                         .sense_interrupt_reg32 = 0x00224,
122                         .ioarrin_reg = 0x00404,
123                         .sense_uproc_interrupt_reg = 0x00214,
124                         .sense_uproc_interrupt_reg32 = 0x00214,
125                         .set_uproc_interrupt_reg = 0x00214,
126                         .set_uproc_interrupt_reg32 = 0x00214,
127                         .clr_uproc_interrupt_reg = 0x00218,
128                         .clr_uproc_interrupt_reg32 = 0x00218
129                 }
130         },
131         { /* Snipe and Scamp */
132                 .mailbox = 0x0052C,
133                 .max_cmds = 100,
134                 .cache_line_size = 0x20,
135                 .clear_isr = 1,
136                 .iopoll_weight = 0,
137                 {
138                         .set_interrupt_mask_reg = 0x00288,
139                         .clr_interrupt_mask_reg = 0x0028C,
140                         .clr_interrupt_mask_reg32 = 0x0028C,
141                         .sense_interrupt_mask_reg = 0x00288,
142                         .sense_interrupt_mask_reg32 = 0x00288,
143                         .clr_interrupt_reg = 0x00284,
144                         .clr_interrupt_reg32 = 0x00284,
145                         .sense_interrupt_reg = 0x00280,
146                         .sense_interrupt_reg32 = 0x00280,
147                         .ioarrin_reg = 0x00504,
148                         .sense_uproc_interrupt_reg = 0x00290,
149                         .sense_uproc_interrupt_reg32 = 0x00290,
150                         .set_uproc_interrupt_reg = 0x00290,
151                         .set_uproc_interrupt_reg32 = 0x00290,
152                         .clr_uproc_interrupt_reg = 0x00294,
153                         .clr_uproc_interrupt_reg32 = 0x00294
154                 }
155         },
156         { /* CRoC */
157                 .mailbox = 0x00044,
158                 .max_cmds = 1000,
159                 .cache_line_size = 0x20,
160                 .clear_isr = 0,
161                 .iopoll_weight = 64,
162                 {
163                         .set_interrupt_mask_reg = 0x00010,
164                         .clr_interrupt_mask_reg = 0x00018,
165                         .clr_interrupt_mask_reg32 = 0x0001C,
166                         .sense_interrupt_mask_reg = 0x00010,
167                         .sense_interrupt_mask_reg32 = 0x00014,
168                         .clr_interrupt_reg = 0x00008,
169                         .clr_interrupt_reg32 = 0x0000C,
170                         .sense_interrupt_reg = 0x00000,
171                         .sense_interrupt_reg32 = 0x00004,
172                         .ioarrin_reg = 0x00070,
173                         .sense_uproc_interrupt_reg = 0x00020,
174                         .sense_uproc_interrupt_reg32 = 0x00024,
175                         .set_uproc_interrupt_reg = 0x00020,
176                         .set_uproc_interrupt_reg32 = 0x00024,
177                         .clr_uproc_interrupt_reg = 0x00028,
178                         .clr_uproc_interrupt_reg32 = 0x0002C,
179                         .init_feedback_reg = 0x0005C,
180                         .dump_addr_reg = 0x00064,
181                         .dump_data_reg = 0x00068,
182                         .endian_swap_reg = 0x00084
183                 }
184         },
185 };
186 
187 static const struct ipr_chip_t ipr_chip[] = {
188         { PCI_VENDOR_ID_MYLEX, PCI_DEVICE_ID_IBM_GEMSTONE, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
189         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CITRINE, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
190         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_OBSIDIAN, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
191         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
192         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_OBSIDIAN_E, IPR_USE_MSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[0] },
193         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_SNIPE, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[1] },
194         { PCI_VENDOR_ID_ADAPTEC2, PCI_DEVICE_ID_ADAPTEC2_SCAMP, IPR_USE_LSI, IPR_SIS32, IPR_PCI_CFG, &ipr_chip_cfg[1] },
195         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROC_FPGA_E2, IPR_USE_MSI, IPR_SIS64, IPR_MMIO, &ipr_chip_cfg[2] },
196         { PCI_VENDOR_ID_IBM, PCI_DEVICE_ID_IBM_CROCODILE, IPR_USE_MSI, IPR_SIS64, IPR_MMIO, &ipr_chip_cfg[2] }
197 };
198 
199 static int ipr_max_bus_speeds[] = {
200         IPR_80MBs_SCSI_RATE, IPR_U160_SCSI_RATE, IPR_U320_SCSI_RATE
201 };
202 
203 MODULE_AUTHOR("Brian King <brking@us.ibm.com>");
204 MODULE_DESCRIPTION("IBM Power RAID SCSI Adapter Driver");
205 module_param_named(max_speed, ipr_max_speed, uint, 0);
206 MODULE_PARM_DESC(max_speed, "Maximum bus speed (0-2). Default: 1=U160. Speeds: 0=80 MB/s, 1=U160, 2=U320");
207 module_param_named(log_level, ipr_log_level, uint, 0);
208 MODULE_PARM_DESC(log_level, "Set to 0 - 4 for increasing verbosity of device driver");
209 module_param_named(testmode, ipr_testmode, int, 0);
210 MODULE_PARM_DESC(testmode, "DANGEROUS!!! Allows unsupported configurations");
211 module_param_named(fastfail, ipr_fastfail, int, S_IRUGO | S_IWUSR);
212 MODULE_PARM_DESC(fastfail, "Reduce timeouts and retries");
213 module_param_named(transop_timeout, ipr_transop_timeout, int, 0);
214 MODULE_PARM_DESC(transop_timeout, "Time in seconds to wait for adapter to come operational (default: 300)");
215 module_param_named(debug, ipr_debug, int, S_IRUGO | S_IWUSR);
216 MODULE_PARM_DESC(debug, "Enable device driver debugging logging. Set to 1 to enable. (default: 0)");
217 module_param_named(dual_ioa_raid, ipr_dual_ioa_raid, int, 0);
218 MODULE_PARM_DESC(dual_ioa_raid, "Enable dual adapter RAID support. Set to 1 to enable. (default: 1)");
219 module_param_named(max_devs, ipr_max_devs, int, 0);
220 MODULE_PARM_DESC(max_devs, "Specify the maximum number of physical devices. "
221                  "[Default=" __stringify(IPR_DEFAULT_SIS64_DEVS) "]");
222 module_param_named(number_of_msix, ipr_number_of_msix, int, 0);
223 MODULE_PARM_DESC(number_of_msix, "Specify the number of MSIX interrupts to use on capable adapters (1 - 16).  (default:2)");
224 MODULE_LICENSE("GPL");
225 MODULE_VERSION(IPR_DRIVER_VERSION);
226 
227 /*  A constant array of IOASCs/URCs/Error Messages */
228 static const
229 struct ipr_error_table_t ipr_error_table[] = {
230         {0x00000000, 1, IPR_DEFAULT_LOG_LEVEL,
231         "8155: An unknown error was received"},
232         {0x00330000, 0, 0,
233         "Soft underlength error"},
234         {0x005A0000, 0, 0,
235         "Command to be cancelled not found"},
236         {0x00808000, 0, 0,
237         "Qualified success"},
238         {0x01080000, 1, IPR_DEFAULT_LOG_LEVEL,
239         "FFFE: Soft device bus error recovered by the IOA"},
240         {0x01088100, 0, IPR_DEFAULT_LOG_LEVEL,
241         "4101: Soft device bus fabric error"},
242         {0x01100100, 0, IPR_DEFAULT_LOG_LEVEL,
243         "FFFC: Logical block guard error recovered by the device"},
244         {0x01100300, 0, IPR_DEFAULT_LOG_LEVEL,
245         "FFFC: Logical block reference tag error recovered by the device"},
246         {0x01108300, 0, IPR_DEFAULT_LOG_LEVEL,
247         "4171: Recovered scatter list tag / sequence number error"},
248         {0x01109000, 0, IPR_DEFAULT_LOG_LEVEL,
249         "FF3D: Recovered logical block CRC error on IOA to Host transfer"},
250         {0x01109200, 0, IPR_DEFAULT_LOG_LEVEL,
251         "4171: Recovered logical block sequence number error on IOA to Host transfer"},
252         {0x0110A000, 0, IPR_DEFAULT_LOG_LEVEL,
253         "FFFD: Recovered logical block reference tag error detected by the IOA"},
254         {0x0110A100, 0, IPR_DEFAULT_LOG_LEVEL,
255         "FFFD: Logical block guard error recovered by the IOA"},
256         {0x01170600, 0, IPR_DEFAULT_LOG_LEVEL,
257         "FFF9: Device sector reassign successful"},
258         {0x01170900, 0, IPR_DEFAULT_LOG_LEVEL,
259         "FFF7: Media error recovered by device rewrite procedures"},
260         {0x01180200, 0, IPR_DEFAULT_LOG_LEVEL,
261         "7001: IOA sector reassignment successful"},
262         {0x01180500, 0, IPR_DEFAULT_LOG_LEVEL,
263         "FFF9: Soft media error. Sector reassignment recommended"},
264         {0x01180600, 0, IPR_DEFAULT_LOG_LEVEL,
265         "FFF7: Media error recovered by IOA rewrite procedures"},
266         {0x01418000, 0, IPR_DEFAULT_LOG_LEVEL,
267         "FF3D: Soft PCI bus error recovered by the IOA"},
268         {0x01440000, 1, IPR_DEFAULT_LOG_LEVEL,
269         "FFF6: Device hardware error recovered by the IOA"},
270         {0x01448100, 0, IPR_DEFAULT_LOG_LEVEL,
271         "FFF6: Device hardware error recovered by the device"},
272         {0x01448200, 1, IPR_DEFAULT_LOG_LEVEL,
273         "FF3D: Soft IOA error recovered by the IOA"},
274         {0x01448300, 0, IPR_DEFAULT_LOG_LEVEL,
275         "FFFA: Undefined device response recovered by the IOA"},
276         {0x014A0000, 1, IPR_DEFAULT_LOG_LEVEL,
277         "FFF6: Device bus error, message or command phase"},
278         {0x014A8000, 0, IPR_DEFAULT_LOG_LEVEL,
279         "FFFE: Task Management Function failed"},
280         {0x015D0000, 0, IPR_DEFAULT_LOG_LEVEL,
281         "FFF6: Failure prediction threshold exceeded"},
282         {0x015D9200, 0, IPR_DEFAULT_LOG_LEVEL,
283         "8009: Impending cache battery pack failure"},
284         {0x02040100, 0, 0,
285         "Logical Unit in process of becoming ready"},
286         {0x02040200, 0, 0,
287         "Initializing command required"},
288         {0x02040400, 0, 0,
289         "34FF: Disk device format in progress"},
290         {0x02040C00, 0, 0,
291         "Logical unit not accessible, target port in unavailable state"},
292         {0x02048000, 0, IPR_DEFAULT_LOG_LEVEL,
293         "9070: IOA requested reset"},
294         {0x023F0000, 0, 0,
295         "Synchronization required"},
296         {0x02408500, 0, 0,
297         "IOA microcode download required"},
298         {0x02408600, 0, 0,
299         "Device bus connection is prohibited by host"},
300         {0x024E0000, 0, 0,
301         "No ready, IOA shutdown"},
302         {0x025A0000, 0, 0,
303         "Not ready, IOA has been shutdown"},
304         {0x02670100, 0, IPR_DEFAULT_LOG_LEVEL,
305         "3020: Storage subsystem configuration error"},
306         {0x03110B00, 0, 0,
307         "FFF5: Medium error, data unreadable, recommend reassign"},
308         {0x03110C00, 0, 0,
309         "7000: Medium error, data unreadable, do not reassign"},
310         {0x03310000, 0, IPR_DEFAULT_LOG_LEVEL,
311         "FFF3: Disk media format bad"},
312         {0x04050000, 0, IPR_DEFAULT_LOG_LEVEL,
313         "3002: Addressed device failed to respond to selection"},
314         {0x04080000, 1, IPR_DEFAULT_LOG_LEVEL,
315         "3100: Device bus error"},
316         {0x04080100, 0, IPR_DEFAULT_LOG_LEVEL,
317         "3109: IOA timed out a device command"},
318         {0x04088000, 0, 0,
319         "3120: SCSI bus is not operational"},
320         {0x04088100, 0, IPR_DEFAULT_LOG_LEVEL,
321         "4100: Hard device bus fabric error"},
322         {0x04100100, 0, IPR_DEFAULT_LOG_LEVEL,
323         "310C: Logical block guard error detected by the device"},
324         {0x04100300, 0, IPR_DEFAULT_LOG_LEVEL,
325         "310C: Logical block reference tag error detected by the device"},
326         {0x04108300, 1, IPR_DEFAULT_LOG_LEVEL,
327         "4170: Scatter list tag / sequence number error"},
328         {0x04109000, 1, IPR_DEFAULT_LOG_LEVEL,
329         "8150: Logical block CRC error on IOA to Host transfer"},
330         {0x04109200, 1, IPR_DEFAULT_LOG_LEVEL,
331         "4170: Logical block sequence number error on IOA to Host transfer"},
332         {0x0410A000, 0, IPR_DEFAULT_LOG_LEVEL,
333         "310D: Logical block reference tag error detected by the IOA"},
334         {0x0410A100, 0, IPR_DEFAULT_LOG_LEVEL,
335         "310D: Logical block guard error detected by the IOA"},
336         {0x04118000, 0, IPR_DEFAULT_LOG_LEVEL,
337         "9000: IOA reserved area data check"},
338         {0x04118100, 0, IPR_DEFAULT_LOG_LEVEL,
339         "9001: IOA reserved area invalid data pattern"},
340         {0x04118200, 0, IPR_DEFAULT_LOG_LEVEL,
341         "9002: IOA reserved area LRC error"},
342         {0x04118300, 1, IPR_DEFAULT_LOG_LEVEL,
343         "Hardware Error, IOA metadata access error"},
344         {0x04320000, 0, IPR_DEFAULT_LOG_LEVEL,
345         "102E: Out of alternate sectors for disk storage"},
346         {0x04330000, 1, IPR_DEFAULT_LOG_LEVEL,
347         "FFF4: Data transfer underlength error"},
348         {0x04338000, 1, IPR_DEFAULT_LOG_LEVEL,
349         "FFF4: Data transfer overlength error"},
350         {0x043E0100, 0, IPR_DEFAULT_LOG_LEVEL,
351         "3400: Logical unit failure"},
352         {0x04408500, 0, IPR_DEFAULT_LOG_LEVEL,
353         "FFF4: Device microcode is corrupt"},
354         {0x04418000, 1, IPR_DEFAULT_LOG_LEVEL,
355         "8150: PCI bus error"},
356         {0x04430000, 1, 0,
357         "Unsupported device bus message received"},
358         {0x04440000, 1, IPR_DEFAULT_LOG_LEVEL,
359         "FFF4: Disk device problem"},
360         {0x04448200, 1, IPR_DEFAULT_LOG_LEVEL,
361         "8150: Permanent IOA failure"},
362         {0x04448300, 0, IPR_DEFAULT_LOG_LEVEL,
363         "3010: Disk device returned wrong response to IOA"},
364         {0x04448400, 0, IPR_DEFAULT_LOG_LEVEL,
365         "8151: IOA microcode error"},
366         {0x04448500, 0, 0,
367         "Device bus status error"},
368         {0x04448600, 0, IPR_DEFAULT_LOG_LEVEL,
369         "8157: IOA error requiring IOA reset to recover"},
370         {0x04448700, 0, 0,
371         "ATA device status error"},
372         {0x04490000, 0, 0,
373         "Message reject received from the device"},
374         {0x04449200, 0, IPR_DEFAULT_LOG_LEVEL,
375         "8008: A permanent cache battery pack failure occurred"},
376         {0x0444A000, 0, IPR_DEFAULT_LOG_LEVEL,
377         "9090: Disk unit has been modified after the last known status"},
378         {0x0444A200, 0, IPR_DEFAULT_LOG_LEVEL,
379         "9081: IOA detected device error"},
380         {0x0444A300, 0, IPR_DEFAULT_LOG_LEVEL,
381         "9082: IOA detected device error"},
382         {0x044A0000, 1, IPR_DEFAULT_LOG_LEVEL,
383         "3110: Device bus error, message or command phase"},
384         {0x044A8000, 1, IPR_DEFAULT_LOG_LEVEL,
385         "3110: SAS Command / Task Management Function failed"},
386         {0x04670400, 0, IPR_DEFAULT_LOG_LEVEL,
387         "9091: Incorrect hardware configuration change has been detected"},
388         {0x04678000, 0, IPR_DEFAULT_LOG_LEVEL,
389         "9073: Invalid multi-adapter configuration"},
390         {0x04678100, 0, IPR_DEFAULT_LOG_LEVEL,
391         "4010: Incorrect connection between cascaded expanders"},
392         {0x04678200, 0, IPR_DEFAULT_LOG_LEVEL,
393         "4020: Connections exceed IOA design limits"},
394         {0x04678300, 0, IPR_DEFAULT_LOG_LEVEL,
395         "4030: Incorrect multipath connection"},
396         {0x04679000, 0, IPR_DEFAULT_LOG_LEVEL,
397         "4110: Unsupported enclosure function"},
398         {0x04679800, 0, IPR_DEFAULT_LOG_LEVEL,
399         "4120: SAS cable VPD cannot be read"},
400         {0x046E0000, 0, IPR_DEFAULT_LOG_LEVEL,
401         "FFF4: Command to logical unit failed"},
402         {0x05240000, 1, 0,
403         "Illegal request, invalid request type or request packet"},
404         {0x05250000, 0, 0,
405         "Illegal request, invalid resource handle"},
406         {0x05258000, 0, 0,
407         "Illegal request, commands not allowed to this device"},
408         {0x05258100, 0, 0,
409         "Illegal request, command not allowed to a secondary adapter"},
410         {0x05258200, 0, 0,
411         "Illegal request, command not allowed to a non-optimized resource"},
412         {0x05260000, 0, 0,
413         "Illegal request, invalid field in parameter list"},
414         {0x05260100, 0, 0,
415         "Illegal request, parameter not supported"},
416         {0x05260200, 0, 0,
417         "Illegal request, parameter value invalid"},
418         {0x052C0000, 0, 0,
419         "Illegal request, command sequence error"},
420         {0x052C8000, 1, 0,
421         "Illegal request, dual adapter support not enabled"},
422         {0x052C8100, 1, 0,
423         "Illegal request, another cable connector was physically disabled"},
424         {0x054E8000, 1, 0,
425         "Illegal request, inconsistent group id/group count"},
426         {0x06040500, 0, IPR_DEFAULT_LOG_LEVEL,
427         "9031: Array protection temporarily suspended, protection resuming"},
428         {0x06040600, 0, IPR_DEFAULT_LOG_LEVEL,
429         "9040: Array protection temporarily suspended, protection resuming"},
430         {0x060B0100, 0, IPR_DEFAULT_LOG_LEVEL,
431         "4080: IOA exceeded maximum operating temperature"},
432         {0x060B8000, 0, IPR_DEFAULT_LOG_LEVEL,
433         "4085: Service required"},
434         {0x06288000, 0, IPR_DEFAULT_LOG_LEVEL,
435         "3140: Device bus not ready to ready transition"},
436         {0x06290000, 0, IPR_DEFAULT_LOG_LEVEL,
437         "FFFB: SCSI bus was reset"},
438         {0x06290500, 0, 0,
439         "FFFE: SCSI bus transition to single ended"},
440         {0x06290600, 0, 0,
441         "FFFE: SCSI bus transition to LVD"},
442         {0x06298000, 0, IPR_DEFAULT_LOG_LEVEL,
443         "FFFB: SCSI bus was reset by another initiator"},
444         {0x063F0300, 0, IPR_DEFAULT_LOG_LEVEL,
445         "3029: A device replacement has occurred"},
446         {0x063F8300, 0, IPR_DEFAULT_LOG_LEVEL,
447         "4102: Device bus fabric performance degradation"},
448         {0x064C8000, 0, IPR_DEFAULT_LOG_LEVEL,
449         "9051: IOA cache data exists for a missing or failed device"},
450         {0x064C8100, 0, IPR_DEFAULT_LOG_LEVEL,
451         "9055: Auxiliary cache IOA contains cache data needed by the primary IOA"},
452         {0x06670100, 0, IPR_DEFAULT_LOG_LEVEL,
453         "9025: Disk unit is not supported at its physical location"},
454         {0x06670600, 0, IPR_DEFAULT_LOG_LEVEL,
455         "3020: IOA detected a SCSI bus configuration error"},
456         {0x06678000, 0, IPR_DEFAULT_LOG_LEVEL,
457         "3150: SCSI bus configuration error"},
458         {0x06678100, 0, IPR_DEFAULT_LOG_LEVEL,
459         "9074: Asymmetric advanced function disk configuration"},
460         {0x06678300, 0, IPR_DEFAULT_LOG_LEVEL,
461         "4040: Incomplete multipath connection between IOA and enclosure"},
462         {0x06678400, 0, IPR_DEFAULT_LOG_LEVEL,
463         "4041: Incomplete multipath connection between enclosure and device"},
464         {0x06678500, 0, IPR_DEFAULT_LOG_LEVEL,
465         "9075: Incomplete multipath connection between IOA and remote IOA"},
466         {0x06678600, 0, IPR_DEFAULT_LOG_LEVEL,
467         "9076: Configuration error, missing remote IOA"},
468         {0x06679100, 0, IPR_DEFAULT_LOG_LEVEL,
469         "4050: Enclosure does not support a required multipath function"},
470         {0x06679800, 0, IPR_DEFAULT_LOG_LEVEL,
471         "4121: Configuration error, required cable is missing"},
472         {0x06679900, 0, IPR_DEFAULT_LOG_LEVEL,
473         "4122: Cable is not plugged into the correct location on remote IOA"},
474         {0x06679A00, 0, IPR_DEFAULT_LOG_LEVEL,
475         "4123: Configuration error, invalid cable vital product data"},
476         {0x06679B00, 0, IPR_DEFAULT_LOG_LEVEL,
477         "4124: Configuration error, both cable ends are plugged into the same IOA"},
478         {0x06690000, 0, IPR_DEFAULT_LOG_LEVEL,
479         "4070: Logically bad block written on device"},
480         {0x06690200, 0, IPR_DEFAULT_LOG_LEVEL,
481         "9041: Array protection temporarily suspended"},
482         {0x06698200, 0, IPR_DEFAULT_LOG_LEVEL,
483         "9042: Corrupt array parity detected on specified device"},
484         {0x066B0200, 0, IPR_DEFAULT_LOG_LEVEL,
485         "9030: Array no longer protected due to missing or failed disk unit"},
486         {0x066B8000, 0, IPR_DEFAULT_LOG_LEVEL,
487         "9071: Link operational transition"},
488         {0x066B8100, 0, IPR_DEFAULT_LOG_LEVEL,
489         "9072: Link not operational transition"},
490         {0x066B8200, 0, IPR_DEFAULT_LOG_LEVEL,
491         "9032: Array exposed but still protected"},
492         {0x066B8300, 0, IPR_DEFAULT_LOG_LEVEL + 1,
493         "70DD: Device forced failed by disrupt device command"},
494         {0x066B9100, 0, IPR_DEFAULT_LOG_LEVEL,
495         "4061: Multipath redundancy level got better"},
496         {0x066B9200, 0, IPR_DEFAULT_LOG_LEVEL,
497         "4060: Multipath redundancy level got worse"},
498         {0x07270000, 0, 0,
499         "Failure due to other device"},
500         {0x07278000, 0, IPR_DEFAULT_LOG_LEVEL,
501         "9008: IOA does not support functions expected by devices"},
502         {0x07278100, 0, IPR_DEFAULT_LOG_LEVEL,
503         "9010: Cache data associated with attached devices cannot be found"},
504         {0x07278200, 0, IPR_DEFAULT_LOG_LEVEL,
505         "9011: Cache data belongs to devices other than those attached"},
506         {0x07278400, 0, IPR_DEFAULT_LOG_LEVEL,
507         "9020: Array missing 2 or more devices with only 1 device present"},
508         {0x07278500, 0, IPR_DEFAULT_LOG_LEVEL,
509         "9021: Array missing 2 or more devices with 2 or more devices present"},
510         {0x07278600, 0, IPR_DEFAULT_LOG_LEVEL,
511         "9022: Exposed array is missing a required device"},
512         {0x07278700, 0, IPR_DEFAULT_LOG_LEVEL,
513         "9023: Array member(s) not at required physical locations"},
514         {0x07278800, 0, IPR_DEFAULT_LOG_LEVEL,
515         "9024: Array not functional due to present hardware configuration"},
516         {0x07278900, 0, IPR_DEFAULT_LOG_LEVEL,
517         "9026: Array not functional due to present hardware configuration"},
518         {0x07278A00, 0, IPR_DEFAULT_LOG_LEVEL,
519         "9027: Array is missing a device and parity is out of sync"},
520         {0x07278B00, 0, IPR_DEFAULT_LOG_LEVEL,
521         "9028: Maximum number of arrays already exist"},
522         {0x07278C00, 0, IPR_DEFAULT_LOG_LEVEL,
523         "9050: Required cache data cannot be located for a disk unit"},
524         {0x07278D00, 0, IPR_DEFAULT_LOG_LEVEL,
525         "9052: Cache data exists for a device that has been modified"},
526         {0x07278F00, 0, IPR_DEFAULT_LOG_LEVEL,
527         "9054: IOA resources not available due to previous problems"},
528         {0x07279100, 0, IPR_DEFAULT_LOG_LEVEL,
529         "9092: Disk unit requires initialization before use"},
530         {0x07279200, 0, IPR_DEFAULT_LOG_LEVEL,
531         "9029: Incorrect hardware configuration change has been detected"},
532         {0x07279600, 0, IPR_DEFAULT_LOG_LEVEL,
533         "9060: One or more disk pairs are missing from an array"},
534         {0x07279700, 0, IPR_DEFAULT_LOG_LEVEL,
535         "9061: One or more disks are missing from an array"},
536         {0x07279800, 0, IPR_DEFAULT_LOG_LEVEL,
537         "9062: One or more disks are missing from an array"},
538         {0x07279900, 0, IPR_DEFAULT_LOG_LEVEL,
539         "9063: Maximum number of functional arrays has been exceeded"},
540         {0x07279A00, 0, 0,
541         "Data protect, other volume set problem"},
542         {0x0B260000, 0, 0,
543         "Aborted command, invalid descriptor"},
544         {0x0B3F9000, 0, 0,
545         "Target operating conditions have changed, dual adapter takeover"},
546         {0x0B530200, 0, 0,
547         "Aborted command, medium removal prevented"},
548         {0x0B5A0000, 0, 0,
549         "Command terminated by host"},
550         {0x0B5B8000, 0, 0,
551         "Aborted command, command terminated by host"}
552 };
553 
554 static const struct ipr_ses_table_entry ipr_ses_table[] = {
555         { "2104-DL1        ", "XXXXXXXXXXXXXXXX", 80 },
556         { "2104-TL1        ", "XXXXXXXXXXXXXXXX", 80 },
557         { "HSBP07M P U2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* Hidive 7 slot */
558         { "HSBP05M P U2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* Hidive 5 slot */
559         { "HSBP05M S U2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* Bowtie */
560         { "HSBP06E ASU2SCSI", "XXXXXXXXXXXXXXXX", 80 }, /* MartinFenning */
561         { "2104-DU3        ", "XXXXXXXXXXXXXXXX", 160 },
562         { "2104-TU3        ", "XXXXXXXXXXXXXXXX", 160 },
563         { "HSBP04C RSU2SCSI", "XXXXXXX*XXXXXXXX", 160 },
564         { "HSBP06E RSU2SCSI", "XXXXXXX*XXXXXXXX", 160 },
565         { "St  V1S2        ", "XXXXXXXXXXXXXXXX", 160 },
566         { "HSBPD4M  PU3SCSI", "XXXXXXX*XXXXXXXX", 160 },
567         { "VSBPD1H   U3SCSI", "XXXXXXX*XXXXXXXX", 160 }
568 };
569 
570 /*
571  *  Function Prototypes
572  */
573 static int ipr_reset_alert(struct ipr_cmnd *);
574 static void ipr_process_ccn(struct ipr_cmnd *);
575 static void ipr_process_error(struct ipr_cmnd *);
576 static void ipr_reset_ioa_job(struct ipr_cmnd *);
577 static void ipr_initiate_ioa_reset(struct ipr_ioa_cfg *,
578                                    enum ipr_shutdown_type);
579 
580 #ifdef CONFIG_SCSI_IPR_TRACE
581 /**
582  * ipr_trc_hook - Add a trace entry to the driver trace
583  * @ipr_cmd:    ipr command struct
584  * @type:               trace type
585  * @add_data:   additional data
586  *
587  * Return value:
588  *      none
589  **/
590 static void ipr_trc_hook(struct ipr_cmnd *ipr_cmd,
591                          u8 type, u32 add_data)
592 {
593         struct ipr_trace_entry *trace_entry;
594         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
595 
596         trace_entry = &ioa_cfg->trace[atomic_add_return
597                         (1, &ioa_cfg->trace_index)%IPR_NUM_TRACE_ENTRIES];
598         trace_entry->time = jiffies;
599         trace_entry->op_code = ipr_cmd->ioarcb.cmd_pkt.cdb[0];
600         trace_entry->type = type;
601         if (ipr_cmd->ioa_cfg->sis64)
602                 trace_entry->ata_op_code = ipr_cmd->i.ata_ioadl.regs.command;
603         else
604                 trace_entry->ata_op_code = ipr_cmd->ioarcb.u.add_data.u.regs.command;
605         trace_entry->cmd_index = ipr_cmd->cmd_index & 0xff;
606         trace_entry->res_handle = ipr_cmd->ioarcb.res_handle;
607         trace_entry->u.add_data = add_data;
608         wmb();
609 }
610 #else
611 #define ipr_trc_hook(ipr_cmd, type, add_data) do { } while (0)
612 #endif
613 
614 /**
615  * ipr_lock_and_done - Acquire lock and complete command
616  * @ipr_cmd:    ipr command struct
617  *
618  * Return value:
619  *      none
620  **/
621 static void ipr_lock_and_done(struct ipr_cmnd *ipr_cmd)
622 {
623         unsigned long lock_flags;
624         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
625 
626         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
627         ipr_cmd->done(ipr_cmd);
628         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
629 }
630 
631 /**
632  * ipr_reinit_ipr_cmnd - Re-initialize an IPR Cmnd block for reuse
633  * @ipr_cmd:    ipr command struct
634  *
635  * Return value:
636  *      none
637  **/
638 static void ipr_reinit_ipr_cmnd(struct ipr_cmnd *ipr_cmd)
639 {
640         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
641         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
642         struct ipr_ioasa64 *ioasa64 = &ipr_cmd->s.ioasa64;
643         dma_addr_t dma_addr = ipr_cmd->dma_addr;
644         int hrrq_id;
645 
646         hrrq_id = ioarcb->cmd_pkt.hrrq_id;
647         memset(&ioarcb->cmd_pkt, 0, sizeof(struct ipr_cmd_pkt));
648         ioarcb->cmd_pkt.hrrq_id = hrrq_id;
649         ioarcb->data_transfer_length = 0;
650         ioarcb->read_data_transfer_length = 0;
651         ioarcb->ioadl_len = 0;
652         ioarcb->read_ioadl_len = 0;
653 
654         if (ipr_cmd->ioa_cfg->sis64) {
655                 ioarcb->u.sis64_addr_data.data_ioadl_addr =
656                         cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ioadl64));
657                 ioasa64->u.gata.status = 0;
658         } else {
659                 ioarcb->write_ioadl_addr =
660                         cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, i.ioadl));
661                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
662                 ioasa->u.gata.status = 0;
663         }
664 
665         ioasa->hdr.ioasc = 0;
666         ioasa->hdr.residual_data_len = 0;
667         ipr_cmd->scsi_cmd = NULL;
668         ipr_cmd->qc = NULL;
669         ipr_cmd->sense_buffer[0] = 0;
670         ipr_cmd->dma_use_sg = 0;
671 }
672 
673 /**
674  * ipr_init_ipr_cmnd - Initialize an IPR Cmnd block
675  * @ipr_cmd:    ipr command struct
676  *
677  * Return value:
678  *      none
679  **/
680 static void ipr_init_ipr_cmnd(struct ipr_cmnd *ipr_cmd,
681                               void (*fast_done) (struct ipr_cmnd *))
682 {
683         ipr_reinit_ipr_cmnd(ipr_cmd);
684         ipr_cmd->u.scratch = 0;
685         ipr_cmd->sibling = NULL;
686         ipr_cmd->fast_done = fast_done;
687         init_timer(&ipr_cmd->timer);
688 }
689 
690 /**
691  * __ipr_get_free_ipr_cmnd - Get a free IPR Cmnd block
692  * @ioa_cfg:    ioa config struct
693  *
694  * Return value:
695  *      pointer to ipr command struct
696  **/
697 static
698 struct ipr_cmnd *__ipr_get_free_ipr_cmnd(struct ipr_hrr_queue *hrrq)
699 {
700         struct ipr_cmnd *ipr_cmd = NULL;
701 
702         if (likely(!list_empty(&hrrq->hrrq_free_q))) {
703                 ipr_cmd = list_entry(hrrq->hrrq_free_q.next,
704                         struct ipr_cmnd, queue);
705                 list_del(&ipr_cmd->queue);
706         }
707 
708 
709         return ipr_cmd;
710 }
711 
712 /**
713  * ipr_get_free_ipr_cmnd - Get a free IPR Cmnd block and initialize it
714  * @ioa_cfg:    ioa config struct
715  *
716  * Return value:
717  *      pointer to ipr command struct
718  **/
719 static
720 struct ipr_cmnd *ipr_get_free_ipr_cmnd(struct ipr_ioa_cfg *ioa_cfg)
721 {
722         struct ipr_cmnd *ipr_cmd =
723                 __ipr_get_free_ipr_cmnd(&ioa_cfg->hrrq[IPR_INIT_HRRQ]);
724         ipr_init_ipr_cmnd(ipr_cmd, ipr_lock_and_done);
725         return ipr_cmd;
726 }
727 
728 /**
729  * ipr_mask_and_clear_interrupts - Mask all and clear specified interrupts
730  * @ioa_cfg:    ioa config struct
731  * @clr_ints:     interrupts to clear
732  *
733  * This function masks all interrupts on the adapter, then clears the
734  * interrupts specified in the mask
735  *
736  * Return value:
737  *      none
738  **/
739 static void ipr_mask_and_clear_interrupts(struct ipr_ioa_cfg *ioa_cfg,
740                                           u32 clr_ints)
741 {
742         volatile u32 int_reg;
743         int i;
744 
745         /* Stop new interrupts */
746         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
747                 spin_lock(&ioa_cfg->hrrq[i]._lock);
748                 ioa_cfg->hrrq[i].allow_interrupts = 0;
749                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
750         }
751         wmb();
752 
753         /* Set interrupt mask to stop all new interrupts */
754         if (ioa_cfg->sis64)
755                 writeq(~0, ioa_cfg->regs.set_interrupt_mask_reg);
756         else
757                 writel(~0, ioa_cfg->regs.set_interrupt_mask_reg);
758 
759         /* Clear any pending interrupts */
760         if (ioa_cfg->sis64)
761                 writel(~0, ioa_cfg->regs.clr_interrupt_reg);
762         writel(clr_ints, ioa_cfg->regs.clr_interrupt_reg32);
763         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
764 }
765 
766 /**
767  * ipr_save_pcix_cmd_reg - Save PCI-X command register
768  * @ioa_cfg:    ioa config struct
769  *
770  * Return value:
771  *      0 on success / -EIO on failure
772  **/
773 static int ipr_save_pcix_cmd_reg(struct ipr_ioa_cfg *ioa_cfg)
774 {
775         int pcix_cmd_reg = pci_find_capability(ioa_cfg->pdev, PCI_CAP_ID_PCIX);
776 
777         if (pcix_cmd_reg == 0)
778                 return 0;
779 
780         if (pci_read_config_word(ioa_cfg->pdev, pcix_cmd_reg + PCI_X_CMD,
781                                  &ioa_cfg->saved_pcix_cmd_reg) != PCIBIOS_SUCCESSFUL) {
782                 dev_err(&ioa_cfg->pdev->dev, "Failed to save PCI-X command register\n");
783                 return -EIO;
784         }
785 
786         ioa_cfg->saved_pcix_cmd_reg |= PCI_X_CMD_DPERR_E | PCI_X_CMD_ERO;
787         return 0;
788 }
789 
790 /**
791  * ipr_set_pcix_cmd_reg - Setup PCI-X command register
792  * @ioa_cfg:    ioa config struct
793  *
794  * Return value:
795  *      0 on success / -EIO on failure
796  **/
797 static int ipr_set_pcix_cmd_reg(struct ipr_ioa_cfg *ioa_cfg)
798 {
799         int pcix_cmd_reg = pci_find_capability(ioa_cfg->pdev, PCI_CAP_ID_PCIX);
800 
801         if (pcix_cmd_reg) {
802                 if (pci_write_config_word(ioa_cfg->pdev, pcix_cmd_reg + PCI_X_CMD,
803                                           ioa_cfg->saved_pcix_cmd_reg) != PCIBIOS_SUCCESSFUL) {
804                         dev_err(&ioa_cfg->pdev->dev, "Failed to setup PCI-X command register\n");
805                         return -EIO;
806                 }
807         }
808 
809         return 0;
810 }
811 
812 /**
813  * ipr_sata_eh_done - done function for aborted SATA commands
814  * @ipr_cmd:    ipr command struct
815  *
816  * This function is invoked for ops generated to SATA
817  * devices which are being aborted.
818  *
819  * Return value:
820  *      none
821  **/
822 static void ipr_sata_eh_done(struct ipr_cmnd *ipr_cmd)
823 {
824         struct ata_queued_cmd *qc = ipr_cmd->qc;
825         struct ipr_sata_port *sata_port = qc->ap->private_data;
826 
827         qc->err_mask |= AC_ERR_OTHER;
828         sata_port->ioasa.status |= ATA_BUSY;
829         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
830         ata_qc_complete(qc);
831 }
832 
833 /**
834  * ipr_scsi_eh_done - mid-layer done function for aborted ops
835  * @ipr_cmd:    ipr command struct
836  *
837  * This function is invoked by the interrupt handler for
838  * ops generated by the SCSI mid-layer which are being aborted.
839  *
840  * Return value:
841  *      none
842  **/
843 static void ipr_scsi_eh_done(struct ipr_cmnd *ipr_cmd)
844 {
845         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
846 
847         scsi_cmd->result |= (DID_ERROR << 16);
848 
849         scsi_dma_unmap(ipr_cmd->scsi_cmd);
850         scsi_cmd->scsi_done(scsi_cmd);
851         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
852 }
853 
854 /**
855  * ipr_fail_all_ops - Fails all outstanding ops.
856  * @ioa_cfg:    ioa config struct
857  *
858  * This function fails all outstanding ops.
859  *
860  * Return value:
861  *      none
862  **/
863 static void ipr_fail_all_ops(struct ipr_ioa_cfg *ioa_cfg)
864 {
865         struct ipr_cmnd *ipr_cmd, *temp;
866         struct ipr_hrr_queue *hrrq;
867 
868         ENTER;
869         for_each_hrrq(hrrq, ioa_cfg) {
870                 spin_lock(&hrrq->_lock);
871                 list_for_each_entry_safe(ipr_cmd,
872                                         temp, &hrrq->hrrq_pending_q, queue) {
873                         list_del(&ipr_cmd->queue);
874 
875                         ipr_cmd->s.ioasa.hdr.ioasc =
876                                 cpu_to_be32(IPR_IOASC_IOA_WAS_RESET);
877                         ipr_cmd->s.ioasa.hdr.ilid =
878                                 cpu_to_be32(IPR_DRIVER_ILID);
879 
880                         if (ipr_cmd->scsi_cmd)
881                                 ipr_cmd->done = ipr_scsi_eh_done;
882                         else if (ipr_cmd->qc)
883                                 ipr_cmd->done = ipr_sata_eh_done;
884 
885                         ipr_trc_hook(ipr_cmd, IPR_TRACE_FINISH,
886                                      IPR_IOASC_IOA_WAS_RESET);
887                         del_timer(&ipr_cmd->timer);
888                         ipr_cmd->done(ipr_cmd);
889                 }
890                 spin_unlock(&hrrq->_lock);
891         }
892         LEAVE;
893 }
894 
895 /**
896  * ipr_send_command -  Send driver initiated requests.
897  * @ipr_cmd:            ipr command struct
898  *
899  * This function sends a command to the adapter using the correct write call.
900  * In the case of sis64, calculate the ioarcb size required. Then or in the
901  * appropriate bits.
902  *
903  * Return value:
904  *      none
905  **/
906 static void ipr_send_command(struct ipr_cmnd *ipr_cmd)
907 {
908         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
909         dma_addr_t send_dma_addr = ipr_cmd->dma_addr;
910 
911         if (ioa_cfg->sis64) {
912                 /* The default size is 256 bytes */
913                 send_dma_addr |= 0x1;
914 
915                 /* If the number of ioadls * size of ioadl > 128 bytes,
916                    then use a 512 byte ioarcb */
917                 if (ipr_cmd->dma_use_sg * sizeof(struct ipr_ioadl64_desc) > 128 )
918                         send_dma_addr |= 0x4;
919                 writeq(send_dma_addr, ioa_cfg->regs.ioarrin_reg);
920         } else
921                 writel(send_dma_addr, ioa_cfg->regs.ioarrin_reg);
922 }
923 
924 /**
925  * ipr_do_req -  Send driver initiated requests.
926  * @ipr_cmd:            ipr command struct
927  * @done:                       done function
928  * @timeout_func:       timeout function
929  * @timeout:            timeout value
930  *
931  * This function sends the specified command to the adapter with the
932  * timeout given. The done function is invoked on command completion.
933  *
934  * Return value:
935  *      none
936  **/
937 static void ipr_do_req(struct ipr_cmnd *ipr_cmd,
938                        void (*done) (struct ipr_cmnd *),
939                        void (*timeout_func) (struct ipr_cmnd *), u32 timeout)
940 {
941         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
942 
943         ipr_cmd->done = done;
944 
945         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
946         ipr_cmd->timer.expires = jiffies + timeout;
947         ipr_cmd->timer.function = (void (*)(unsigned long))timeout_func;
948 
949         add_timer(&ipr_cmd->timer);
950 
951         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, 0);
952 
953         ipr_send_command(ipr_cmd);
954 }
955 
956 /**
957  * ipr_internal_cmd_done - Op done function for an internally generated op.
958  * @ipr_cmd:    ipr command struct
959  *
960  * This function is the op done function for an internally generated,
961  * blocking op. It simply wakes the sleeping thread.
962  *
963  * Return value:
964  *      none
965  **/
966 static void ipr_internal_cmd_done(struct ipr_cmnd *ipr_cmd)
967 {
968         if (ipr_cmd->sibling)
969                 ipr_cmd->sibling = NULL;
970         else
971                 complete(&ipr_cmd->completion);
972 }
973 
974 /**
975  * ipr_init_ioadl - initialize the ioadl for the correct SIS type
976  * @ipr_cmd:    ipr command struct
977  * @dma_addr:   dma address
978  * @len:        transfer length
979  * @flags:      ioadl flag value
980  *
981  * This function initializes an ioadl in the case where there is only a single
982  * descriptor.
983  *
984  * Return value:
985  *      nothing
986  **/
987 static void ipr_init_ioadl(struct ipr_cmnd *ipr_cmd, dma_addr_t dma_addr,
988                            u32 len, int flags)
989 {
990         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
991         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ioadl64;
992 
993         ipr_cmd->dma_use_sg = 1;
994 
995         if (ipr_cmd->ioa_cfg->sis64) {
996                 ioadl64->flags = cpu_to_be32(flags);
997                 ioadl64->data_len = cpu_to_be32(len);
998                 ioadl64->address = cpu_to_be64(dma_addr);
999 
1000                 ipr_cmd->ioarcb.ioadl_len =
1001                         cpu_to_be32(sizeof(struct ipr_ioadl64_desc));
1002                 ipr_cmd->ioarcb.data_transfer_length = cpu_to_be32(len);
1003         } else {
1004                 ioadl->flags_and_data_len = cpu_to_be32(flags | len);
1005                 ioadl->address = cpu_to_be32(dma_addr);
1006 
1007                 if (flags == IPR_IOADL_FLAGS_READ_LAST) {
1008                         ipr_cmd->ioarcb.read_ioadl_len =
1009                                 cpu_to_be32(sizeof(struct ipr_ioadl_desc));
1010                         ipr_cmd->ioarcb.read_data_transfer_length = cpu_to_be32(len);
1011                 } else {
1012                         ipr_cmd->ioarcb.ioadl_len =
1013                                 cpu_to_be32(sizeof(struct ipr_ioadl_desc));
1014                         ipr_cmd->ioarcb.data_transfer_length = cpu_to_be32(len);
1015                 }
1016         }
1017 }
1018 
1019 /**
1020  * ipr_send_blocking_cmd - Send command and sleep on its completion.
1021  * @ipr_cmd:    ipr command struct
1022  * @timeout_func:       function to invoke if command times out
1023  * @timeout:    timeout
1024  *
1025  * Return value:
1026  *      none
1027  **/
1028 static void ipr_send_blocking_cmd(struct ipr_cmnd *ipr_cmd,
1029                                   void (*timeout_func) (struct ipr_cmnd *ipr_cmd),
1030                                   u32 timeout)
1031 {
1032         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
1033 
1034         init_completion(&ipr_cmd->completion);
1035         ipr_do_req(ipr_cmd, ipr_internal_cmd_done, timeout_func, timeout);
1036 
1037         spin_unlock_irq(ioa_cfg->host->host_lock);
1038         wait_for_completion(&ipr_cmd->completion);
1039         spin_lock_irq(ioa_cfg->host->host_lock);
1040 }
1041 
1042 static int ipr_get_hrrq_index(struct ipr_ioa_cfg *ioa_cfg)
1043 {
1044         if (ioa_cfg->hrrq_num == 1)
1045                 return 0;
1046         else
1047                 return (atomic_add_return(1, &ioa_cfg->hrrq_index) % (ioa_cfg->hrrq_num - 1)) + 1;
1048 }
1049 
1050 /**
1051  * ipr_send_hcam - Send an HCAM to the adapter.
1052  * @ioa_cfg:    ioa config struct
1053  * @type:               HCAM type
1054  * @hostrcb:    hostrcb struct
1055  *
1056  * This function will send a Host Controlled Async command to the adapter.
1057  * If HCAMs are currently not allowed to be issued to the adapter, it will
1058  * place the hostrcb on the free queue.
1059  *
1060  * Return value:
1061  *      none
1062  **/
1063 static void ipr_send_hcam(struct ipr_ioa_cfg *ioa_cfg, u8 type,
1064                           struct ipr_hostrcb *hostrcb)
1065 {
1066         struct ipr_cmnd *ipr_cmd;
1067         struct ipr_ioarcb *ioarcb;
1068 
1069         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds) {
1070                 ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
1071                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
1072                 list_add_tail(&hostrcb->queue, &ioa_cfg->hostrcb_pending_q);
1073 
1074                 ipr_cmd->u.hostrcb = hostrcb;
1075                 ioarcb = &ipr_cmd->ioarcb;
1076 
1077                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
1078                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_HCAM;
1079                 ioarcb->cmd_pkt.cdb[0] = IPR_HOST_CONTROLLED_ASYNC;
1080                 ioarcb->cmd_pkt.cdb[1] = type;
1081                 ioarcb->cmd_pkt.cdb[7] = (sizeof(hostrcb->hcam) >> 8) & 0xff;
1082                 ioarcb->cmd_pkt.cdb[8] = sizeof(hostrcb->hcam) & 0xff;
1083 
1084                 ipr_init_ioadl(ipr_cmd, hostrcb->hostrcb_dma,
1085                                sizeof(hostrcb->hcam), IPR_IOADL_FLAGS_READ_LAST);
1086 
1087                 if (type == IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE)
1088                         ipr_cmd->done = ipr_process_ccn;
1089                 else
1090                         ipr_cmd->done = ipr_process_error;
1091 
1092                 ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_IOA_RES_ADDR);
1093 
1094                 ipr_send_command(ipr_cmd);
1095         } else {
1096                 list_add_tail(&hostrcb->queue, &ioa_cfg->hostrcb_free_q);
1097         }
1098 }
1099 
1100 /**
1101  * ipr_update_ata_class - Update the ata class in the resource entry
1102  * @res:        resource entry struct
1103  * @proto:      cfgte device bus protocol value
1104  *
1105  * Return value:
1106  *      none
1107  **/
1108 static void ipr_update_ata_class(struct ipr_resource_entry *res, unsigned int proto)
1109 {
1110         switch (proto) {
1111         case IPR_PROTO_SATA:
1112         case IPR_PROTO_SAS_STP:
1113                 res->ata_class = ATA_DEV_ATA;
1114                 break;
1115         case IPR_PROTO_SATA_ATAPI:
1116         case IPR_PROTO_SAS_STP_ATAPI:
1117                 res->ata_class = ATA_DEV_ATAPI;
1118                 break;
1119         default:
1120                 res->ata_class = ATA_DEV_UNKNOWN;
1121                 break;
1122         };
1123 }
1124 
1125 /**
1126  * ipr_init_res_entry - Initialize a resource entry struct.
1127  * @res:        resource entry struct
1128  * @cfgtew:     config table entry wrapper struct
1129  *
1130  * Return value:
1131  *      none
1132  **/
1133 static void ipr_init_res_entry(struct ipr_resource_entry *res,
1134                                struct ipr_config_table_entry_wrapper *cfgtew)
1135 {
1136         int found = 0;
1137         unsigned int proto;
1138         struct ipr_ioa_cfg *ioa_cfg = res->ioa_cfg;
1139         struct ipr_resource_entry *gscsi_res = NULL;
1140 
1141         res->needs_sync_complete = 0;
1142         res->in_erp = 0;
1143         res->add_to_ml = 0;
1144         res->del_from_ml = 0;
1145         res->resetting_device = 0;
1146         res->reset_occurred = 0;
1147         res->sdev = NULL;
1148         res->sata_port = NULL;
1149 
1150         if (ioa_cfg->sis64) {
1151                 proto = cfgtew->u.cfgte64->proto;
1152                 res->res_flags = cfgtew->u.cfgte64->res_flags;
1153                 res->qmodel = IPR_QUEUEING_MODEL64(res);
1154                 res->type = cfgtew->u.cfgte64->res_type;
1155 
1156                 memcpy(res->res_path, &cfgtew->u.cfgte64->res_path,
1157                         sizeof(res->res_path));
1158 
1159                 res->bus = 0;
1160                 memcpy(&res->dev_lun.scsi_lun, &cfgtew->u.cfgte64->lun,
1161                         sizeof(res->dev_lun.scsi_lun));
1162                 res->lun = scsilun_to_int(&res->dev_lun);
1163 
1164                 if (res->type == IPR_RES_TYPE_GENERIC_SCSI) {
1165                         list_for_each_entry(gscsi_res, &ioa_cfg->used_res_q, queue) {
1166                                 if (gscsi_res->dev_id == cfgtew->u.cfgte64->dev_id) {
1167                                         found = 1;
1168                                         res->target = gscsi_res->target;
1169                                         break;
1170                                 }
1171                         }
1172                         if (!found) {
1173                                 res->target = find_first_zero_bit(ioa_cfg->target_ids,
1174                                                                   ioa_cfg->max_devs_supported);
1175                                 set_bit(res->target, ioa_cfg->target_ids);
1176                         }
1177                 } else if (res->type == IPR_RES_TYPE_IOAFP) {
1178                         res->bus = IPR_IOAFP_VIRTUAL_BUS;
1179                         res->target = 0;
1180                 } else if (res->type == IPR_RES_TYPE_ARRAY) {
1181                         res->bus = IPR_ARRAY_VIRTUAL_BUS;
1182                         res->target = find_first_zero_bit(ioa_cfg->array_ids,
1183                                                           ioa_cfg->max_devs_supported);
1184                         set_bit(res->target, ioa_cfg->array_ids);
1185                 } else if (res->type == IPR_RES_TYPE_VOLUME_SET) {
1186                         res->bus = IPR_VSET_VIRTUAL_BUS;
1187                         res->target = find_first_zero_bit(ioa_cfg->vset_ids,
1188                                                           ioa_cfg->max_devs_supported);
1189                         set_bit(res->target, ioa_cfg->vset_ids);
1190                 } else {
1191                         res->target = find_first_zero_bit(ioa_cfg->target_ids,
1192                                                           ioa_cfg->max_devs_supported);
1193                         set_bit(res->target, ioa_cfg->target_ids);
1194                 }
1195         } else {
1196                 proto = cfgtew->u.cfgte->proto;
1197                 res->qmodel = IPR_QUEUEING_MODEL(res);
1198                 res->flags = cfgtew->u.cfgte->flags;
1199                 if (res->flags & IPR_IS_IOA_RESOURCE)
1200                         res->type = IPR_RES_TYPE_IOAFP;
1201                 else
1202                         res->type = cfgtew->u.cfgte->rsvd_subtype & 0x0f;
1203 
1204                 res->bus = cfgtew->u.cfgte->res_addr.bus;
1205                 res->target = cfgtew->u.cfgte->res_addr.target;
1206                 res->lun = cfgtew->u.cfgte->res_addr.lun;
1207                 res->lun_wwn = get_unaligned_be64(cfgtew->u.cfgte->lun_wwn);
1208         }
1209 
1210         ipr_update_ata_class(res, proto);
1211 }
1212 
1213 /**
1214  * ipr_is_same_device - Determine if two devices are the same.
1215  * @res:        resource entry struct
1216  * @cfgtew:     config table entry wrapper struct
1217  *
1218  * Return value:
1219  *      1 if the devices are the same / 0 otherwise
1220  **/
1221 static int ipr_is_same_device(struct ipr_resource_entry *res,
1222                               struct ipr_config_table_entry_wrapper *cfgtew)
1223 {
1224         if (res->ioa_cfg->sis64) {
1225                 if (!memcmp(&res->dev_id, &cfgtew->u.cfgte64->dev_id,
1226                                         sizeof(cfgtew->u.cfgte64->dev_id)) &&
1227                         !memcmp(&res->dev_lun.scsi_lun, &cfgtew->u.cfgte64->lun,
1228                                         sizeof(cfgtew->u.cfgte64->lun))) {
1229                         return 1;
1230                 }
1231         } else {
1232                 if (res->bus == cfgtew->u.cfgte->res_addr.bus &&
1233                     res->target == cfgtew->u.cfgte->res_addr.target &&
1234                     res->lun == cfgtew->u.cfgte->res_addr.lun)
1235                         return 1;
1236         }
1237 
1238         return 0;
1239 }
1240 
1241 /**
1242  * __ipr_format_res_path - Format the resource path for printing.
1243  * @res_path:   resource path
1244  * @buf:        buffer
1245  * @len:        length of buffer provided
1246  *
1247  * Return value:
1248  *      pointer to buffer
1249  **/
1250 static char *__ipr_format_res_path(u8 *res_path, char *buffer, int len)
1251 {
1252         int i;
1253         char *p = buffer;
1254 
1255         *p = '\0';
1256         p += snprintf(p, buffer + len - p, "%02X", res_path[0]);
1257         for (i = 1; res_path[i] != 0xff && ((i * 3) < len); i++)
1258                 p += snprintf(p, buffer + len - p, "-%02X", res_path[i]);
1259 
1260         return buffer;
1261 }
1262 
1263 /**
1264  * ipr_format_res_path - Format the resource path for printing.
1265  * @ioa_cfg:    ioa config struct
1266  * @res_path:   resource path
1267  * @buf:        buffer
1268  * @len:        length of buffer provided
1269  *
1270  * Return value:
1271  *      pointer to buffer
1272  **/
1273 static char *ipr_format_res_path(struct ipr_ioa_cfg *ioa_cfg,
1274                                  u8 *res_path, char *buffer, int len)
1275 {
1276         char *p = buffer;
1277 
1278         *p = '\0';
1279         p += snprintf(p, buffer + len - p, "%d/", ioa_cfg->host->host_no);
1280         __ipr_format_res_path(res_path, p, len - (buffer - p));
1281         return buffer;
1282 }
1283 
1284 /**
1285  * ipr_update_res_entry - Update the resource entry.
1286  * @res:        resource entry struct
1287  * @cfgtew:     config table entry wrapper struct
1288  *
1289  * Return value:
1290  *      none
1291  **/
1292 static void ipr_update_res_entry(struct ipr_resource_entry *res,
1293                                  struct ipr_config_table_entry_wrapper *cfgtew)
1294 {
1295         char buffer[IPR_MAX_RES_PATH_LENGTH];
1296         unsigned int proto;
1297         int new_path = 0;
1298 
1299         if (res->ioa_cfg->sis64) {
1300                 res->flags = cfgtew->u.cfgte64->flags;
1301                 res->res_flags = cfgtew->u.cfgte64->res_flags;
1302                 res->type = cfgtew->u.cfgte64->res_type;
1303 
1304                 memcpy(&res->std_inq_data, &cfgtew->u.cfgte64->std_inq_data,
1305                         sizeof(struct ipr_std_inq_data));
1306 
1307                 res->qmodel = IPR_QUEUEING_MODEL64(res);
1308                 proto = cfgtew->u.cfgte64->proto;
1309                 res->res_handle = cfgtew->u.cfgte64->res_handle;
1310                 res->dev_id = cfgtew->u.cfgte64->dev_id;
1311 
1312                 memcpy(&res->dev_lun.scsi_lun, &cfgtew->u.cfgte64->lun,
1313                         sizeof(res->dev_lun.scsi_lun));
1314 
1315                 if (memcmp(res->res_path, &cfgtew->u.cfgte64->res_path,
1316                                         sizeof(res->res_path))) {
1317                         memcpy(res->res_path, &cfgtew->u.cfgte64->res_path,
1318                                 sizeof(res->res_path));
1319                         new_path = 1;
1320                 }
1321 
1322                 if (res->sdev && new_path)
1323                         sdev_printk(KERN_INFO, res->sdev, "Resource path: %s\n",
1324                                     ipr_format_res_path(res->ioa_cfg,
1325                                         res->res_path, buffer, sizeof(buffer)));
1326         } else {
1327                 res->flags = cfgtew->u.cfgte->flags;
1328                 if (res->flags & IPR_IS_IOA_RESOURCE)
1329                         res->type = IPR_RES_TYPE_IOAFP;
1330                 else
1331                         res->type = cfgtew->u.cfgte->rsvd_subtype & 0x0f;
1332 
1333                 memcpy(&res->std_inq_data, &cfgtew->u.cfgte->std_inq_data,
1334                         sizeof(struct ipr_std_inq_data));
1335 
1336                 res->qmodel = IPR_QUEUEING_MODEL(res);
1337                 proto = cfgtew->u.cfgte->proto;
1338                 res->res_handle = cfgtew->u.cfgte->res_handle;
1339         }
1340 
1341         ipr_update_ata_class(res, proto);
1342 }
1343 
1344 /**
1345  * ipr_clear_res_target - Clear the bit in the bit map representing the target
1346  *                        for the resource.
1347  * @res:        resource entry struct
1348  * @cfgtew:     config table entry wrapper struct
1349  *
1350  * Return value:
1351  *      none
1352  **/
1353 static void ipr_clear_res_target(struct ipr_resource_entry *res)
1354 {
1355         struct ipr_resource_entry *gscsi_res = NULL;
1356         struct ipr_ioa_cfg *ioa_cfg = res->ioa_cfg;
1357 
1358         if (!ioa_cfg->sis64)
1359                 return;
1360 
1361         if (res->bus == IPR_ARRAY_VIRTUAL_BUS)
1362                 clear_bit(res->target, ioa_cfg->array_ids);
1363         else if (res->bus == IPR_VSET_VIRTUAL_BUS)
1364                 clear_bit(res->target, ioa_cfg->vset_ids);
1365         else if (res->bus == 0 && res->type == IPR_RES_TYPE_GENERIC_SCSI) {
1366                 list_for_each_entry(gscsi_res, &ioa_cfg->used_res_q, queue)
1367                         if (gscsi_res->dev_id == res->dev_id && gscsi_res != res)
1368                                 return;
1369                 clear_bit(res->target, ioa_cfg->target_ids);
1370 
1371         } else if (res->bus == 0)
1372                 clear_bit(res->target, ioa_cfg->target_ids);
1373 }
1374 
1375 /**
1376  * ipr_handle_config_change - Handle a config change from the adapter
1377  * @ioa_cfg:    ioa config struct
1378  * @hostrcb:    hostrcb
1379  *
1380  * Return value:
1381  *      none
1382  **/
1383 static void ipr_handle_config_change(struct ipr_ioa_cfg *ioa_cfg,
1384                                      struct ipr_hostrcb *hostrcb)
1385 {
1386         struct ipr_resource_entry *res = NULL;
1387         struct ipr_config_table_entry_wrapper cfgtew;
1388         __be32 cc_res_handle;
1389 
1390         u32 is_ndn = 1;
1391 
1392         if (ioa_cfg->sis64) {
1393                 cfgtew.u.cfgte64 = &hostrcb->hcam.u.ccn.u.cfgte64;
1394                 cc_res_handle = cfgtew.u.cfgte64->res_handle;
1395         } else {
1396                 cfgtew.u.cfgte = &hostrcb->hcam.u.ccn.u.cfgte;
1397                 cc_res_handle = cfgtew.u.cfgte->res_handle;
1398         }
1399 
1400         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
1401                 if (res->res_handle == cc_res_handle) {
1402                         is_ndn = 0;
1403                         break;
1404                 }
1405         }
1406 
1407         if (is_ndn) {
1408                 if (list_empty(&ioa_cfg->free_res_q)) {
1409                         ipr_send_hcam(ioa_cfg,
1410                                       IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE,
1411                                       hostrcb);
1412                         return;
1413                 }
1414 
1415                 res = list_entry(ioa_cfg->free_res_q.next,
1416                                  struct ipr_resource_entry, queue);
1417 
1418                 list_del(&res->queue);
1419                 ipr_init_res_entry(res, &cfgtew);
1420                 list_add_tail(&res->queue, &ioa_cfg->used_res_q);
1421         }
1422 
1423         ipr_update_res_entry(res, &cfgtew);
1424 
1425         if (hostrcb->hcam.notify_type == IPR_HOST_RCB_NOTIF_TYPE_REM_ENTRY) {
1426                 if (res->sdev) {
1427                         res->del_from_ml = 1;
1428                         res->res_handle = IPR_INVALID_RES_HANDLE;
1429                         if (ioa_cfg->allow_ml_add_del)
1430                                 schedule_work(&ioa_cfg->work_q);
1431                 } else {
1432                         ipr_clear_res_target(res);
1433                         list_move_tail(&res->queue, &ioa_cfg->free_res_q);
1434                 }
1435         } else if (!res->sdev || res->del_from_ml) {
1436                 res->add_to_ml = 1;
1437                 if (ioa_cfg->allow_ml_add_del)
1438                         schedule_work(&ioa_cfg->work_q);
1439         }
1440 
1441         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE, hostrcb);
1442 }
1443 
1444 /**
1445  * ipr_process_ccn - Op done function for a CCN.
1446  * @ipr_cmd:    ipr command struct
1447  *
1448  * This function is the op done function for a configuration
1449  * change notification host controlled async from the adapter.
1450  *
1451  * Return value:
1452  *      none
1453  **/
1454 static void ipr_process_ccn(struct ipr_cmnd *ipr_cmd)
1455 {
1456         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
1457         struct ipr_hostrcb *hostrcb = ipr_cmd->u.hostrcb;
1458         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
1459 
1460         list_del(&hostrcb->queue);
1461         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
1462 
1463         if (ioasc) {
1464                 if (ioasc != IPR_IOASC_IOA_WAS_RESET)
1465                         dev_err(&ioa_cfg->pdev->dev,
1466                                 "Host RCB failed with IOASC: 0x%08X\n", ioasc);
1467 
1468                 ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE, hostrcb);
1469         } else {
1470                 ipr_handle_config_change(ioa_cfg, hostrcb);
1471         }
1472 }
1473 
1474 /**
1475  * strip_and_pad_whitespace - Strip and pad trailing whitespace.
1476  * @i:          index into buffer
1477  * @buf:                string to modify
1478  *
1479  * This function will strip all trailing whitespace, pad the end
1480  * of the string with a single space, and NULL terminate the string.
1481  *
1482  * Return value:
1483  *      new length of string
1484  **/
1485 static int strip_and_pad_whitespace(int i, char *buf)
1486 {
1487         while (i && buf[i] == ' ')
1488                 i--;
1489         buf[i+1] = ' ';
1490         buf[i+2] = '\0';
1491         return i + 2;
1492 }
1493 
1494 /**
1495  * ipr_log_vpd_compact - Log the passed extended VPD compactly.
1496  * @prefix:             string to print at start of printk
1497  * @hostrcb:    hostrcb pointer
1498  * @vpd:                vendor/product id/sn struct
1499  *
1500  * Return value:
1501  *      none
1502  **/
1503 static void ipr_log_vpd_compact(char *prefix, struct ipr_hostrcb *hostrcb,
1504                                 struct ipr_vpd *vpd)
1505 {
1506         char buffer[IPR_VENDOR_ID_LEN + IPR_PROD_ID_LEN + IPR_SERIAL_NUM_LEN + 3];
1507         int i = 0;
1508 
1509         memcpy(buffer, vpd->vpids.vendor_id, IPR_VENDOR_ID_LEN);
1510         i = strip_and_pad_whitespace(IPR_VENDOR_ID_LEN - 1, buffer);
1511 
1512         memcpy(&buffer[i], vpd->vpids.product_id, IPR_PROD_ID_LEN);
1513         i = strip_and_pad_whitespace(i + IPR_PROD_ID_LEN - 1, buffer);
1514 
1515         memcpy(&buffer[i], vpd->sn, IPR_SERIAL_NUM_LEN);
1516         buffer[IPR_SERIAL_NUM_LEN + i] = '\0';
1517 
1518         ipr_hcam_err(hostrcb, "%s VPID/SN: %s\n", prefix, buffer);
1519 }
1520 
1521 /**
1522  * ipr_log_vpd - Log the passed VPD to the error log.
1523  * @vpd:                vendor/product id/sn struct
1524  *
1525  * Return value:
1526  *      none
1527  **/
1528 static void ipr_log_vpd(struct ipr_vpd *vpd)
1529 {
1530         char buffer[IPR_VENDOR_ID_LEN + IPR_PROD_ID_LEN
1531                     + IPR_SERIAL_NUM_LEN];
1532 
1533         memcpy(buffer, vpd->vpids.vendor_id, IPR_VENDOR_ID_LEN);
1534         memcpy(buffer + IPR_VENDOR_ID_LEN, vpd->vpids.product_id,
1535                IPR_PROD_ID_LEN);
1536         buffer[IPR_VENDOR_ID_LEN + IPR_PROD_ID_LEN] = '\0';
1537         ipr_err("Vendor/Product ID: %s\n", buffer);
1538 
1539         memcpy(buffer, vpd->sn, IPR_SERIAL_NUM_LEN);
1540         buffer[IPR_SERIAL_NUM_LEN] = '\0';
1541         ipr_err("    Serial Number: %s\n", buffer);
1542 }
1543 
1544 /**
1545  * ipr_log_ext_vpd_compact - Log the passed extended VPD compactly.
1546  * @prefix:             string to print at start of printk
1547  * @hostrcb:    hostrcb pointer
1548  * @vpd:                vendor/product id/sn/wwn struct
1549  *
1550  * Return value:
1551  *      none
1552  **/
1553 static void ipr_log_ext_vpd_compact(char *prefix, struct ipr_hostrcb *hostrcb,
1554                                     struct ipr_ext_vpd *vpd)
1555 {
1556         ipr_log_vpd_compact(prefix, hostrcb, &vpd->vpd);
1557         ipr_hcam_err(hostrcb, "%s WWN: %08X%08X\n", prefix,
1558                      be32_to_cpu(vpd->wwid[0]), be32_to_cpu(vpd->wwid[1]));
1559 }
1560 
1561 /**
1562  * ipr_log_ext_vpd - Log the passed extended VPD to the error log.
1563  * @vpd:                vendor/product id/sn/wwn struct
1564  *
1565  * Return value:
1566  *      none
1567  **/
1568 static void ipr_log_ext_vpd(struct ipr_ext_vpd *vpd)
1569 {
1570         ipr_log_vpd(&vpd->vpd);
1571         ipr_err("    WWN: %08X%08X\n", be32_to_cpu(vpd->wwid[0]),
1572                 be32_to_cpu(vpd->wwid[1]));
1573 }
1574 
1575 /**
1576  * ipr_log_enhanced_cache_error - Log a cache error.
1577  * @ioa_cfg:    ioa config struct
1578  * @hostrcb:    hostrcb struct
1579  *
1580  * Return value:
1581  *      none
1582  **/
1583 static void ipr_log_enhanced_cache_error(struct ipr_ioa_cfg *ioa_cfg,
1584                                          struct ipr_hostrcb *hostrcb)
1585 {
1586         struct ipr_hostrcb_type_12_error *error;
1587 
1588         if (ioa_cfg->sis64)
1589                 error = &hostrcb->hcam.u.error64.u.type_12_error;
1590         else
1591                 error = &hostrcb->hcam.u.error.u.type_12_error;
1592 
1593         ipr_err("-----Current Configuration-----\n");
1594         ipr_err("Cache Directory Card Information:\n");
1595         ipr_log_ext_vpd(&error->ioa_vpd);
1596         ipr_err("Adapter Card Information:\n");
1597         ipr_log_ext_vpd(&error->cfc_vpd);
1598 
1599         ipr_err("-----Expected Configuration-----\n");
1600         ipr_err("Cache Directory Card Information:\n");
1601         ipr_log_ext_vpd(&error->ioa_last_attached_to_cfc_vpd);
1602         ipr_err("Adapter Card Information:\n");
1603         ipr_log_ext_vpd(&error->cfc_last_attached_to_ioa_vpd);
1604 
1605         ipr_err("Additional IOA Data: %08X %08X %08X\n",
1606                      be32_to_cpu(error->ioa_data[0]),
1607                      be32_to_cpu(error->ioa_data[1]),
1608                      be32_to_cpu(error->ioa_data[2]));
1609 }
1610 
1611 /**
1612  * ipr_log_cache_error - Log a cache error.
1613  * @ioa_cfg:    ioa config struct
1614  * @hostrcb:    hostrcb struct
1615  *
1616  * Return value:
1617  *      none
1618  **/
1619 static void ipr_log_cache_error(struct ipr_ioa_cfg *ioa_cfg,
1620                                 struct ipr_hostrcb *hostrcb)
1621 {
1622         struct ipr_hostrcb_type_02_error *error =
1623                 &hostrcb->hcam.u.error.u.type_02_error;
1624 
1625         ipr_err("-----Current Configuration-----\n");
1626         ipr_err("Cache Directory Card Information:\n");
1627         ipr_log_vpd(&error->ioa_vpd);
1628         ipr_err("Adapter Card Information:\n");
1629         ipr_log_vpd(&error->cfc_vpd);
1630 
1631         ipr_err("-----Expected Configuration-----\n");
1632         ipr_err("Cache Directory Card Information:\n");
1633         ipr_log_vpd(&error->ioa_last_attached_to_cfc_vpd);
1634         ipr_err("Adapter Card Information:\n");
1635         ipr_log_vpd(&error->cfc_last_attached_to_ioa_vpd);
1636 
1637         ipr_err("Additional IOA Data: %08X %08X %08X\n",
1638                      be32_to_cpu(error->ioa_data[0]),
1639                      be32_to_cpu(error->ioa_data[1]),
1640                      be32_to_cpu(error->ioa_data[2]));
1641 }
1642 
1643 /**
1644  * ipr_log_enhanced_config_error - Log a configuration error.
1645  * @ioa_cfg:    ioa config struct
1646  * @hostrcb:    hostrcb struct
1647  *
1648  * Return value:
1649  *      none
1650  **/
1651 static void ipr_log_enhanced_config_error(struct ipr_ioa_cfg *ioa_cfg,
1652                                           struct ipr_hostrcb *hostrcb)
1653 {
1654         int errors_logged, i;
1655         struct ipr_hostrcb_device_data_entry_enhanced *dev_entry;
1656         struct ipr_hostrcb_type_13_error *error;
1657 
1658         error = &hostrcb->hcam.u.error.u.type_13_error;
1659         errors_logged = be32_to_cpu(error->errors_logged);
1660 
1661         ipr_err("Device Errors Detected/Logged: %d/%d\n",
1662                 be32_to_cpu(error->errors_detected), errors_logged);
1663 
1664         dev_entry = error->dev;
1665 
1666         for (i = 0; i < errors_logged; i++, dev_entry++) {
1667                 ipr_err_separator;
1668 
1669                 ipr_phys_res_err(ioa_cfg, dev_entry->dev_res_addr, "Device %d", i + 1);
1670                 ipr_log_ext_vpd(&dev_entry->vpd);
1671 
1672                 ipr_err("-----New Device Information-----\n");
1673                 ipr_log_ext_vpd(&dev_entry->new_vpd);
1674 
1675                 ipr_err("Cache Directory Card Information:\n");
1676                 ipr_log_ext_vpd(&dev_entry->ioa_last_with_dev_vpd);
1677 
1678                 ipr_err("Adapter Card Information:\n");
1679                 ipr_log_ext_vpd(&dev_entry->cfc_last_with_dev_vpd);
1680         }
1681 }
1682 
1683 /**
1684  * ipr_log_sis64_config_error - Log a device error.
1685  * @ioa_cfg:    ioa config struct
1686  * @hostrcb:    hostrcb struct
1687  *
1688  * Return value:
1689  *      none
1690  **/
1691 static void ipr_log_sis64_config_error(struct ipr_ioa_cfg *ioa_cfg,
1692                                        struct ipr_hostrcb *hostrcb)
1693 {
1694         int errors_logged, i;
1695         struct ipr_hostrcb64_device_data_entry_enhanced *dev_entry;
1696         struct ipr_hostrcb_type_23_error *error;
1697         char buffer[IPR_MAX_RES_PATH_LENGTH];
1698 
1699         error = &hostrcb->hcam.u.error64.u.type_23_error;
1700         errors_logged = be32_to_cpu(error->errors_logged);
1701 
1702         ipr_err("Device Errors Detected/Logged: %d/%d\n",
1703                 be32_to_cpu(error->errors_detected), errors_logged);
1704 
1705         dev_entry = error->dev;
1706 
1707         for (i = 0; i < errors_logged; i++, dev_entry++) {
1708                 ipr_err_separator;
1709 
1710                 ipr_err("Device %d : %s", i + 1,
1711                         __ipr_format_res_path(dev_entry->res_path,
1712                                               buffer, sizeof(buffer)));
1713                 ipr_log_ext_vpd(&dev_entry->vpd);
1714 
1715                 ipr_err("-----New Device Information-----\n");
1716                 ipr_log_ext_vpd(&dev_entry->new_vpd);
1717 
1718                 ipr_err("Cache Directory Card Information:\n");
1719                 ipr_log_ext_vpd(&dev_entry->ioa_last_with_dev_vpd);
1720 
1721                 ipr_err("Adapter Card Information:\n");
1722                 ipr_log_ext_vpd(&dev_entry->cfc_last_with_dev_vpd);
1723         }
1724 }
1725 
1726 /**
1727  * ipr_log_config_error - Log a configuration error.
1728  * @ioa_cfg:    ioa config struct
1729  * @hostrcb:    hostrcb struct
1730  *
1731  * Return value:
1732  *      none
1733  **/
1734 static void ipr_log_config_error(struct ipr_ioa_cfg *ioa_cfg,
1735                                  struct ipr_hostrcb *hostrcb)
1736 {
1737         int errors_logged, i;
1738         struct ipr_hostrcb_device_data_entry *dev_entry;
1739         struct ipr_hostrcb_type_03_error *error;
1740 
1741         error = &hostrcb->hcam.u.error.u.type_03_error;
1742         errors_logged = be32_to_cpu(error->errors_logged);
1743 
1744         ipr_err("Device Errors Detected/Logged: %d/%d\n",
1745                 be32_to_cpu(error->errors_detected), errors_logged);
1746 
1747         dev_entry = error->dev;
1748 
1749         for (i = 0; i < errors_logged; i++, dev_entry++) {
1750                 ipr_err_separator;
1751 
1752                 ipr_phys_res_err(ioa_cfg, dev_entry->dev_res_addr, "Device %d", i + 1);
1753                 ipr_log_vpd(&dev_entry->vpd);
1754 
1755                 ipr_err("-----New Device Information-----\n");
1756                 ipr_log_vpd(&dev_entry->new_vpd);
1757 
1758                 ipr_err("Cache Directory Card Information:\n");
1759                 ipr_log_vpd(&dev_entry->ioa_last_with_dev_vpd);
1760 
1761                 ipr_err("Adapter Card Information:\n");
1762                 ipr_log_vpd(&dev_entry->cfc_last_with_dev_vpd);
1763 
1764                 ipr_err("Additional IOA Data: %08X %08X %08X %08X %08X\n",
1765                         be32_to_cpu(dev_entry->ioa_data[0]),
1766                         be32_to_cpu(dev_entry->ioa_data[1]),
1767                         be32_to_cpu(dev_entry->ioa_data[2]),
1768                         be32_to_cpu(dev_entry->ioa_data[3]),
1769                         be32_to_cpu(dev_entry->ioa_data[4]));
1770         }
1771 }
1772 
1773 /**
1774  * ipr_log_enhanced_array_error - Log an array configuration error.
1775  * @ioa_cfg:    ioa config struct
1776  * @hostrcb:    hostrcb struct
1777  *
1778  * Return value:
1779  *      none
1780  **/
1781 static void ipr_log_enhanced_array_error(struct ipr_ioa_cfg *ioa_cfg,
1782                                          struct ipr_hostrcb *hostrcb)
1783 {
1784         int i, num_entries;
1785         struct ipr_hostrcb_type_14_error *error;
1786         struct ipr_hostrcb_array_data_entry_enhanced *array_entry;
1787         const u8 zero_sn[IPR_SERIAL_NUM_LEN] = { [0 ... IPR_SERIAL_NUM_LEN-1] = '' };
1788 
1789         error = &hostrcb->hcam.u.error.u.type_14_error;
1790 
1791         ipr_err_separator;
1792 
1793         ipr_err("RAID %s Array Configuration: %d:%d:%d:%d\n",
1794                 error->protection_level,
1795                 ioa_cfg->host->host_no,
1796                 error->last_func_vset_res_addr.bus,
1797                 error->last_func_vset_res_addr.target,
1798                 error->last_func_vset_res_addr.lun);
1799 
1800         ipr_err_separator;
1801 
1802         array_entry = error->array_member;
1803         num_entries = min_t(u32, be32_to_cpu(error->num_entries),
1804                             ARRAY_SIZE(error->array_member));
1805 
1806         for (i = 0; i < num_entries; i++, array_entry++) {
1807                 if (!memcmp(array_entry->vpd.vpd.sn, zero_sn, IPR_SERIAL_NUM_LEN))
1808                         continue;
1809 
1810                 if (be32_to_cpu(error->exposed_mode_adn) == i)
1811                         ipr_err("Exposed Array Member %d:\n", i);
1812                 else
1813                         ipr_err("Array Member %d:\n", i);
1814 
1815                 ipr_log_ext_vpd(&array_entry->vpd);
1816                 ipr_phys_res_err(ioa_cfg, array_entry->dev_res_addr, "Current Location");
1817                 ipr_phys_res_err(ioa_cfg, array_entry->expected_dev_res_addr,
1818                                  "Expected Location");
1819 
1820                 ipr_err_separator;
1821         }
1822 }
1823 
1824 /**
1825  * ipr_log_array_error - Log an array configuration error.
1826  * @ioa_cfg:    ioa config struct
1827  * @hostrcb:    hostrcb struct
1828  *
1829  * Return value:
1830  *      none
1831  **/
1832 static void ipr_log_array_error(struct ipr_ioa_cfg *ioa_cfg,
1833                                 struct ipr_hostrcb *hostrcb)
1834 {
1835         int i;
1836         struct ipr_hostrcb_type_04_error *error;
1837         struct ipr_hostrcb_array_data_entry *array_entry;
1838         const u8 zero_sn[IPR_SERIAL_NUM_LEN] = { [0 ... IPR_SERIAL_NUM_LEN-1] = '' };
1839 
1840         error = &hostrcb->hcam.u.error.u.type_04_error;
1841 
1842         ipr_err_separator;
1843 
1844         ipr_err("RAID %s Array Configuration: %d:%d:%d:%d\n",
1845                 error->protection_level,
1846                 ioa_cfg->host->host_no,
1847                 error->last_func_vset_res_addr.bus,
1848                 error->last_func_vset_res_addr.target,
1849                 error->last_func_vset_res_addr.lun);
1850 
1851         ipr_err_separator;
1852 
1853         array_entry = error->array_member;
1854 
1855         for (i = 0; i < 18; i++) {
1856                 if (!memcmp(array_entry->vpd.sn, zero_sn, IPR_SERIAL_NUM_LEN))
1857                         continue;
1858 
1859                 if (be32_to_cpu(error->exposed_mode_adn) == i)
1860                         ipr_err("Exposed Array Member %d:\n", i);
1861                 else
1862                         ipr_err("Array Member %d:\n", i);
1863 
1864                 ipr_log_vpd(&array_entry->vpd);
1865 
1866                 ipr_phys_res_err(ioa_cfg, array_entry->dev_res_addr, "Current Location");
1867                 ipr_phys_res_err(ioa_cfg, array_entry->expected_dev_res_addr,
1868                                  "Expected Location");
1869 
1870                 ipr_err_separator;
1871 
1872                 if (i == 9)
1873                         array_entry = error->array_member2;
1874                 else
1875                         array_entry++;
1876         }
1877 }
1878 
1879 /**
1880  * ipr_log_hex_data - Log additional hex IOA error data.
1881  * @ioa_cfg:    ioa config struct
1882  * @data:               IOA error data
1883  * @len:                data length
1884  *
1885  * Return value:
1886  *      none
1887  **/
1888 static void ipr_log_hex_data(struct ipr_ioa_cfg *ioa_cfg, u32 *data, int len)
1889 {
1890         int i;
1891 
1892         if (len == 0)
1893                 return;
1894 
1895         if (ioa_cfg->log_level <= IPR_DEFAULT_LOG_LEVEL)
1896                 len = min_t(int, len, IPR_DEFAULT_MAX_ERROR_DUMP);
1897 
1898         for (i = 0; i < len / 4; i += 4) {
1899                 ipr_err("%08X: %08X %08X %08X %08X\n", i*4,
1900                         be32_to_cpu(data[i]),
1901                         be32_to_cpu(data[i+1]),
1902                         be32_to_cpu(data[i+2]),
1903                         be32_to_cpu(data[i+3]));
1904         }
1905 }
1906 
1907 /**
1908  * ipr_log_enhanced_dual_ioa_error - Log an enhanced dual adapter error.
1909  * @ioa_cfg:    ioa config struct
1910  * @hostrcb:    hostrcb struct
1911  *
1912  * Return value:
1913  *      none
1914  **/
1915 static void ipr_log_enhanced_dual_ioa_error(struct ipr_ioa_cfg *ioa_cfg,
1916                                             struct ipr_hostrcb *hostrcb)
1917 {
1918         struct ipr_hostrcb_type_17_error *error;
1919 
1920         if (ioa_cfg->sis64)
1921                 error = &hostrcb->hcam.u.error64.u.type_17_error;
1922         else
1923                 error = &hostrcb->hcam.u.error.u.type_17_error;
1924 
1925         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
1926         strim(error->failure_reason);
1927 
1928         ipr_hcam_err(hostrcb, "%s [PRC: %08X]\n", error->failure_reason,
1929                      be32_to_cpu(hostrcb->hcam.u.error.prc));
1930         ipr_log_ext_vpd_compact("Remote IOA", hostrcb, &error->vpd);
1931         ipr_log_hex_data(ioa_cfg, error->data,
1932                          be32_to_cpu(hostrcb->hcam.length) -
1933                          (offsetof(struct ipr_hostrcb_error, u) +
1934                           offsetof(struct ipr_hostrcb_type_17_error, data)));
1935 }
1936 
1937 /**
1938  * ipr_log_dual_ioa_error - Log a dual adapter error.
1939  * @ioa_cfg:    ioa config struct
1940  * @hostrcb:    hostrcb struct
1941  *
1942  * Return value:
1943  *      none
1944  **/
1945 static void ipr_log_dual_ioa_error(struct ipr_ioa_cfg *ioa_cfg,
1946                                    struct ipr_hostrcb *hostrcb)
1947 {
1948         struct ipr_hostrcb_type_07_error *error;
1949 
1950         error = &hostrcb->hcam.u.error.u.type_07_error;
1951         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
1952         strim(error->failure_reason);
1953 
1954         ipr_hcam_err(hostrcb, "%s [PRC: %08X]\n", error->failure_reason,
1955                      be32_to_cpu(hostrcb->hcam.u.error.prc));
1956         ipr_log_vpd_compact("Remote IOA", hostrcb, &error->vpd);
1957         ipr_log_hex_data(ioa_cfg, error->data,
1958                          be32_to_cpu(hostrcb->hcam.length) -
1959                          (offsetof(struct ipr_hostrcb_error, u) +
1960                           offsetof(struct ipr_hostrcb_type_07_error, data)));
1961 }
1962 
1963 static const struct {
1964         u8 active;
1965         char *desc;
1966 } path_active_desc[] = {
1967         { IPR_PATH_NO_INFO, "Path" },
1968         { IPR_PATH_ACTIVE, "Active path" },
1969         { IPR_PATH_NOT_ACTIVE, "Inactive path" }
1970 };
1971 
1972 static const struct {
1973         u8 state;
1974         char *desc;
1975 } path_state_desc[] = {
1976         { IPR_PATH_STATE_NO_INFO, "has no path state information available" },
1977         { IPR_PATH_HEALTHY, "is healthy" },
1978         { IPR_PATH_DEGRADED, "is degraded" },
1979         { IPR_PATH_FAILED, "is failed" }
1980 };
1981 
1982 /**
1983  * ipr_log_fabric_path - Log a fabric path error
1984  * @hostrcb:    hostrcb struct
1985  * @fabric:             fabric descriptor
1986  *
1987  * Return value:
1988  *      none
1989  **/
1990 static void ipr_log_fabric_path(struct ipr_hostrcb *hostrcb,
1991                                 struct ipr_hostrcb_fabric_desc *fabric)
1992 {
1993         int i, j;
1994         u8 path_state = fabric->path_state;
1995         u8 active = path_state & IPR_PATH_ACTIVE_MASK;
1996         u8 state = path_state & IPR_PATH_STATE_MASK;
1997 
1998         for (i = 0; i < ARRAY_SIZE(path_active_desc); i++) {
1999                 if (path_active_desc[i].active != active)
2000                         continue;
2001 
2002                 for (j = 0; j < ARRAY_SIZE(path_state_desc); j++) {
2003                         if (path_state_desc[j].state != state)
2004                                 continue;
2005 
2006                         if (fabric->cascaded_expander == 0xff && fabric->phy == 0xff) {
2007                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d\n",
2008                                              path_active_desc[i].desc, path_state_desc[j].desc,
2009                                              fabric->ioa_port);
2010                         } else if (fabric->cascaded_expander == 0xff) {
2011                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d, Phy=%d\n",
2012                                              path_active_desc[i].desc, path_state_desc[j].desc,
2013                                              fabric->ioa_port, fabric->phy);
2014                         } else if (fabric->phy == 0xff) {
2015                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d, Cascade=%d\n",
2016                                              path_active_desc[i].desc, path_state_desc[j].desc,
2017                                              fabric->ioa_port, fabric->cascaded_expander);
2018                         } else {
2019                                 ipr_hcam_err(hostrcb, "%s %s: IOA Port=%d, Cascade=%d, Phy=%d\n",
2020                                              path_active_desc[i].desc, path_state_desc[j].desc,
2021                                              fabric->ioa_port, fabric->cascaded_expander, fabric->phy);
2022                         }
2023                         return;
2024                 }
2025         }
2026 
2027         ipr_err("Path state=%02X IOA Port=%d Cascade=%d Phy=%d\n", path_state,
2028                 fabric->ioa_port, fabric->cascaded_expander, fabric->phy);
2029 }
2030 
2031 /**
2032  * ipr_log64_fabric_path - Log a fabric path error
2033  * @hostrcb:    hostrcb struct
2034  * @fabric:             fabric descriptor
2035  *
2036  * Return value:
2037  *      none
2038  **/
2039 static void ipr_log64_fabric_path(struct ipr_hostrcb *hostrcb,
2040                                   struct ipr_hostrcb64_fabric_desc *fabric)
2041 {
2042         int i, j;
2043         u8 path_state = fabric->path_state;
2044         u8 active = path_state & IPR_PATH_ACTIVE_MASK;
2045         u8 state = path_state & IPR_PATH_STATE_MASK;
2046         char buffer[IPR_MAX_RES_PATH_LENGTH];
2047 
2048         for (i = 0; i < ARRAY_SIZE(path_active_desc); i++) {
2049                 if (path_active_desc[i].active != active)
2050                         continue;
2051 
2052                 for (j = 0; j < ARRAY_SIZE(path_state_desc); j++) {
2053                         if (path_state_desc[j].state != state)
2054                                 continue;
2055 
2056                         ipr_hcam_err(hostrcb, "%s %s: Resource Path=%s\n",
2057                                      path_active_desc[i].desc, path_state_desc[j].desc,
2058                                      ipr_format_res_path(hostrcb->ioa_cfg,
2059                                                 fabric->res_path,
2060                                                 buffer, sizeof(buffer)));
2061                         return;
2062                 }
2063         }
2064 
2065         ipr_err("Path state=%02X Resource Path=%s\n", path_state,
2066                 ipr_format_res_path(hostrcb->ioa_cfg, fabric->res_path,
2067                                     buffer, sizeof(buffer)));
2068 }
2069 
2070 static const struct {
2071         u8 type;
2072         char *desc;
2073 } path_type_desc[] = {
2074         { IPR_PATH_CFG_IOA_PORT, "IOA port" },
2075         { IPR_PATH_CFG_EXP_PORT, "Expander port" },
2076         { IPR_PATH_CFG_DEVICE_PORT, "Device port" },
2077         { IPR_PATH_CFG_DEVICE_LUN, "Device LUN" }
2078 };
2079 
2080 static const struct {
2081         u8 status;
2082         char *desc;
2083 } path_status_desc[] = {
2084         { IPR_PATH_CFG_NO_PROB, "Functional" },
2085         { IPR_PATH_CFG_DEGRADED, "Degraded" },
2086         { IPR_PATH_CFG_FAILED, "Failed" },
2087         { IPR_PATH_CFG_SUSPECT, "Suspect" },
2088         { IPR_PATH_NOT_DETECTED, "Missing" },
2089         { IPR_PATH_INCORRECT_CONN, "Incorrectly connected" }
2090 };
2091 
2092 static const char *link_rate[] = {
2093         "unknown",
2094         "disabled",
2095         "phy reset problem",
2096         "spinup hold",
2097         "port selector",
2098         "unknown",
2099         "unknown",
2100         "unknown",
2101         "1.5Gbps",
2102         "3.0Gbps",
2103         "unknown",
2104         "unknown",
2105         "unknown",
2106         "unknown",
2107         "unknown",
2108         "unknown"
2109 };
2110 
2111 /**
2112  * ipr_log_path_elem - Log a fabric path element.
2113  * @hostrcb:    hostrcb struct
2114  * @cfg:                fabric path element struct
2115  *
2116  * Return value:
2117  *      none
2118  **/
2119 static void ipr_log_path_elem(struct ipr_hostrcb *hostrcb,
2120                               struct ipr_hostrcb_config_element *cfg)
2121 {
2122         int i, j;
2123         u8 type = cfg->type_status & IPR_PATH_CFG_TYPE_MASK;
2124         u8 status = cfg->type_status & IPR_PATH_CFG_STATUS_MASK;
2125 
2126         if (type == IPR_PATH_CFG_NOT_EXIST)
2127                 return;
2128 
2129         for (i = 0; i < ARRAY_SIZE(path_type_desc); i++) {
2130                 if (path_type_desc[i].type != type)
2131                         continue;
2132 
2133                 for (j = 0; j < ARRAY_SIZE(path_status_desc); j++) {
2134                         if (path_status_desc[j].status != status)
2135                                 continue;
2136 
2137                         if (type == IPR_PATH_CFG_IOA_PORT) {
2138                                 ipr_hcam_err(hostrcb, "%s %s: Phy=%d, Link rate=%s, WWN=%08X%08X\n",
2139                                              path_status_desc[j].desc, path_type_desc[i].desc,
2140                                              cfg->phy, link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2141                                              be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2142                         } else {
2143                                 if (cfg->cascaded_expander == 0xff && cfg->phy == 0xff) {
2144                                         ipr_hcam_err(hostrcb, "%s %s: Link rate=%s, WWN=%08X%08X\n",
2145                                                      path_status_desc[j].desc, path_type_desc[i].desc,
2146                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2147                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2148                                 } else if (cfg->cascaded_expander == 0xff) {
2149                                         ipr_hcam_err(hostrcb, "%s %s: Phy=%d, Link rate=%s, "
2150                                                      "WWN=%08X%08X\n", path_status_desc[j].desc,
2151                                                      path_type_desc[i].desc, cfg->phy,
2152                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2153                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2154                                 } else if (cfg->phy == 0xff) {
2155                                         ipr_hcam_err(hostrcb, "%s %s: Cascade=%d, Link rate=%s, "
2156                                                      "WWN=%08X%08X\n", path_status_desc[j].desc,
2157                                                      path_type_desc[i].desc, cfg->cascaded_expander,
2158                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2159                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2160                                 } else {
2161                                         ipr_hcam_err(hostrcb, "%s %s: Cascade=%d, Phy=%d, Link rate=%s "
2162                                                      "WWN=%08X%08X\n", path_status_desc[j].desc,
2163                                                      path_type_desc[i].desc, cfg->cascaded_expander, cfg->phy,
2164                                                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2165                                                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2166                                 }
2167                         }
2168                         return;
2169                 }
2170         }
2171 
2172         ipr_hcam_err(hostrcb, "Path element=%02X: Cascade=%d Phy=%d Link rate=%s "
2173                      "WWN=%08X%08X\n", cfg->type_status, cfg->cascaded_expander, cfg->phy,
2174                      link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2175                      be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2176 }
2177 
2178 /**
2179  * ipr_log64_path_elem - Log a fabric path element.
2180  * @hostrcb:    hostrcb struct
2181  * @cfg:                fabric path element struct
2182  *
2183  * Return value:
2184  *      none
2185  **/
2186 static void ipr_log64_path_elem(struct ipr_hostrcb *hostrcb,
2187                                 struct ipr_hostrcb64_config_element *cfg)
2188 {
2189         int i, j;
2190         u8 desc_id = cfg->descriptor_id & IPR_DESCRIPTOR_MASK;
2191         u8 type = cfg->type_status & IPR_PATH_CFG_TYPE_MASK;
2192         u8 status = cfg->type_status & IPR_PATH_CFG_STATUS_MASK;
2193         char buffer[IPR_MAX_RES_PATH_LENGTH];
2194 
2195         if (type == IPR_PATH_CFG_NOT_EXIST || desc_id != IPR_DESCRIPTOR_SIS64)
2196                 return;
2197 
2198         for (i = 0; i < ARRAY_SIZE(path_type_desc); i++) {
2199                 if (path_type_desc[i].type != type)
2200                         continue;
2201 
2202                 for (j = 0; j < ARRAY_SIZE(path_status_desc); j++) {
2203                         if (path_status_desc[j].status != status)
2204                                 continue;
2205 
2206                         ipr_hcam_err(hostrcb, "%s %s: Resource Path=%s, Link rate=%s, WWN=%08X%08X\n",
2207                                      path_status_desc[j].desc, path_type_desc[i].desc,
2208                                      ipr_format_res_path(hostrcb->ioa_cfg,
2209                                         cfg->res_path, buffer, sizeof(buffer)),
2210                                         link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2211                                         be32_to_cpu(cfg->wwid[0]),
2212                                         be32_to_cpu(cfg->wwid[1]));
2213                         return;
2214                 }
2215         }
2216         ipr_hcam_err(hostrcb, "Path element=%02X: Resource Path=%s, Link rate=%s "
2217                      "WWN=%08X%08X\n", cfg->type_status,
2218                      ipr_format_res_path(hostrcb->ioa_cfg,
2219                         cfg->res_path, buffer, sizeof(buffer)),
2220                         link_rate[cfg->link_rate & IPR_PHY_LINK_RATE_MASK],
2221                         be32_to_cpu(cfg->wwid[0]), be32_to_cpu(cfg->wwid[1]));
2222 }
2223 
2224 /**
2225  * ipr_log_fabric_error - Log a fabric error.
2226  * @ioa_cfg:    ioa config struct
2227  * @hostrcb:    hostrcb struct
2228  *
2229  * Return value:
2230  *      none
2231  **/
2232 static void ipr_log_fabric_error(struct ipr_ioa_cfg *ioa_cfg,
2233                                  struct ipr_hostrcb *hostrcb)
2234 {
2235         struct ipr_hostrcb_type_20_error *error;
2236         struct ipr_hostrcb_fabric_desc *fabric;
2237         struct ipr_hostrcb_config_element *cfg;
2238         int i, add_len;
2239 
2240         error = &hostrcb->hcam.u.error.u.type_20_error;
2241         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
2242         ipr_hcam_err(hostrcb, "%s\n", error->failure_reason);
2243 
2244         add_len = be32_to_cpu(hostrcb->hcam.length) -
2245                 (offsetof(struct ipr_hostrcb_error, u) +
2246                  offsetof(struct ipr_hostrcb_type_20_error, desc));
2247 
2248         for (i = 0, fabric = error->desc; i < error->num_entries; i++) {
2249                 ipr_log_fabric_path(hostrcb, fabric);
2250                 for_each_fabric_cfg(fabric, cfg)
2251                         ipr_log_path_elem(hostrcb, cfg);
2252 
2253                 add_len -= be16_to_cpu(fabric->length);
2254                 fabric = (struct ipr_hostrcb_fabric_desc *)
2255                         ((unsigned long)fabric + be16_to_cpu(fabric->length));
2256         }
2257 
2258         ipr_log_hex_data(ioa_cfg, (u32 *)fabric, add_len);
2259 }
2260 
2261 /**
2262  * ipr_log_sis64_array_error - Log a sis64 array error.
2263  * @ioa_cfg:    ioa config struct
2264  * @hostrcb:    hostrcb struct
2265  *
2266  * Return value:
2267  *      none
2268  **/
2269 static void ipr_log_sis64_array_error(struct ipr_ioa_cfg *ioa_cfg,
2270                                       struct ipr_hostrcb *hostrcb)
2271 {
2272         int i, num_entries;
2273         struct ipr_hostrcb_type_24_error *error;
2274         struct ipr_hostrcb64_array_data_entry *array_entry;
2275         char buffer[IPR_MAX_RES_PATH_LENGTH];
2276         const u8 zero_sn[IPR_SERIAL_NUM_LEN] = { [0 ... IPR_SERIAL_NUM_LEN-1] = '' };
2277 
2278         error = &hostrcb->hcam.u.error64.u.type_24_error;
2279 
2280         ipr_err_separator;
2281 
2282         ipr_err("RAID %s Array Configuration: %s\n",
2283                 error->protection_level,
2284                 ipr_format_res_path(ioa_cfg, error->last_res_path,
2285                         buffer, sizeof(buffer)));
2286 
2287         ipr_err_separator;
2288 
2289         array_entry = error->array_member;
2290         num_entries = min_t(u32, error->num_entries,
2291                             ARRAY_SIZE(error->array_member));
2292 
2293         for (i = 0; i < num_entries; i++, array_entry++) {
2294 
2295                 if (!memcmp(array_entry->vpd.vpd.sn, zero_sn, IPR_SERIAL_NUM_LEN))
2296                         continue;
2297 
2298                 if (error->exposed_mode_adn == i)
2299                         ipr_err("Exposed Array Member %d:\n", i);
2300                 else
2301                         ipr_err("Array Member %d:\n", i);
2302 
2303                 ipr_err("Array Member %d:\n", i);
2304                 ipr_log_ext_vpd(&array_entry->vpd);
2305                 ipr_err("Current Location: %s\n",
2306                          ipr_format_res_path(ioa_cfg, array_entry->res_path,
2307                                 buffer, sizeof(buffer)));
2308                 ipr_err("Expected Location: %s\n",
2309                          ipr_format_res_path(ioa_cfg,
2310                                 array_entry->expected_res_path,
2311                                 buffer, sizeof(buffer)));
2312 
2313                 ipr_err_separator;
2314         }
2315 }
2316 
2317 /**
2318  * ipr_log_sis64_fabric_error - Log a sis64 fabric error.
2319  * @ioa_cfg:    ioa config struct
2320  * @hostrcb:    hostrcb struct
2321  *
2322  * Return value:
2323  *      none
2324  **/
2325 static void ipr_log_sis64_fabric_error(struct ipr_ioa_cfg *ioa_cfg,
2326                                        struct ipr_hostrcb *hostrcb)
2327 {
2328         struct ipr_hostrcb_type_30_error *error;
2329         struct ipr_hostrcb64_fabric_desc *fabric;
2330         struct ipr_hostrcb64_config_element *cfg;
2331         int i, add_len;
2332 
2333         error = &hostrcb->hcam.u.error64.u.type_30_error;
2334 
2335         error->failure_reason[sizeof(error->failure_reason) - 1] = '\0';
2336         ipr_hcam_err(hostrcb, "%s\n", error->failure_reason);
2337 
2338         add_len = be32_to_cpu(hostrcb->hcam.length) -
2339                 (offsetof(struct ipr_hostrcb64_error, u) +
2340                  offsetof(struct ipr_hostrcb_type_30_error, desc));
2341 
2342         for (i = 0, fabric = error->desc; i < error->num_entries; i++) {
2343                 ipr_log64_fabric_path(hostrcb, fabric);
2344                 for_each_fabric_cfg(fabric, cfg)
2345                         ipr_log64_path_elem(hostrcb, cfg);
2346 
2347                 add_len -= be16_to_cpu(fabric->length);
2348                 fabric = (struct ipr_hostrcb64_fabric_desc *)
2349                         ((unsigned long)fabric + be16_to_cpu(fabric->length));
2350         }
2351 
2352         ipr_log_hex_data(ioa_cfg, (u32 *)fabric, add_len);
2353 }
2354 
2355 /**
2356  * ipr_log_generic_error - Log an adapter error.
2357  * @ioa_cfg:    ioa config struct
2358  * @hostrcb:    hostrcb struct
2359  *
2360  * Return value:
2361  *      none
2362  **/
2363 static void ipr_log_generic_error(struct ipr_ioa_cfg *ioa_cfg,
2364                                   struct ipr_hostrcb *hostrcb)
2365 {
2366         ipr_log_hex_data(ioa_cfg, hostrcb->hcam.u.raw.data,
2367                          be32_to_cpu(hostrcb->hcam.length));
2368 }
2369 
2370 /**
2371  * ipr_log_sis64_device_error - Log a cache error.
2372  * @ioa_cfg:    ioa config struct
2373  * @hostrcb:    hostrcb struct
2374  *
2375  * Return value:
2376  *      none
2377  **/
2378 static void ipr_log_sis64_device_error(struct ipr_ioa_cfg *ioa_cfg,
2379                                          struct ipr_hostrcb *hostrcb)
2380 {
2381         struct ipr_hostrcb_type_21_error *error;
2382         char buffer[IPR_MAX_RES_PATH_LENGTH];
2383 
2384         error = &hostrcb->hcam.u.error64.u.type_21_error;
2385 
2386         ipr_err("-----Failing Device Information-----\n");
2387         ipr_err("World Wide Unique ID: %08X%08X%08X%08X\n",
2388                 be32_to_cpu(error->wwn[0]), be32_to_cpu(error->wwn[1]),
2389                  be32_to_cpu(error->wwn[2]), be32_to_cpu(error->wwn[3]));
2390         ipr_err("Device Resource Path: %s\n",
2391                 __ipr_format_res_path(error->res_path,
2392                                       buffer, sizeof(buffer)));
2393         error->primary_problem_desc[sizeof(error->primary_problem_desc) - 1] = '\0';
2394         error->second_problem_desc[sizeof(error->second_problem_desc) - 1] = '\0';
2395         ipr_err("Primary Problem Description: %s\n", error->primary_problem_desc);
2396         ipr_err("Secondary Problem Description:  %s\n", error->second_problem_desc);
2397         ipr_err("SCSI Sense Data:\n");
2398         ipr_log_hex_data(ioa_cfg, error->sense_data, sizeof(error->sense_data));
2399         ipr_err("SCSI Command Descriptor Block: \n");
2400         ipr_log_hex_data(ioa_cfg, error->cdb, sizeof(error->cdb));
2401 
2402         ipr_err("Additional IOA Data:\n");
2403         ipr_log_hex_data(ioa_cfg, error->ioa_data, be32_to_cpu(error->length_of_error));
2404 }
2405 
2406 /**
2407  * ipr_get_error - Find the specfied IOASC in the ipr_error_table.
2408  * @ioasc:      IOASC
2409  *
2410  * This function will return the index of into the ipr_error_table
2411  * for the specified IOASC. If the IOASC is not in the table,
2412  * 0 will be returned, which points to the entry used for unknown errors.
2413  *
2414  * Return value:
2415  *      index into the ipr_error_table
2416  **/
2417 static u32 ipr_get_error(u32 ioasc)
2418 {
2419         int i;
2420 
2421         for (i = 0; i < ARRAY_SIZE(ipr_error_table); i++)
2422                 if (ipr_error_table[i].ioasc == (ioasc & IPR_IOASC_IOASC_MASK))
2423                         return i;
2424 
2425         return 0;
2426 }
2427 
2428 /**
2429  * ipr_handle_log_data - Log an adapter error.
2430  * @ioa_cfg:    ioa config struct
2431  * @hostrcb:    hostrcb struct
2432  *
2433  * This function logs an adapter error to the system.
2434  *
2435  * Return value:
2436  *      none
2437  **/
2438 static void ipr_handle_log_data(struct ipr_ioa_cfg *ioa_cfg,
2439                                 struct ipr_hostrcb *hostrcb)
2440 {
2441         u32 ioasc;
2442         int error_index;
2443 
2444         if (hostrcb->hcam.notify_type != IPR_HOST_RCB_NOTIF_TYPE_ERROR_LOG_ENTRY)
2445                 return;
2446 
2447         if (hostrcb->hcam.notifications_lost == IPR_HOST_RCB_NOTIFICATIONS_LOST)
2448                 dev_err(&ioa_cfg->pdev->dev, "Error notifications lost\n");
2449 
2450         if (ioa_cfg->sis64)
2451                 ioasc = be32_to_cpu(hostrcb->hcam.u.error64.fd_ioasc);
2452         else
2453                 ioasc = be32_to_cpu(hostrcb->hcam.u.error.fd_ioasc);
2454 
2455         if (!ioa_cfg->sis64 && (ioasc == IPR_IOASC_BUS_WAS_RESET ||
2456             ioasc == IPR_IOASC_BUS_WAS_RESET_BY_OTHER)) {
2457                 /* Tell the midlayer we had a bus reset so it will handle the UA properly */
2458                 scsi_report_bus_reset(ioa_cfg->host,
2459                                       hostrcb->hcam.u.error.fd_res_addr.bus);
2460         }
2461 
2462         error_index = ipr_get_error(ioasc);
2463 
2464         if (!ipr_error_table[error_index].log_hcam)
2465                 return;
2466 
2467         ipr_hcam_err(hostrcb, "%s\n", ipr_error_table[error_index].error);
2468 
2469         /* Set indication we have logged an error */
2470         ioa_cfg->errors_logged++;
2471 
2472         if (ioa_cfg->log_level < ipr_error_table[error_index].log_hcam)
2473                 return;
2474         if (be32_to_cpu(hostrcb->hcam.length) > sizeof(hostrcb->hcam.u.raw))
2475                 hostrcb->hcam.length = cpu_to_be32(sizeof(hostrcb->hcam.u.raw));
2476 
2477         switch (hostrcb->hcam.overlay_id) {
2478         case IPR_HOST_RCB_OVERLAY_ID_2:
2479                 ipr_log_cache_error(ioa_cfg, hostrcb);
2480                 break;
2481         case IPR_HOST_RCB_OVERLAY_ID_3:
2482                 ipr_log_config_error(ioa_cfg, hostrcb);
2483                 break;
2484         case IPR_HOST_RCB_OVERLAY_ID_4:
2485         case IPR_HOST_RCB_OVERLAY_ID_6:
2486                 ipr_log_array_error(ioa_cfg, hostrcb);
2487                 break;
2488         case IPR_HOST_RCB_OVERLAY_ID_7:
2489                 ipr_log_dual_ioa_error(ioa_cfg, hostrcb);
2490                 break;
2491         case IPR_HOST_RCB_OVERLAY_ID_12:
2492                 ipr_log_enhanced_cache_error(ioa_cfg, hostrcb);
2493                 break;
2494         case IPR_HOST_RCB_OVERLAY_ID_13:
2495                 ipr_log_enhanced_config_error(ioa_cfg, hostrcb);
2496                 break;
2497         case IPR_HOST_RCB_OVERLAY_ID_14:
2498         case IPR_HOST_RCB_OVERLAY_ID_16:
2499                 ipr_log_enhanced_array_error(ioa_cfg, hostrcb);
2500                 break;
2501         case IPR_HOST_RCB_OVERLAY_ID_17:
2502                 ipr_log_enhanced_dual_ioa_error(ioa_cfg, hostrcb);
2503                 break;
2504         case IPR_HOST_RCB_OVERLAY_ID_20:
2505                 ipr_log_fabric_error(ioa_cfg, hostrcb);
2506                 break;
2507         case IPR_HOST_RCB_OVERLAY_ID_21:
2508                 ipr_log_sis64_device_error(ioa_cfg, hostrcb);
2509                 break;
2510         case IPR_HOST_RCB_OVERLAY_ID_23:
2511                 ipr_log_sis64_config_error(ioa_cfg, hostrcb);
2512                 break;
2513         case IPR_HOST_RCB_OVERLAY_ID_24:
2514         case IPR_HOST_RCB_OVERLAY_ID_26:
2515                 ipr_log_sis64_array_error(ioa_cfg, hostrcb);
2516                 break;
2517         case IPR_HOST_RCB_OVERLAY_ID_30:
2518                 ipr_log_sis64_fabric_error(ioa_cfg, hostrcb);
2519                 break;
2520         case IPR_HOST_RCB_OVERLAY_ID_1:
2521         case IPR_HOST_RCB_OVERLAY_ID_DEFAULT:
2522         default:
2523                 ipr_log_generic_error(ioa_cfg, hostrcb);
2524                 break;
2525         }
2526 }
2527 
2528 /**
2529  * ipr_process_error - Op done function for an adapter error log.
2530  * @ipr_cmd:    ipr command struct
2531  *
2532  * This function is the op done function for an error log host
2533  * controlled async from the adapter. It will log the error and
2534  * send the HCAM back to the adapter.
2535  *
2536  * Return value:
2537  *      none
2538  **/
2539 static void ipr_process_error(struct ipr_cmnd *ipr_cmd)
2540 {
2541         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
2542         struct ipr_hostrcb *hostrcb = ipr_cmd->u.hostrcb;
2543         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
2544         u32 fd_ioasc;
2545 
2546         if (ioa_cfg->sis64)
2547                 fd_ioasc = be32_to_cpu(hostrcb->hcam.u.error64.fd_ioasc);
2548         else
2549                 fd_ioasc = be32_to_cpu(hostrcb->hcam.u.error.fd_ioasc);
2550 
2551         list_del(&hostrcb->queue);
2552         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
2553 
2554         if (!ioasc) {
2555                 ipr_handle_log_data(ioa_cfg, hostrcb);
2556                 if (fd_ioasc == IPR_IOASC_NR_IOA_RESET_REQUIRED)
2557                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_ABBREV);
2558         } else if (ioasc != IPR_IOASC_IOA_WAS_RESET) {
2559                 dev_err(&ioa_cfg->pdev->dev,
2560                         "Host RCB failed with IOASC: 0x%08X\n", ioasc);
2561         }
2562 
2563         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_LOG_DATA, hostrcb);
2564 }
2565 
2566 /**
2567  * ipr_timeout -  An internally generated op has timed out.
2568  * @ipr_cmd:    ipr command struct
2569  *
2570  * This function blocks host requests and initiates an
2571  * adapter reset.
2572  *
2573  * Return value:
2574  *      none
2575  **/
2576 static void ipr_timeout(struct ipr_cmnd *ipr_cmd)
2577 {
2578         unsigned long lock_flags = 0;
2579         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
2580 
2581         ENTER;
2582         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
2583 
2584         ioa_cfg->errors_logged++;
2585         dev_err(&ioa_cfg->pdev->dev,
2586                 "Adapter being reset due to command timeout.\n");
2587 
2588         if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
2589                 ioa_cfg->sdt_state = GET_DUMP;
2590 
2591         if (!ioa_cfg->in_reset_reload || ioa_cfg->reset_cmd == ipr_cmd)
2592                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
2593 
2594         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
2595         LEAVE;
2596 }
2597 
2598 /**
2599  * ipr_oper_timeout -  Adapter timed out transitioning to operational
2600  * @ipr_cmd:    ipr command struct
2601  *
2602  * This function blocks host requests and initiates an
2603  * adapter reset.
2604  *
2605  * Return value:
2606  *      none
2607  **/
2608 static void ipr_oper_timeout(struct ipr_cmnd *ipr_cmd)
2609 {
2610         unsigned long lock_flags = 0;
2611         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
2612 
2613         ENTER;
2614         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
2615 
2616         ioa_cfg->errors_logged++;
2617         dev_err(&ioa_cfg->pdev->dev,
2618                 "Adapter timed out transitioning to operational.\n");
2619 
2620         if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
2621                 ioa_cfg->sdt_state = GET_DUMP;
2622 
2623         if (!ioa_cfg->in_reset_reload || ioa_cfg->reset_cmd == ipr_cmd) {
2624                 if (ipr_fastfail)
2625                         ioa_cfg->reset_retries += IPR_NUM_RESET_RELOAD_RETRIES;
2626                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
2627         }
2628 
2629         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
2630         LEAVE;
2631 }
2632 
2633 /**
2634  * ipr_find_ses_entry - Find matching SES in SES table
2635  * @res:        resource entry struct of SES
2636  *
2637  * Return value:
2638  *      pointer to SES table entry / NULL on failure
2639  **/
2640 static const struct ipr_ses_table_entry *
2641 ipr_find_ses_entry(struct ipr_resource_entry *res)
2642 {
2643         int i, j, matches;
2644         struct ipr_std_inq_vpids *vpids;
2645         const struct ipr_ses_table_entry *ste = ipr_ses_table;
2646 
2647         for (i = 0; i < ARRAY_SIZE(ipr_ses_table); i++, ste++) {
2648                 for (j = 0, matches = 0; j < IPR_PROD_ID_LEN; j++) {
2649                         if (ste->compare_product_id_byte[j] == 'X') {
2650                                 vpids = &res->std_inq_data.vpids;
2651                                 if (vpids->product_id[j] == ste->product_id[j])
2652                                         matches++;
2653                                 else
2654                                         break;
2655                         } else
2656                                 matches++;
2657                 }
2658 
2659                 if (matches == IPR_PROD_ID_LEN)
2660                         return ste;
2661         }
2662 
2663         return NULL;
2664 }
2665 
2666 /**
2667  * ipr_get_max_scsi_speed - Determine max SCSI speed for a given bus
2668  * @ioa_cfg:    ioa config struct
2669  * @bus:                SCSI bus
2670  * @bus_width:  bus width
2671  *
2672  * Return value:
2673  *      SCSI bus speed in units of 100KHz, 1600 is 160 MHz
2674  *      For a 2-byte wide SCSI bus, the maximum transfer speed is
2675  *      twice the maximum transfer rate (e.g. for a wide enabled bus,
2676  *      max 160MHz = max 320MB/sec).
2677  **/
2678 static u32 ipr_get_max_scsi_speed(struct ipr_ioa_cfg *ioa_cfg, u8 bus, u8 bus_width)
2679 {
2680         struct ipr_resource_entry *res;
2681         const struct ipr_ses_table_entry *ste;
2682         u32 max_xfer_rate = IPR_MAX_SCSI_RATE(bus_width);
2683 
2684         /* Loop through each config table entry in the config table buffer */
2685         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
2686                 if (!(IPR_IS_SES_DEVICE(res->std_inq_data)))
2687                         continue;
2688 
2689                 if (bus != res->bus)
2690                         continue;
2691 
2692                 if (!(ste = ipr_find_ses_entry(res)))
2693                         continue;
2694 
2695                 max_xfer_rate = (ste->max_bus_speed_limit * 10) / (bus_width / 8);
2696         }
2697 
2698         return max_xfer_rate;
2699 }
2700 
2701 /**
2702  * ipr_wait_iodbg_ack - Wait for an IODEBUG ACK from the IOA
2703  * @ioa_cfg:            ioa config struct
2704  * @max_delay:          max delay in micro-seconds to wait
2705  *
2706  * Waits for an IODEBUG ACK from the IOA, doing busy looping.
2707  *
2708  * Return value:
2709  *      0 on success / other on failure
2710  **/
2711 static int ipr_wait_iodbg_ack(struct ipr_ioa_cfg *ioa_cfg, int max_delay)
2712 {
2713         volatile u32 pcii_reg;
2714         int delay = 1;
2715 
2716         /* Read interrupt reg until IOA signals IO Debug Acknowledge */
2717         while (delay < max_delay) {
2718                 pcii_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
2719 
2720                 if (pcii_reg & IPR_PCII_IO_DEBUG_ACKNOWLEDGE)
2721                         return 0;
2722 
2723                 /* udelay cannot be used if delay is more than a few milliseconds */
2724                 if ((delay / 1000) > MAX_UDELAY_MS)
2725                         mdelay(delay / 1000);
2726                 else
2727                         udelay(delay);
2728 
2729                 delay += delay;
2730         }
2731         return -EIO;
2732 }
2733 
2734 /**
2735  * ipr_get_sis64_dump_data_section - Dump IOA memory
2736  * @ioa_cfg:                    ioa config struct
2737  * @start_addr:                 adapter address to dump
2738  * @dest:                       destination kernel buffer
2739  * @length_in_words:            length to dump in 4 byte words
2740  *
2741  * Return value:
2742  *      0 on success
2743  **/
2744 static int ipr_get_sis64_dump_data_section(struct ipr_ioa_cfg *ioa_cfg,
2745                                            u32 start_addr,
2746                                            __be32 *dest, u32 length_in_words)
2747 {
2748         int i;
2749 
2750         for (i = 0; i < length_in_words; i++) {
2751                 writel(start_addr+(i*4), ioa_cfg->regs.dump_addr_reg);
2752                 *dest = cpu_to_be32(readl(ioa_cfg->regs.dump_data_reg));
2753                 dest++;
2754         }
2755 
2756         return 0;
2757 }
2758 
2759 /**
2760  * ipr_get_ldump_data_section - Dump IOA memory
2761  * @ioa_cfg:                    ioa config struct
2762  * @start_addr:                 adapter address to dump
2763  * @dest:                               destination kernel buffer
2764  * @length_in_words:    length to dump in 4 byte words
2765  *
2766  * Return value:
2767  *      0 on success / -EIO on failure
2768  **/
2769 static int ipr_get_ldump_data_section(struct ipr_ioa_cfg *ioa_cfg,
2770                                       u32 start_addr,
2771                                       __be32 *dest, u32 length_in_words)
2772 {
2773         volatile u32 temp_pcii_reg;
2774         int i, delay = 0;
2775 
2776         if (ioa_cfg->sis64)
2777                 return ipr_get_sis64_dump_data_section(ioa_cfg, start_addr,
2778                                                        dest, length_in_words);
2779 
2780         /* Write IOA interrupt reg starting LDUMP state  */
2781         writel((IPR_UPROCI_RESET_ALERT | IPR_UPROCI_IO_DEBUG_ALERT),
2782                ioa_cfg->regs.set_uproc_interrupt_reg32);
2783 
2784         /* Wait for IO debug acknowledge */
2785         if (ipr_wait_iodbg_ack(ioa_cfg,
2786                                IPR_LDUMP_MAX_LONG_ACK_DELAY_IN_USEC)) {
2787                 dev_err(&ioa_cfg->pdev->dev,
2788                         "IOA dump long data transfer timeout\n");
2789                 return -EIO;
2790         }
2791 
2792         /* Signal LDUMP interlocked - clear IO debug ack */
2793         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE,
2794                ioa_cfg->regs.clr_interrupt_reg);
2795 
2796         /* Write Mailbox with starting address */
2797         writel(start_addr, ioa_cfg->ioa_mailbox);
2798 
2799         /* Signal address valid - clear IOA Reset alert */
2800         writel(IPR_UPROCI_RESET_ALERT,
2801                ioa_cfg->regs.clr_uproc_interrupt_reg32);
2802 
2803         for (i = 0; i < length_in_words; i++) {
2804                 /* Wait for IO debug acknowledge */
2805                 if (ipr_wait_iodbg_ack(ioa_cfg,
2806                                        IPR_LDUMP_MAX_SHORT_ACK_DELAY_IN_USEC)) {
2807                         dev_err(&ioa_cfg->pdev->dev,
2808                                 "IOA dump short data transfer timeout\n");
2809                         return -EIO;
2810                 }
2811 
2812                 /* Read data from mailbox and increment destination pointer */
2813                 *dest = cpu_to_be32(readl(ioa_cfg->ioa_mailbox));
2814                 dest++;
2815 
2816                 /* For all but the last word of data, signal data received */
2817                 if (i < (length_in_words - 1)) {
2818                         /* Signal dump data received - Clear IO debug Ack */
2819                         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE,
2820                                ioa_cfg->regs.clr_interrupt_reg);
2821                 }
2822         }
2823 
2824         /* Signal end of block transfer. Set reset alert then clear IO debug ack */
2825         writel(IPR_UPROCI_RESET_ALERT,
2826                ioa_cfg->regs.set_uproc_interrupt_reg32);
2827 
2828         writel(IPR_UPROCI_IO_DEBUG_ALERT,
2829                ioa_cfg->regs.clr_uproc_interrupt_reg32);
2830 
2831         /* Signal dump data received - Clear IO debug Ack */
2832         writel(IPR_PCII_IO_DEBUG_ACKNOWLEDGE,
2833                ioa_cfg->regs.clr_interrupt_reg);
2834 
2835         /* Wait for IOA to signal LDUMP exit - IOA reset alert will be cleared */
2836         while (delay < IPR_LDUMP_MAX_SHORT_ACK_DELAY_IN_USEC) {
2837                 temp_pcii_reg =
2838                     readl(ioa_cfg->regs.sense_uproc_interrupt_reg32);
2839 
2840                 if (!(temp_pcii_reg & IPR_UPROCI_RESET_ALERT))
2841                         return 0;
2842 
2843                 udelay(10);
2844                 delay += 10;
2845         }
2846 
2847         return 0;
2848 }
2849 
2850 #ifdef CONFIG_SCSI_IPR_DUMP
2851 /**
2852  * ipr_sdt_copy - Copy Smart Dump Table to kernel buffer
2853  * @ioa_cfg:            ioa config struct
2854  * @pci_address:        adapter address
2855  * @length:                     length of data to copy
2856  *
2857  * Copy data from PCI adapter to kernel buffer.
2858  * Note: length MUST be a 4 byte multiple
2859  * Return value:
2860  *      0 on success / other on failure
2861  **/
2862 static int ipr_sdt_copy(struct ipr_ioa_cfg *ioa_cfg,
2863                         unsigned long pci_address, u32 length)
2864 {
2865         int bytes_copied = 0;
2866         int cur_len, rc, rem_len, rem_page_len, max_dump_size;
2867         __be32 *page;
2868         unsigned long lock_flags = 0;
2869         struct ipr_ioa_dump *ioa_dump = &ioa_cfg->dump->ioa_dump;
2870 
2871         if (ioa_cfg->sis64)
2872                 max_dump_size = IPR_FMT3_MAX_IOA_DUMP_SIZE;
2873         else
2874                 max_dump_size = IPR_FMT2_MAX_IOA_DUMP_SIZE;
2875 
2876         while (bytes_copied < length &&
2877                (ioa_dump->hdr.len + bytes_copied) < max_dump_size) {
2878                 if (ioa_dump->page_offset >= PAGE_SIZE ||
2879                     ioa_dump->page_offset == 0) {
2880                         page = (__be32 *)__get_free_page(GFP_ATOMIC);
2881 
2882                         if (!page) {
2883                                 ipr_trace;
2884                                 return bytes_copied;
2885                         }
2886 
2887                         ioa_dump->page_offset = 0;
2888                         ioa_dump->ioa_data[ioa_dump->next_page_index] = page;
2889                         ioa_dump->next_page_index++;
2890                 } else
2891                         page = ioa_dump->ioa_data[ioa_dump->next_page_index - 1];
2892 
2893                 rem_len = length - bytes_copied;
2894                 rem_page_len = PAGE_SIZE - ioa_dump->page_offset;
2895                 cur_len = min(rem_len, rem_page_len);
2896 
2897                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
2898                 if (ioa_cfg->sdt_state == ABORT_DUMP) {
2899                         rc = -EIO;
2900                 } else {
2901                         rc = ipr_get_ldump_data_section(ioa_cfg,
2902                                                         pci_address + bytes_copied,
2903                                                         &page[ioa_dump->page_offset / 4],
2904                                                         (cur_len / sizeof(u32)));
2905                 }
2906                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
2907 
2908                 if (!rc) {
2909                         ioa_dump->page_offset += cur_len;
2910                         bytes_copied += cur_len;
2911                 } else {
2912                         ipr_trace;
2913                         break;
2914                 }
2915                 schedule();
2916         }
2917 
2918         return bytes_copied;
2919 }
2920 
2921 /**
2922  * ipr_init_dump_entry_hdr - Initialize a dump entry header.
2923  * @hdr:        dump entry header struct
2924  *
2925  * Return value:
2926  *      nothing
2927  **/
2928 static void ipr_init_dump_entry_hdr(struct ipr_dump_entry_header *hdr)
2929 {
2930         hdr->eye_catcher = IPR_DUMP_EYE_CATCHER;
2931         hdr->num_elems = 1;
2932         hdr->offset = sizeof(*hdr);
2933         hdr->status = IPR_DUMP_STATUS_SUCCESS;
2934 }
2935 
2936 /**
2937  * ipr_dump_ioa_type_data - Fill in the adapter type in the dump.
2938  * @ioa_cfg:    ioa config struct
2939  * @driver_dump:        driver dump struct
2940  *
2941  * Return value:
2942  *      nothing
2943  **/
2944 static void ipr_dump_ioa_type_data(struct ipr_ioa_cfg *ioa_cfg,
2945                                    struct ipr_driver_dump *driver_dump)
2946 {
2947         struct ipr_inquiry_page3 *ucode_vpd = &ioa_cfg->vpd_cbs->page3_data;
2948 
2949         ipr_init_dump_entry_hdr(&driver_dump->ioa_type_entry.hdr);
2950         driver_dump->ioa_type_entry.hdr.len =
2951                 sizeof(struct ipr_dump_ioa_type_entry) -
2952                 sizeof(struct ipr_dump_entry_header);
2953         driver_dump->ioa_type_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_BINARY;
2954         driver_dump->ioa_type_entry.hdr.id = IPR_DUMP_DRIVER_TYPE_ID;
2955         driver_dump->ioa_type_entry.type = ioa_cfg->type;
2956         driver_dump->ioa_type_entry.fw_version = (ucode_vpd->major_release << 24) |
2957                 (ucode_vpd->card_type << 16) | (ucode_vpd->minor_release[0] << 8) |
2958                 ucode_vpd->minor_release[1];
2959         driver_dump->hdr.num_entries++;
2960 }
2961 
2962 /**
2963  * ipr_dump_version_data - Fill in the driver version in the dump.
2964  * @ioa_cfg:    ioa config struct
2965  * @driver_dump:        driver dump struct
2966  *
2967  * Return value:
2968  *      nothing
2969  **/
2970 static void ipr_dump_version_data(struct ipr_ioa_cfg *ioa_cfg,
2971                                   struct ipr_driver_dump *driver_dump)
2972 {
2973         ipr_init_dump_entry_hdr(&driver_dump->version_entry.hdr);
2974         driver_dump->version_entry.hdr.len =
2975                 sizeof(struct ipr_dump_version_entry) -
2976                 sizeof(struct ipr_dump_entry_header);
2977         driver_dump->version_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_ASCII;
2978         driver_dump->version_entry.hdr.id = IPR_DUMP_DRIVER_VERSION_ID;
2979         strcpy(driver_dump->version_entry.version, IPR_DRIVER_VERSION);
2980         driver_dump->hdr.num_entries++;
2981 }
2982 
2983 /**
2984  * ipr_dump_trace_data - Fill in the IOA trace in the dump.
2985  * @ioa_cfg:    ioa config struct
2986  * @driver_dump:        driver dump struct
2987  *
2988  * Return value:
2989  *      nothing
2990  **/
2991 static void ipr_dump_trace_data(struct ipr_ioa_cfg *ioa_cfg,
2992                                    struct ipr_driver_dump *driver_dump)
2993 {
2994         ipr_init_dump_entry_hdr(&driver_dump->trace_entry.hdr);
2995         driver_dump->trace_entry.hdr.len =
2996                 sizeof(struct ipr_dump_trace_entry) -
2997                 sizeof(struct ipr_dump_entry_header);
2998         driver_dump->trace_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_BINARY;
2999         driver_dump->trace_entry.hdr.id = IPR_DUMP_TRACE_ID;
3000         memcpy(driver_dump->trace_entry.trace, ioa_cfg->trace, IPR_TRACE_SIZE);
3001         driver_dump->hdr.num_entries++;
3002 }
3003 
3004 /**
3005  * ipr_dump_location_data - Fill in the IOA location in the dump.
3006  * @ioa_cfg:    ioa config struct
3007  * @driver_dump:        driver dump struct
3008  *
3009  * Return value:
3010  *      nothing
3011  **/
3012 static void ipr_dump_location_data(struct ipr_ioa_cfg *ioa_cfg,
3013                                    struct ipr_driver_dump *driver_dump)
3014 {
3015         ipr_init_dump_entry_hdr(&driver_dump->location_entry.hdr);
3016         driver_dump->location_entry.hdr.len =
3017                 sizeof(struct ipr_dump_location_entry) -
3018                 sizeof(struct ipr_dump_entry_header);
3019         driver_dump->location_entry.hdr.data_type = IPR_DUMP_DATA_TYPE_ASCII;
3020         driver_dump->location_entry.hdr.id = IPR_DUMP_LOCATION_ID;
3021         strcpy(driver_dump->location_entry.location, dev_name(&ioa_cfg->pdev->dev));
3022         driver_dump->hdr.num_entries++;
3023 }
3024 
3025 /**
3026  * ipr_get_ioa_dump - Perform a dump of the driver and adapter.
3027  * @ioa_cfg:    ioa config struct
3028  * @dump:               dump struct
3029  *
3030  * Return value:
3031  *      nothing
3032  **/
3033 static void ipr_get_ioa_dump(struct ipr_ioa_cfg *ioa_cfg, struct ipr_dump *dump)
3034 {
3035         unsigned long start_addr, sdt_word;
3036         unsigned long lock_flags = 0;
3037         struct ipr_driver_dump *driver_dump = &dump->driver_dump;
3038         struct ipr_ioa_dump *ioa_dump = &dump->ioa_dump;
3039         u32 num_entries, max_num_entries, start_off, end_off;
3040         u32 max_dump_size, bytes_to_copy, bytes_copied, rc;
3041         struct ipr_sdt *sdt;
3042         int valid = 1;
3043         int i;
3044 
3045         ENTER;
3046 
3047         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3048 
3049         if (ioa_cfg->sdt_state != READ_DUMP) {
3050                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3051                 return;
3052         }
3053 
3054         if (ioa_cfg->sis64) {
3055                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3056                 ssleep(IPR_DUMP_DELAY_SECONDS);
3057                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3058         }
3059 
3060         start_addr = readl(ioa_cfg->ioa_mailbox);
3061 
3062         if (!ioa_cfg->sis64 && !ipr_sdt_is_fmt2(start_addr)) {
3063                 dev_err(&ioa_cfg->pdev->dev,
3064                         "Invalid dump table format: %lx\n", start_addr);
3065                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3066                 return;
3067         }
3068 
3069         dev_err(&ioa_cfg->pdev->dev, "Dump of IOA initiated\n");
3070 
3071         driver_dump->hdr.eye_catcher = IPR_DUMP_EYE_CATCHER;
3072 
3073         /* Initialize the overall dump header */
3074         driver_dump->hdr.len = sizeof(struct ipr_driver_dump);
3075         driver_dump->hdr.num_entries = 1;
3076         driver_dump->hdr.first_entry_offset = sizeof(struct ipr_dump_header);
3077         driver_dump->hdr.status = IPR_DUMP_STATUS_SUCCESS;
3078         driver_dump->hdr.os = IPR_DUMP_OS_LINUX;
3079         driver_dump->hdr.driver_name = IPR_DUMP_DRIVER_NAME;
3080 
3081         ipr_dump_version_data(ioa_cfg, driver_dump);
3082         ipr_dump_location_data(ioa_cfg, driver_dump);
3083         ipr_dump_ioa_type_data(ioa_cfg, driver_dump);
3084         ipr_dump_trace_data(ioa_cfg, driver_dump);
3085 
3086         /* Update dump_header */
3087         driver_dump->hdr.len += sizeof(struct ipr_dump_entry_header);
3088 
3089         /* IOA Dump entry */
3090         ipr_init_dump_entry_hdr(&ioa_dump->hdr);
3091         ioa_dump->hdr.len = 0;
3092         ioa_dump->hdr.data_type = IPR_DUMP_DATA_TYPE_BINARY;
3093         ioa_dump->hdr.id = IPR_DUMP_IOA_DUMP_ID;
3094 
3095         /* First entries in sdt are actually a list of dump addresses and
3096          lengths to gather the real dump data.  sdt represents the pointer
3097          to the ioa generated dump table.  Dump data will be extracted based
3098          on entries in this table */
3099         sdt = &ioa_dump->sdt;
3100 
3101         if (ioa_cfg->sis64) {
3102                 max_num_entries = IPR_FMT3_NUM_SDT_ENTRIES;
3103                 max_dump_size = IPR_FMT3_MAX_IOA_DUMP_SIZE;
3104         } else {
3105                 max_num_entries = IPR_FMT2_NUM_SDT_ENTRIES;
3106                 max_dump_size = IPR_FMT2_MAX_IOA_DUMP_SIZE;
3107         }
3108 
3109         bytes_to_copy = offsetof(struct ipr_sdt, entry) +
3110                         (max_num_entries * sizeof(struct ipr_sdt_entry));
3111         rc = ipr_get_ldump_data_section(ioa_cfg, start_addr, (__be32 *)sdt,
3112                                         bytes_to_copy / sizeof(__be32));
3113 
3114         /* Smart Dump table is ready to use and the first entry is valid */
3115         if (rc || ((be32_to_cpu(sdt->hdr.state) != IPR_FMT3_SDT_READY_TO_USE) &&
3116             (be32_to_cpu(sdt->hdr.state) != IPR_FMT2_SDT_READY_TO_USE))) {
3117                 dev_err(&ioa_cfg->pdev->dev,
3118                         "Dump of IOA failed. Dump table not valid: %d, %X.\n",
3119                         rc, be32_to_cpu(sdt->hdr.state));
3120                 driver_dump->hdr.status = IPR_DUMP_STATUS_FAILED;
3121                 ioa_cfg->sdt_state = DUMP_OBTAINED;
3122                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3123                 return;
3124         }
3125 
3126         num_entries = be32_to_cpu(sdt->hdr.num_entries_used);
3127 
3128         if (num_entries > max_num_entries)
3129                 num_entries = max_num_entries;
3130 
3131         /* Update dump length to the actual data to be copied */
3132         dump->driver_dump.hdr.len += sizeof(struct ipr_sdt_header);
3133         if (ioa_cfg->sis64)
3134                 dump->driver_dump.hdr.len += num_entries * sizeof(struct ipr_sdt_entry);
3135         else
3136                 dump->driver_dump.hdr.len += max_num_entries * sizeof(struct ipr_sdt_entry);
3137 
3138         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3139 
3140         for (i = 0; i < num_entries; i++) {
3141                 if (ioa_dump->hdr.len > max_dump_size) {
3142                         driver_dump->hdr.status = IPR_DUMP_STATUS_QUAL_SUCCESS;
3143                         break;
3144                 }
3145 
3146                 if (sdt->entry[i].flags & IPR_SDT_VALID_ENTRY) {
3147                         sdt_word = be32_to_cpu(sdt->entry[i].start_token);
3148                         if (ioa_cfg->sis64)
3149                                 bytes_to_copy = be32_to_cpu(sdt->entry[i].end_token);
3150                         else {
3151                                 start_off = sdt_word & IPR_FMT2_MBX_ADDR_MASK;
3152                                 end_off = be32_to_cpu(sdt->entry[i].end_token);
3153 
3154                                 if (ipr_sdt_is_fmt2(sdt_word) && sdt_word)
3155                                         bytes_to_copy = end_off - start_off;
3156                                 else
3157                                         valid = 0;
3158                         }
3159                         if (valid) {
3160                                 if (bytes_to_copy > max_dump_size) {
3161                                         sdt->entry[i].flags &= ~IPR_SDT_VALID_ENTRY;
3162                                         continue;
3163                                 }
3164 
3165                                 /* Copy data from adapter to driver buffers */
3166                                 bytes_copied = ipr_sdt_copy(ioa_cfg, sdt_word,
3167                                                             bytes_to_copy);
3168 
3169                                 ioa_dump->hdr.len += bytes_copied;
3170 
3171                                 if (bytes_copied != bytes_to_copy) {
3172                                         driver_dump->hdr.status = IPR_DUMP_STATUS_QUAL_SUCCESS;
3173                                         break;
3174                                 }
3175                         }
3176                 }
3177         }
3178 
3179         dev_err(&ioa_cfg->pdev->dev, "Dump of IOA completed.\n");
3180 
3181         /* Update dump_header */
3182         driver_dump->hdr.len += ioa_dump->hdr.len;
3183         wmb();
3184         ioa_cfg->sdt_state = DUMP_OBTAINED;
3185         LEAVE;
3186 }
3187 
3188 #else
3189 #define ipr_get_ioa_dump(ioa_cfg, dump) do { } while (0)
3190 #endif
3191 
3192 /**
3193  * ipr_release_dump - Free adapter dump memory
3194  * @kref:       kref struct
3195  *
3196  * Return value:
3197  *      nothing
3198  **/
3199 static void ipr_release_dump(struct kref *kref)
3200 {
3201         struct ipr_dump *dump = container_of(kref, struct ipr_dump, kref);
3202         struct ipr_ioa_cfg *ioa_cfg = dump->ioa_cfg;
3203         unsigned long lock_flags = 0;
3204         int i;
3205 
3206         ENTER;
3207         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3208         ioa_cfg->dump = NULL;
3209         ioa_cfg->sdt_state = INACTIVE;
3210         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3211 
3212         for (i = 0; i < dump->ioa_dump.next_page_index; i++)
3213                 free_page((unsigned long) dump->ioa_dump.ioa_data[i]);
3214 
3215         vfree(dump->ioa_dump.ioa_data);
3216         kfree(dump);
3217         LEAVE;
3218 }
3219 
3220 /**
3221  * ipr_worker_thread - Worker thread
3222  * @work:               ioa config struct
3223  *
3224  * Called at task level from a work thread. This function takes care
3225  * of adding and removing device from the mid-layer as configuration
3226  * changes are detected by the adapter.
3227  *
3228  * Return value:
3229  *      nothing
3230  **/
3231 static void ipr_worker_thread(struct work_struct *work)
3232 {
3233         unsigned long lock_flags;
3234         struct ipr_resource_entry *res;
3235         struct scsi_device *sdev;
3236         struct ipr_dump *dump;
3237         struct ipr_ioa_cfg *ioa_cfg =
3238                 container_of(work, struct ipr_ioa_cfg, work_q);
3239         u8 bus, target, lun;
3240         int did_work;
3241 
3242         ENTER;
3243         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3244 
3245         if (ioa_cfg->sdt_state == READ_DUMP) {
3246                 dump = ioa_cfg->dump;
3247                 if (!dump) {
3248                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3249                         return;
3250                 }
3251                 kref_get(&dump->kref);
3252                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3253                 ipr_get_ioa_dump(ioa_cfg, dump);
3254                 kref_put(&dump->kref, ipr_release_dump);
3255 
3256                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3257                 if (ioa_cfg->sdt_state == DUMP_OBTAINED && !ioa_cfg->dump_timeout)
3258                         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
3259                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3260                 return;
3261         }
3262 
3263 restart:
3264         do {
3265                 did_work = 0;
3266                 if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds ||
3267                     !ioa_cfg->allow_ml_add_del) {
3268                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3269                         return;
3270                 }
3271 
3272                 list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
3273                         if (res->del_from_ml && res->sdev) {
3274                                 did_work = 1;
3275                                 sdev = res->sdev;
3276                                 if (!scsi_device_get(sdev)) {
3277                                         if (!res->add_to_ml)
3278                                                 list_move_tail(&res->queue, &ioa_cfg->free_res_q);
3279                                         else
3280                                                 res->del_from_ml = 0;
3281                                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3282                                         scsi_remove_device(sdev);
3283                                         scsi_device_put(sdev);
3284                                         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3285                                 }
3286                                 break;
3287                         }
3288                 }
3289         } while (did_work);
3290 
3291         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
3292                 if (res->add_to_ml) {
3293                         bus = res->bus;
3294                         target = res->target;
3295                         lun = res->lun;
3296                         res->add_to_ml = 0;
3297                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3298                         scsi_add_device(ioa_cfg->host, bus, target, lun);
3299                         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3300                         goto restart;
3301                 }
3302         }
3303 
3304         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3305         kobject_uevent(&ioa_cfg->host->shost_dev.kobj, KOBJ_CHANGE);
3306         LEAVE;
3307 }
3308 
3309 #ifdef CONFIG_SCSI_IPR_TRACE
3310 /**
3311  * ipr_read_trace - Dump the adapter trace
3312  * @filp:               open sysfs file
3313  * @kobj:               kobject struct
3314  * @bin_attr:           bin_attribute struct
3315  * @buf:                buffer
3316  * @off:                offset
3317  * @count:              buffer size
3318  *
3319  * Return value:
3320  *      number of bytes printed to buffer
3321  **/
3322 static ssize_t ipr_read_trace(struct file *filp, struct kobject *kobj,
3323                               struct bin_attribute *bin_attr,
3324                               char *buf, loff_t off, size_t count)
3325 {
3326         struct device *dev = container_of(kobj, struct device, kobj);
3327         struct Scsi_Host *shost = class_to_shost(dev);
3328         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3329         unsigned long lock_flags = 0;
3330         ssize_t ret;
3331 
3332         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3333         ret = memory_read_from_buffer(buf, count, &off, ioa_cfg->trace,
3334                                 IPR_TRACE_SIZE);
3335         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3336 
3337         return ret;
3338 }
3339 
3340 static struct bin_attribute ipr_trace_attr = {
3341         .attr = {
3342                 .name = "trace",
3343                 .mode = S_IRUGO,
3344         },
3345         .size = 0,
3346         .read = ipr_read_trace,
3347 };
3348 #endif
3349 
3350 /**
3351  * ipr_show_fw_version - Show the firmware version
3352  * @dev:        class device struct
3353  * @buf:        buffer
3354  *
3355  * Return value:
3356  *      number of bytes printed to buffer
3357  **/
3358 static ssize_t ipr_show_fw_version(struct device *dev,
3359                                    struct device_attribute *attr, char *buf)
3360 {
3361         struct Scsi_Host *shost = class_to_shost(dev);
3362         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3363         struct ipr_inquiry_page3 *ucode_vpd = &ioa_cfg->vpd_cbs->page3_data;
3364         unsigned long lock_flags = 0;
3365         int len;
3366 
3367         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3368         len = snprintf(buf, PAGE_SIZE, "%02X%02X%02X%02X\n",
3369                        ucode_vpd->major_release, ucode_vpd->card_type,
3370                        ucode_vpd->minor_release[0],
3371                        ucode_vpd->minor_release[1]);
3372         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3373         return len;
3374 }
3375 
3376 static struct device_attribute ipr_fw_version_attr = {
3377         .attr = {
3378                 .name =         "fw_version",
3379                 .mode =         S_IRUGO,
3380         },
3381         .show = ipr_show_fw_version,
3382 };
3383 
3384 /**
3385  * ipr_show_log_level - Show the adapter's error logging level
3386  * @dev:        class device struct
3387  * @buf:        buffer
3388  *
3389  * Return value:
3390  *      number of bytes printed to buffer
3391  **/
3392 static ssize_t ipr_show_log_level(struct device *dev,
3393                                    struct device_attribute *attr, char *buf)
3394 {
3395         struct Scsi_Host *shost = class_to_shost(dev);
3396         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3397         unsigned long lock_flags = 0;
3398         int len;
3399 
3400         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3401         len = snprintf(buf, PAGE_SIZE, "%d\n", ioa_cfg->log_level);
3402         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3403         return len;
3404 }
3405 
3406 /**
3407  * ipr_store_log_level - Change the adapter's error logging level
3408  * @dev:        class device struct
3409  * @buf:        buffer
3410  *
3411  * Return value:
3412  *      number of bytes printed to buffer
3413  **/
3414 static ssize_t ipr_store_log_level(struct device *dev,
3415                                    struct device_attribute *attr,
3416                                    const char *buf, size_t count)
3417 {
3418         struct Scsi_Host *shost = class_to_shost(dev);
3419         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3420         unsigned long lock_flags = 0;
3421 
3422         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3423         ioa_cfg->log_level = simple_strtoul(buf, NULL, 10);
3424         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3425         return strlen(buf);
3426 }
3427 
3428 static struct device_attribute ipr_log_level_attr = {
3429         .attr = {
3430                 .name =         "log_level",
3431                 .mode =         S_IRUGO | S_IWUSR,
3432         },
3433         .show = ipr_show_log_level,
3434         .store = ipr_store_log_level
3435 };
3436 
3437 /**
3438  * ipr_store_diagnostics - IOA Diagnostics interface
3439  * @dev:        device struct
3440  * @buf:        buffer
3441  * @count:      buffer size
3442  *
3443  * This function will reset the adapter and wait a reasonable
3444  * amount of time for any errors that the adapter might log.
3445  *
3446  * Return value:
3447  *      count on success / other on failure
3448  **/
3449 static ssize_t ipr_store_diagnostics(struct device *dev,
3450                                      struct device_attribute *attr,
3451                                      const char *buf, size_t count)
3452 {
3453         struct Scsi_Host *shost = class_to_shost(dev);
3454         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3455         unsigned long lock_flags = 0;
3456         int rc = count;
3457 
3458         if (!capable(CAP_SYS_ADMIN))
3459                 return -EACCES;
3460 
3461         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3462         while (ioa_cfg->in_reset_reload) {
3463                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3464                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3465                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3466         }
3467 
3468         ioa_cfg->errors_logged = 0;
3469         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NORMAL);
3470 
3471         if (ioa_cfg->in_reset_reload) {
3472                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3473                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3474 
3475                 /* Wait for a second for any errors to be logged */
3476                 msleep(1000);
3477         } else {
3478                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3479                 return -EIO;
3480         }
3481 
3482         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3483         if (ioa_cfg->in_reset_reload || ioa_cfg->errors_logged)
3484                 rc = -EIO;
3485         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3486 
3487         return rc;
3488 }
3489 
3490 static struct device_attribute ipr_diagnostics_attr = {
3491         .attr = {
3492                 .name =         "run_diagnostics",
3493                 .mode =         S_IWUSR,
3494         },
3495         .store = ipr_store_diagnostics
3496 };
3497 
3498 /**
3499  * ipr_show_adapter_state - Show the adapter's state
3500  * @class_dev:  device struct
3501  * @buf:        buffer
3502  *
3503  * Return value:
3504  *      number of bytes printed to buffer
3505  **/
3506 static ssize_t ipr_show_adapter_state(struct device *dev,
3507                                       struct device_attribute *attr, char *buf)
3508 {
3509         struct Scsi_Host *shost = class_to_shost(dev);
3510         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3511         unsigned long lock_flags = 0;
3512         int len;
3513 
3514         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3515         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
3516                 len = snprintf(buf, PAGE_SIZE, "offline\n");
3517         else
3518                 len = snprintf(buf, PAGE_SIZE, "online\n");
3519         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3520         return len;
3521 }
3522 
3523 /**
3524  * ipr_store_adapter_state - Change adapter state
3525  * @dev:        device struct
3526  * @buf:        buffer
3527  * @count:      buffer size
3528  *
3529  * This function will change the adapter's state.
3530  *
3531  * Return value:
3532  *      count on success / other on failure
3533  **/
3534 static ssize_t ipr_store_adapter_state(struct device *dev,
3535                                        struct device_attribute *attr,
3536                                        const char *buf, size_t count)
3537 {
3538         struct Scsi_Host *shost = class_to_shost(dev);
3539         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3540         unsigned long lock_flags;
3541         int result = count, i;
3542 
3543         if (!capable(CAP_SYS_ADMIN))
3544                 return -EACCES;
3545 
3546         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3547         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead &&
3548             !strncmp(buf, "online", 6)) {
3549                 for (i = 0; i < ioa_cfg->hrrq_num; i++) {
3550                         spin_lock(&ioa_cfg->hrrq[i]._lock);
3551                         ioa_cfg->hrrq[i].ioa_is_dead = 0;
3552                         spin_unlock(&ioa_cfg->hrrq[i]._lock);
3553                 }
3554                 wmb();
3555                 ioa_cfg->reset_retries = 0;
3556                 ioa_cfg->in_ioa_bringdown = 0;
3557                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
3558         }
3559         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3560         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3561 
3562         return result;
3563 }
3564 
3565 static struct device_attribute ipr_ioa_state_attr = {
3566         .attr = {
3567                 .name =         "online_state",
3568                 .mode =         S_IRUGO | S_IWUSR,
3569         },
3570         .show = ipr_show_adapter_state,
3571         .store = ipr_store_adapter_state
3572 };
3573 
3574 /**
3575  * ipr_store_reset_adapter - Reset the adapter
3576  * @dev:        device struct
3577  * @buf:        buffer
3578  * @count:      buffer size
3579  *
3580  * This function will reset the adapter.
3581  *
3582  * Return value:
3583  *      count on success / other on failure
3584  **/
3585 static ssize_t ipr_store_reset_adapter(struct device *dev,
3586                                        struct device_attribute *attr,
3587                                        const char *buf, size_t count)
3588 {
3589         struct Scsi_Host *shost = class_to_shost(dev);
3590         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3591         unsigned long lock_flags;
3592         int result = count;
3593 
3594         if (!capable(CAP_SYS_ADMIN))
3595                 return -EACCES;
3596 
3597         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3598         if (!ioa_cfg->in_reset_reload)
3599                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NORMAL);
3600         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3601         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3602 
3603         return result;
3604 }
3605 
3606 static struct device_attribute ipr_ioa_reset_attr = {
3607         .attr = {
3608                 .name =         "reset_host",
3609                 .mode =         S_IWUSR,
3610         },
3611         .store = ipr_store_reset_adapter
3612 };
3613 
3614 static int ipr_iopoll(struct blk_iopoll *iop, int budget);
3615  /**
3616  * ipr_show_iopoll_weight - Show ipr polling mode
3617  * @dev:        class device struct
3618  * @buf:        buffer
3619  *
3620  * Return value:
3621  *      number of bytes printed to buffer
3622  **/
3623 static ssize_t ipr_show_iopoll_weight(struct device *dev,
3624                                    struct device_attribute *attr, char *buf)
3625 {
3626         struct Scsi_Host *shost = class_to_shost(dev);
3627         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3628         unsigned long lock_flags = 0;
3629         int len;
3630 
3631         spin_lock_irqsave(shost->host_lock, lock_flags);
3632         len = snprintf(buf, PAGE_SIZE, "%d\n", ioa_cfg->iopoll_weight);
3633         spin_unlock_irqrestore(shost->host_lock, lock_flags);
3634 
3635         return len;
3636 }
3637 
3638 /**
3639  * ipr_store_iopoll_weight - Change the adapter's polling mode
3640  * @dev:        class device struct
3641  * @buf:        buffer
3642  *
3643  * Return value:
3644  *      number of bytes printed to buffer
3645  **/
3646 static ssize_t ipr_store_iopoll_weight(struct device *dev,
3647                                         struct device_attribute *attr,
3648                                         const char *buf, size_t count)
3649 {
3650         struct Scsi_Host *shost = class_to_shost(dev);
3651         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3652         unsigned long user_iopoll_weight;
3653         unsigned long lock_flags = 0;
3654         int i;
3655 
3656         if (!ioa_cfg->sis64) {
3657                 dev_info(&ioa_cfg->pdev->dev, "blk-iopoll not supported on this adapter\n");
3658                 return -EINVAL;
3659         }
3660         if (kstrtoul(buf, 10, &user_iopoll_weight))
3661                 return -EINVAL;
3662 
3663         if (user_iopoll_weight > 256) {
3664                 dev_info(&ioa_cfg->pdev->dev, "Invalid blk-iopoll weight. It must be less than 256\n");
3665                 return -EINVAL;
3666         }
3667 
3668         if (user_iopoll_weight == ioa_cfg->iopoll_weight) {
3669                 dev_info(&ioa_cfg->pdev->dev, "Current blk-iopoll weight has the same weight\n");
3670                 return strlen(buf);
3671         }
3672 
3673         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
3674                 for (i = 1; i < ioa_cfg->hrrq_num; i++)
3675                         blk_iopoll_disable(&ioa_cfg->hrrq[i].iopoll);
3676         }
3677 
3678         spin_lock_irqsave(shost->host_lock, lock_flags);
3679         ioa_cfg->iopoll_weight = user_iopoll_weight;
3680         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
3681                 for (i = 1; i < ioa_cfg->hrrq_num; i++) {
3682                         blk_iopoll_init(&ioa_cfg->hrrq[i].iopoll,
3683                                         ioa_cfg->iopoll_weight, ipr_iopoll);
3684                         blk_iopoll_enable(&ioa_cfg->hrrq[i].iopoll);
3685                 }
3686         }
3687         spin_unlock_irqrestore(shost->host_lock, lock_flags);
3688 
3689         return strlen(buf);
3690 }
3691 
3692 static struct device_attribute ipr_iopoll_weight_attr = {
3693         .attr = {
3694                 .name =         "iopoll_weight",
3695                 .mode =         S_IRUGO | S_IWUSR,
3696         },
3697         .show = ipr_show_iopoll_weight,
3698         .store = ipr_store_iopoll_weight
3699 };
3700 
3701 /**
3702  * ipr_alloc_ucode_buffer - Allocates a microcode download buffer
3703  * @buf_len:            buffer length
3704  *
3705  * Allocates a DMA'able buffer in chunks and assembles a scatter/gather
3706  * list to use for microcode download
3707  *
3708  * Return value:
3709  *      pointer to sglist / NULL on failure
3710  **/
3711 static struct ipr_sglist *ipr_alloc_ucode_buffer(int buf_len)
3712 {
3713         int sg_size, order, bsize_elem, num_elem, i, j;
3714         struct ipr_sglist *sglist;
3715         struct scatterlist *scatterlist;
3716         struct page *page;
3717 
3718         /* Get the minimum size per scatter/gather element */
3719         sg_size = buf_len / (IPR_MAX_SGLIST - 1);
3720 
3721         /* Get the actual size per element */
3722         order = get_order(sg_size);
3723 
3724         /* Determine the actual number of bytes per element */
3725         bsize_elem = PAGE_SIZE * (1 << order);
3726 
3727         /* Determine the actual number of sg entries needed */
3728         if (buf_len % bsize_elem)
3729                 num_elem = (buf_len / bsize_elem) + 1;
3730         else
3731                 num_elem = buf_len / bsize_elem;
3732 
3733         /* Allocate a scatter/gather list for the DMA */
3734         sglist = kzalloc(sizeof(struct ipr_sglist) +
3735                          (sizeof(struct scatterlist) * (num_elem - 1)),
3736                          GFP_KERNEL);
3737 
3738         if (sglist == NULL) {
3739                 ipr_trace;
3740                 return NULL;
3741         }
3742 
3743         scatterlist = sglist->scatterlist;
3744         sg_init_table(scatterlist, num_elem);
3745 
3746         sglist->order = order;
3747         sglist->num_sg = num_elem;
3748 
3749         /* Allocate a bunch of sg elements */
3750         for (i = 0; i < num_elem; i++) {
3751                 page = alloc_pages(GFP_KERNEL, order);
3752                 if (!page) {
3753                         ipr_trace;
3754 
3755                         /* Free up what we already allocated */
3756                         for (j = i - 1; j >= 0; j--)
3757                                 __free_pages(sg_page(&scatterlist[j]), order);
3758                         kfree(sglist);
3759                         return NULL;
3760                 }
3761 
3762                 sg_set_page(&scatterlist[i], page, 0, 0);
3763         }
3764 
3765         return sglist;
3766 }
3767 
3768 /**
3769  * ipr_free_ucode_buffer - Frees a microcode download buffer
3770  * @p_dnld:             scatter/gather list pointer
3771  *
3772  * Free a DMA'able ucode download buffer previously allocated with
3773  * ipr_alloc_ucode_buffer
3774  *
3775  * Return value:
3776  *      nothing
3777  **/
3778 static void ipr_free_ucode_buffer(struct ipr_sglist *sglist)
3779 {
3780         int i;
3781 
3782         for (i = 0; i < sglist->num_sg; i++)
3783                 __free_pages(sg_page(&sglist->scatterlist[i]), sglist->order);
3784 
3785         kfree(sglist);
3786 }
3787 
3788 /**
3789  * ipr_copy_ucode_buffer - Copy user buffer to kernel buffer
3790  * @sglist:             scatter/gather list pointer
3791  * @buffer:             buffer pointer
3792  * @len:                buffer length
3793  *
3794  * Copy a microcode image from a user buffer into a buffer allocated by
3795  * ipr_alloc_ucode_buffer
3796  *
3797  * Return value:
3798  *      0 on success / other on failure
3799  **/
3800 static int ipr_copy_ucode_buffer(struct ipr_sglist *sglist,
3801                                  u8 *buffer, u32 len)
3802 {
3803         int bsize_elem, i, result = 0;
3804         struct scatterlist *scatterlist;
3805         void *kaddr;
3806 
3807         /* Determine the actual number of bytes per element */
3808         bsize_elem = PAGE_SIZE * (1 << sglist->order);
3809 
3810         scatterlist = sglist->scatterlist;
3811 
3812         for (i = 0; i < (len / bsize_elem); i++, buffer += bsize_elem) {
3813                 struct page *page = sg_page(&scatterlist[i]);
3814 
3815                 kaddr = kmap(page);
3816                 memcpy(kaddr, buffer, bsize_elem);
3817                 kunmap(page);
3818 
3819                 scatterlist[i].length = bsize_elem;
3820 
3821                 if (result != 0) {
3822                         ipr_trace;
3823                         return result;
3824                 }
3825         }
3826 
3827         if (len % bsize_elem) {
3828                 struct page *page = sg_page(&scatterlist[i]);
3829 
3830                 kaddr = kmap(page);
3831                 memcpy(kaddr, buffer, len % bsize_elem);
3832                 kunmap(page);
3833 
3834                 scatterlist[i].length = len % bsize_elem;
3835         }
3836 
3837         sglist->buffer_len = len;
3838         return result;
3839 }
3840 
3841 /**
3842  * ipr_build_ucode_ioadl64 - Build a microcode download IOADL
3843  * @ipr_cmd:            ipr command struct
3844  * @sglist:             scatter/gather list
3845  *
3846  * Builds a microcode download IOA data list (IOADL).
3847  *
3848  **/
3849 static void ipr_build_ucode_ioadl64(struct ipr_cmnd *ipr_cmd,
3850                                     struct ipr_sglist *sglist)
3851 {
3852         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
3853         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ioadl64;
3854         struct scatterlist *scatterlist = sglist->scatterlist;
3855         int i;
3856 
3857         ipr_cmd->dma_use_sg = sglist->num_dma_sg;
3858         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
3859         ioarcb->data_transfer_length = cpu_to_be32(sglist->buffer_len);
3860 
3861         ioarcb->ioadl_len =
3862                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
3863         for (i = 0; i < ipr_cmd->dma_use_sg; i++) {
3864                 ioadl64[i].flags = cpu_to_be32(IPR_IOADL_FLAGS_WRITE);
3865                 ioadl64[i].data_len = cpu_to_be32(sg_dma_len(&scatterlist[i]));
3866                 ioadl64[i].address = cpu_to_be64(sg_dma_address(&scatterlist[i]));
3867         }
3868 
3869         ioadl64[i-1].flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
3870 }
3871 
3872 /**
3873  * ipr_build_ucode_ioadl - Build a microcode download IOADL
3874  * @ipr_cmd:    ipr command struct
3875  * @sglist:             scatter/gather list
3876  *
3877  * Builds a microcode download IOA data list (IOADL).
3878  *
3879  **/
3880 static void ipr_build_ucode_ioadl(struct ipr_cmnd *ipr_cmd,
3881                                   struct ipr_sglist *sglist)
3882 {
3883         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
3884         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
3885         struct scatterlist *scatterlist = sglist->scatterlist;
3886         int i;
3887 
3888         ipr_cmd->dma_use_sg = sglist->num_dma_sg;
3889         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
3890         ioarcb->data_transfer_length = cpu_to_be32(sglist->buffer_len);
3891 
3892         ioarcb->ioadl_len =
3893                 cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
3894 
3895         for (i = 0; i < ipr_cmd->dma_use_sg; i++) {
3896                 ioadl[i].flags_and_data_len =
3897                         cpu_to_be32(IPR_IOADL_FLAGS_WRITE | sg_dma_len(&scatterlist[i]));
3898                 ioadl[i].address =
3899                         cpu_to_be32(sg_dma_address(&scatterlist[i]));
3900         }
3901 
3902         ioadl[i-1].flags_and_data_len |=
3903                 cpu_to_be32(IPR_IOADL_FLAGS_LAST);
3904 }
3905 
3906 /**
3907  * ipr_update_ioa_ucode - Update IOA's microcode
3908  * @ioa_cfg:    ioa config struct
3909  * @sglist:             scatter/gather list
3910  *
3911  * Initiate an adapter reset to update the IOA's microcode
3912  *
3913  * Return value:
3914  *      0 on success / -EIO on failure
3915  **/
3916 static int ipr_update_ioa_ucode(struct ipr_ioa_cfg *ioa_cfg,
3917                                 struct ipr_sglist *sglist)
3918 {
3919         unsigned long lock_flags;
3920 
3921         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3922         while (ioa_cfg->in_reset_reload) {
3923                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3924                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3925                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3926         }
3927 
3928         if (ioa_cfg->ucode_sglist) {
3929                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3930                 dev_err(&ioa_cfg->pdev->dev,
3931                         "Microcode download already in progress\n");
3932                 return -EIO;
3933         }
3934 
3935         sglist->num_dma_sg = pci_map_sg(ioa_cfg->pdev, sglist->scatterlist,
3936                                         sglist->num_sg, DMA_TO_DEVICE);
3937 
3938         if (!sglist->num_dma_sg) {
3939                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3940                 dev_err(&ioa_cfg->pdev->dev,
3941                         "Failed to map microcode download buffer!\n");
3942                 return -EIO;
3943         }
3944 
3945         ioa_cfg->ucode_sglist = sglist;
3946         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NORMAL);
3947         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3948         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
3949 
3950         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
3951         ioa_cfg->ucode_sglist = NULL;
3952         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
3953         return 0;
3954 }
3955 
3956 /**
3957  * ipr_store_update_fw - Update the firmware on the adapter
3958  * @class_dev:  device struct
3959  * @buf:        buffer
3960  * @count:      buffer size
3961  *
3962  * This function will update the firmware on the adapter.
3963  *
3964  * Return value:
3965  *      count on success / other on failure
3966  **/
3967 static ssize_t ipr_store_update_fw(struct device *dev,
3968                                    struct device_attribute *attr,
3969                                    const char *buf, size_t count)
3970 {
3971         struct Scsi_Host *shost = class_to_shost(dev);
3972         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
3973         struct ipr_ucode_image_header *image_hdr;
3974         const struct firmware *fw_entry;
3975         struct ipr_sglist *sglist;
3976         char fname[100];
3977         char *src;
3978         int len, result, dnld_size;
3979 
3980         if (!capable(CAP_SYS_ADMIN))
3981                 return -EACCES;
3982 
3983         len = snprintf(fname, 99, "%s", buf);
3984         fname[len-1] = '\0';
3985 
3986         if (request_firmware(&fw_entry, fname, &ioa_cfg->pdev->dev)) {
3987                 dev_err(&ioa_cfg->pdev->dev, "Firmware file %s not found\n", fname);
3988                 return -EIO;
3989         }
3990 
3991         image_hdr = (struct ipr_ucode_image_header *)fw_entry->data;
3992 
3993         src = (u8 *)image_hdr + be32_to_cpu(image_hdr->header_length);
3994         dnld_size = fw_entry->size - be32_to_cpu(image_hdr->header_length);
3995         sglist = ipr_alloc_ucode_buffer(dnld_size);
3996 
3997         if (!sglist) {
3998                 dev_err(&ioa_cfg->pdev->dev, "Microcode buffer allocation failed\n");
3999                 release_firmware(fw_entry);
4000                 return -ENOMEM;
4001         }
4002 
4003         result = ipr_copy_ucode_buffer(sglist, src, dnld_size);
4004 
4005         if (result) {
4006                 dev_err(&ioa_cfg->pdev->dev,
4007                         "Microcode buffer copy to DMA buffer failed\n");
4008                 goto out;
4009         }
4010 
4011         ipr_info("Updating microcode, please be patient.  This may take up to 30 minutes.\n");
4012 
4013         result = ipr_update_ioa_ucode(ioa_cfg, sglist);
4014 
4015         if (!result)
4016                 result = count;
4017 out:
4018         ipr_free_ucode_buffer(sglist);
4019         release_firmware(fw_entry);
4020         return result;
4021 }
4022 
4023 static struct device_attribute ipr_update_fw_attr = {
4024         .attr = {
4025                 .name =         "update_fw",
4026                 .mode =         S_IWUSR,
4027         },
4028         .store = ipr_store_update_fw
4029 };
4030 
4031 /**
4032  * ipr_show_fw_type - Show the adapter's firmware type.
4033  * @dev:        class device struct
4034  * @buf:        buffer
4035  *
4036  * Return value:
4037  *      number of bytes printed to buffer
4038  **/
4039 static ssize_t ipr_show_fw_type(struct device *dev,
4040                                 struct device_attribute *attr, char *buf)
4041 {
4042         struct Scsi_Host *shost = class_to_shost(dev);
4043         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4044         unsigned long lock_flags = 0;
4045         int len;
4046 
4047         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4048         len = snprintf(buf, PAGE_SIZE, "%d\n", ioa_cfg->sis64);
4049         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4050         return len;
4051 }
4052 
4053 static struct device_attribute ipr_ioa_fw_type_attr = {
4054         .attr = {
4055                 .name =         "fw_type",
4056                 .mode =         S_IRUGO,
4057         },
4058         .show = ipr_show_fw_type
4059 };
4060 
4061 static struct device_attribute *ipr_ioa_attrs[] = {
4062         &ipr_fw_version_attr,
4063         &ipr_log_level_attr,
4064         &ipr_diagnostics_attr,
4065         &ipr_ioa_state_attr,
4066         &ipr_ioa_reset_attr,
4067         &ipr_update_fw_attr,
4068         &ipr_ioa_fw_type_attr,
4069         &ipr_iopoll_weight_attr,
4070         NULL,
4071 };
4072 
4073 #ifdef CONFIG_SCSI_IPR_DUMP
4074 /**
4075  * ipr_read_dump - Dump the adapter
4076  * @filp:               open sysfs file
4077  * @kobj:               kobject struct
4078  * @bin_attr:           bin_attribute struct
4079  * @buf:                buffer
4080  * @off:                offset
4081  * @count:              buffer size
4082  *
4083  * Return value:
4084  *      number of bytes printed to buffer
4085  **/
4086 static ssize_t ipr_read_dump(struct file *filp, struct kobject *kobj,
4087                              struct bin_attribute *bin_attr,
4088                              char *buf, loff_t off, size_t count)
4089 {
4090         struct device *cdev = container_of(kobj, struct device, kobj);
4091         struct Scsi_Host *shost = class_to_shost(cdev);
4092         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4093         struct ipr_dump *dump;
4094         unsigned long lock_flags = 0;
4095         char *src;
4096         int len, sdt_end;
4097         size_t rc = count;
4098 
4099         if (!capable(CAP_SYS_ADMIN))
4100                 return -EACCES;
4101 
4102         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4103         dump = ioa_cfg->dump;
4104 
4105         if (ioa_cfg->sdt_state != DUMP_OBTAINED || !dump) {
4106                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4107                 return 0;
4108         }
4109         kref_get(&dump->kref);
4110         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4111 
4112         if (off > dump->driver_dump.hdr.len) {
4113                 kref_put(&dump->kref, ipr_release_dump);
4114                 return 0;
4115         }
4116 
4117         if (off + count > dump->driver_dump.hdr.len) {
4118                 count = dump->driver_dump.hdr.len - off;
4119                 rc = count;
4120         }
4121 
4122         if (count && off < sizeof(dump->driver_dump)) {
4123                 if (off + count > sizeof(dump->driver_dump))
4124                         len = sizeof(dump->driver_dump) - off;
4125                 else
4126                         len = count;
4127                 src = (u8 *)&dump->driver_dump + off;
4128                 memcpy(buf, src, len);
4129                 buf += len;
4130                 off += len;
4131                 count -= len;
4132         }
4133 
4134         off -= sizeof(dump->driver_dump);
4135 
4136         if (ioa_cfg->sis64)
4137                 sdt_end = offsetof(struct ipr_ioa_dump, sdt.entry) +
4138                           (be32_to_cpu(dump->ioa_dump.sdt.hdr.num_entries_used) *
4139                            sizeof(struct ipr_sdt_entry));
4140         else
4141                 sdt_end = offsetof(struct ipr_ioa_dump, sdt.entry) +
4142                           (IPR_FMT2_NUM_SDT_ENTRIES * sizeof(struct ipr_sdt_entry));
4143 
4144         if (count && off < sdt_end) {
4145                 if (off + count > sdt_end)
4146                         len = sdt_end - off;
4147                 else
4148                         len = count;
4149                 src = (u8 *)&dump->ioa_dump + off;
4150                 memcpy(buf, src, len);
4151                 buf += len;
4152                 off += len;
4153                 count -= len;
4154         }
4155 
4156         off -= sdt_end;
4157 
4158         while (count) {
4159                 if ((off & PAGE_MASK) != ((off + count) & PAGE_MASK))
4160                         len = PAGE_ALIGN(off) - off;
4161                 else
4162                         len = count;
4163                 src = (u8 *)dump->ioa_dump.ioa_data[(off & PAGE_MASK) >> PAGE_SHIFT];
4164                 src += off & ~PAGE_MASK;
4165                 memcpy(buf, src, len);
4166                 buf += len;
4167                 off += len;
4168                 count -= len;
4169         }
4170 
4171         kref_put(&dump->kref, ipr_release_dump);
4172         return rc;
4173 }
4174 
4175 /**
4176  * ipr_alloc_dump - Prepare for adapter dump
4177  * @ioa_cfg:    ioa config struct
4178  *
4179  * Return value:
4180  *      0 on success / other on failure
4181  **/
4182 static int ipr_alloc_dump(struct ipr_ioa_cfg *ioa_cfg)
4183 {
4184         struct ipr_dump *dump;
4185         __be32 **ioa_data;
4186         unsigned long lock_flags = 0;
4187 
4188         dump = kzalloc(sizeof(struct ipr_dump), GFP_KERNEL);
4189 
4190         if (!dump) {
4191                 ipr_err("Dump memory allocation failed\n");
4192                 return -ENOMEM;
4193         }
4194 
4195         if (ioa_cfg->sis64)
4196                 ioa_data = vmalloc(IPR_FMT3_MAX_NUM_DUMP_PAGES * sizeof(__be32 *));
4197         else
4198                 ioa_data = vmalloc(IPR_FMT2_MAX_NUM_DUMP_PAGES * sizeof(__be32 *));
4199 
4200         if (!ioa_data) {
4201                 ipr_err("Dump memory allocation failed\n");
4202                 kfree(dump);
4203                 return -ENOMEM;
4204         }
4205 
4206         dump->ioa_dump.ioa_data = ioa_data;
4207 
4208         kref_init(&dump->kref);
4209         dump->ioa_cfg = ioa_cfg;
4210 
4211         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4212 
4213         if (INACTIVE != ioa_cfg->sdt_state) {
4214                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4215                 vfree(dump->ioa_dump.ioa_data);
4216                 kfree(dump);
4217                 return 0;
4218         }
4219 
4220         ioa_cfg->dump = dump;
4221         ioa_cfg->sdt_state = WAIT_FOR_DUMP;
4222         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead && !ioa_cfg->dump_taken) {
4223                 ioa_cfg->dump_taken = 1;
4224                 schedule_work(&ioa_cfg->work_q);
4225         }
4226         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4227 
4228         return 0;
4229 }
4230 
4231 /**
4232  * ipr_free_dump - Free adapter dump memory
4233  * @ioa_cfg:    ioa config struct
4234  *
4235  * Return value:
4236  *      0 on success / other on failure
4237  **/
4238 static int ipr_free_dump(struct ipr_ioa_cfg *ioa_cfg)
4239 {
4240         struct ipr_dump *dump;
4241         unsigned long lock_flags = 0;
4242 
4243         ENTER;
4244 
4245         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4246         dump = ioa_cfg->dump;
4247         if (!dump) {
4248                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4249                 return 0;
4250         }
4251 
4252         ioa_cfg->dump = NULL;
4253         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4254 
4255         kref_put(&dump->kref, ipr_release_dump);
4256 
4257         LEAVE;
4258         return 0;
4259 }
4260 
4261 /**
4262  * ipr_write_dump - Setup dump state of adapter
4263  * @filp:               open sysfs file
4264  * @kobj:               kobject struct
4265  * @bin_attr:           bin_attribute struct
4266  * @buf:                buffer
4267  * @off:                offset
4268  * @count:              buffer size
4269  *
4270  * Return value:
4271  *      number of bytes printed to buffer
4272  **/
4273 static ssize_t ipr_write_dump(struct file *filp, struct kobject *kobj,
4274                               struct bin_attribute *bin_attr,
4275                               char *buf, loff_t off, size_t count)
4276 {
4277         struct device *cdev = container_of(kobj, struct device, kobj);
4278         struct Scsi_Host *shost = class_to_shost(cdev);
4279         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
4280         int rc;
4281 
4282         if (!capable(CAP_SYS_ADMIN))
4283                 return -EACCES;
4284 
4285         if (buf[0] == '1')
4286                 rc = ipr_alloc_dump(ioa_cfg);
4287         else if (buf[0] == '')
4288                 rc = ipr_free_dump(ioa_cfg);
4289         else
4290                 return -EINVAL;
4291 
4292         if (rc)
4293                 return rc;
4294         else
4295                 return count;
4296 }
4297 
4298 static struct bin_attribute ipr_dump_attr = {
4299         .attr = {
4300                 .name = "dump",
4301                 .mode = S_IRUSR | S_IWUSR,
4302         },
4303         .size = 0,
4304         .read = ipr_read_dump,
4305         .write = ipr_write_dump
4306 };
4307 #else
4308 static int ipr_free_dump(struct ipr_ioa_cfg *ioa_cfg) { return 0; };
4309 #endif
4310 
4311 /**
4312  * ipr_change_queue_depth - Change the device's queue depth
4313  * @sdev:       scsi device struct
4314  * @qdepth:     depth to set
4315  * @reason:     calling context
4316  *
4317  * Return value:
4318  *      actual depth set
4319  **/
4320 static int ipr_change_queue_depth(struct scsi_device *sdev, int qdepth,
4321                                   int reason)
4322 {
4323         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4324         struct ipr_resource_entry *res;
4325         unsigned long lock_flags = 0;
4326 
4327         if (reason != SCSI_QDEPTH_DEFAULT)
4328                 return -EOPNOTSUPP;
4329 
4330         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4331         res = (struct ipr_resource_entry *)sdev->hostdata;
4332 
4333         if (res && ipr_is_gata(res) && qdepth > IPR_MAX_CMD_PER_ATA_LUN)
4334                 qdepth = IPR_MAX_CMD_PER_ATA_LUN;
4335         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4336 
4337         scsi_adjust_queue_depth(sdev, scsi_get_tag_type(sdev), qdepth);
4338         return sdev->queue_depth;
4339 }
4340 
4341 /**
4342  * ipr_change_queue_type - Change the device's queue type
4343  * @dsev:               scsi device struct
4344  * @tag_type:   type of tags to use
4345  *
4346  * Return value:
4347  *      actual queue type set
4348  **/
4349 static int ipr_change_queue_type(struct scsi_device *sdev, int tag_type)
4350 {
4351         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4352         struct ipr_resource_entry *res;
4353         unsigned long lock_flags = 0;
4354 
4355         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4356         res = (struct ipr_resource_entry *)sdev->hostdata;
4357 
4358         if (res) {
4359                 if (ipr_is_gscsi(res) && sdev->tagged_supported) {
4360                         /*
4361                          * We don't bother quiescing the device here since the
4362                          * adapter firmware does it for us.
4363                          */
4364                         scsi_set_tag_type(sdev, tag_type);
4365 
4366                         if (tag_type)
4367                                 scsi_activate_tcq(sdev, sdev->queue_depth);
4368                         else
4369                                 scsi_deactivate_tcq(sdev, sdev->queue_depth);
4370                 } else
4371                         tag_type = 0;
4372         } else
4373                 tag_type = 0;
4374 
4375         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4376         return tag_type;
4377 }
4378 
4379 /**
4380  * ipr_show_adapter_handle - Show the adapter's resource handle for this device
4381  * @dev:        device struct
4382  * @attr:       device attribute structure
4383  * @buf:        buffer
4384  *
4385  * Return value:
4386  *      number of bytes printed to buffer
4387  **/
4388 static ssize_t ipr_show_adapter_handle(struct device *dev, struct device_attribute *attr, char *buf)
4389 {
4390         struct scsi_device *sdev = to_scsi_device(dev);
4391         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4392         struct ipr_resource_entry *res;
4393         unsigned long lock_flags = 0;
4394         ssize_t len = -ENXIO;
4395 
4396         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4397         res = (struct ipr_resource_entry *)sdev->hostdata;
4398         if (res)
4399                 len = snprintf(buf, PAGE_SIZE, "%08X\n", res->res_handle);
4400         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4401         return len;
4402 }
4403 
4404 static struct device_attribute ipr_adapter_handle_attr = {
4405         .attr = {
4406                 .name =         "adapter_handle",
4407                 .mode =         S_IRUSR,
4408         },
4409         .show = ipr_show_adapter_handle
4410 };
4411 
4412 /**
4413  * ipr_show_resource_path - Show the resource path or the resource address for
4414  *                          this device.
4415  * @dev:        device struct
4416  * @attr:       device attribute structure
4417  * @buf:        buffer
4418  *
4419  * Return value:
4420  *      number of bytes printed to buffer
4421  **/
4422 static ssize_t ipr_show_resource_path(struct device *dev, struct device_attribute *attr, char *buf)
4423 {
4424         struct scsi_device *sdev = to_scsi_device(dev);
4425         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4426         struct ipr_resource_entry *res;
4427         unsigned long lock_flags = 0;
4428         ssize_t len = -ENXIO;
4429         char buffer[IPR_MAX_RES_PATH_LENGTH];
4430 
4431         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4432         res = (struct ipr_resource_entry *)sdev->hostdata;
4433         if (res && ioa_cfg->sis64)
4434                 len = snprintf(buf, PAGE_SIZE, "%s\n",
4435                                __ipr_format_res_path(res->res_path, buffer,
4436                                                      sizeof(buffer)));
4437         else if (res)
4438                 len = snprintf(buf, PAGE_SIZE, "%d:%d:%d:%d\n", ioa_cfg->host->host_no,
4439                                res->bus, res->target, res->lun);
4440 
4441         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4442         return len;
4443 }
4444 
4445 static struct device_attribute ipr_resource_path_attr = {
4446         .attr = {
4447                 .name =         "resource_path",
4448                 .mode =         S_IRUGO,
4449         },
4450         .show = ipr_show_resource_path
4451 };
4452 
4453 /**
4454  * ipr_show_device_id - Show the device_id for this device.
4455  * @dev:        device struct
4456  * @attr:       device attribute structure
4457  * @buf:        buffer
4458  *
4459  * Return value:
4460  *      number of bytes printed to buffer
4461  **/
4462 static ssize_t ipr_show_device_id(struct device *dev, struct device_attribute *attr, char *buf)
4463 {
4464         struct scsi_device *sdev = to_scsi_device(dev);
4465         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4466         struct ipr_resource_entry *res;
4467         unsigned long lock_flags = 0;
4468         ssize_t len = -ENXIO;
4469 
4470         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4471         res = (struct ipr_resource_entry *)sdev->hostdata;
4472         if (res && ioa_cfg->sis64)
4473                 len = snprintf(buf, PAGE_SIZE, "0x%llx\n", res->dev_id);
4474         else if (res)
4475                 len = snprintf(buf, PAGE_SIZE, "0x%llx\n", res->lun_wwn);
4476 
4477         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4478         return len;
4479 }
4480 
4481 static struct device_attribute ipr_device_id_attr = {
4482         .attr = {
4483                 .name =         "device_id",
4484                 .mode =         S_IRUGO,
4485         },
4486         .show = ipr_show_device_id
4487 };
4488 
4489 /**
4490  * ipr_show_resource_type - Show the resource type for this device.
4491  * @dev:        device struct
4492  * @attr:       device attribute structure
4493  * @buf:        buffer
4494  *
4495  * Return value:
4496  *      number of bytes printed to buffer
4497  **/
4498 static ssize_t ipr_show_resource_type(struct device *dev, struct device_attribute *attr, char *buf)
4499 {
4500         struct scsi_device *sdev = to_scsi_device(dev);
4501         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *)sdev->host->hostdata;
4502         struct ipr_resource_entry *res;
4503         unsigned long lock_flags = 0;
4504         ssize_t len = -ENXIO;
4505 
4506         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4507         res = (struct ipr_resource_entry *)sdev->hostdata;
4508 
4509         if (res)
4510                 len = snprintf(buf, PAGE_SIZE, "%x\n", res->type);
4511 
4512         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4513         return len;
4514 }
4515 
4516 static struct device_attribute ipr_resource_type_attr = {
4517         .attr = {
4518                 .name =         "resource_type",
4519                 .mode =         S_IRUGO,
4520         },
4521         .show = ipr_show_resource_type
4522 };
4523 
4524 static struct device_attribute *ipr_dev_attrs[] = {
4525         &ipr_adapter_handle_attr,
4526         &ipr_resource_path_attr,
4527         &ipr_device_id_attr,
4528         &ipr_resource_type_attr,
4529         NULL,
4530 };
4531 
4532 /**
4533  * ipr_biosparam - Return the HSC mapping
4534  * @sdev:                       scsi device struct
4535  * @block_device:       block device pointer
4536  * @capacity:           capacity of the device
4537  * @parm:                       Array containing returned HSC values.
4538  *
4539  * This function generates the HSC parms that fdisk uses.
4540  * We want to make sure we return something that places partitions
4541  * on 4k boundaries for best performance with the IOA.
4542  *
4543  * Return value:
4544  *      0 on success
4545  **/
4546 static int ipr_biosparam(struct scsi_device *sdev,
4547                          struct block_device *block_device,
4548                          sector_t capacity, int *parm)
4549 {
4550         int heads, sectors;
4551         sector_t cylinders;
4552 
4553         heads = 128;
4554         sectors = 32;
4555 
4556         cylinders = capacity;
4557         sector_div(cylinders, (128 * 32));
4558 
4559         /* return result */
4560         parm[0] = heads;
4561         parm[1] = sectors;
4562         parm[2] = cylinders;
4563 
4564         return 0;
4565 }
4566 
4567 /**
4568  * ipr_find_starget - Find target based on bus/target.
4569  * @starget:    scsi target struct
4570  *
4571  * Return value:
4572  *      resource entry pointer if found / NULL if not found
4573  **/
4574 static struct ipr_resource_entry *ipr_find_starget(struct scsi_target *starget)
4575 {
4576         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4577         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4578         struct ipr_resource_entry *res;
4579 
4580         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
4581                 if ((res->bus == starget->channel) &&
4582                     (res->target == starget->id)) {
4583                         return res;
4584                 }
4585         }
4586 
4587         return NULL;
4588 }
4589 
4590 static struct ata_port_info sata_port_info;
4591 
4592 /**
4593  * ipr_target_alloc - Prepare for commands to a SCSI target
4594  * @starget:    scsi target struct
4595  *
4596  * If the device is a SATA device, this function allocates an
4597  * ATA port with libata, else it does nothing.
4598  *
4599  * Return value:
4600  *      0 on success / non-0 on failure
4601  **/
4602 static int ipr_target_alloc(struct scsi_target *starget)
4603 {
4604         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4605         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4606         struct ipr_sata_port *sata_port;
4607         struct ata_port *ap;
4608         struct ipr_resource_entry *res;
4609         unsigned long lock_flags;
4610 
4611         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4612         res = ipr_find_starget(starget);
4613         starget->hostdata = NULL;
4614 
4615         if (res && ipr_is_gata(res)) {
4616                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4617                 sata_port = kzalloc(sizeof(*sata_port), GFP_KERNEL);
4618                 if (!sata_port)
4619                         return -ENOMEM;
4620 
4621                 ap = ata_sas_port_alloc(&ioa_cfg->ata_host, &sata_port_info, shost);
4622                 if (ap) {
4623                         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4624                         sata_port->ioa_cfg = ioa_cfg;
4625                         sata_port->ap = ap;
4626                         sata_port->res = res;
4627 
4628                         res->sata_port = sata_port;
4629                         ap->private_data = sata_port;
4630                         starget->hostdata = sata_port;
4631                 } else {
4632                         kfree(sata_port);
4633                         return -ENOMEM;
4634                 }
4635         }
4636         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4637 
4638         return 0;
4639 }
4640 
4641 /**
4642  * ipr_target_destroy - Destroy a SCSI target
4643  * @starget:    scsi target struct
4644  *
4645  * If the device was a SATA device, this function frees the libata
4646  * ATA port, else it does nothing.
4647  *
4648  **/
4649 static void ipr_target_destroy(struct scsi_target *starget)
4650 {
4651         struct ipr_sata_port *sata_port = starget->hostdata;
4652         struct Scsi_Host *shost = dev_to_shost(&starget->dev);
4653         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) shost->hostdata;
4654 
4655         if (ioa_cfg->sis64) {
4656                 if (!ipr_find_starget(starget)) {
4657                         if (starget->channel == IPR_ARRAY_VIRTUAL_BUS)
4658                                 clear_bit(starget->id, ioa_cfg->array_ids);
4659                         else if (starget->channel == IPR_VSET_VIRTUAL_BUS)
4660                                 clear_bit(starget->id, ioa_cfg->vset_ids);
4661                         else if (starget->channel == 0)
4662                                 clear_bit(starget->id, ioa_cfg->target_ids);
4663                 }
4664         }
4665 
4666         if (sata_port) {
4667                 starget->hostdata = NULL;
4668                 ata_sas_port_destroy(sata_port->ap);
4669                 kfree(sata_port);
4670         }
4671 }
4672 
4673 /**
4674  * ipr_find_sdev - Find device based on bus/target/lun.
4675  * @sdev:       scsi device struct
4676  *
4677  * Return value:
4678  *      resource entry pointer if found / NULL if not found
4679  **/
4680 static struct ipr_resource_entry *ipr_find_sdev(struct scsi_device *sdev)
4681 {
4682         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4683         struct ipr_resource_entry *res;
4684 
4685         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
4686                 if ((res->bus == sdev->channel) &&
4687                     (res->target == sdev->id) &&
4688                     (res->lun == sdev->lun))
4689                         return res;
4690         }
4691 
4692         return NULL;
4693 }
4694 
4695 /**
4696  * ipr_slave_destroy - Unconfigure a SCSI device
4697  * @sdev:       scsi device struct
4698  *
4699  * Return value:
4700  *      nothing
4701  **/
4702 static void ipr_slave_destroy(struct scsi_device *sdev)
4703 {
4704         struct ipr_resource_entry *res;
4705         struct ipr_ioa_cfg *ioa_cfg;
4706         unsigned long lock_flags = 0;
4707 
4708         ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4709 
4710         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4711         res = (struct ipr_resource_entry *) sdev->hostdata;
4712         if (res) {
4713                 if (res->sata_port)
4714                         res->sata_port->ap->link.device[0].class = ATA_DEV_NONE;
4715                 sdev->hostdata = NULL;
4716                 res->sdev = NULL;
4717                 res->sata_port = NULL;
4718         }
4719         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4720 }
4721 
4722 /**
4723  * ipr_slave_configure - Configure a SCSI device
4724  * @sdev:       scsi device struct
4725  *
4726  * This function configures the specified scsi device.
4727  *
4728  * Return value:
4729  *      0 on success
4730  **/
4731 static int ipr_slave_configure(struct scsi_device *sdev)
4732 {
4733         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4734         struct ipr_resource_entry *res;
4735         struct ata_port *ap = NULL;
4736         unsigned long lock_flags = 0;
4737         char buffer[IPR_MAX_RES_PATH_LENGTH];
4738 
4739         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4740         res = sdev->hostdata;
4741         if (res) {
4742                 if (ipr_is_af_dasd_device(res))
4743                         sdev->type = TYPE_RAID;
4744                 if (ipr_is_af_dasd_device(res) || ipr_is_ioa_resource(res)) {
4745                         sdev->scsi_level = 4;
4746                         sdev->no_uld_attach = 1;
4747                 }
4748                 if (ipr_is_vset_device(res)) {
4749                         blk_queue_rq_timeout(sdev->request_queue,
4750                                              IPR_VSET_RW_TIMEOUT);
4751                         blk_queue_max_hw_sectors(sdev->request_queue, IPR_VSET_MAX_SECTORS);
4752                 }
4753                 if (ipr_is_gata(res) && res->sata_port)
4754                         ap = res->sata_port->ap;
4755                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4756 
4757                 if (ap) {
4758                         scsi_adjust_queue_depth(sdev, 0, IPR_MAX_CMD_PER_ATA_LUN);
4759                         ata_sas_slave_configure(sdev, ap);
4760                 } else
4761                         scsi_adjust_queue_depth(sdev, 0, sdev->host->cmd_per_lun);
4762                 if (ioa_cfg->sis64)
4763                         sdev_printk(KERN_INFO, sdev, "Resource path: %s\n",
4764                                     ipr_format_res_path(ioa_cfg,
4765                                 res->res_path, buffer, sizeof(buffer)));
4766                 return 0;
4767         }
4768         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4769         return 0;
4770 }
4771 
4772 /**
4773  * ipr_ata_slave_alloc - Prepare for commands to a SATA device
4774  * @sdev:       scsi device struct
4775  *
4776  * This function initializes an ATA port so that future commands
4777  * sent through queuecommand will work.
4778  *
4779  * Return value:
4780  *      0 on success
4781  **/
4782 static int ipr_ata_slave_alloc(struct scsi_device *sdev)
4783 {
4784         struct ipr_sata_port *sata_port = NULL;
4785         int rc = -ENXIO;
4786 
4787         ENTER;
4788         if (sdev->sdev_target)
4789                 sata_port = sdev->sdev_target->hostdata;
4790         if (sata_port) {
4791                 rc = ata_sas_port_init(sata_port->ap);
4792                 if (rc == 0)
4793                         rc = ata_sas_sync_probe(sata_port->ap);
4794         }
4795 
4796         if (rc)
4797                 ipr_slave_destroy(sdev);
4798 
4799         LEAVE;
4800         return rc;
4801 }
4802 
4803 /**
4804  * ipr_slave_alloc - Prepare for commands to a device.
4805  * @sdev:       scsi device struct
4806  *
4807  * This function saves a pointer to the resource entry
4808  * in the scsi device struct if the device exists. We
4809  * can then use this pointer in ipr_queuecommand when
4810  * handling new commands.
4811  *
4812  * Return value:
4813  *      0 on success / -ENXIO if device does not exist
4814  **/
4815 static int ipr_slave_alloc(struct scsi_device *sdev)
4816 {
4817         struct ipr_ioa_cfg *ioa_cfg = (struct ipr_ioa_cfg *) sdev->host->hostdata;
4818         struct ipr_resource_entry *res;
4819         unsigned long lock_flags;
4820         int rc = -ENXIO;
4821 
4822         sdev->hostdata = NULL;
4823 
4824         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4825 
4826         res = ipr_find_sdev(sdev);
4827         if (res) {
4828                 res->sdev = sdev;
4829                 res->add_to_ml = 0;
4830                 res->in_erp = 0;
4831                 sdev->hostdata = res;
4832                 if (!ipr_is_naca_model(res))
4833                         res->needs_sync_complete = 1;
4834                 rc = 0;
4835                 if (ipr_is_gata(res)) {
4836                         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4837                         return ipr_ata_slave_alloc(sdev);
4838                 }
4839         }
4840 
4841         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4842 
4843         return rc;
4844 }
4845 
4846 static int ipr_eh_host_reset(struct scsi_cmnd *cmd)
4847 {
4848         struct ipr_ioa_cfg *ioa_cfg;
4849         unsigned long lock_flags = 0;
4850         int rc = SUCCESS;
4851 
4852         ENTER;
4853         ioa_cfg = (struct ipr_ioa_cfg *) cmd->device->host->hostdata;
4854         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4855 
4856         if (!ioa_cfg->in_reset_reload && !ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
4857                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_ABBREV);
4858                 dev_err(&ioa_cfg->pdev->dev,
4859                         "Adapter being reset as a result of error recovery.\n");
4860 
4861                 if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
4862                         ioa_cfg->sdt_state = GET_DUMP;
4863         }
4864 
4865         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4866         wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
4867         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4868 
4869         /* If we got hit with a host reset while we were already resetting
4870          the adapter for some reason, and the reset failed. */
4871         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead) {
4872                 ipr_trace;
4873                 rc = FAILED;
4874         }
4875 
4876         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4877         LEAVE;
4878         return rc;
4879 }
4880 
4881 /**
4882  * ipr_device_reset - Reset the device
4883  * @ioa_cfg:    ioa config struct
4884  * @res:                resource entry struct
4885  *
4886  * This function issues a device reset to the affected device.
4887  * If the device is a SCSI device, a LUN reset will be sent
4888  * to the device first. If that does not work, a target reset
4889  * will be sent. If the device is a SATA device, a PHY reset will
4890  * be sent.
4891  *
4892  * Return value:
4893  *      0 on success / non-zero on failure
4894  **/
4895 static int ipr_device_reset(struct ipr_ioa_cfg *ioa_cfg,
4896                             struct ipr_resource_entry *res)
4897 {
4898         struct ipr_cmnd *ipr_cmd;
4899         struct ipr_ioarcb *ioarcb;
4900         struct ipr_cmd_pkt *cmd_pkt;
4901         struct ipr_ioarcb_ata_regs *regs;
4902         u32 ioasc;
4903 
4904         ENTER;
4905         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
4906         ioarcb = &ipr_cmd->ioarcb;
4907         cmd_pkt = &ioarcb->cmd_pkt;
4908 
4909         if (ipr_cmd->ioa_cfg->sis64) {
4910                 regs = &ipr_cmd->i.ata_ioadl.regs;
4911                 ioarcb->add_cmd_parms_offset = cpu_to_be16(sizeof(*ioarcb));
4912         } else
4913                 regs = &ioarcb->u.add_data.u.regs;
4914 
4915         ioarcb->res_handle = res->res_handle;
4916         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
4917         cmd_pkt->cdb[0] = IPR_RESET_DEVICE;
4918         if (ipr_is_gata(res)) {
4919                 cmd_pkt->cdb[2] = IPR_ATA_PHY_RESET;
4920                 ioarcb->add_cmd_parms_len = cpu_to_be16(sizeof(regs->flags));
4921                 regs->flags |= IPR_ATA_FLAG_STATUS_ON_GOOD_COMPLETION;
4922         }
4923 
4924         ipr_send_blocking_cmd(ipr_cmd, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
4925         ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
4926         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
4927         if (ipr_is_gata(res) && res->sata_port && ioasc != IPR_IOASC_IOA_WAS_RESET) {
4928                 if (ipr_cmd->ioa_cfg->sis64)
4929                         memcpy(&res->sata_port->ioasa, &ipr_cmd->s.ioasa64.u.gata,
4930                                sizeof(struct ipr_ioasa_gata));
4931                 else
4932                         memcpy(&res->sata_port->ioasa, &ipr_cmd->s.ioasa.u.gata,
4933                                sizeof(struct ipr_ioasa_gata));
4934         }
4935 
4936         LEAVE;
4937         return IPR_IOASC_SENSE_KEY(ioasc) ? -EIO : 0;
4938 }
4939 
4940 /**
4941  * ipr_sata_reset - Reset the SATA port
4942  * @link:       SATA link to reset
4943  * @classes:    class of the attached device
4944  *
4945  * This function issues a SATA phy reset to the affected ATA link.
4946  *
4947  * Return value:
4948  *      0 on success / non-zero on failure
4949  **/
4950 static int ipr_sata_reset(struct ata_link *link, unsigned int *classes,
4951                                 unsigned long deadline)
4952 {
4953         struct ipr_sata_port *sata_port = link->ap->private_data;
4954         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
4955         struct ipr_resource_entry *res;
4956         unsigned long lock_flags = 0;
4957         int rc = -ENXIO;
4958 
4959         ENTER;
4960         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4961         while (ioa_cfg->in_reset_reload) {
4962                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4963                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
4964                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
4965         }
4966 
4967         res = sata_port->res;
4968         if (res) {
4969                 rc = ipr_device_reset(ioa_cfg, res);
4970                 *classes = res->ata_class;
4971         }
4972 
4973         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
4974         LEAVE;
4975         return rc;
4976 }
4977 
4978 /**
4979  * ipr_eh_dev_reset - Reset the device
4980  * @scsi_cmd:   scsi command struct
4981  *
4982  * This function issues a device reset to the affected device.
4983  * A LUN reset will be sent to the device first. If that does
4984  * not work, a target reset will be sent.
4985  *
4986  * Return value:
4987  *      SUCCESS / FAILED
4988  **/
4989 static int __ipr_eh_dev_reset(struct scsi_cmnd *scsi_cmd)
4990 {
4991         struct ipr_cmnd *ipr_cmd;
4992         struct ipr_ioa_cfg *ioa_cfg;
4993         struct ipr_resource_entry *res;
4994         struct ata_port *ap;
4995         int rc = 0;
4996         struct ipr_hrr_queue *hrrq;
4997 
4998         ENTER;
4999         ioa_cfg = (struct ipr_ioa_cfg *) scsi_cmd->device->host->hostdata;
5000         res = scsi_cmd->device->hostdata;
5001 
5002         if (!res)
5003                 return FAILED;
5004 
5005         /*
5006          * If we are currently going through reset/reload, return failed. This will force the
5007          * mid-layer to call ipr_eh_host_reset, which will then go to sleep and wait for the
5008          * reset to complete
5009          */
5010         if (ioa_cfg->in_reset_reload)
5011                 return FAILED;
5012         if (ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
5013                 return FAILED;
5014 
5015         for_each_hrrq(hrrq, ioa_cfg) {
5016                 spin_lock(&hrrq->_lock);
5017                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
5018                         if (ipr_cmd->ioarcb.res_handle == res->res_handle) {
5019                                 if (ipr_cmd->scsi_cmd)
5020                                         ipr_cmd->done = ipr_scsi_eh_done;
5021                                 if (ipr_cmd->qc)
5022                                         ipr_cmd->done = ipr_sata_eh_done;
5023                                 if (ipr_cmd->qc &&
5024                                     !(ipr_cmd->qc->flags & ATA_QCFLAG_FAILED)) {
5025                                         ipr_cmd->qc->err_mask |= AC_ERR_TIMEOUT;
5026                                         ipr_cmd->qc->flags |= ATA_QCFLAG_FAILED;
5027                                 }
5028                         }
5029                 }
5030                 spin_unlock(&hrrq->_lock);
5031         }
5032         res->resetting_device = 1;
5033         scmd_printk(KERN_ERR, scsi_cmd, "Resetting device\n");
5034 
5035         if (ipr_is_gata(res) && res->sata_port) {
5036                 ap = res->sata_port->ap;
5037                 spin_unlock_irq(scsi_cmd->device->host->host_lock);
5038                 ata_std_error_handler(ap);
5039                 spin_lock_irq(scsi_cmd->device->host->host_lock);
5040 
5041                 for_each_hrrq(hrrq, ioa_cfg) {
5042                         spin_lock(&hrrq->_lock);
5043                         list_for_each_entry(ipr_cmd,
5044                                             &hrrq->hrrq_pending_q, queue) {
5045                                 if (ipr_cmd->ioarcb.res_handle ==
5046                                     res->res_handle) {
5047                                         rc = -EIO;
5048                                         break;
5049                                 }
5050                         }
5051                         spin_unlock(&hrrq->_lock);
5052                 }
5053         } else
5054                 rc = ipr_device_reset(ioa_cfg, res);
5055         res->resetting_device = 0;
5056         res->reset_occurred = 1;
5057 
5058         LEAVE;
5059         return rc ? FAILED : SUCCESS;
5060 }
5061 
5062 static int ipr_eh_dev_reset(struct scsi_cmnd *cmd)
5063 {
5064         int rc;
5065 
5066         spin_lock_irq(cmd->device->host->host_lock);
5067         rc = __ipr_eh_dev_reset(cmd);
5068         spin_unlock_irq(cmd->device->host->host_lock);
5069 
5070         return rc;
5071 }
5072 
5073 /**
5074  * ipr_bus_reset_done - Op done function for bus reset.
5075  * @ipr_cmd:    ipr command struct
5076  *
5077  * This function is the op done function for a bus reset
5078  *
5079  * Return value:
5080  *      none
5081  **/
5082 static void ipr_bus_reset_done(struct ipr_cmnd *ipr_cmd)
5083 {
5084         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
5085         struct ipr_resource_entry *res;
5086 
5087         ENTER;
5088         if (!ioa_cfg->sis64)
5089                 list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
5090                         if (res->res_handle == ipr_cmd->ioarcb.res_handle) {
5091                                 scsi_report_bus_reset(ioa_cfg->host, res->bus);
5092                                 break;
5093                         }
5094                 }
5095 
5096         /*
5097          * If abort has not completed, indicate the reset has, else call the
5098          * abort's done function to wake the sleeping eh thread
5099          */
5100         if (ipr_cmd->sibling->sibling)
5101                 ipr_cmd->sibling->sibling = NULL;
5102         else
5103                 ipr_cmd->sibling->done(ipr_cmd->sibling);
5104 
5105         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5106         LEAVE;
5107 }
5108 
5109 /**
5110  * ipr_abort_timeout - An abort task has timed out
5111  * @ipr_cmd:    ipr command struct
5112  *
5113  * This function handles when an abort task times out. If this
5114  * happens we issue a bus reset since we have resources tied
5115  * up that must be freed before returning to the midlayer.
5116  *
5117  * Return value:
5118  *      none
5119  **/
5120 static void ipr_abort_timeout(struct ipr_cmnd *ipr_cmd)
5121 {
5122         struct ipr_cmnd *reset_cmd;
5123         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
5124         struct ipr_cmd_pkt *cmd_pkt;
5125         unsigned long lock_flags = 0;
5126 
5127         ENTER;
5128         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
5129         if (ipr_cmd->completion.done || ioa_cfg->in_reset_reload) {
5130                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5131                 return;
5132         }
5133 
5134         sdev_printk(KERN_ERR, ipr_cmd->u.sdev, "Abort timed out. Resetting bus.\n");
5135         reset_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5136         ipr_cmd->sibling = reset_cmd;
5137         reset_cmd->sibling = ipr_cmd;
5138         reset_cmd->ioarcb.res_handle = ipr_cmd->ioarcb.res_handle;
5139         cmd_pkt = &reset_cmd->ioarcb.cmd_pkt;
5140         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5141         cmd_pkt->cdb[0] = IPR_RESET_DEVICE;
5142         cmd_pkt->cdb[2] = IPR_RESET_TYPE_SELECT | IPR_BUS_RESET;
5143 
5144         ipr_do_req(reset_cmd, ipr_bus_reset_done, ipr_timeout, IPR_DEVICE_RESET_TIMEOUT);
5145         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
5146         LEAVE;
5147 }
5148 
5149 /**
5150  * ipr_cancel_op - Cancel specified op
5151  * @scsi_cmd:   scsi command struct
5152  *
5153  * This function cancels specified op.
5154  *
5155  * Return value:
5156  *      SUCCESS / FAILED
5157  **/
5158 static int ipr_cancel_op(struct scsi_cmnd *scsi_cmd)
5159 {
5160         struct ipr_cmnd *ipr_cmd;
5161         struct ipr_ioa_cfg *ioa_cfg;
5162         struct ipr_resource_entry *res;
5163         struct ipr_cmd_pkt *cmd_pkt;
5164         u32 ioasc, int_reg;
5165         int op_found = 0;
5166         struct ipr_hrr_queue *hrrq;
5167 
5168         ENTER;
5169         ioa_cfg = (struct ipr_ioa_cfg *)scsi_cmd->device->host->hostdata;
5170         res = scsi_cmd->device->hostdata;
5171 
5172         /* If we are currently going through reset/reload, return failed.
5173          * This will force the mid-layer to call ipr_eh_host_reset,
5174          * which will then go to sleep and wait for the reset to complete
5175          */
5176         if (ioa_cfg->in_reset_reload ||
5177             ioa_cfg->hrrq[IPR_INIT_HRRQ].ioa_is_dead)
5178                 return FAILED;
5179         if (!res)
5180                 return FAILED;
5181 
5182         /*
5183          * If we are aborting a timed out op, chances are that the timeout was caused
5184          * by a still not detected EEH error. In such cases, reading a register will
5185          * trigger the EEH recovery infrastructure.
5186          */
5187         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
5188 
5189         if (!ipr_is_gscsi(res))
5190                 return FAILED;
5191 
5192         for_each_hrrq(hrrq, ioa_cfg) {
5193                 spin_lock(&hrrq->_lock);
5194                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
5195                         if (ipr_cmd->scsi_cmd == scsi_cmd) {
5196                                 ipr_cmd->done = ipr_scsi_eh_done;
5197                                 op_found = 1;
5198                                 break;
5199                         }
5200                 }
5201                 spin_unlock(&hrrq->_lock);
5202         }
5203 
5204         if (!op_found)
5205                 return SUCCESS;
5206 
5207         ipr_cmd = ipr_get_free_ipr_cmnd(ioa_cfg);
5208         ipr_cmd->ioarcb.res_handle = res->res_handle;
5209         cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5210         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5211         cmd_pkt->cdb[0] = IPR_CANCEL_ALL_REQUESTS;
5212         ipr_cmd->u.sdev = scsi_cmd->device;
5213 
5214         scmd_printk(KERN_ERR, scsi_cmd, "Aborting command: %02X\n",
5215                     scsi_cmd->cmnd[0]);
5216         ipr_send_blocking_cmd(ipr_cmd, ipr_abort_timeout, IPR_CANCEL_ALL_TIMEOUT);
5217         ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5218 
5219         /*
5220          * If the abort task timed out and we sent a bus reset, we will get
5221          * one the following responses to the abort
5222          */
5223         if (ioasc == IPR_IOASC_BUS_WAS_RESET || ioasc == IPR_IOASC_SYNC_REQUIRED) {
5224                 ioasc = 0;
5225                 ipr_trace;
5226         }
5227 
5228         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5229         if (!ipr_is_naca_model(res))
5230                 res->needs_sync_complete = 1;
5231 
5232         LEAVE;
5233         return IPR_IOASC_SENSE_KEY(ioasc) ? FAILED : SUCCESS;
5234 }
5235 
5236 /**
5237  * ipr_eh_abort - Abort a single op
5238  * @scsi_cmd:   scsi command struct
5239  *
5240  * Return value:
5241  *      SUCCESS / FAILED
5242  **/
5243 static int ipr_eh_abort(struct scsi_cmnd *scsi_cmd)
5244 {
5245         unsigned long flags;
5246         int rc;
5247 
5248         ENTER;
5249 
5250         spin_lock_irqsave(scsi_cmd->device->host->host_lock, flags);
5251         rc = ipr_cancel_op(scsi_cmd);
5252         spin_unlock_irqrestore(scsi_cmd->device->host->host_lock, flags);
5253 
5254         LEAVE;
5255         return rc;
5256 }
5257 
5258 /**
5259  * ipr_handle_other_interrupt - Handle "other" interrupts
5260  * @ioa_cfg:    ioa config struct
5261  * @int_reg:    interrupt register
5262  *
5263  * Return value:
5264  *      IRQ_NONE / IRQ_HANDLED
5265  **/
5266 static irqreturn_t ipr_handle_other_interrupt(struct ipr_ioa_cfg *ioa_cfg,
5267                                               u32 int_reg)
5268 {
5269         irqreturn_t rc = IRQ_HANDLED;
5270         u32 int_mask_reg;
5271 
5272         int_mask_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg32);
5273         int_reg &= ~int_mask_reg;
5274 
5275         /* If an interrupt on the adapter did not occur, ignore it.
5276          * Or in the case of SIS 64, check for a stage change interrupt.
5277          */
5278         if ((int_reg & IPR_PCII_OPER_INTERRUPTS) == 0) {
5279                 if (ioa_cfg->sis64) {
5280                         int_mask_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
5281                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg) & ~int_mask_reg;
5282                         if (int_reg & IPR_PCII_IPL_STAGE_CHANGE) {
5283 
5284                                 /* clear stage change */
5285                                 writel(IPR_PCII_IPL_STAGE_CHANGE, ioa_cfg->regs.clr_interrupt_reg);
5286                                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg) & ~int_mask_reg;
5287                                 list_del(&ioa_cfg->reset_cmd->queue);
5288                                 del_timer(&ioa_cfg->reset_cmd->timer);
5289                                 ipr_reset_ioa_job(ioa_cfg->reset_cmd);
5290                                 return IRQ_HANDLED;
5291                         }
5292                 }
5293 
5294                 return IRQ_NONE;
5295         }
5296 
5297         if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
5298                 /* Mask the interrupt */
5299                 writel(IPR_PCII_IOA_TRANS_TO_OPER, ioa_cfg->regs.set_interrupt_mask_reg);
5300 
5301                 /* Clear the interrupt */
5302                 writel(IPR_PCII_IOA_TRANS_TO_OPER, ioa_cfg->regs.clr_interrupt_reg);
5303                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg);
5304 
5305                 list_del(&ioa_cfg->reset_cmd->queue);
5306                 del_timer(&ioa_cfg->reset_cmd->timer);
5307                 ipr_reset_ioa_job(ioa_cfg->reset_cmd);
5308         } else if ((int_reg & IPR_PCII_HRRQ_UPDATED) == int_reg) {
5309                 if (ioa_cfg->clear_isr) {
5310                         if (ipr_debug && printk_ratelimit())
5311                                 dev_err(&ioa_cfg->pdev->dev,
5312                                         "Spurious interrupt detected. 0x%08X\n", int_reg);
5313                         writel(IPR_PCII_HRRQ_UPDATED, ioa_cfg->regs.clr_interrupt_reg32);
5314                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5315                         return IRQ_NONE;
5316                 }
5317         } else {
5318                 if (int_reg & IPR_PCII_IOA_UNIT_CHECKED)
5319                         ioa_cfg->ioa_unit_checked = 1;
5320                 else if (int_reg & IPR_PCII_NO_HOST_RRQ)
5321                         dev_err(&ioa_cfg->pdev->dev,
5322                                 "No Host RRQ. 0x%08X\n", int_reg);
5323                 else
5324                         dev_err(&ioa_cfg->pdev->dev,
5325                                 "Permanent IOA failure. 0x%08X\n", int_reg);
5326 
5327                 if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
5328                         ioa_cfg->sdt_state = GET_DUMP;
5329 
5330                 ipr_mask_and_clear_interrupts(ioa_cfg, ~0);
5331                 ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
5332         }
5333 
5334         return rc;
5335 }
5336 
5337 /**
5338  * ipr_isr_eh - Interrupt service routine error handler
5339  * @ioa_cfg:    ioa config struct
5340  * @msg:        message to log
5341  *
5342  * Return value:
5343  *      none
5344  **/
5345 static void ipr_isr_eh(struct ipr_ioa_cfg *ioa_cfg, char *msg, u16 number)
5346 {
5347         ioa_cfg->errors_logged++;
5348         dev_err(&ioa_cfg->pdev->dev, "%s %d\n", msg, number);
5349 
5350         if (WAIT_FOR_DUMP == ioa_cfg->sdt_state)
5351                 ioa_cfg->sdt_state = GET_DUMP;
5352 
5353         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
5354 }
5355 
5356 static int ipr_process_hrrq(struct ipr_hrr_queue *hrr_queue, int budget,
5357                                                 struct list_head *doneq)
5358 {
5359         u32 ioasc;
5360         u16 cmd_index;
5361         struct ipr_cmnd *ipr_cmd;
5362         struct ipr_ioa_cfg *ioa_cfg = hrr_queue->ioa_cfg;
5363         int num_hrrq = 0;
5364 
5365         /* If interrupts are disabled, ignore the interrupt */
5366         if (!hrr_queue->allow_interrupts)
5367                 return 0;
5368 
5369         while ((be32_to_cpu(*hrr_queue->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5370                hrr_queue->toggle_bit) {
5371 
5372                 cmd_index = (be32_to_cpu(*hrr_queue->hrrq_curr) &
5373                              IPR_HRRQ_REQ_RESP_HANDLE_MASK) >>
5374                              IPR_HRRQ_REQ_RESP_HANDLE_SHIFT;
5375 
5376                 if (unlikely(cmd_index > hrr_queue->max_cmd_id ||
5377                              cmd_index < hrr_queue->min_cmd_id)) {
5378                         ipr_isr_eh(ioa_cfg,
5379                                 "Invalid response handle from IOA: ",
5380                                 cmd_index);
5381                         break;
5382                 }
5383 
5384                 ipr_cmd = ioa_cfg->ipr_cmnd_list[cmd_index];
5385                 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5386 
5387                 ipr_trc_hook(ipr_cmd, IPR_TRACE_FINISH, ioasc);
5388 
5389                 list_move_tail(&ipr_cmd->queue, doneq);
5390 
5391                 if (hrr_queue->hrrq_curr < hrr_queue->hrrq_end) {
5392                         hrr_queue->hrrq_curr++;
5393                 } else {
5394                         hrr_queue->hrrq_curr = hrr_queue->hrrq_start;
5395                         hrr_queue->toggle_bit ^= 1u;
5396                 }
5397                 num_hrrq++;
5398                 if (budget > 0 && num_hrrq >= budget)
5399                         break;
5400         }
5401 
5402         return num_hrrq;
5403 }
5404 
5405 static int ipr_iopoll(struct blk_iopoll *iop, int budget)
5406 {
5407         struct ipr_ioa_cfg *ioa_cfg;
5408         struct ipr_hrr_queue *hrrq;
5409         struct ipr_cmnd *ipr_cmd, *temp;
5410         unsigned long hrrq_flags;
5411         int completed_ops;
5412         LIST_HEAD(doneq);
5413 
5414         hrrq = container_of(iop, struct ipr_hrr_queue, iopoll);
5415         ioa_cfg = hrrq->ioa_cfg;
5416 
5417         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5418         completed_ops = ipr_process_hrrq(hrrq, budget, &doneq);
5419 
5420         if (completed_ops < budget)
5421                 blk_iopoll_complete(iop);
5422         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5423 
5424         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5425                 list_del(&ipr_cmd->queue);
5426                 del_timer(&ipr_cmd->timer);
5427                 ipr_cmd->fast_done(ipr_cmd);
5428         }
5429 
5430         return completed_ops;
5431 }
5432 
5433 /**
5434  * ipr_isr - Interrupt service routine
5435  * @irq:        irq number
5436  * @devp:       pointer to ioa config struct
5437  *
5438  * Return value:
5439  *      IRQ_NONE / IRQ_HANDLED
5440  **/
5441 static irqreturn_t ipr_isr(int irq, void *devp)
5442 {
5443         struct ipr_hrr_queue *hrrq = (struct ipr_hrr_queue *)devp;
5444         struct ipr_ioa_cfg *ioa_cfg = hrrq->ioa_cfg;
5445         unsigned long hrrq_flags = 0;
5446         u32 int_reg = 0;
5447         int num_hrrq = 0;
5448         int irq_none = 0;
5449         struct ipr_cmnd *ipr_cmd, *temp;
5450         irqreturn_t rc = IRQ_NONE;
5451         LIST_HEAD(doneq);
5452 
5453         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5454         /* If interrupts are disabled, ignore the interrupt */
5455         if (!hrrq->allow_interrupts) {
5456                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5457                 return IRQ_NONE;
5458         }
5459 
5460         while (1) {
5461                 if (ipr_process_hrrq(hrrq, -1, &doneq)) {
5462                         rc =  IRQ_HANDLED;
5463 
5464                         if (!ioa_cfg->clear_isr)
5465                                 break;
5466 
5467                         /* Clear the PCI interrupt */
5468                         num_hrrq = 0;
5469                         do {
5470                                 writel(IPR_PCII_HRRQ_UPDATED,
5471                                      ioa_cfg->regs.clr_interrupt_reg32);
5472                                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5473                         } while (int_reg & IPR_PCII_HRRQ_UPDATED &&
5474                                 num_hrrq++ < IPR_MAX_HRRQ_RETRIES);
5475 
5476                 } else if (rc == IRQ_NONE && irq_none == 0) {
5477                         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
5478                         irq_none++;
5479                 } else if (num_hrrq == IPR_MAX_HRRQ_RETRIES &&
5480                            int_reg & IPR_PCII_HRRQ_UPDATED) {
5481                         ipr_isr_eh(ioa_cfg,
5482                                 "Error clearing HRRQ: ", num_hrrq);
5483                         rc = IRQ_HANDLED;
5484                         break;
5485                 } else
5486                         break;
5487         }
5488 
5489         if (unlikely(rc == IRQ_NONE))
5490                 rc = ipr_handle_other_interrupt(ioa_cfg, int_reg);
5491 
5492         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5493         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5494                 list_del(&ipr_cmd->queue);
5495                 del_timer(&ipr_cmd->timer);
5496                 ipr_cmd->fast_done(ipr_cmd);
5497         }
5498         return rc;
5499 }
5500 
5501 /**
5502  * ipr_isr_mhrrq - Interrupt service routine
5503  * @irq:        irq number
5504  * @devp:       pointer to ioa config struct
5505  *
5506  * Return value:
5507  *      IRQ_NONE / IRQ_HANDLED
5508  **/
5509 static irqreturn_t ipr_isr_mhrrq(int irq, void *devp)
5510 {
5511         struct ipr_hrr_queue *hrrq = (struct ipr_hrr_queue *)devp;
5512         struct ipr_ioa_cfg *ioa_cfg = hrrq->ioa_cfg;
5513         unsigned long hrrq_flags = 0;
5514         struct ipr_cmnd *ipr_cmd, *temp;
5515         irqreturn_t rc = IRQ_NONE;
5516         LIST_HEAD(doneq);
5517 
5518         spin_lock_irqsave(hrrq->lock, hrrq_flags);
5519 
5520         /* If interrupts are disabled, ignore the interrupt */
5521         if (!hrrq->allow_interrupts) {
5522                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5523                 return IRQ_NONE;
5524         }
5525 
5526         if (ioa_cfg->iopoll_weight && ioa_cfg->sis64 && ioa_cfg->nvectors > 1) {
5527                 if ((be32_to_cpu(*hrrq->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5528                        hrrq->toggle_bit) {
5529                         if (!blk_iopoll_sched_prep(&hrrq->iopoll))
5530                                 blk_iopoll_sched(&hrrq->iopoll);
5531                         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5532                         return IRQ_HANDLED;
5533                 }
5534         } else {
5535                 if ((be32_to_cpu(*hrrq->hrrq_curr) & IPR_HRRQ_TOGGLE_BIT) ==
5536                         hrrq->toggle_bit)
5537 
5538                         if (ipr_process_hrrq(hrrq, -1, &doneq))
5539                                 rc =  IRQ_HANDLED;
5540         }
5541 
5542         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
5543 
5544         list_for_each_entry_safe(ipr_cmd, temp, &doneq, queue) {
5545                 list_del(&ipr_cmd->queue);
5546                 del_timer(&ipr_cmd->timer);
5547                 ipr_cmd->fast_done(ipr_cmd);
5548         }
5549         return rc;
5550 }
5551 
5552 /**
5553  * ipr_build_ioadl64 - Build a scatter/gather list and map the buffer
5554  * @ioa_cfg:    ioa config struct
5555  * @ipr_cmd:    ipr command struct
5556  *
5557  * Return value:
5558  *      0 on success / -1 on failure
5559  **/
5560 static int ipr_build_ioadl64(struct ipr_ioa_cfg *ioa_cfg,
5561                              struct ipr_cmnd *ipr_cmd)
5562 {
5563         int i, nseg;
5564         struct scatterlist *sg;
5565         u32 length;
5566         u32 ioadl_flags = 0;
5567         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5568         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5569         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ioadl64;
5570 
5571         length = scsi_bufflen(scsi_cmd);
5572         if (!length)
5573                 return 0;
5574 
5575         nseg = scsi_dma_map(scsi_cmd);
5576         if (nseg < 0) {
5577                 if (printk_ratelimit())
5578                         dev_err(&ioa_cfg->pdev->dev, "pci_map_sg failed!\n");
5579                 return -1;
5580         }
5581 
5582         ipr_cmd->dma_use_sg = nseg;
5583 
5584         ioarcb->data_transfer_length = cpu_to_be32(length);
5585         ioarcb->ioadl_len =
5586                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
5587 
5588         if (scsi_cmd->sc_data_direction == DMA_TO_DEVICE) {
5589                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
5590                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
5591         } else if (scsi_cmd->sc_data_direction == DMA_FROM_DEVICE)
5592                 ioadl_flags = IPR_IOADL_FLAGS_READ;
5593 
5594         scsi_for_each_sg(scsi_cmd, sg, ipr_cmd->dma_use_sg, i) {
5595                 ioadl64[i].flags = cpu_to_be32(ioadl_flags);
5596                 ioadl64[i].data_len = cpu_to_be32(sg_dma_len(sg));
5597                 ioadl64[i].address = cpu_to_be64(sg_dma_address(sg));
5598         }
5599 
5600         ioadl64[i-1].flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
5601         return 0;
5602 }
5603 
5604 /**
5605  * ipr_build_ioadl - Build a scatter/gather list and map the buffer
5606  * @ioa_cfg:    ioa config struct
5607  * @ipr_cmd:    ipr command struct
5608  *
5609  * Return value:
5610  *      0 on success / -1 on failure
5611  **/
5612 static int ipr_build_ioadl(struct ipr_ioa_cfg *ioa_cfg,
5613                            struct ipr_cmnd *ipr_cmd)
5614 {
5615         int i, nseg;
5616         struct scatterlist *sg;
5617         u32 length;
5618         u32 ioadl_flags = 0;
5619         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5620         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5621         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
5622 
5623         length = scsi_bufflen(scsi_cmd);
5624         if (!length)
5625                 return 0;
5626 
5627         nseg = scsi_dma_map(scsi_cmd);
5628         if (nseg < 0) {
5629                 dev_err(&ioa_cfg->pdev->dev, "pci_map_sg failed!\n");
5630                 return -1;
5631         }
5632 
5633         ipr_cmd->dma_use_sg = nseg;
5634 
5635         if (scsi_cmd->sc_data_direction == DMA_TO_DEVICE) {
5636                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
5637                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
5638                 ioarcb->data_transfer_length = cpu_to_be32(length);
5639                 ioarcb->ioadl_len =
5640                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
5641         } else if (scsi_cmd->sc_data_direction == DMA_FROM_DEVICE) {
5642                 ioadl_flags = IPR_IOADL_FLAGS_READ;
5643                 ioarcb->read_data_transfer_length = cpu_to_be32(length);
5644                 ioarcb->read_ioadl_len =
5645                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
5646         }
5647 
5648         if (ipr_cmd->dma_use_sg <= ARRAY_SIZE(ioarcb->u.add_data.u.ioadl)) {
5649                 ioadl = ioarcb->u.add_data.u.ioadl;
5650                 ioarcb->write_ioadl_addr = cpu_to_be32((ipr_cmd->dma_addr) +
5651                                     offsetof(struct ipr_ioarcb, u.add_data));
5652                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
5653         }
5654 
5655         scsi_for_each_sg(scsi_cmd, sg, ipr_cmd->dma_use_sg, i) {
5656                 ioadl[i].flags_and_data_len =
5657                         cpu_to_be32(ioadl_flags | sg_dma_len(sg));
5658                 ioadl[i].address = cpu_to_be32(sg_dma_address(sg));
5659         }
5660 
5661         ioadl[i-1].flags_and_data_len |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
5662         return 0;
5663 }
5664 
5665 /**
5666  * ipr_get_task_attributes - Translate SPI Q-Tag to task attributes
5667  * @scsi_cmd:   scsi command struct
5668  *
5669  * Return value:
5670  *      task attributes
5671  **/
5672 static u8 ipr_get_task_attributes(struct scsi_cmnd *scsi_cmd)
5673 {
5674         u8 tag[2];
5675         u8 rc = IPR_FLAGS_LO_UNTAGGED_TASK;
5676 
5677         if (scsi_populate_tag_msg(scsi_cmd, tag)) {
5678                 switch (tag[0]) {
5679                 case MSG_SIMPLE_TAG:
5680                         rc = IPR_FLAGS_LO_SIMPLE_TASK;
5681                         break;
5682                 case MSG_HEAD_TAG:
5683                         rc = IPR_FLAGS_LO_HEAD_OF_Q_TASK;
5684                         break;
5685                 case MSG_ORDERED_TAG:
5686                         rc = IPR_FLAGS_LO_ORDERED_TASK;
5687                         break;
5688                 };
5689         }
5690 
5691         return rc;
5692 }
5693 
5694 /**
5695  * ipr_erp_done - Process completion of ERP for a device
5696  * @ipr_cmd:            ipr command struct
5697  *
5698  * This function copies the sense buffer into the scsi_cmd
5699  * struct and pushes the scsi_done function.
5700  *
5701  * Return value:
5702  *      nothing
5703  **/
5704 static void ipr_erp_done(struct ipr_cmnd *ipr_cmd)
5705 {
5706         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5707         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
5708         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5709 
5710         if (IPR_IOASC_SENSE_KEY(ioasc) > 0) {
5711                 scsi_cmd->result |= (DID_ERROR << 16);
5712                 scmd_printk(KERN_ERR, scsi_cmd,
5713                             "Request Sense failed with IOASC: 0x%08X\n", ioasc);
5714         } else {
5715                 memcpy(scsi_cmd->sense_buffer, ipr_cmd->sense_buffer,
5716                        SCSI_SENSE_BUFFERSIZE);
5717         }
5718 
5719         if (res) {
5720                 if (!ipr_is_naca_model(res))
5721                         res->needs_sync_complete = 1;
5722                 res->in_erp = 0;
5723         }
5724         scsi_dma_unmap(ipr_cmd->scsi_cmd);
5725         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
5726         scsi_cmd->scsi_done(scsi_cmd);
5727 }
5728 
5729 /**
5730  * ipr_reinit_ipr_cmnd_for_erp - Re-initialize a cmnd block to be used for ERP
5731  * @ipr_cmd:    ipr command struct
5732  *
5733  * Return value:
5734  *      none
5735  **/
5736 static void ipr_reinit_ipr_cmnd_for_erp(struct ipr_cmnd *ipr_cmd)
5737 {
5738         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
5739         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
5740         dma_addr_t dma_addr = ipr_cmd->dma_addr;
5741 
5742         memset(&ioarcb->cmd_pkt, 0, sizeof(struct ipr_cmd_pkt));
5743         ioarcb->data_transfer_length = 0;
5744         ioarcb->read_data_transfer_length = 0;
5745         ioarcb->ioadl_len = 0;
5746         ioarcb->read_ioadl_len = 0;
5747         ioasa->hdr.ioasc = 0;
5748         ioasa->hdr.residual_data_len = 0;
5749 
5750         if (ipr_cmd->ioa_cfg->sis64)
5751                 ioarcb->u.sis64_addr_data.data_ioadl_addr =
5752                         cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ioadl64));
5753         else {
5754                 ioarcb->write_ioadl_addr =
5755                         cpu_to_be32(dma_addr + offsetof(struct ipr_cmnd, i.ioadl));
5756                 ioarcb->read_ioadl_addr = ioarcb->write_ioadl_addr;
5757         }
5758 }
5759 
5760 /**
5761  * ipr_erp_request_sense - Send request sense to a device
5762  * @ipr_cmd:    ipr command struct
5763  *
5764  * This function sends a request sense to a device as a result
5765  * of a check condition.
5766  *
5767  * Return value:
5768  *      nothing
5769  **/
5770 static void ipr_erp_request_sense(struct ipr_cmnd *ipr_cmd)
5771 {
5772         struct ipr_cmd_pkt *cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5773         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
5774 
5775         if (IPR_IOASC_SENSE_KEY(ioasc) > 0) {
5776                 ipr_erp_done(ipr_cmd);
5777                 return;
5778         }
5779 
5780         ipr_reinit_ipr_cmnd_for_erp(ipr_cmd);
5781 
5782         cmd_pkt->request_type = IPR_RQTYPE_SCSICDB;
5783         cmd_pkt->cdb[0] = REQUEST_SENSE;
5784         cmd_pkt->cdb[4] = SCSI_SENSE_BUFFERSIZE;
5785         cmd_pkt->flags_hi |= IPR_FLAGS_HI_SYNC_OVERRIDE;
5786         cmd_pkt->flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
5787         cmd_pkt->timeout = cpu_to_be16(IPR_REQUEST_SENSE_TIMEOUT / HZ);
5788 
5789         ipr_init_ioadl(ipr_cmd, ipr_cmd->sense_buffer_dma,
5790                        SCSI_SENSE_BUFFERSIZE, IPR_IOADL_FLAGS_READ_LAST);
5791 
5792         ipr_do_req(ipr_cmd, ipr_erp_done, ipr_timeout,
5793                    IPR_REQUEST_SENSE_TIMEOUT * 2);
5794 }
5795 
5796 /**
5797  * ipr_erp_cancel_all - Send cancel all to a device
5798  * @ipr_cmd:    ipr command struct
5799  *
5800  * This function sends a cancel all to a device to clear the
5801  * queue. If we are running TCQ on the device, QERR is set to 1,
5802  * which means all outstanding ops have been dropped on the floor.
5803  * Cancel all will return them to us.
5804  *
5805  * Return value:
5806  *      nothing
5807  **/
5808 static void ipr_erp_cancel_all(struct ipr_cmnd *ipr_cmd)
5809 {
5810         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
5811         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
5812         struct ipr_cmd_pkt *cmd_pkt;
5813 
5814         res->in_erp = 1;
5815 
5816         ipr_reinit_ipr_cmnd_for_erp(ipr_cmd);
5817 
5818         if (!scsi_get_tag_type(scsi_cmd->device)) {
5819                 ipr_erp_request_sense(ipr_cmd);
5820                 return;
5821         }
5822 
5823         cmd_pkt = &ipr_cmd->ioarcb.cmd_pkt;
5824         cmd_pkt->request_type = IPR_RQTYPE_IOACMD;
5825         cmd_pkt->cdb[0] = IPR_CANCEL_ALL_REQUESTS;
5826 
5827         ipr_do_req(ipr_cmd, ipr_erp_request_sense, ipr_timeout,
5828                    IPR_CANCEL_ALL_TIMEOUT);
5829 }
5830 
5831 /**
5832  * ipr_dump_ioasa - Dump contents of IOASA
5833  * @ioa_cfg:    ioa config struct
5834  * @ipr_cmd:    ipr command struct
5835  * @res:                resource entry struct
5836  *
5837  * This function is invoked by the interrupt handler when ops
5838  * fail. It will log the IOASA if appropriate. Only called
5839  * for GPDD ops.
5840  *
5841  * Return value:
5842  *      none
5843  **/
5844 static void ipr_dump_ioasa(struct ipr_ioa_cfg *ioa_cfg,
5845                            struct ipr_cmnd *ipr_cmd, struct ipr_resource_entry *res)
5846 {
5847         int i;
5848         u16 data_len;
5849         u32 ioasc, fd_ioasc;
5850         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
5851         __be32 *ioasa_data = (__be32 *)ioasa;
5852         int error_index;
5853 
5854         ioasc = be32_to_cpu(ioasa->hdr.ioasc) & IPR_IOASC_IOASC_MASK;
5855         fd_ioasc = be32_to_cpu(ioasa->hdr.fd_ioasc) & IPR_IOASC_IOASC_MASK;
5856 
5857         if (0 == ioasc)
5858                 return;
5859 
5860         if (ioa_cfg->log_level < IPR_DEFAULT_LOG_LEVEL)
5861                 return;
5862 
5863         if (ioasc == IPR_IOASC_BUS_WAS_RESET && fd_ioasc)
5864                 error_index = ipr_get_error(fd_ioasc);
5865         else
5866                 error_index = ipr_get_error(ioasc);
5867 
5868         if (ioa_cfg->log_level < IPR_MAX_LOG_LEVEL) {
5869                 /* Don't log an error if the IOA already logged one */
5870                 if (ioasa->hdr.ilid != 0)
5871                         return;
5872 
5873                 if (!ipr_is_gscsi(res))
5874                         return;
5875 
5876                 if (ipr_error_table[error_index].log_ioasa == 0)
5877                         return;
5878         }
5879 
5880         ipr_res_err(ioa_cfg, res, "%s\n", ipr_error_table[error_index].error);
5881 
5882         data_len = be16_to_cpu(ioasa->hdr.ret_stat_len);
5883         if (ioa_cfg->sis64 && sizeof(struct ipr_ioasa64) < data_len)
5884                 data_len = sizeof(struct ipr_ioasa64);
5885         else if (!ioa_cfg->sis64 && sizeof(struct ipr_ioasa) < data_len)
5886                 data_len = sizeof(struct ipr_ioasa);
5887 
5888         ipr_err("IOASA Dump:\n");
5889 
5890         for (i = 0; i < data_len / 4; i += 4) {
5891                 ipr_err("%08X: %08X %08X %08X %08X\n", i*4,
5892                         be32_to_cpu(ioasa_data[i]),
5893                         be32_to_cpu(ioasa_data[i+1]),
5894                         be32_to_cpu(ioasa_data[i+2]),
5895                         be32_to_cpu(ioasa_data[i+3]));
5896         }
5897 }
5898 
5899 /**
5900  * ipr_gen_sense - Generate SCSI sense data from an IOASA
5901  * @ioasa:              IOASA
5902  * @sense_buf:  sense data buffer
5903  *
5904  * Return value:
5905  *      none
5906  **/
5907 static void ipr_gen_sense(struct ipr_cmnd *ipr_cmd)
5908 {
5909         u32 failing_lba;
5910         u8 *sense_buf = ipr_cmd->scsi_cmd->sense_buffer;
5911         struct ipr_resource_entry *res = ipr_cmd->scsi_cmd->device->hostdata;
5912         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
5913         u32 ioasc = be32_to_cpu(ioasa->hdr.ioasc);
5914 
5915         memset(sense_buf, 0, SCSI_SENSE_BUFFERSIZE);
5916 
5917         if (ioasc >= IPR_FIRST_DRIVER_IOASC)
5918                 return;
5919 
5920         ipr_cmd->scsi_cmd->result = SAM_STAT_CHECK_CONDITION;
5921 
5922         if (ipr_is_vset_device(res) &&
5923             ioasc == IPR_IOASC_MED_DO_NOT_REALLOC &&
5924             ioasa->u.vset.failing_lba_hi != 0) {
5925                 sense_buf[0] = 0x72;
5926                 sense_buf[1] = IPR_IOASC_SENSE_KEY(ioasc);
5927                 sense_buf[2] = IPR_IOASC_SENSE_CODE(ioasc);
5928                 sense_buf[3] = IPR_IOASC_SENSE_QUAL(ioasc);
5929 
5930                 sense_buf[7] = 12;
5931                 sense_buf[8] = 0;
5932                 sense_buf[9] = 0x0A;
5933                 sense_buf[10] = 0x80;
5934 
5935                 failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_hi);
5936 
5937                 sense_buf[12] = (failing_lba & 0xff000000) >> 24;
5938                 sense_buf[13] = (failing_lba & 0x00ff0000) >> 16;
5939                 sense_buf[14] = (failing_lba & 0x0000ff00) >> 8;
5940                 sense_buf[15] = failing_lba & 0x000000ff;
5941 
5942                 failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_lo);
5943 
5944                 sense_buf[16] = (failing_lba & 0xff000000) >> 24;
5945                 sense_buf[17] = (failing_lba & 0x00ff0000) >> 16;
5946                 sense_buf[18] = (failing_lba & 0x0000ff00) >> 8;
5947                 sense_buf[19] = failing_lba & 0x000000ff;
5948         } else {
5949                 sense_buf[0] = 0x70;
5950                 sense_buf[2] = IPR_IOASC_SENSE_KEY(ioasc);
5951                 sense_buf[12] = IPR_IOASC_SENSE_CODE(ioasc);
5952                 sense_buf[13] = IPR_IOASC_SENSE_QUAL(ioasc);
5953 
5954                 /* Illegal request */
5955                 if ((IPR_IOASC_SENSE_KEY(ioasc) == 0x05) &&
5956                     (be32_to_cpu(ioasa->hdr.ioasc_specific) & IPR_FIELD_POINTER_VALID)) {
5957                         sense_buf[7] = 10;      /* additional length */
5958 
5959                         /* IOARCB was in error */
5960                         if (IPR_IOASC_SENSE_CODE(ioasc) == 0x24)
5961                                 sense_buf[15] = 0xC0;
5962                         else    /* Parameter data was invalid */
5963                                 sense_buf[15] = 0x80;
5964 
5965                         sense_buf[16] =
5966                             ((IPR_FIELD_POINTER_MASK &
5967                               be32_to_cpu(ioasa->hdr.ioasc_specific)) >> 8) & 0xff;
5968                         sense_buf[17] =
5969                             (IPR_FIELD_POINTER_MASK &
5970                              be32_to_cpu(ioasa->hdr.ioasc_specific)) & 0xff;
5971                 } else {
5972                         if (ioasc == IPR_IOASC_MED_DO_NOT_REALLOC) {
5973                                 if (ipr_is_vset_device(res))
5974                                         failing_lba = be32_to_cpu(ioasa->u.vset.failing_lba_lo);
5975                                 else
5976                                         failing_lba = be32_to_cpu(ioasa->u.dasd.failing_lba);
5977 
5978                                 sense_buf[0] |= 0x80;   /* Or in the Valid bit */
5979                                 sense_buf[3] = (failing_lba & 0xff000000) >> 24;
5980                                 sense_buf[4] = (failing_lba & 0x00ff0000) >> 16;
5981                                 sense_buf[5] = (failing_lba & 0x0000ff00) >> 8;
5982                                 sense_buf[6] = failing_lba & 0x000000ff;
5983                         }
5984 
5985                         sense_buf[7] = 6;       /* additional length */
5986                 }
5987         }
5988 }
5989 
5990 /**
5991  * ipr_get_autosense - Copy autosense data to sense buffer
5992  * @ipr_cmd:    ipr command struct
5993  *
5994  * This function copies the autosense buffer to the buffer
5995  * in the scsi_cmd, if there is autosense available.
5996  *
5997  * Return value:
5998  *      1 if autosense was available / 0 if not
5999  **/
6000 static int ipr_get_autosense(struct ipr_cmnd *ipr_cmd)
6001 {
6002         struct ipr_ioasa *ioasa = &ipr_cmd->s.ioasa;
6003         struct ipr_ioasa64 *ioasa64 = &ipr_cmd->s.ioasa64;
6004 
6005         if ((be32_to_cpu(ioasa->hdr.ioasc_specific) & IPR_AUTOSENSE_VALID) == 0)
6006                 return 0;
6007 
6008         if (ipr_cmd->ioa_cfg->sis64)
6009                 memcpy(ipr_cmd->scsi_cmd->sense_buffer, ioasa64->auto_sense.data,
6010                        min_t(u16, be16_to_cpu(ioasa64->auto_sense.auto_sense_len),
6011                            SCSI_SENSE_BUFFERSIZE));
6012         else
6013                 memcpy(ipr_cmd->scsi_cmd->sense_buffer, ioasa->auto_sense.data,
6014                        min_t(u16, be16_to_cpu(ioasa->auto_sense.auto_sense_len),
6015                            SCSI_SENSE_BUFFERSIZE));
6016         return 1;
6017 }
6018 
6019 /**
6020  * ipr_erp_start - Process an error response for a SCSI op
6021  * @ioa_cfg:    ioa config struct
6022  * @ipr_cmd:    ipr command struct
6023  *
6024  * This function determines whether or not to initiate ERP
6025  * on the affected device.
6026  *
6027  * Return value:
6028  *      nothing
6029  **/
6030 static void ipr_erp_start(struct ipr_ioa_cfg *ioa_cfg,
6031                               struct ipr_cmnd *ipr_cmd)
6032 {
6033         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
6034         struct ipr_resource_entry *res = scsi_cmd->device->hostdata;
6035         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6036         u32 masked_ioasc = ioasc & IPR_IOASC_IOASC_MASK;
6037 
6038         if (!res) {
6039                 ipr_scsi_eh_done(ipr_cmd);
6040                 return;
6041         }
6042 
6043         if (!ipr_is_gscsi(res) && masked_ioasc != IPR_IOASC_HW_DEV_BUS_STATUS)
6044                 ipr_gen_sense(ipr_cmd);
6045 
6046         ipr_dump_ioasa(ioa_cfg, ipr_cmd, res);
6047 
6048         switch (masked_ioasc) {
6049         case IPR_IOASC_ABORTED_CMD_TERM_BY_HOST:
6050                 if (ipr_is_naca_model(res))
6051                         scsi_cmd->result |= (DID_ABORT << 16);
6052                 else
6053                         scsi_cmd->result |= (DID_IMM_RETRY << 16);
6054                 break;
6055         case IPR_IOASC_IR_RESOURCE_HANDLE:
6056         case IPR_IOASC_IR_NO_CMDS_TO_2ND_IOA:
6057                 scsi_cmd->result |= (DID_NO_CONNECT << 16);
6058                 break;
6059         case IPR_IOASC_HW_SEL_TIMEOUT:
6060                 scsi_cmd->result |= (DID_NO_CONNECT << 16);
6061                 if (!ipr_is_naca_model(res))
6062                         res->needs_sync_complete = 1;
6063                 break;
6064         case IPR_IOASC_SYNC_REQUIRED:
6065                 if (!res->in_erp)
6066                         res->needs_sync_complete = 1;
6067                 scsi_cmd->result |= (DID_IMM_RETRY << 16);
6068                 break;
6069         case IPR_IOASC_MED_DO_NOT_REALLOC: /* prevent retries */
6070         case IPR_IOASA_IR_DUAL_IOA_DISABLED:
6071                 scsi_cmd->result |= (DID_PASSTHROUGH << 16);
6072                 break;
6073         case IPR_IOASC_BUS_WAS_RESET:
6074         case IPR_IOASC_BUS_WAS_RESET_BY_OTHER:
6075                 /*
6076                  * Report the bus reset and ask for a retry. The device
6077                  * will give CC/UA the next command.
6078                  */
6079                 if (!res->resetting_device)
6080                         scsi_report_bus_reset(ioa_cfg->host, scsi_cmd->device->channel);
6081                 scsi_cmd->result |= (DID_ERROR << 16);
6082                 if (!ipr_is_naca_model(res))
6083                         res->needs_sync_complete = 1;
6084                 break;
6085         case IPR_IOASC_HW_DEV_BUS_STATUS:
6086                 scsi_cmd->result |= IPR_IOASC_SENSE_STATUS(ioasc);
6087                 if (IPR_IOASC_SENSE_STATUS(ioasc) == SAM_STAT_CHECK_CONDITION) {
6088                         if (!ipr_get_autosense(ipr_cmd)) {
6089                                 if (!ipr_is_naca_model(res)) {
6090                                         ipr_erp_cancel_all(ipr_cmd);
6091                                         return;
6092                                 }
6093                         }
6094                 }
6095                 if (!ipr_is_naca_model(res))
6096                         res->needs_sync_complete = 1;
6097                 break;
6098         case IPR_IOASC_NR_INIT_CMD_REQUIRED:
6099                 break;
6100         default:
6101                 if (IPR_IOASC_SENSE_KEY(ioasc) > RECOVERED_ERROR)
6102                         scsi_cmd->result |= (DID_ERROR << 16);
6103                 if (!ipr_is_vset_device(res) && !ipr_is_naca_model(res))
6104                         res->needs_sync_complete = 1;
6105                 break;
6106         }
6107 
6108         scsi_dma_unmap(ipr_cmd->scsi_cmd);
6109         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6110         scsi_cmd->scsi_done(scsi_cmd);
6111 }
6112 
6113 /**
6114  * ipr_scsi_done - mid-layer done function
6115  * @ipr_cmd:    ipr command struct
6116  *
6117  * This function is invoked by the interrupt handler for
6118  * ops generated by the SCSI mid-layer
6119  *
6120  * Return value:
6121  *      none
6122  **/
6123 static void ipr_scsi_done(struct ipr_cmnd *ipr_cmd)
6124 {
6125         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6126         struct scsi_cmnd *scsi_cmd = ipr_cmd->scsi_cmd;
6127         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6128         unsigned long hrrq_flags;
6129 
6130         scsi_set_resid(scsi_cmd, be32_to_cpu(ipr_cmd->s.ioasa.hdr.residual_data_len));
6131 
6132         if (likely(IPR_IOASC_SENSE_KEY(ioasc) == 0)) {
6133                 scsi_dma_unmap(scsi_cmd);
6134 
6135                 spin_lock_irqsave(ipr_cmd->hrrq->lock, hrrq_flags);
6136                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6137                 scsi_cmd->scsi_done(scsi_cmd);
6138                 spin_unlock_irqrestore(ipr_cmd->hrrq->lock, hrrq_flags);
6139         } else {
6140                 spin_lock_irqsave(ipr_cmd->hrrq->lock, hrrq_flags);
6141                 ipr_erp_start(ioa_cfg, ipr_cmd);
6142                 spin_unlock_irqrestore(ipr_cmd->hrrq->lock, hrrq_flags);
6143         }
6144 }
6145 
6146 /**
6147  * ipr_queuecommand - Queue a mid-layer request
6148  * @shost:              scsi host struct
6149  * @scsi_cmd:   scsi command struct
6150  *
6151  * This function queues a request generated by the mid-layer.
6152  *
6153  * Return value:
6154  *      0 on success
6155  *      SCSI_MLQUEUE_DEVICE_BUSY if device is busy
6156  *      SCSI_MLQUEUE_HOST_BUSY if host is busy
6157  **/
6158 static int ipr_queuecommand(struct Scsi_Host *shost,
6159                             struct scsi_cmnd *scsi_cmd)
6160 {
6161         struct ipr_ioa_cfg *ioa_cfg;
6162         struct ipr_resource_entry *res;
6163         struct ipr_ioarcb *ioarcb;
6164         struct ipr_cmnd *ipr_cmd;
6165         unsigned long hrrq_flags, lock_flags;
6166         int rc;
6167         struct ipr_hrr_queue *hrrq;
6168         int hrrq_id;
6169 
6170         ioa_cfg = (struct ipr_ioa_cfg *)shost->hostdata;
6171 
6172         scsi_cmd->result = (DID_OK << 16);
6173         res = scsi_cmd->device->hostdata;
6174 
6175         if (ipr_is_gata(res) && res->sata_port) {
6176                 spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
6177                 rc = ata_sas_queuecmd(scsi_cmd, res->sata_port->ap);
6178                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
6179                 return rc;
6180         }
6181 
6182         hrrq_id = ipr_get_hrrq_index(ioa_cfg);
6183         hrrq = &ioa_cfg->hrrq[hrrq_id];
6184 
6185         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6186         /*
6187          * We are currently blocking all devices due to a host reset
6188          * We have told the host to stop giving us new requests, but
6189          * ERP ops don't count. FIXME
6190          */
6191         if (unlikely(!hrrq->allow_cmds && !hrrq->ioa_is_dead && !hrrq->removing_ioa)) {
6192                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6193                 return SCSI_MLQUEUE_HOST_BUSY;
6194         }
6195 
6196         /*
6197          * FIXME - Create scsi_set_host_offline interface
6198          *  and the ioa_is_dead check can be removed
6199          */
6200         if (unlikely(hrrq->ioa_is_dead || hrrq->removing_ioa || !res)) {
6201                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6202                 goto err_nodev;
6203         }
6204 
6205         ipr_cmd = __ipr_get_free_ipr_cmnd(hrrq);
6206         if (ipr_cmd == NULL) {
6207                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6208                 return SCSI_MLQUEUE_HOST_BUSY;
6209         }
6210         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6211 
6212         ipr_init_ipr_cmnd(ipr_cmd, ipr_scsi_done);
6213         ioarcb = &ipr_cmd->ioarcb;
6214 
6215         memcpy(ioarcb->cmd_pkt.cdb, scsi_cmd->cmnd, scsi_cmd->cmd_len);
6216         ipr_cmd->scsi_cmd = scsi_cmd;
6217         ipr_cmd->done = ipr_scsi_eh_done;
6218 
6219         if (ipr_is_gscsi(res) || ipr_is_vset_device(res)) {
6220                 if (scsi_cmd->underflow == 0)
6221                         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6222 
6223                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_LINK_DESC;
6224                 if (ipr_is_gscsi(res) && res->reset_occurred) {
6225                         res->reset_occurred = 0;
6226                         ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_DELAY_AFTER_RST;
6227                 }
6228                 ioarcb->cmd_pkt.flags_lo |= IPR_FLAGS_LO_ALIGNED_BFR;
6229                 ioarcb->cmd_pkt.flags_lo |= ipr_get_task_attributes(scsi_cmd);
6230         }
6231 
6232         if (scsi_cmd->cmnd[0] >= 0xC0 &&
6233             (!ipr_is_gscsi(res) || scsi_cmd->cmnd[0] == IPR_QUERY_RSRC_STATE)) {
6234                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
6235         }
6236 
6237         if (ioa_cfg->sis64)
6238                 rc = ipr_build_ioadl64(ioa_cfg, ipr_cmd);
6239         else
6240                 rc = ipr_build_ioadl(ioa_cfg, ipr_cmd);
6241 
6242         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6243         if (unlikely(rc || (!hrrq->allow_cmds && !hrrq->ioa_is_dead))) {
6244                 list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_free_q);
6245                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6246                 if (!rc)
6247                         scsi_dma_unmap(scsi_cmd);
6248                 return SCSI_MLQUEUE_HOST_BUSY;
6249         }
6250 
6251         if (unlikely(hrrq->ioa_is_dead)) {
6252                 list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_free_q);
6253                 spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6254                 scsi_dma_unmap(scsi_cmd);
6255                 goto err_nodev;
6256         }
6257 
6258         ioarcb->res_handle = res->res_handle;
6259         if (res->needs_sync_complete) {
6260                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_SYNC_COMPLETE;
6261                 res->needs_sync_complete = 0;
6262         }
6263         list_add_tail(&ipr_cmd->queue, &hrrq->hrrq_pending_q);
6264         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_GET_RES_PHYS_LOC(res));
6265         ipr_send_command(ipr_cmd);
6266         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6267         return 0;
6268 
6269 err_nodev:
6270         spin_lock_irqsave(hrrq->lock, hrrq_flags);
6271         memset(scsi_cmd->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
6272         scsi_cmd->result = (DID_NO_CONNECT << 16);
6273         scsi_cmd->scsi_done(scsi_cmd);
6274         spin_unlock_irqrestore(hrrq->lock, hrrq_flags);
6275         return 0;
6276 }
6277 
6278 /**
6279  * ipr_ioctl - IOCTL handler
6280  * @sdev:       scsi device struct
6281  * @cmd:        IOCTL cmd
6282  * @arg:        IOCTL arg
6283  *
6284  * Return value:
6285  *      0 on success / other on failure
6286  **/
6287 static int ipr_ioctl(struct scsi_device *sdev, int cmd, void __user *arg)
6288 {
6289         struct ipr_resource_entry *res;
6290 
6291         res = (struct ipr_resource_entry *)sdev->hostdata;
6292         if (res && ipr_is_gata(res)) {
6293                 if (cmd == HDIO_GET_IDENTITY)
6294                         return -ENOTTY;
6295                 return ata_sas_scsi_ioctl(res->sata_port->ap, sdev, cmd, arg);
6296         }
6297 
6298         return -EINVAL;
6299 }
6300 
6301 /**
6302  * ipr_info - Get information about the card/driver
6303  * @scsi_host:  scsi host struct
6304  *
6305  * Return value:
6306  *      pointer to buffer with description string
6307  **/
6308 static const char *ipr_ioa_info(struct Scsi_Host *host)
6309 {
6310         static char buffer[512];
6311         struct ipr_ioa_cfg *ioa_cfg;
6312         unsigned long lock_flags = 0;
6313 
6314         ioa_cfg = (struct ipr_ioa_cfg *) host->hostdata;
6315 
6316         spin_lock_irqsave(host->host_lock, lock_flags);
6317         sprintf(buffer, "IBM %X Storage Adapter", ioa_cfg->type);
6318         spin_unlock_irqrestore(host->host_lock, lock_flags);
6319 
6320         return buffer;
6321 }
6322 
6323 static struct scsi_host_template driver_template = {
6324         .module = THIS_MODULE,
6325         .name = "IPR",
6326         .info = ipr_ioa_info,
6327         .ioctl = ipr_ioctl,
6328         .queuecommand = ipr_queuecommand,
6329         .eh_abort_handler = ipr_eh_abort,
6330         .eh_device_reset_handler = ipr_eh_dev_reset,
6331         .eh_host_reset_handler = ipr_eh_host_reset,
6332         .slave_alloc = ipr_slave_alloc,
6333         .slave_configure = ipr_slave_configure,
6334         .slave_destroy = ipr_slave_destroy,
6335         .target_alloc = ipr_target_alloc,
6336         .target_destroy = ipr_target_destroy,
6337         .change_queue_depth = ipr_change_queue_depth,
6338         .change_queue_type = ipr_change_queue_type,
6339         .bios_param = ipr_biosparam,
6340         .can_queue = IPR_MAX_COMMANDS,
6341         .this_id = -1,
6342         .sg_tablesize = IPR_MAX_SGLIST,
6343         .max_sectors = IPR_IOA_MAX_SECTORS,
6344         .cmd_per_lun = IPR_MAX_CMD_PER_LUN,
6345         .use_clustering = ENABLE_CLUSTERING,
6346         .shost_attrs = ipr_ioa_attrs,
6347         .sdev_attrs = ipr_dev_attrs,
6348         .proc_name = IPR_NAME,
6349         .no_write_same = 1,
6350 };
6351 
6352 /**
6353  * ipr_ata_phy_reset - libata phy_reset handler
6354  * @ap:         ata port to reset
6355  *
6356  **/
6357 static void ipr_ata_phy_reset(struct ata_port *ap)
6358 {
6359         unsigned long flags;
6360         struct ipr_sata_port *sata_port = ap->private_data;
6361         struct ipr_resource_entry *res = sata_port->res;
6362         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6363         int rc;
6364 
6365         ENTER;
6366         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6367         while (ioa_cfg->in_reset_reload) {
6368                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6369                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
6370                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6371         }
6372 
6373         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds)
6374                 goto out_unlock;
6375 
6376         rc = ipr_device_reset(ioa_cfg, res);
6377 
6378         if (rc) {
6379                 ap->link.device[0].class = ATA_DEV_NONE;
6380                 goto out_unlock;
6381         }
6382 
6383         ap->link.device[0].class = res->ata_class;
6384         if (ap->link.device[0].class == ATA_DEV_UNKNOWN)
6385                 ap->link.device[0].class = ATA_DEV_NONE;
6386 
6387 out_unlock:
6388         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6389         LEAVE;
6390 }
6391 
6392 /**
6393  * ipr_ata_post_internal - Cleanup after an internal command
6394  * @qc: ATA queued command
6395  *
6396  * Return value:
6397  *      none
6398  **/
6399 static void ipr_ata_post_internal(struct ata_queued_cmd *qc)
6400 {
6401         struct ipr_sata_port *sata_port = qc->ap->private_data;
6402         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6403         struct ipr_cmnd *ipr_cmd;
6404         struct ipr_hrr_queue *hrrq;
6405         unsigned long flags;
6406 
6407         spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6408         while (ioa_cfg->in_reset_reload) {
6409                 spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6410                 wait_event(ioa_cfg->reset_wait_q, !ioa_cfg->in_reset_reload);
6411                 spin_lock_irqsave(ioa_cfg->host->host_lock, flags);
6412         }
6413 
6414         for_each_hrrq(hrrq, ioa_cfg) {
6415                 spin_lock(&hrrq->_lock);
6416                 list_for_each_entry(ipr_cmd, &hrrq->hrrq_pending_q, queue) {
6417                         if (ipr_cmd->qc == qc) {
6418                                 ipr_device_reset(ioa_cfg, sata_port->res);
6419                                 break;
6420                         }
6421                 }
6422                 spin_unlock(&hrrq->_lock);
6423         }
6424         spin_unlock_irqrestore(ioa_cfg->host->host_lock, flags);
6425 }
6426 
6427 /**
6428  * ipr_copy_sata_tf - Copy a SATA taskfile to an IOA data structure
6429  * @regs:       destination
6430  * @tf: source ATA taskfile
6431  *
6432  * Return value:
6433  *      none
6434  **/
6435 static void ipr_copy_sata_tf(struct ipr_ioarcb_ata_regs *regs,
6436                              struct ata_taskfile *tf)
6437 {
6438         regs->feature = tf->feature;
6439         regs->nsect = tf->nsect;
6440         regs->lbal = tf->lbal;
6441         regs->lbam = tf->lbam;
6442         regs->lbah = tf->lbah;
6443         regs->device = tf->device;
6444         regs->command = tf->command;
6445         regs->hob_feature = tf->hob_feature;
6446         regs->hob_nsect = tf->hob_nsect;
6447         regs->hob_lbal = tf->hob_lbal;
6448         regs->hob_lbam = tf->hob_lbam;
6449         regs->hob_lbah = tf->hob_lbah;
6450         regs->ctl = tf->ctl;
6451 }
6452 
6453 /**
6454  * ipr_sata_done - done function for SATA commands
6455  * @ipr_cmd:    ipr command struct
6456  *
6457  * This function is invoked by the interrupt handler for
6458  * ops generated by the SCSI mid-layer to SATA devices
6459  *
6460  * Return value:
6461  *      none
6462  **/
6463 static void ipr_sata_done(struct ipr_cmnd *ipr_cmd)
6464 {
6465         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6466         struct ata_queued_cmd *qc = ipr_cmd->qc;
6467         struct ipr_sata_port *sata_port = qc->ap->private_data;
6468         struct ipr_resource_entry *res = sata_port->res;
6469         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
6470 
6471         spin_lock(&ipr_cmd->hrrq->_lock);
6472         if (ipr_cmd->ioa_cfg->sis64)
6473                 memcpy(&sata_port->ioasa, &ipr_cmd->s.ioasa64.u.gata,
6474                        sizeof(struct ipr_ioasa_gata));
6475         else
6476                 memcpy(&sata_port->ioasa, &ipr_cmd->s.ioasa.u.gata,
6477                        sizeof(struct ipr_ioasa_gata));
6478         ipr_dump_ioasa(ioa_cfg, ipr_cmd, res);
6479 
6480         if (be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc_specific) & IPR_ATA_DEVICE_WAS_RESET)
6481                 scsi_report_device_reset(ioa_cfg->host, res->bus, res->target);
6482 
6483         if (IPR_IOASC_SENSE_KEY(ioasc) > RECOVERED_ERROR)
6484                 qc->err_mask |= __ac_err_mask(sata_port->ioasa.status);
6485         else
6486                 qc->err_mask |= ac_err_mask(sata_port->ioasa.status);
6487         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6488         spin_unlock(&ipr_cmd->hrrq->_lock);
6489         ata_qc_complete(qc);
6490 }
6491 
6492 /**
6493  * ipr_build_ata_ioadl64 - Build an ATA scatter/gather list
6494  * @ipr_cmd:    ipr command struct
6495  * @qc:         ATA queued command
6496  *
6497  **/
6498 static void ipr_build_ata_ioadl64(struct ipr_cmnd *ipr_cmd,
6499                                   struct ata_queued_cmd *qc)
6500 {
6501         u32 ioadl_flags = 0;
6502         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
6503         struct ipr_ioadl64_desc *ioadl64 = ipr_cmd->i.ata_ioadl.ioadl64;
6504         struct ipr_ioadl64_desc *last_ioadl64 = NULL;
6505         int len = qc->nbytes;
6506         struct scatterlist *sg;
6507         unsigned int si;
6508         dma_addr_t dma_addr = ipr_cmd->dma_addr;
6509 
6510         if (len == 0)
6511                 return;
6512 
6513         if (qc->dma_dir == DMA_TO_DEVICE) {
6514                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
6515                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
6516         } else if (qc->dma_dir == DMA_FROM_DEVICE)
6517                 ioadl_flags = IPR_IOADL_FLAGS_READ;
6518 
6519         ioarcb->data_transfer_length = cpu_to_be32(len);
6520         ioarcb->ioadl_len =
6521                 cpu_to_be32(sizeof(struct ipr_ioadl64_desc) * ipr_cmd->dma_use_sg);
6522         ioarcb->u.sis64_addr_data.data_ioadl_addr =
6523                 cpu_to_be64(dma_addr + offsetof(struct ipr_cmnd, i.ata_ioadl.ioadl64));
6524 
6525         for_each_sg(qc->sg, sg, qc->n_elem, si) {
6526                 ioadl64->flags = cpu_to_be32(ioadl_flags);
6527                 ioadl64->data_len = cpu_to_be32(sg_dma_len(sg));
6528                 ioadl64->address = cpu_to_be64(sg_dma_address(sg));
6529 
6530                 last_ioadl64 = ioadl64;
6531                 ioadl64++;
6532         }
6533 
6534         if (likely(last_ioadl64))
6535                 last_ioadl64->flags |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
6536 }
6537 
6538 /**
6539  * ipr_build_ata_ioadl - Build an ATA scatter/gather list
6540  * @ipr_cmd:    ipr command struct
6541  * @qc:         ATA queued command
6542  *
6543  **/
6544 static void ipr_build_ata_ioadl(struct ipr_cmnd *ipr_cmd,
6545                                 struct ata_queued_cmd *qc)
6546 {
6547         u32 ioadl_flags = 0;
6548         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
6549         struct ipr_ioadl_desc *ioadl = ipr_cmd->i.ioadl;
6550         struct ipr_ioadl_desc *last_ioadl = NULL;
6551         int len = qc->nbytes;
6552         struct scatterlist *sg;
6553         unsigned int si;
6554 
6555         if (len == 0)
6556                 return;
6557 
6558         if (qc->dma_dir == DMA_TO_DEVICE) {
6559                 ioadl_flags = IPR_IOADL_FLAGS_WRITE;
6560                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
6561                 ioarcb->data_transfer_length = cpu_to_be32(len);
6562                 ioarcb->ioadl_len =
6563                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
6564         } else if (qc->dma_dir == DMA_FROM_DEVICE) {
6565                 ioadl_flags = IPR_IOADL_FLAGS_READ;
6566                 ioarcb->read_data_transfer_length = cpu_to_be32(len);
6567                 ioarcb->read_ioadl_len =
6568                         cpu_to_be32(sizeof(struct ipr_ioadl_desc) * ipr_cmd->dma_use_sg);
6569         }
6570 
6571         for_each_sg(qc->sg, sg, qc->n_elem, si) {
6572                 ioadl->flags_and_data_len = cpu_to_be32(ioadl_flags | sg_dma_len(sg));
6573                 ioadl->address = cpu_to_be32(sg_dma_address(sg));
6574 
6575                 last_ioadl = ioadl;
6576                 ioadl++;
6577         }
6578 
6579         if (likely(last_ioadl))
6580                 last_ioadl->flags_and_data_len |= cpu_to_be32(IPR_IOADL_FLAGS_LAST);
6581 }
6582 
6583 /**
6584  * ipr_qc_defer - Get a free ipr_cmd
6585  * @qc: queued command
6586  *
6587  * Return value:
6588  *      0 if success
6589  **/
6590 static int ipr_qc_defer(struct ata_queued_cmd *qc)
6591 {
6592         struct ata_port *ap = qc->ap;
6593         struct ipr_sata_port *sata_port = ap->private_data;
6594         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6595         struct ipr_cmnd *ipr_cmd;
6596         struct ipr_hrr_queue *hrrq;
6597         int hrrq_id;
6598 
6599         hrrq_id = ipr_get_hrrq_index(ioa_cfg);
6600         hrrq = &ioa_cfg->hrrq[hrrq_id];
6601 
6602         qc->lldd_task = NULL;
6603         spin_lock(&hrrq->_lock);
6604         if (unlikely(hrrq->ioa_is_dead)) {
6605                 spin_unlock(&hrrq->_lock);
6606                 return 0;
6607         }
6608 
6609         if (unlikely(!hrrq->allow_cmds)) {
6610                 spin_unlock(&hrrq->_lock);
6611                 return ATA_DEFER_LINK;
6612         }
6613 
6614         ipr_cmd = __ipr_get_free_ipr_cmnd(hrrq);
6615         if (ipr_cmd == NULL) {
6616                 spin_unlock(&hrrq->_lock);
6617                 return ATA_DEFER_LINK;
6618         }
6619 
6620         qc->lldd_task = ipr_cmd;
6621         spin_unlock(&hrrq->_lock);
6622         return 0;
6623 }
6624 
6625 /**
6626  * ipr_qc_issue - Issue a SATA qc to a device
6627  * @qc: queued command
6628  *
6629  * Return value:
6630  *      0 if success
6631  **/
6632 static unsigned int ipr_qc_issue(struct ata_queued_cmd *qc)
6633 {
6634         struct ata_port *ap = qc->ap;
6635         struct ipr_sata_port *sata_port = ap->private_data;
6636         struct ipr_resource_entry *res = sata_port->res;
6637         struct ipr_ioa_cfg *ioa_cfg = sata_port->ioa_cfg;
6638         struct ipr_cmnd *ipr_cmd;
6639         struct ipr_ioarcb *ioarcb;
6640         struct ipr_ioarcb_ata_regs *regs;
6641 
6642         if (qc->lldd_task == NULL)
6643                 ipr_qc_defer(qc);
6644 
6645         ipr_cmd = qc->lldd_task;
6646         if (ipr_cmd == NULL)
6647                 return AC_ERR_SYSTEM;
6648 
6649         qc->lldd_task = NULL;
6650         spin_lock(&ipr_cmd->hrrq->_lock);
6651         if (unlikely(!ipr_cmd->hrrq->allow_cmds ||
6652                         ipr_cmd->hrrq->ioa_is_dead)) {
6653                 list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6654                 spin_unlock(&ipr_cmd->hrrq->_lock);
6655                 return AC_ERR_SYSTEM;
6656         }
6657 
6658         ipr_init_ipr_cmnd(ipr_cmd, ipr_lock_and_done);
6659         ioarcb = &ipr_cmd->ioarcb;
6660 
6661         if (ioa_cfg->sis64) {
6662                 regs = &ipr_cmd->i.ata_ioadl.regs;
6663                 ioarcb->add_cmd_parms_offset = cpu_to_be16(sizeof(*ioarcb));
6664         } else
6665                 regs = &ioarcb->u.add_data.u.regs;
6666 
6667         memset(regs, 0, sizeof(*regs));
6668         ioarcb->add_cmd_parms_len = cpu_to_be16(sizeof(*regs));
6669 
6670         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
6671         ipr_cmd->qc = qc;
6672         ipr_cmd->done = ipr_sata_done;
6673         ipr_cmd->ioarcb.res_handle = res->res_handle;
6674         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_ATA_PASSTHRU;
6675         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_LINK_DESC;
6676         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_NO_ULEN_CHK;
6677         ipr_cmd->dma_use_sg = qc->n_elem;
6678 
6679         if (ioa_cfg->sis64)
6680                 ipr_build_ata_ioadl64(ipr_cmd, qc);
6681         else
6682                 ipr_build_ata_ioadl(ipr_cmd, qc);
6683 
6684         regs->flags |= IPR_ATA_FLAG_STATUS_ON_GOOD_COMPLETION;
6685         ipr_copy_sata_tf(regs, &qc->tf);
6686         memcpy(ioarcb->cmd_pkt.cdb, qc->cdb, IPR_MAX_CDB_LEN);
6687         ipr_trc_hook(ipr_cmd, IPR_TRACE_START, IPR_GET_RES_PHYS_LOC(res));
6688 
6689         switch (qc->tf.protocol) {
6690         case ATA_PROT_NODATA:
6691         case ATA_PROT_PIO:
6692                 break;
6693 
6694         case ATA_PROT_DMA:
6695                 regs->flags |= IPR_ATA_FLAG_XFER_TYPE_DMA;
6696                 break;
6697 
6698         case ATAPI_PROT_PIO:
6699         case ATAPI_PROT_NODATA:
6700                 regs->flags |= IPR_ATA_FLAG_PACKET_CMD;
6701                 break;
6702 
6703         case ATAPI_PROT_DMA:
6704                 regs->flags |= IPR_ATA_FLAG_PACKET_CMD;
6705                 regs->flags |= IPR_ATA_FLAG_XFER_TYPE_DMA;
6706                 break;
6707 
6708         default:
6709                 WARN_ON(1);
6710                 spin_unlock(&ipr_cmd->hrrq->_lock);
6711                 return AC_ERR_INVALID;
6712         }
6713 
6714         ipr_send_command(ipr_cmd);
6715         spin_unlock(&ipr_cmd->hrrq->_lock);
6716 
6717         return 0;
6718 }
6719 
6720 /**
6721  * ipr_qc_fill_rtf - Read result TF
6722  * @qc: ATA queued command
6723  *
6724  * Return value:
6725  *      true
6726  **/
6727 static bool ipr_qc_fill_rtf(struct ata_queued_cmd *qc)
6728 {
6729         struct ipr_sata_port *sata_port = qc->ap->private_data;
6730         struct ipr_ioasa_gata *g = &sata_port->ioasa;
6731         struct ata_taskfile *tf = &qc->result_tf;
6732 
6733         tf->feature = g->error;
6734         tf->nsect = g->nsect;
6735         tf->lbal = g->lbal;
6736         tf->lbam = g->lbam;
6737         tf->lbah = g->lbah;
6738         tf->device = g->device;
6739         tf->command = g->status;
6740         tf->hob_nsect = g->hob_nsect;
6741         tf->hob_lbal = g->hob_lbal;
6742         tf->hob_lbam = g->hob_lbam;
6743         tf->hob_lbah = g->hob_lbah;
6744 
6745         return true;
6746 }
6747 
6748 static struct ata_port_operations ipr_sata_ops = {
6749         .phy_reset = ipr_ata_phy_reset,
6750         .hardreset = ipr_sata_reset,
6751         .post_internal_cmd = ipr_ata_post_internal,
6752         .qc_prep = ata_noop_qc_prep,
6753         .qc_defer = ipr_qc_defer,
6754         .qc_issue = ipr_qc_issue,
6755         .qc_fill_rtf = ipr_qc_fill_rtf,
6756         .port_start = ata_sas_port_start,
6757         .port_stop = ata_sas_port_stop
6758 };
6759 
6760 static struct ata_port_info sata_port_info = {
6761         .flags          = ATA_FLAG_SATA | ATA_FLAG_PIO_DMA,
6762         .pio_mask       = ATA_PIO4_ONLY,
6763         .mwdma_mask     = ATA_MWDMA2,
6764         .udma_mask      = ATA_UDMA6,
6765         .port_ops       = &ipr_sata_ops
6766 };
6767 
6768 #ifdef CONFIG_PPC_PSERIES
6769 static const u16 ipr_blocked_processors[] = {
6770         PVR_NORTHSTAR,
6771         PVR_PULSAR,
6772         PVR_POWER4,
6773         PVR_ICESTAR,
6774         PVR_SSTAR,
6775         PVR_POWER4p,
6776         PVR_630,
6777         PVR_630p
6778 };
6779 
6780 /**
6781  * ipr_invalid_adapter - Determine if this adapter is supported on this hardware
6782  * @ioa_cfg:    ioa cfg struct
6783  *
6784  * Adapters that use Gemstone revision < 3.1 do not work reliably on
6785  * certain pSeries hardware. This function determines if the given
6786  * adapter is in one of these confgurations or not.
6787  *
6788  * Return value:
6789  *      1 if adapter is not supported / 0 if adapter is supported
6790  **/
6791 static int ipr_invalid_adapter(struct ipr_ioa_cfg *ioa_cfg)
6792 {
6793         int i;
6794 
6795         if ((ioa_cfg->type == 0x5702) && (ioa_cfg->pdev->revision < 4)) {
6796                 for (i = 0; i < ARRAY_SIZE(ipr_blocked_processors); i++) {
6797                         if (pvr_version_is(ipr_blocked_processors[i]))
6798                                 return 1;
6799                 }
6800         }
6801         return 0;
6802 }
6803 #else
6804 #define ipr_invalid_adapter(ioa_cfg) 0
6805 #endif
6806 
6807 /**
6808  * ipr_ioa_bringdown_done - IOA bring down completion.
6809  * @ipr_cmd:    ipr command struct
6810  *
6811  * This function processes the completion of an adapter bring down.
6812  * It wakes any reset sleepers.
6813  *
6814  * Return value:
6815  *      IPR_RC_JOB_RETURN
6816  **/
6817 static int ipr_ioa_bringdown_done(struct ipr_cmnd *ipr_cmd)
6818 {
6819         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6820         int i;
6821 
6822         ENTER;
6823         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].removing_ioa) {
6824                 ipr_trace;
6825                 spin_unlock_irq(ioa_cfg->host->host_lock);
6826                 scsi_unblock_requests(ioa_cfg->host);
6827                 spin_lock_irq(ioa_cfg->host->host_lock);
6828         }
6829 
6830         ioa_cfg->in_reset_reload = 0;
6831         ioa_cfg->reset_retries = 0;
6832         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
6833                 spin_lock(&ioa_cfg->hrrq[i]._lock);
6834                 ioa_cfg->hrrq[i].ioa_is_dead = 1;
6835                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
6836         }
6837         wmb();
6838 
6839         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6840         wake_up_all(&ioa_cfg->reset_wait_q);
6841         LEAVE;
6842 
6843         return IPR_RC_JOB_RETURN;
6844 }
6845 
6846 /**
6847  * ipr_ioa_reset_done - IOA reset completion.
6848  * @ipr_cmd:    ipr command struct
6849  *
6850  * This function processes the completion of an adapter reset.
6851  * It schedules any necessary mid-layer add/removes and
6852  * wakes any reset sleepers.
6853  *
6854  * Return value:
6855  *      IPR_RC_JOB_RETURN
6856  **/
6857 static int ipr_ioa_reset_done(struct ipr_cmnd *ipr_cmd)
6858 {
6859         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6860         struct ipr_resource_entry *res;
6861         struct ipr_hostrcb *hostrcb, *temp;
6862         int i = 0, j;
6863 
6864         ENTER;
6865         ioa_cfg->in_reset_reload = 0;
6866         for (j = 0; j < ioa_cfg->hrrq_num; j++) {
6867                 spin_lock(&ioa_cfg->hrrq[j]._lock);
6868                 ioa_cfg->hrrq[j].allow_cmds = 1;
6869                 spin_unlock(&ioa_cfg->hrrq[j]._lock);
6870         }
6871         wmb();
6872         ioa_cfg->reset_cmd = NULL;
6873         ioa_cfg->doorbell |= IPR_RUNTIME_RESET;
6874 
6875         list_for_each_entry(res, &ioa_cfg->used_res_q, queue) {
6876                 if (ioa_cfg->allow_ml_add_del && (res->add_to_ml || res->del_from_ml)) {
6877                         ipr_trace;
6878                         break;
6879                 }
6880         }
6881         schedule_work(&ioa_cfg->work_q);
6882 
6883         list_for_each_entry_safe(hostrcb, temp, &ioa_cfg->hostrcb_free_q, queue) {
6884                 list_del(&hostrcb->queue);
6885                 if (i++ < IPR_NUM_LOG_HCAMS)
6886                         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_LOG_DATA, hostrcb);
6887                 else
6888                         ipr_send_hcam(ioa_cfg, IPR_HCAM_CDB_OP_CODE_CONFIG_CHANGE, hostrcb);
6889         }
6890 
6891         scsi_report_bus_reset(ioa_cfg->host, IPR_VSET_BUS);
6892         dev_info(&ioa_cfg->pdev->dev, "IOA initialized.\n");
6893 
6894         ioa_cfg->reset_retries = 0;
6895         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
6896         wake_up_all(&ioa_cfg->reset_wait_q);
6897 
6898         spin_unlock(ioa_cfg->host->host_lock);
6899         scsi_unblock_requests(ioa_cfg->host);
6900         spin_lock(ioa_cfg->host->host_lock);
6901 
6902         if (!ioa_cfg->hrrq[IPR_INIT_HRRQ].allow_cmds)
6903                 scsi_block_requests(ioa_cfg->host);
6904 
6905         LEAVE;
6906         return IPR_RC_JOB_RETURN;
6907 }
6908 
6909 /**
6910  * ipr_set_sup_dev_dflt - Initialize a Set Supported Device buffer
6911  * @supported_dev:      supported device struct
6912  * @vpids:                      vendor product id struct
6913  *
6914  * Return value:
6915  *      none
6916  **/
6917 static void ipr_set_sup_dev_dflt(struct ipr_supported_device *supported_dev,
6918                                  struct ipr_std_inq_vpids *vpids)
6919 {
6920         memset(supported_dev, 0, sizeof(struct ipr_supported_device));
6921         memcpy(&supported_dev->vpids, vpids, sizeof(struct ipr_std_inq_vpids));
6922         supported_dev->num_records = 1;
6923         supported_dev->data_length =
6924                 cpu_to_be16(sizeof(struct ipr_supported_device));
6925         supported_dev->reserved = 0;
6926 }
6927 
6928 /**
6929  * ipr_set_supported_devs - Send Set Supported Devices for a device
6930  * @ipr_cmd:    ipr command struct
6931  *
6932  * This function sends a Set Supported Devices to the adapter
6933  *
6934  * Return value:
6935  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
6936  **/
6937 static int ipr_set_supported_devs(struct ipr_cmnd *ipr_cmd)
6938 {
6939         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
6940         struct ipr_supported_device *supp_dev = &ioa_cfg->vpd_cbs->supp_dev;
6941         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
6942         struct ipr_resource_entry *res = ipr_cmd->u.res;
6943 
6944         ipr_cmd->job_step = ipr_ioa_reset_done;
6945 
6946         list_for_each_entry_continue(res, &ioa_cfg->used_res_q, queue) {
6947                 if (!ipr_is_scsi_disk(res))
6948                         continue;
6949 
6950                 ipr_cmd->u.res = res;
6951                 ipr_set_sup_dev_dflt(supp_dev, &res->std_inq_data.vpids);
6952 
6953                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
6954                 ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
6955                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
6956 
6957                 ioarcb->cmd_pkt.cdb[0] = IPR_SET_SUPPORTED_DEVICES;
6958                 ioarcb->cmd_pkt.cdb[1] = IPR_SET_ALL_SUPPORTED_DEVICES;
6959                 ioarcb->cmd_pkt.cdb[7] = (sizeof(struct ipr_supported_device) >> 8) & 0xff;
6960                 ioarcb->cmd_pkt.cdb[8] = sizeof(struct ipr_supported_device) & 0xff;
6961 
6962                 ipr_init_ioadl(ipr_cmd,
6963                                ioa_cfg->vpd_cbs_dma +
6964                                  offsetof(struct ipr_misc_cbs, supp_dev),
6965                                sizeof(struct ipr_supported_device),
6966                                IPR_IOADL_FLAGS_WRITE_LAST);
6967 
6968                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
6969                            IPR_SET_SUP_DEVICE_TIMEOUT);
6970 
6971                 if (!ioa_cfg->sis64)
6972                         ipr_cmd->job_step = ipr_set_supported_devs;
6973                 LEAVE;
6974                 return IPR_RC_JOB_RETURN;
6975         }
6976 
6977         LEAVE;
6978         return IPR_RC_JOB_CONTINUE;
6979 }
6980 
6981 /**
6982  * ipr_get_mode_page - Locate specified mode page
6983  * @mode_pages: mode page buffer
6984  * @page_code:  page code to find
6985  * @len:                minimum required length for mode page
6986  *
6987  * Return value:
6988  *      pointer to mode page / NULL on failure
6989  **/
6990 static void *ipr_get_mode_page(struct ipr_mode_pages *mode_pages,
6991                                u32 page_code, u32 len)
6992 {
6993         struct ipr_mode_page_hdr *mode_hdr;
6994         u32 page_length;
6995         u32 length;
6996 
6997         if (!mode_pages || (mode_pages->hdr.length == 0))
6998                 return NULL;
6999 
7000         length = (mode_pages->hdr.length + 1) - 4 - mode_pages->hdr.block_desc_len;
7001         mode_hdr = (struct ipr_mode_page_hdr *)
7002                 (mode_pages->data + mode_pages->hdr.block_desc_len);
7003 
7004         while (length) {
7005                 if (IPR_GET_MODE_PAGE_CODE(mode_hdr) == page_code) {
7006                         if (mode_hdr->page_length >= (len - sizeof(struct ipr_mode_page_hdr)))
7007                                 return mode_hdr;
7008                         break;
7009                 } else {
7010                         page_length = (sizeof(struct ipr_mode_page_hdr) +
7011                                        mode_hdr->page_length);
7012                         length -= page_length;
7013                         mode_hdr = (struct ipr_mode_page_hdr *)
7014                                 ((unsigned long)mode_hdr + page_length);
7015                 }
7016         }
7017         return NULL;
7018 }
7019 
7020 /**
7021  * ipr_check_term_power - Check for term power errors
7022  * @ioa_cfg:    ioa config struct
7023  * @mode_pages: IOAFP mode pages buffer
7024  *
7025  * Check the IOAFP's mode page 28 for term power errors
7026  *
7027  * Return value:
7028  *      nothing
7029  **/
7030 static void ipr_check_term_power(struct ipr_ioa_cfg *ioa_cfg,
7031                                  struct ipr_mode_pages *mode_pages)
7032 {
7033         int i;
7034         int entry_length;
7035         struct ipr_dev_bus_entry *bus;
7036         struct ipr_mode_page28 *mode_page;
7037 
7038         mode_page = ipr_get_mode_page(mode_pages, 0x28,
7039                                       sizeof(struct ipr_mode_page28));
7040 
7041         entry_length = mode_page->entry_length;
7042 
7043         bus = mode_page->bus;
7044 
7045         for (i = 0; i < mode_page->num_entries; i++) {
7046                 if (bus->flags & IPR_SCSI_ATTR_NO_TERM_PWR) {
7047                         dev_err(&ioa_cfg->pdev->dev,
7048                                 "Term power is absent on scsi bus %d\n",
7049                                 bus->res_addr.bus);
7050                 }
7051 
7052                 bus = (struct ipr_dev_bus_entry *)((char *)bus + entry_length);
7053         }
7054 }
7055 
7056 /**
7057  * ipr_scsi_bus_speed_limit - Limit the SCSI speed based on SES table
7058  * @ioa_cfg:    ioa config struct
7059  *
7060  * Looks through the config table checking for SES devices. If
7061  * the SES device is in the SES table indicating a maximum SCSI
7062  * bus speed, the speed is limited for the bus.
7063  *
7064  * Return value:
7065  *      none
7066  **/
7067 static void ipr_scsi_bus_speed_limit(struct ipr_ioa_cfg *ioa_cfg)
7068 {
7069         u32 max_xfer_rate;
7070         int i;
7071 
7072         for (i = 0; i < IPR_MAX_NUM_BUSES; i++) {
7073                 max_xfer_rate = ipr_get_max_scsi_speed(ioa_cfg, i,
7074                                                        ioa_cfg->bus_attr[i].bus_width);
7075 
7076                 if (max_xfer_rate < ioa_cfg->bus_attr[i].max_xfer_rate)
7077                         ioa_cfg->bus_attr[i].max_xfer_rate = max_xfer_rate;
7078         }
7079 }
7080 
7081 /**
7082  * ipr_modify_ioafp_mode_page_28 - Modify IOAFP Mode Page 28
7083  * @ioa_cfg:    ioa config struct
7084  * @mode_pages: mode page 28 buffer
7085  *
7086  * Updates mode page 28 based on driver configuration
7087  *
7088  * Return value:
7089  *      none
7090  **/
7091 static void ipr_modify_ioafp_mode_page_28(struct ipr_ioa_cfg *ioa_cfg,
7092                                           struct ipr_mode_pages *mode_pages)
7093 {
7094         int i, entry_length;
7095         struct ipr_dev_bus_entry *bus;
7096         struct ipr_bus_attributes *bus_attr;
7097         struct ipr_mode_page28 *mode_page;
7098 
7099         mode_page = ipr_get_mode_page(mode_pages, 0x28,
7100                                       sizeof(struct ipr_mode_page28));
7101 
7102         entry_length = mode_page->entry_length;
7103 
7104         /* Loop for each device bus entry */
7105         for (i = 0, bus = mode_page->bus;
7106              i < mode_page->num_entries;
7107              i++, bus = (struct ipr_dev_bus_entry *)((u8 *)bus + entry_length)) {
7108                 if (bus->res_addr.bus > IPR_MAX_NUM_BUSES) {
7109                         dev_err(&ioa_cfg->pdev->dev,
7110                                 "Invalid resource address reported: 0x%08X\n",
7111                                 IPR_GET_PHYS_LOC(bus->res_addr));
7112                         continue;
7113                 }
7114 
7115                 bus_attr = &ioa_cfg->bus_attr[i];
7116                 bus->extended_reset_delay = IPR_EXTENDED_RESET_DELAY;
7117                 bus->bus_width = bus_attr->bus_width;
7118                 bus->max_xfer_rate = cpu_to_be32(bus_attr->max_xfer_rate);
7119                 bus->flags &= ~IPR_SCSI_ATTR_QAS_MASK;
7120                 if (bus_attr->qas_enabled)
7121                         bus->flags |= IPR_SCSI_ATTR_ENABLE_QAS;
7122                 else
7123                         bus->flags |= IPR_SCSI_ATTR_DISABLE_QAS;
7124         }
7125 }
7126 
7127 /**
7128  * ipr_build_mode_select - Build a mode select command
7129  * @ipr_cmd:    ipr command struct
7130  * @res_handle: resource handle to send command to
7131  * @parm:               Byte 2 of Mode Sense command
7132  * @dma_addr:   DMA buffer address
7133  * @xfer_len:   data transfer length
7134  *
7135  * Return value:
7136  *      none
7137  **/
7138 static void ipr_build_mode_select(struct ipr_cmnd *ipr_cmd,
7139                                   __be32 res_handle, u8 parm,
7140                                   dma_addr_t dma_addr, u8 xfer_len)
7141 {
7142         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7143 
7144         ioarcb->res_handle = res_handle;
7145         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7146         ioarcb->cmd_pkt.flags_hi |= IPR_FLAGS_HI_WRITE_NOT_READ;
7147         ioarcb->cmd_pkt.cdb[0] = MODE_SELECT;
7148         ioarcb->cmd_pkt.cdb[1] = parm;
7149         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7150 
7151         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_WRITE_LAST);
7152 }
7153 
7154 /**
7155  * ipr_ioafp_mode_select_page28 - Issue Mode Select Page 28 to IOA
7156  * @ipr_cmd:    ipr command struct
7157  *
7158  * This function sets up the SCSI bus attributes and sends
7159  * a Mode Select for Page 28 to activate them.
7160  *
7161  * Return value:
7162  *      IPR_RC_JOB_RETURN
7163  **/
7164 static int ipr_ioafp_mode_select_page28(struct ipr_cmnd *ipr_cmd)
7165 {
7166         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7167         struct ipr_mode_pages *mode_pages = &ioa_cfg->vpd_cbs->mode_pages;
7168         int length;
7169 
7170         ENTER;
7171         ipr_scsi_bus_speed_limit(ioa_cfg);
7172         ipr_check_term_power(ioa_cfg, mode_pages);
7173         ipr_modify_ioafp_mode_page_28(ioa_cfg, mode_pages);
7174         length = mode_pages->hdr.length + 1;
7175         mode_pages->hdr.length = 0;
7176 
7177         ipr_build_mode_select(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE), 0x11,
7178                               ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, mode_pages),
7179                               length);
7180 
7181         ipr_cmd->job_step = ipr_set_supported_devs;
7182         ipr_cmd->u.res = list_entry(ioa_cfg->used_res_q.next,
7183                                     struct ipr_resource_entry, queue);
7184         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7185 
7186         LEAVE;
7187         return IPR_RC_JOB_RETURN;
7188 }
7189 
7190 /**
7191  * ipr_build_mode_sense - Builds a mode sense command
7192  * @ipr_cmd:    ipr command struct
7193  * @res:                resource entry struct
7194  * @parm:               Byte 2 of mode sense command
7195  * @dma_addr:   DMA address of mode sense buffer
7196  * @xfer_len:   Size of DMA buffer
7197  *
7198  * Return value:
7199  *      none
7200  **/
7201 static void ipr_build_mode_sense(struct ipr_cmnd *ipr_cmd,
7202                                  __be32 res_handle,
7203                                  u8 parm, dma_addr_t dma_addr, u8 xfer_len)
7204 {
7205         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7206 
7207         ioarcb->res_handle = res_handle;
7208         ioarcb->cmd_pkt.cdb[0] = MODE_SENSE;
7209         ioarcb->cmd_pkt.cdb[2] = parm;
7210         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7211         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7212 
7213         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_READ_LAST);
7214 }
7215 
7216 /**
7217  * ipr_reset_cmd_failed - Handle failure of IOA reset command
7218  * @ipr_cmd:    ipr command struct
7219  *
7220  * This function handles the failure of an IOA bringup command.
7221  *
7222  * Return value:
7223  *      IPR_RC_JOB_RETURN
7224  **/
7225 static int ipr_reset_cmd_failed(struct ipr_cmnd *ipr_cmd)
7226 {
7227         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7228         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7229 
7230         dev_err(&ioa_cfg->pdev->dev,
7231                 "0x%02X failed with IOASC: 0x%08X\n",
7232                 ipr_cmd->ioarcb.cmd_pkt.cdb[0], ioasc);
7233 
7234         ipr_initiate_ioa_reset(ioa_cfg, IPR_SHUTDOWN_NONE);
7235         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_free_q);
7236         return IPR_RC_JOB_RETURN;
7237 }
7238 
7239 /**
7240  * ipr_reset_mode_sense_failed - Handle failure of IOAFP mode sense
7241  * @ipr_cmd:    ipr command struct
7242  *
7243  * This function handles the failure of a Mode Sense to the IOAFP.
7244  * Some adapters do not handle all mode pages.
7245  *
7246  * Return value:
7247  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7248  **/
7249 static int ipr_reset_mode_sense_failed(struct ipr_cmnd *ipr_cmd)
7250 {
7251         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7252         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7253 
7254         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT) {
7255                 ipr_cmd->job_step = ipr_set_supported_devs;
7256                 ipr_cmd->u.res = list_entry(ioa_cfg->used_res_q.next,
7257                                             struct ipr_resource_entry, queue);
7258                 return IPR_RC_JOB_CONTINUE;
7259         }
7260 
7261         return ipr_reset_cmd_failed(ipr_cmd);
7262 }
7263 
7264 /**
7265  * ipr_ioafp_mode_sense_page28 - Issue Mode Sense Page 28 to IOA
7266  * @ipr_cmd:    ipr command struct
7267  *
7268  * This function send a Page 28 mode sense to the IOA to
7269  * retrieve SCSI bus attributes.
7270  *
7271  * Return value:
7272  *      IPR_RC_JOB_RETURN
7273  **/
7274 static int ipr_ioafp_mode_sense_page28(struct ipr_cmnd *ipr_cmd)
7275 {
7276         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7277 
7278         ENTER;
7279         ipr_build_mode_sense(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE),
7280                              0x28, ioa_cfg->vpd_cbs_dma +
7281                              offsetof(struct ipr_misc_cbs, mode_pages),
7282                              sizeof(struct ipr_mode_pages));
7283 
7284         ipr_cmd->job_step = ipr_ioafp_mode_select_page28;
7285         ipr_cmd->job_step_failed = ipr_reset_mode_sense_failed;
7286 
7287         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7288 
7289         LEAVE;
7290         return IPR_RC_JOB_RETURN;
7291 }
7292 
7293 /**
7294  * ipr_ioafp_mode_select_page24 - Issue Mode Select to IOA
7295  * @ipr_cmd:    ipr command struct
7296  *
7297  * This function enables dual IOA RAID support if possible.
7298  *
7299  * Return value:
7300  *      IPR_RC_JOB_RETURN
7301  **/
7302 static int ipr_ioafp_mode_select_page24(struct ipr_cmnd *ipr_cmd)
7303 {
7304         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7305         struct ipr_mode_pages *mode_pages = &ioa_cfg->vpd_cbs->mode_pages;
7306         struct ipr_mode_page24 *mode_page;
7307         int length;
7308 
7309         ENTER;
7310         mode_page = ipr_get_mode_page(mode_pages, 0x24,
7311                                       sizeof(struct ipr_mode_page24));
7312 
7313         if (mode_page)
7314                 mode_page->flags |= IPR_ENABLE_DUAL_IOA_AF;
7315 
7316         length = mode_pages->hdr.length + 1;
7317         mode_pages->hdr.length = 0;
7318 
7319         ipr_build_mode_select(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE), 0x11,
7320                               ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, mode_pages),
7321                               length);
7322 
7323         ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7324         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7325 
7326         LEAVE;
7327         return IPR_RC_JOB_RETURN;
7328 }
7329 
7330 /**
7331  * ipr_reset_mode_sense_page24_failed - Handle failure of IOAFP mode sense
7332  * @ipr_cmd:    ipr command struct
7333  *
7334  * This function handles the failure of a Mode Sense to the IOAFP.
7335  * Some adapters do not handle all mode pages.
7336  *
7337  * Return value:
7338  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7339  **/
7340 static int ipr_reset_mode_sense_page24_failed(struct ipr_cmnd *ipr_cmd)
7341 {
7342         u32 ioasc = be32_to_cpu(ipr_cmd->s.ioasa.hdr.ioasc);
7343 
7344         if (ioasc == IPR_IOASC_IR_INVALID_REQ_TYPE_OR_PKT) {
7345                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7346                 return IPR_RC_JOB_CONTINUE;
7347         }
7348 
7349         return ipr_reset_cmd_failed(ipr_cmd);
7350 }
7351 
7352 /**
7353  * ipr_ioafp_mode_sense_page24 - Issue Page 24 Mode Sense to IOA
7354  * @ipr_cmd:    ipr command struct
7355  *
7356  * This function send a mode sense to the IOA to retrieve
7357  * the IOA Advanced Function Control mode page.
7358  *
7359  * Return value:
7360  *      IPR_RC_JOB_RETURN
7361  **/
7362 static int ipr_ioafp_mode_sense_page24(struct ipr_cmnd *ipr_cmd)
7363 {
7364         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7365 
7366         ENTER;
7367         ipr_build_mode_sense(ipr_cmd, cpu_to_be32(IPR_IOA_RES_HANDLE),
7368                              0x24, ioa_cfg->vpd_cbs_dma +
7369                              offsetof(struct ipr_misc_cbs, mode_pages),
7370                              sizeof(struct ipr_mode_pages));
7371 
7372         ipr_cmd->job_step = ipr_ioafp_mode_select_page24;
7373         ipr_cmd->job_step_failed = ipr_reset_mode_sense_page24_failed;
7374 
7375         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7376 
7377         LEAVE;
7378         return IPR_RC_JOB_RETURN;
7379 }
7380 
7381 /**
7382  * ipr_init_res_table - Initialize the resource table
7383  * @ipr_cmd:    ipr command struct
7384  *
7385  * This function looks through the existing resource table, comparing
7386  * it with the config table. This function will take care of old/new
7387  * devices and schedule adding/removing them from the mid-layer
7388  * as appropriate.
7389  *
7390  * Return value:
7391  *      IPR_RC_JOB_CONTINUE
7392  **/
7393 static int ipr_init_res_table(struct ipr_cmnd *ipr_cmd)
7394 {
7395         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7396         struct ipr_resource_entry *res, *temp;
7397         struct ipr_config_table_entry_wrapper cfgtew;
7398         int entries, found, flag, i;
7399         LIST_HEAD(old_res);
7400 
7401         ENTER;
7402         if (ioa_cfg->sis64)
7403                 flag = ioa_cfg->u.cfg_table64->hdr64.flags;
7404         else
7405                 flag = ioa_cfg->u.cfg_table->hdr.flags;
7406 
7407         if (flag & IPR_UCODE_DOWNLOAD_REQ)
7408                 dev_err(&ioa_cfg->pdev->dev, "Microcode download required\n");
7409 
7410         list_for_each_entry_safe(res, temp, &ioa_cfg->used_res_q, queue)
7411                 list_move_tail(&res->queue, &old_res);
7412 
7413         if (ioa_cfg->sis64)
7414                 entries = be16_to_cpu(ioa_cfg->u.cfg_table64->hdr64.num_entries);
7415         else
7416                 entries = ioa_cfg->u.cfg_table->hdr.num_entries;
7417 
7418         for (i = 0; i < entries; i++) {
7419                 if (ioa_cfg->sis64)
7420                         cfgtew.u.cfgte64 = &ioa_cfg->u.cfg_table64->dev[i];
7421                 else
7422                         cfgtew.u.cfgte = &ioa_cfg->u.cfg_table->dev[i];
7423                 found = 0;
7424 
7425                 list_for_each_entry_safe(res, temp, &old_res, queue) {
7426                         if (ipr_is_same_device(res, &cfgtew)) {
7427                                 list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7428                                 found = 1;
7429                                 break;
7430                         }
7431                 }
7432 
7433                 if (!found) {
7434                         if (list_empty(&ioa_cfg->free_res_q)) {
7435                                 dev_err(&ioa_cfg->pdev->dev, "Too many devices attached\n");
7436                                 break;
7437                         }
7438 
7439                         found = 1;
7440                         res = list_entry(ioa_cfg->free_res_q.next,
7441                                          struct ipr_resource_entry, queue);
7442                         list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7443                         ipr_init_res_entry(res, &cfgtew);
7444                         res->add_to_ml = 1;
7445                 } else if (res->sdev && (ipr_is_vset_device(res) || ipr_is_scsi_disk(res)))
7446                         res->sdev->allow_restart = 1;
7447 
7448                 if (found)
7449                         ipr_update_res_entry(res, &cfgtew);
7450         }
7451 
7452         list_for_each_entry_safe(res, temp, &old_res, queue) {
7453                 if (res->sdev) {
7454                         res->del_from_ml = 1;
7455                         res->res_handle = IPR_INVALID_RES_HANDLE;
7456                         list_move_tail(&res->queue, &ioa_cfg->used_res_q);
7457                 }
7458         }
7459 
7460         list_for_each_entry_safe(res, temp, &old_res, queue) {
7461                 ipr_clear_res_target(res);
7462                 list_move_tail(&res->queue, &ioa_cfg->free_res_q);
7463         }
7464 
7465         if (ioa_cfg->dual_raid && ipr_dual_ioa_raid)
7466                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page24;
7467         else
7468                 ipr_cmd->job_step = ipr_ioafp_mode_sense_page28;
7469 
7470         LEAVE;
7471         return IPR_RC_JOB_CONTINUE;
7472 }
7473 
7474 /**
7475  * ipr_ioafp_query_ioa_cfg - Send a Query IOA Config to the adapter.
7476  * @ipr_cmd:    ipr command struct
7477  *
7478  * This function sends a Query IOA Configuration command
7479  * to the adapter to retrieve the IOA configuration table.
7480  *
7481  * Return value:
7482  *      IPR_RC_JOB_RETURN
7483  **/
7484 static int ipr_ioafp_query_ioa_cfg(struct ipr_cmnd *ipr_cmd)
7485 {
7486         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7487         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7488         struct ipr_inquiry_page3 *ucode_vpd = &ioa_cfg->vpd_cbs->page3_data;
7489         struct ipr_inquiry_cap *cap = &ioa_cfg->vpd_cbs->cap;
7490 
7491         ENTER;
7492         if (cap->cap & IPR_CAP_DUAL_IOA_RAID)
7493                 ioa_cfg->dual_raid = 1;
7494         dev_info(&ioa_cfg->pdev->dev, "Adapter firmware version: %02X%02X%02X%02X\n",
7495                  ucode_vpd->major_release, ucode_vpd->card_type,
7496                  ucode_vpd->minor_release[0], ucode_vpd->minor_release[1]);
7497         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7498         ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7499 
7500         ioarcb->cmd_pkt.cdb[0] = IPR_QUERY_IOA_CONFIG;
7501         ioarcb->cmd_pkt.cdb[6] = (ioa_cfg->cfg_table_size >> 16) & 0xff;
7502         ioarcb->cmd_pkt.cdb[7] = (ioa_cfg->cfg_table_size >> 8) & 0xff;
7503         ioarcb->cmd_pkt.cdb[8] = ioa_cfg->cfg_table_size & 0xff;
7504 
7505         ipr_init_ioadl(ipr_cmd, ioa_cfg->cfg_table_dma, ioa_cfg->cfg_table_size,
7506                        IPR_IOADL_FLAGS_READ_LAST);
7507 
7508         ipr_cmd->job_step = ipr_init_res_table;
7509 
7510         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7511 
7512         LEAVE;
7513         return IPR_RC_JOB_RETURN;
7514 }
7515 
7516 /**
7517  * ipr_ioafp_inquiry - Send an Inquiry to the adapter.
7518  * @ipr_cmd:    ipr command struct
7519  *
7520  * This utility function sends an inquiry to the adapter.
7521  *
7522  * Return value:
7523  *      none
7524  **/
7525 static void ipr_ioafp_inquiry(struct ipr_cmnd *ipr_cmd, u8 flags, u8 page,
7526                               dma_addr_t dma_addr, u8 xfer_len)
7527 {
7528         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7529 
7530         ENTER;
7531         ioarcb->cmd_pkt.request_type = IPR_RQTYPE_SCSICDB;
7532         ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7533 
7534         ioarcb->cmd_pkt.cdb[0] = INQUIRY;
7535         ioarcb->cmd_pkt.cdb[1] = flags;
7536         ioarcb->cmd_pkt.cdb[2] = page;
7537         ioarcb->cmd_pkt.cdb[4] = xfer_len;
7538 
7539         ipr_init_ioadl(ipr_cmd, dma_addr, xfer_len, IPR_IOADL_FLAGS_READ_LAST);
7540 
7541         ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout, IPR_INTERNAL_TIMEOUT);
7542         LEAVE;
7543 }
7544 
7545 /**
7546  * ipr_inquiry_page_supported - Is the given inquiry page supported
7547  * @page0:              inquiry page 0 buffer
7548  * @page:               page code.
7549  *
7550  * This function determines if the specified inquiry page is supported.
7551  *
7552  * Return value:
7553  *      1 if page is supported / 0 if not
7554  **/
7555 static int ipr_inquiry_page_supported(struct ipr_inquiry_page0 *page0, u8 page)
7556 {
7557         int i;
7558 
7559         for (i = 0; i < min_t(u8, page0->len, IPR_INQUIRY_PAGE0_ENTRIES); i++)
7560                 if (page0->page[i] == page)
7561                         return 1;
7562 
7563         return 0;
7564 }
7565 
7566 /**
7567  * ipr_ioafp_cap_inquiry - Send a Page 0xD0 Inquiry to the adapter.
7568  * @ipr_cmd:    ipr command struct
7569  *
7570  * This function sends a Page 0xD0 inquiry to the adapter
7571  * to retrieve adapter capabilities.
7572  *
7573  * Return value:
7574  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7575  **/
7576 static int ipr_ioafp_cap_inquiry(struct ipr_cmnd *ipr_cmd)
7577 {
7578         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7579         struct ipr_inquiry_page0 *page0 = &ioa_cfg->vpd_cbs->page0_data;
7580         struct ipr_inquiry_cap *cap = &ioa_cfg->vpd_cbs->cap;
7581 
7582         ENTER;
7583         ipr_cmd->job_step = ipr_ioafp_query_ioa_cfg;
7584         memset(cap, 0, sizeof(*cap));
7585 
7586         if (ipr_inquiry_page_supported(page0, 0xD0)) {
7587                 ipr_ioafp_inquiry(ipr_cmd, 1, 0xD0,
7588                                   ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, cap),
7589                                   sizeof(struct ipr_inquiry_cap));
7590                 return IPR_RC_JOB_RETURN;
7591         }
7592 
7593         LEAVE;
7594         return IPR_RC_JOB_CONTINUE;
7595 }
7596 
7597 /**
7598  * ipr_ioafp_page3_inquiry - Send a Page 3 Inquiry to the adapter.
7599  * @ipr_cmd:    ipr command struct
7600  *
7601  * This function sends a Page 3 inquiry to the adapter
7602  * to retrieve software VPD information.
7603  *
7604  * Return value:
7605  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7606  **/
7607 static int ipr_ioafp_page3_inquiry(struct ipr_cmnd *ipr_cmd)
7608 {
7609         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7610 
7611         ENTER;
7612 
7613         ipr_cmd->job_step = ipr_ioafp_cap_inquiry;
7614 
7615         ipr_ioafp_inquiry(ipr_cmd, 1, 3,
7616                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, page3_data),
7617                           sizeof(struct ipr_inquiry_page3));
7618 
7619         LEAVE;
7620         return IPR_RC_JOB_RETURN;
7621 }
7622 
7623 /**
7624  * ipr_ioafp_page0_inquiry - Send a Page 0 Inquiry to the adapter.
7625  * @ipr_cmd:    ipr command struct
7626  *
7627  * This function sends a Page 0 inquiry to the adapter
7628  * to retrieve supported inquiry pages.
7629  *
7630  * Return value:
7631  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7632  **/
7633 static int ipr_ioafp_page0_inquiry(struct ipr_cmnd *ipr_cmd)
7634 {
7635         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7636         char type[5];
7637 
7638         ENTER;
7639 
7640         /* Grab the type out of the VPD and store it away */
7641         memcpy(type, ioa_cfg->vpd_cbs->ioa_vpd.std_inq_data.vpids.product_id, 4);
7642         type[4] = '\0';
7643         ioa_cfg->type = simple_strtoul((char *)type, NULL, 16);
7644 
7645         ipr_cmd->job_step = ipr_ioafp_page3_inquiry;
7646 
7647         ipr_ioafp_inquiry(ipr_cmd, 1, 0,
7648                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, page0_data),
7649                           sizeof(struct ipr_inquiry_page0));
7650 
7651         LEAVE;
7652         return IPR_RC_JOB_RETURN;
7653 }
7654 
7655 /**
7656  * ipr_ioafp_std_inquiry - Send a Standard Inquiry to the adapter.
7657  * @ipr_cmd:    ipr command struct
7658  *
7659  * This function sends a standard inquiry to the adapter.
7660  *
7661  * Return value:
7662  *      IPR_RC_JOB_RETURN
7663  **/
7664 static int ipr_ioafp_std_inquiry(struct ipr_cmnd *ipr_cmd)
7665 {
7666         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7667 
7668         ENTER;
7669         ipr_cmd->job_step = ipr_ioafp_page0_inquiry;
7670 
7671         ipr_ioafp_inquiry(ipr_cmd, 0, 0,
7672                           ioa_cfg->vpd_cbs_dma + offsetof(struct ipr_misc_cbs, ioa_vpd),
7673                           sizeof(struct ipr_ioa_vpd));
7674 
7675         LEAVE;
7676         return IPR_RC_JOB_RETURN;
7677 }
7678 
7679 /**
7680  * ipr_ioafp_identify_hrrq - Send Identify Host RRQ.
7681  * @ipr_cmd:    ipr command struct
7682  *
7683  * This function send an Identify Host Request Response Queue
7684  * command to establish the HRRQ with the adapter.
7685  *
7686  * Return value:
7687  *      IPR_RC_JOB_RETURN
7688  **/
7689 static int ipr_ioafp_identify_hrrq(struct ipr_cmnd *ipr_cmd)
7690 {
7691         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7692         struct ipr_ioarcb *ioarcb = &ipr_cmd->ioarcb;
7693         struct ipr_hrr_queue *hrrq;
7694 
7695         ENTER;
7696         ipr_cmd->job_step = ipr_ioafp_std_inquiry;
7697         dev_info(&ioa_cfg->pdev->dev, "Starting IOA initialization sequence.\n");
7698 
7699         if (ioa_cfg->identify_hrrq_index < ioa_cfg->hrrq_num) {
7700                 hrrq = &ioa_cfg->hrrq[ioa_cfg->identify_hrrq_index];
7701 
7702                 ioarcb->cmd_pkt.cdb[0] = IPR_ID_HOST_RR_Q;
7703                 ioarcb->res_handle = cpu_to_be32(IPR_IOA_RES_HANDLE);
7704 
7705                 ioarcb->cmd_pkt.request_type = IPR_RQTYPE_IOACMD;
7706                 if (ioa_cfg->sis64)
7707                         ioarcb->cmd_pkt.cdb[1] = 0x1;
7708 
7709                 if (ioa_cfg->nvectors == 1)
7710                         ioarcb->cmd_pkt.cdb[1] &= ~IPR_ID_HRRQ_SELE_ENABLE;
7711                 else
7712                         ioarcb->cmd_pkt.cdb[1] |= IPR_ID_HRRQ_SELE_ENABLE;
7713 
7714                 ioarcb->cmd_pkt.cdb[2] =
7715                         ((u64) hrrq->host_rrq_dma >> 24) & 0xff;
7716                 ioarcb->cmd_pkt.cdb[3] =
7717                         ((u64) hrrq->host_rrq_dma >> 16) & 0xff;
7718                 ioarcb->cmd_pkt.cdb[4] =
7719                         ((u64) hrrq->host_rrq_dma >> 8) & 0xff;
7720                 ioarcb->cmd_pkt.cdb[5] =
7721                         ((u64) hrrq->host_rrq_dma) & 0xff;
7722                 ioarcb->cmd_pkt.cdb[7] =
7723                         ((sizeof(u32) * hrrq->size) >> 8) & 0xff;
7724                 ioarcb->cmd_pkt.cdb[8] =
7725                         (sizeof(u32) * hrrq->size) & 0xff;
7726 
7727                 if (ioarcb->cmd_pkt.cdb[1] & IPR_ID_HRRQ_SELE_ENABLE)
7728                         ioarcb->cmd_pkt.cdb[9] =
7729                                         ioa_cfg->identify_hrrq_index;
7730 
7731                 if (ioa_cfg->sis64) {
7732                         ioarcb->cmd_pkt.cdb[10] =
7733                                 ((u64) hrrq->host_rrq_dma >> 56) & 0xff;
7734                         ioarcb->cmd_pkt.cdb[11] =
7735                                 ((u64) hrrq->host_rrq_dma >> 48) & 0xff;
7736                         ioarcb->cmd_pkt.cdb[12] =
7737                                 ((u64) hrrq->host_rrq_dma >> 40) & 0xff;
7738                         ioarcb->cmd_pkt.cdb[13] =
7739                                 ((u64) hrrq->host_rrq_dma >> 32) & 0xff;
7740                 }
7741 
7742                 if (ioarcb->cmd_pkt.cdb[1] & IPR_ID_HRRQ_SELE_ENABLE)
7743                         ioarcb->cmd_pkt.cdb[14] =
7744                                         ioa_cfg->identify_hrrq_index;
7745 
7746                 ipr_do_req(ipr_cmd, ipr_reset_ioa_job, ipr_timeout,
7747                            IPR_INTERNAL_TIMEOUT);
7748 
7749                 if (++ioa_cfg->identify_hrrq_index < ioa_cfg->hrrq_num)
7750                         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
7751 
7752                 LEAVE;
7753                 return IPR_RC_JOB_RETURN;
7754         }
7755 
7756         LEAVE;
7757         return IPR_RC_JOB_CONTINUE;
7758 }
7759 
7760 /**
7761  * ipr_reset_timer_done - Adapter reset timer function
7762  * @ipr_cmd:    ipr command struct
7763  *
7764  * Description: This function is used in adapter reset processing
7765  * for timing events. If the reset_cmd pointer in the IOA
7766  * config struct is not this adapter's we are doing nested
7767  * resets and fail_all_ops will take care of freeing the
7768  * command block.
7769  *
7770  * Return value:
7771  *      none
7772  **/
7773 static void ipr_reset_timer_done(struct ipr_cmnd *ipr_cmd)
7774 {
7775         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7776         unsigned long lock_flags = 0;
7777 
7778         spin_lock_irqsave(ioa_cfg->host->host_lock, lock_flags);
7779 
7780         if (ioa_cfg->reset_cmd == ipr_cmd) {
7781                 list_del(&ipr_cmd->queue);
7782                 ipr_cmd->done(ipr_cmd);
7783         }
7784 
7785         spin_unlock_irqrestore(ioa_cfg->host->host_lock, lock_flags);
7786 }
7787 
7788 /**
7789  * ipr_reset_start_timer - Start a timer for adapter reset job
7790  * @ipr_cmd:    ipr command struct
7791  * @timeout:    timeout value
7792  *
7793  * Description: This function is used in adapter reset processing
7794  * for timing events. If the reset_cmd pointer in the IOA
7795  * config struct is not this adapter's we are doing nested
7796  * resets and fail_all_ops will take care of freeing the
7797  * command block.
7798  *
7799  * Return value:
7800  *      none
7801  **/
7802 static void ipr_reset_start_timer(struct ipr_cmnd *ipr_cmd,
7803                                   unsigned long timeout)
7804 {
7805 
7806         ENTER;
7807         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
7808         ipr_cmd->done = ipr_reset_ioa_job;
7809 
7810         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
7811         ipr_cmd->timer.expires = jiffies + timeout;
7812         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_reset_timer_done;
7813         add_timer(&ipr_cmd->timer);
7814 }
7815 
7816 /**
7817  * ipr_init_ioa_mem - Initialize ioa_cfg control block
7818  * @ioa_cfg:    ioa cfg struct
7819  *
7820  * Return value:
7821  *      nothing
7822  **/
7823 static void ipr_init_ioa_mem(struct ipr_ioa_cfg *ioa_cfg)
7824 {
7825         struct ipr_hrr_queue *hrrq;
7826 
7827         for_each_hrrq(hrrq, ioa_cfg) {
7828                 spin_lock(&hrrq->_lock);
7829                 memset(hrrq->host_rrq, 0, sizeof(u32) * hrrq->size);
7830 
7831                 /* Initialize Host RRQ pointers */
7832                 hrrq->hrrq_start = hrrq->host_rrq;
7833                 hrrq->hrrq_end = &hrrq->host_rrq[hrrq->size - 1];
7834                 hrrq->hrrq_curr = hrrq->hrrq_start;
7835                 hrrq->toggle_bit = 1;
7836                 spin_unlock(&hrrq->_lock);
7837         }
7838         wmb();
7839 
7840         ioa_cfg->identify_hrrq_index = 0;
7841         if (ioa_cfg->hrrq_num == 1)
7842                 atomic_set(&ioa_cfg->hrrq_index, 0);
7843         else
7844                 atomic_set(&ioa_cfg->hrrq_index, 1);
7845 
7846         /* Zero out config table */
7847         memset(ioa_cfg->u.cfg_table, 0, ioa_cfg->cfg_table_size);
7848 }
7849 
7850 /**
7851  * ipr_reset_next_stage - Process IPL stage change based on feedback register.
7852  * @ipr_cmd:    ipr command struct
7853  *
7854  * Return value:
7855  *      IPR_RC_JOB_CONTINUE / IPR_RC_JOB_RETURN
7856  **/
7857 static int ipr_reset_next_stage(struct ipr_cmnd *ipr_cmd)
7858 {
7859         unsigned long stage, stage_time;
7860         u32 feedback;
7861         volatile u32 int_reg;
7862         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7863         u64 maskval = 0;
7864 
7865         feedback = readl(ioa_cfg->regs.init_feedback_reg);
7866         stage = feedback & IPR_IPL_INIT_STAGE_MASK;
7867         stage_time = feedback & IPR_IPL_INIT_STAGE_TIME_MASK;
7868 
7869         ipr_dbg("IPL stage = 0x%lx, IPL stage time = %ld\n", stage, stage_time);
7870 
7871         /* sanity check the stage_time value */
7872         if (stage_time == 0)
7873                 stage_time = IPR_IPL_INIT_DEFAULT_STAGE_TIME;
7874         else if (stage_time < IPR_IPL_INIT_MIN_STAGE_TIME)
7875                 stage_time = IPR_IPL_INIT_MIN_STAGE_TIME;
7876         else if (stage_time > IPR_LONG_OPERATIONAL_TIMEOUT)
7877                 stage_time = IPR_LONG_OPERATIONAL_TIMEOUT;
7878 
7879         if (stage == IPR_IPL_INIT_STAGE_UNKNOWN) {
7880                 writel(IPR_PCII_IPL_STAGE_CHANGE, ioa_cfg->regs.set_interrupt_mask_reg);
7881                 int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
7882                 stage_time = ioa_cfg->transop_timeout;
7883                 ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
7884         } else if (stage == IPR_IPL_INIT_STAGE_TRANSOP) {
7885                 int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
7886                 if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
7887                         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
7888                         maskval = IPR_PCII_IPL_STAGE_CHANGE;
7889                         maskval = (maskval << 32) | IPR_PCII_IOA_TRANS_TO_OPER;
7890                         writeq(maskval, ioa_cfg->regs.set_interrupt_mask_reg);
7891                         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
7892                         return IPR_RC_JOB_CONTINUE;
7893                 }
7894         }
7895 
7896         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
7897         ipr_cmd->timer.expires = jiffies + stage_time * HZ;
7898         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_oper_timeout;
7899         ipr_cmd->done = ipr_reset_ioa_job;
7900         add_timer(&ipr_cmd->timer);
7901 
7902         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
7903 
7904         return IPR_RC_JOB_RETURN;
7905 }
7906 
7907 /**
7908  * ipr_reset_enable_ioa - Enable the IOA following a reset.
7909  * @ipr_cmd:    ipr command struct
7910  *
7911  * This function reinitializes some control blocks and
7912  * enables destructive diagnostics on the adapter.
7913  *
7914  * Return value:
7915  *      IPR_RC_JOB_RETURN
7916  **/
7917 static int ipr_reset_enable_ioa(struct ipr_cmnd *ipr_cmd)
7918 {
7919         struct ipr_ioa_cfg *ioa_cfg = ipr_cmd->ioa_cfg;
7920         volatile u32 int_reg;
7921         volatile u64 maskval;
7922         int i;
7923 
7924         ENTER;
7925         ipr_cmd->job_step = ipr_ioafp_identify_hrrq;
7926         ipr_init_ioa_mem(ioa_cfg);
7927 
7928         for (i = 0; i < ioa_cfg->hrrq_num; i++) {
7929                 spin_lock(&ioa_cfg->hrrq[i]._lock);
7930                 ioa_cfg->hrrq[i].allow_interrupts = 1;
7931                 spin_unlock(&ioa_cfg->hrrq[i]._lock);
7932         }
7933         wmb();
7934         if (ioa_cfg->sis64) {
7935                 /* Set the adapter to the correct endian mode. */
7936                 writel(IPR_ENDIAN_SWAP_KEY, ioa_cfg->regs.endian_swap_reg);
7937                 int_reg = readl(ioa_cfg->regs.endian_swap_reg);
7938         }
7939 
7940         int_reg = readl(ioa_cfg->regs.sense_interrupt_reg32);
7941 
7942         if (int_reg & IPR_PCII_IOA_TRANS_TO_OPER) {
7943                 writel((IPR_PCII_ERROR_INTERRUPTS | IPR_PCII_HRRQ_UPDATED),
7944                        ioa_cfg->regs.clr_interrupt_mask_reg32);
7945                 int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
7946                 return IPR_RC_JOB_CONTINUE;
7947         }
7948 
7949         /* Enable destructive diagnostics on IOA */
7950         writel(ioa_cfg->doorbell, ioa_cfg->regs.set_uproc_interrupt_reg32);
7951 
7952         if (ioa_cfg->sis64) {
7953                 maskval = IPR_PCII_IPL_STAGE_CHANGE;
7954                 maskval = (maskval << 32) | IPR_PCII_OPER_INTERRUPTS;
7955                 writeq(maskval, ioa_cfg->regs.clr_interrupt_mask_reg);
7956         } else
7957                 writel(IPR_PCII_OPER_INTERRUPTS, ioa_cfg->regs.clr_interrupt_mask_reg32);
7958 
7959         int_reg = readl(ioa_cfg->regs.sense_interrupt_mask_reg);
7960 
7961         dev_info(&ioa_cfg->pdev->dev, "Initializing IOA.\n");
7962 
7963         if (ioa_cfg->sis64) {
7964                 ipr_cmd->job_step = ipr_reset_next_stage;
7965                 return IPR_RC_JOB_CONTINUE;
7966         }
7967 
7968         ipr_cmd->timer.data = (unsigned long) ipr_cmd;
7969         ipr_cmd->timer.expires = jiffies + (ioa_cfg->transop_timeout * HZ);
7970         ipr_cmd->timer.function = (void (*)(unsigned long))ipr_oper_timeout;
7971         ipr_cmd->done = ipr_reset_ioa_job;
7972         add_timer(&ipr_cmd->timer);
7973         list_add_tail(&ipr_cmd->queue, &ipr_cmd->hrrq->hrrq_pending_q);
7974 
7975         LEAVE;
7976         return IPR_RC_JOB_RETURN;
7977 }
7978 
7979 /**
7980  * ipr_reset_wait_for_dump - Wait for a dump to timeout.
7981