Loading...
1/*
2 * linux/drivers/message/fusion/mptsas.c
3 * For use with LSI PCI chip/adapter(s)
4 * running LSI Fusion MPT (Message Passing Technology) firmware.
5 *
6 * Copyright (c) 1999-2008 LSI Corporation
7 * (mailto:DL-MPTFusionLinux@lsi.com)
8 */
9/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
10/*
11 This program is free software; you can redistribute it and/or modify
12 it under the terms of the GNU General Public License as published by
13 the Free Software Foundation; version 2 of the License.
14
15 This program is distributed in the hope that it will be useful,
16 but WITHOUT ANY WARRANTY; without even the implied warranty of
17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 GNU General Public License for more details.
19
20 NO WARRANTY
21 THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
22 CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
23 LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
24 MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
25 solely responsible for determining the appropriateness of using and
26 distributing the Program and assumes all risks associated with its
27 exercise of rights under this Agreement, including but not limited to
28 the risks and costs of program errors, damage to or loss of data,
29 programs or equipment, and unavailability or interruption of operations.
30
31 DISCLAIMER OF LIABILITY
32 NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
33 DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
34 DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
35 ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
36 TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
37 USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
38 HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
39
40 You should have received a copy of the GNU General Public License
41 along with this program; if not, write to the Free Software
42 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
43*/
44/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
45
46#include <linux/module.h>
47#include <linux/kernel.h>
48#include <linux/slab.h>
49#include <linux/init.h>
50#include <linux/errno.h>
51#include <linux/jiffies.h>
52#include <linux/workqueue.h>
53#include <linux/delay.h> /* for mdelay */
54
55#include <scsi/scsi.h>
56#include <scsi/scsi_cmnd.h>
57#include <scsi/scsi_device.h>
58#include <scsi/scsi_host.h>
59#include <scsi/scsi_transport_sas.h>
60#include <scsi/scsi_transport.h>
61#include <scsi/scsi_dbg.h>
62
63#include "mptbase.h"
64#include "mptscsih.h"
65#include "mptsas.h"
66
67
68#define my_NAME "Fusion MPT SAS Host driver"
69#define my_VERSION MPT_LINUX_VERSION_COMMON
70#define MYNAM "mptsas"
71
72/*
73 * Reserved channel for integrated raid
74 */
75#define MPTSAS_RAID_CHANNEL 1
76
77#define SAS_CONFIG_PAGE_TIMEOUT 30
78MODULE_AUTHOR(MODULEAUTHOR);
79MODULE_DESCRIPTION(my_NAME);
80MODULE_LICENSE("GPL");
81MODULE_VERSION(my_VERSION);
82
83static int mpt_pt_clear;
84module_param(mpt_pt_clear, int, 0);
85MODULE_PARM_DESC(mpt_pt_clear,
86 " Clear persistency table: enable=1 "
87 "(default=MPTSCSIH_PT_CLEAR=0)");
88
89/* scsi-mid layer global parmeter is max_report_luns, which is 511 */
90#define MPTSAS_MAX_LUN (16895)
91static int max_lun = MPTSAS_MAX_LUN;
92module_param(max_lun, int, 0);
93MODULE_PARM_DESC(max_lun, " max lun, default=16895 ");
94
95static int mpt_loadtime_max_sectors = 8192;
96module_param(mpt_loadtime_max_sectors, int, 0);
97MODULE_PARM_DESC(mpt_loadtime_max_sectors,
98 " Maximum sector define for Host Bus Adaptor.Range 64 to 8192 default=8192");
99
100static u8 mptsasDoneCtx = MPT_MAX_PROTOCOL_DRIVERS;
101static u8 mptsasTaskCtx = MPT_MAX_PROTOCOL_DRIVERS;
102static u8 mptsasInternalCtx = MPT_MAX_PROTOCOL_DRIVERS; /* Used only for internal commands */
103static u8 mptsasMgmtCtx = MPT_MAX_PROTOCOL_DRIVERS;
104static u8 mptsasDeviceResetCtx = MPT_MAX_PROTOCOL_DRIVERS;
105
106static void mptsas_firmware_event_work(struct work_struct *work);
107static void mptsas_send_sas_event(struct fw_event_work *fw_event);
108static void mptsas_send_raid_event(struct fw_event_work *fw_event);
109static void mptsas_send_ir2_event(struct fw_event_work *fw_event);
110static void mptsas_parse_device_info(struct sas_identify *identify,
111 struct mptsas_devinfo *device_info);
112static inline void mptsas_set_rphy(MPT_ADAPTER *ioc,
113 struct mptsas_phyinfo *phy_info, struct sas_rphy *rphy);
114static struct mptsas_phyinfo *mptsas_find_phyinfo_by_sas_address
115 (MPT_ADAPTER *ioc, u64 sas_address);
116static int mptsas_sas_device_pg0(MPT_ADAPTER *ioc,
117 struct mptsas_devinfo *device_info, u32 form, u32 form_specific);
118static int mptsas_sas_enclosure_pg0(MPT_ADAPTER *ioc,
119 struct mptsas_enclosure *enclosure, u32 form, u32 form_specific);
120static int mptsas_add_end_device(MPT_ADAPTER *ioc,
121 struct mptsas_phyinfo *phy_info);
122static void mptsas_del_end_device(MPT_ADAPTER *ioc,
123 struct mptsas_phyinfo *phy_info);
124static void mptsas_send_link_status_event(struct fw_event_work *fw_event);
125static struct mptsas_portinfo *mptsas_find_portinfo_by_sas_address
126 (MPT_ADAPTER *ioc, u64 sas_address);
127static void mptsas_expander_delete(MPT_ADAPTER *ioc,
128 struct mptsas_portinfo *port_info, u8 force);
129static void mptsas_send_expander_event(struct fw_event_work *fw_event);
130static void mptsas_not_responding_devices(MPT_ADAPTER *ioc);
131static void mptsas_scan_sas_topology(MPT_ADAPTER *ioc);
132static void mptsas_broadcast_primative_work(struct fw_event_work *fw_event);
133static void mptsas_handle_queue_full_event(struct fw_event_work *fw_event);
134static void mptsas_volume_delete(MPT_ADAPTER *ioc, u8 id);
135void mptsas_schedule_target_reset(void *ioc);
136
137static void mptsas_print_phy_data(MPT_ADAPTER *ioc,
138 MPI_SAS_IO_UNIT0_PHY_DATA *phy_data)
139{
140 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
141 "---- IO UNIT PAGE 0 ------------\n", ioc->name));
142 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
143 ioc->name, le16_to_cpu(phy_data->AttachedDeviceHandle)));
144 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Controller Handle=0x%X\n",
145 ioc->name, le16_to_cpu(phy_data->ControllerDevHandle)));
146 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port=0x%X\n",
147 ioc->name, phy_data->Port));
148 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port Flags=0x%X\n",
149 ioc->name, phy_data->PortFlags));
150 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Flags=0x%X\n",
151 ioc->name, phy_data->PhyFlags));
152 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
153 ioc->name, phy_data->NegotiatedLinkRate));
154 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
155 "Controller PHY Device Info=0x%X\n", ioc->name,
156 le32_to_cpu(phy_data->ControllerPhyDeviceInfo)));
157 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "DiscoveryStatus=0x%X\n\n",
158 ioc->name, le32_to_cpu(phy_data->DiscoveryStatus)));
159}
160
161static void mptsas_print_phy_pg0(MPT_ADAPTER *ioc, SasPhyPage0_t *pg0)
162{
163 __le64 sas_address;
164
165 memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
166
167 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
168 "---- SAS PHY PAGE 0 ------------\n", ioc->name));
169 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
170 "Attached Device Handle=0x%X\n", ioc->name,
171 le16_to_cpu(pg0->AttachedDevHandle)));
172 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
173 ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
174 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
175 "Attached PHY Identifier=0x%X\n", ioc->name,
176 pg0->AttachedPhyIdentifier));
177 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Attached Device Info=0x%X\n",
178 ioc->name, le32_to_cpu(pg0->AttachedDeviceInfo)));
179 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
180 ioc->name, pg0->ProgrammedLinkRate));
181 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Change Count=0x%X\n",
182 ioc->name, pg0->ChangeCount));
183 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Info=0x%X\n\n",
184 ioc->name, le32_to_cpu(pg0->PhyInfo)));
185}
186
187static void mptsas_print_phy_pg1(MPT_ADAPTER *ioc, SasPhyPage1_t *pg1)
188{
189 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
190 "---- SAS PHY PAGE 1 ------------\n", ioc->name));
191 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Invalid Dword Count=0x%x\n",
192 ioc->name, pg1->InvalidDwordCount));
193 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
194 "Running Disparity Error Count=0x%x\n", ioc->name,
195 pg1->RunningDisparityErrorCount));
196 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
197 "Loss Dword Synch Count=0x%x\n", ioc->name,
198 pg1->LossDwordSynchCount));
199 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
200 "PHY Reset Problem Count=0x%x\n\n", ioc->name,
201 pg1->PhyResetProblemCount));
202}
203
204static void mptsas_print_device_pg0(MPT_ADAPTER *ioc, SasDevicePage0_t *pg0)
205{
206 __le64 sas_address;
207
208 memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
209
210 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
211 "---- SAS DEVICE PAGE 0 ---------\n", ioc->name));
212 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
213 ioc->name, le16_to_cpu(pg0->DevHandle)));
214 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Handle=0x%X\n",
215 ioc->name, le16_to_cpu(pg0->ParentDevHandle)));
216 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Enclosure Handle=0x%X\n",
217 ioc->name, le16_to_cpu(pg0->EnclosureHandle)));
218 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Slot=0x%X\n",
219 ioc->name, le16_to_cpu(pg0->Slot)));
220 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
221 ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
222 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Target ID=0x%X\n",
223 ioc->name, pg0->TargetID));
224 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Bus=0x%X\n",
225 ioc->name, pg0->Bus));
226 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Phy Num=0x%X\n",
227 ioc->name, pg0->PhyNum));
228 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Access Status=0x%X\n",
229 ioc->name, le16_to_cpu(pg0->AccessStatus)));
230 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Device Info=0x%X\n",
231 ioc->name, le32_to_cpu(pg0->DeviceInfo)));
232 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Flags=0x%X\n",
233 ioc->name, le16_to_cpu(pg0->Flags)));
234 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n\n",
235 ioc->name, pg0->PhysicalPort));
236}
237
238static void mptsas_print_expander_pg1(MPT_ADAPTER *ioc, SasExpanderPage1_t *pg1)
239{
240 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
241 "---- SAS EXPANDER PAGE 1 ------------\n", ioc->name));
242 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n",
243 ioc->name, pg1->PhysicalPort));
244 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Identifier=0x%X\n",
245 ioc->name, pg1->PhyIdentifier));
246 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
247 ioc->name, pg1->NegotiatedLinkRate));
248 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
249 ioc->name, pg1->ProgrammedLinkRate));
250 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Hardware Link Rate=0x%X\n",
251 ioc->name, pg1->HwLinkRate));
252 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Owner Device Handle=0x%X\n",
253 ioc->name, le16_to_cpu(pg1->OwnerDevHandle)));
254 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
255 "Attached Device Handle=0x%X\n\n", ioc->name,
256 le16_to_cpu(pg1->AttachedDevHandle)));
257}
258
259/* inhibit sas firmware event handling */
260static void
261mptsas_fw_event_off(MPT_ADAPTER *ioc)
262{
263 unsigned long flags;
264
265 spin_lock_irqsave(&ioc->fw_event_lock, flags);
266 ioc->fw_events_off = 1;
267 ioc->sas_discovery_quiesce_io = 0;
268 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
269
270}
271
272/* enable sas firmware event handling */
273static void
274mptsas_fw_event_on(MPT_ADAPTER *ioc)
275{
276 unsigned long flags;
277
278 spin_lock_irqsave(&ioc->fw_event_lock, flags);
279 ioc->fw_events_off = 0;
280 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
281}
282
283/* queue a sas firmware event */
284static void
285mptsas_add_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
286 unsigned long delay)
287{
288 unsigned long flags;
289
290 spin_lock_irqsave(&ioc->fw_event_lock, flags);
291 list_add_tail(&fw_event->list, &ioc->fw_event_list);
292 INIT_DELAYED_WORK(&fw_event->work, mptsas_firmware_event_work);
293 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: add (fw_event=0x%p)"
294 "on cpuid %d\n", ioc->name, __func__,
295 fw_event, smp_processor_id()));
296 queue_delayed_work_on(smp_processor_id(), ioc->fw_event_q,
297 &fw_event->work, delay);
298 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
299}
300
301/* requeue a sas firmware event */
302static void
303mptsas_requeue_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
304 unsigned long delay)
305{
306 unsigned long flags;
307 spin_lock_irqsave(&ioc->fw_event_lock, flags);
308 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: reschedule task "
309 "(fw_event=0x%p)on cpuid %d\n", ioc->name, __func__,
310 fw_event, smp_processor_id()));
311 fw_event->retries++;
312 queue_delayed_work_on(smp_processor_id(), ioc->fw_event_q,
313 &fw_event->work, msecs_to_jiffies(delay));
314 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
315}
316
317/* free memory associated to a sas firmware event */
318static void
319mptsas_free_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event)
320{
321 unsigned long flags;
322
323 spin_lock_irqsave(&ioc->fw_event_lock, flags);
324 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: kfree (fw_event=0x%p)\n",
325 ioc->name, __func__, fw_event));
326 list_del(&fw_event->list);
327 kfree(fw_event);
328 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
329}
330
331/* walk the firmware event queue, and either stop or wait for
332 * outstanding events to complete */
333static void
334mptsas_cleanup_fw_event_q(MPT_ADAPTER *ioc)
335{
336 struct fw_event_work *fw_event, *next;
337 struct mptsas_target_reset_event *target_reset_list, *n;
338 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
339
340 /* flush the target_reset_list */
341 if (!list_empty(&hd->target_reset_list)) {
342 list_for_each_entry_safe(target_reset_list, n,
343 &hd->target_reset_list, list) {
344 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
345 "%s: removing target reset for id=%d\n",
346 ioc->name, __func__,
347 target_reset_list->sas_event_data.TargetID));
348 list_del(&target_reset_list->list);
349 kfree(target_reset_list);
350 }
351 }
352
353 if (list_empty(&ioc->fw_event_list) ||
354 !ioc->fw_event_q || in_interrupt())
355 return;
356
357 list_for_each_entry_safe(fw_event, next, &ioc->fw_event_list, list) {
358 if (cancel_delayed_work(&fw_event->work))
359 mptsas_free_fw_event(ioc, fw_event);
360 }
361}
362
363
364static inline MPT_ADAPTER *phy_to_ioc(struct sas_phy *phy)
365{
366 struct Scsi_Host *shost = dev_to_shost(phy->dev.parent);
367 return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
368}
369
370static inline MPT_ADAPTER *rphy_to_ioc(struct sas_rphy *rphy)
371{
372 struct Scsi_Host *shost = dev_to_shost(rphy->dev.parent->parent);
373 return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
374}
375
376/*
377 * mptsas_find_portinfo_by_handle
378 *
379 * This function should be called with the sas_topology_mutex already held
380 */
381static struct mptsas_portinfo *
382mptsas_find_portinfo_by_handle(MPT_ADAPTER *ioc, u16 handle)
383{
384 struct mptsas_portinfo *port_info, *rc=NULL;
385 int i;
386
387 list_for_each_entry(port_info, &ioc->sas_topology, list)
388 for (i = 0; i < port_info->num_phys; i++)
389 if (port_info->phy_info[i].identify.handle == handle) {
390 rc = port_info;
391 goto out;
392 }
393 out:
394 return rc;
395}
396
397/**
398 * mptsas_find_portinfo_by_sas_address -
399 * @ioc: Pointer to MPT_ADAPTER structure
400 * @handle:
401 *
402 * This function should be called with the sas_topology_mutex already held
403 *
404 **/
405static struct mptsas_portinfo *
406mptsas_find_portinfo_by_sas_address(MPT_ADAPTER *ioc, u64 sas_address)
407{
408 struct mptsas_portinfo *port_info, *rc = NULL;
409 int i;
410
411 if (sas_address >= ioc->hba_port_sas_addr &&
412 sas_address < (ioc->hba_port_sas_addr +
413 ioc->hba_port_num_phy))
414 return ioc->hba_port_info;
415
416 mutex_lock(&ioc->sas_topology_mutex);
417 list_for_each_entry(port_info, &ioc->sas_topology, list)
418 for (i = 0; i < port_info->num_phys; i++)
419 if (port_info->phy_info[i].identify.sas_address ==
420 sas_address) {
421 rc = port_info;
422 goto out;
423 }
424 out:
425 mutex_unlock(&ioc->sas_topology_mutex);
426 return rc;
427}
428
429/*
430 * Returns true if there is a scsi end device
431 */
432static inline int
433mptsas_is_end_device(struct mptsas_devinfo * attached)
434{
435 if ((attached->sas_address) &&
436 (attached->device_info &
437 MPI_SAS_DEVICE_INFO_END_DEVICE) &&
438 ((attached->device_info &
439 MPI_SAS_DEVICE_INFO_SSP_TARGET) |
440 (attached->device_info &
441 MPI_SAS_DEVICE_INFO_STP_TARGET) |
442 (attached->device_info &
443 MPI_SAS_DEVICE_INFO_SATA_DEVICE)))
444 return 1;
445 else
446 return 0;
447}
448
449/* no mutex */
450static void
451mptsas_port_delete(MPT_ADAPTER *ioc, struct mptsas_portinfo_details * port_details)
452{
453 struct mptsas_portinfo *port_info;
454 struct mptsas_phyinfo *phy_info;
455 u8 i;
456
457 if (!port_details)
458 return;
459
460 port_info = port_details->port_info;
461 phy_info = port_info->phy_info;
462
463 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: [%p]: num_phys=%02d "
464 "bitmask=0x%016llX\n", ioc->name, __func__, port_details,
465 port_details->num_phys, (unsigned long long)
466 port_details->phy_bitmask));
467
468 for (i = 0; i < port_info->num_phys; i++, phy_info++) {
469 if(phy_info->port_details != port_details)
470 continue;
471 memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
472 mptsas_set_rphy(ioc, phy_info, NULL);
473 phy_info->port_details = NULL;
474 }
475 kfree(port_details);
476}
477
478static inline struct sas_rphy *
479mptsas_get_rphy(struct mptsas_phyinfo *phy_info)
480{
481 if (phy_info->port_details)
482 return phy_info->port_details->rphy;
483 else
484 return NULL;
485}
486
487static inline void
488mptsas_set_rphy(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_rphy *rphy)
489{
490 if (phy_info->port_details) {
491 phy_info->port_details->rphy = rphy;
492 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "sas_rphy_add: rphy=%p\n",
493 ioc->name, rphy));
494 }
495
496 if (rphy) {
497 dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
498 &rphy->dev, MYIOC_s_FMT "add:", ioc->name));
499 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "rphy=%p release=%p\n",
500 ioc->name, rphy, rphy->dev.release));
501 }
502}
503
504static inline struct sas_port *
505mptsas_get_port(struct mptsas_phyinfo *phy_info)
506{
507 if (phy_info->port_details)
508 return phy_info->port_details->port;
509 else
510 return NULL;
511}
512
513static inline void
514mptsas_set_port(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_port *port)
515{
516 if (phy_info->port_details)
517 phy_info->port_details->port = port;
518
519 if (port) {
520 dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
521 &port->dev, MYIOC_s_FMT "add:", ioc->name));
522 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "port=%p release=%p\n",
523 ioc->name, port, port->dev.release));
524 }
525}
526
527static inline struct scsi_target *
528mptsas_get_starget(struct mptsas_phyinfo *phy_info)
529{
530 if (phy_info->port_details)
531 return phy_info->port_details->starget;
532 else
533 return NULL;
534}
535
536static inline void
537mptsas_set_starget(struct mptsas_phyinfo *phy_info, struct scsi_target *
538starget)
539{
540 if (phy_info->port_details)
541 phy_info->port_details->starget = starget;
542}
543
544/**
545 * mptsas_add_device_component -
546 * @ioc: Pointer to MPT_ADAPTER structure
547 * @channel: fw mapped id's
548 * @id:
549 * @sas_address:
550 * @device_info:
551 *
552 **/
553static void
554mptsas_add_device_component(MPT_ADAPTER *ioc, u8 channel, u8 id,
555 u64 sas_address, u32 device_info, u16 slot, u64 enclosure_logical_id)
556{
557 struct mptsas_device_info *sas_info, *next;
558 struct scsi_device *sdev;
559 struct scsi_target *starget;
560 struct sas_rphy *rphy;
561
562 /*
563 * Delete all matching devices out of the list
564 */
565 mutex_lock(&ioc->sas_device_info_mutex);
566 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
567 list) {
568 if (!sas_info->is_logical_volume &&
569 (sas_info->sas_address == sas_address ||
570 (sas_info->fw.channel == channel &&
571 sas_info->fw.id == id))) {
572 list_del(&sas_info->list);
573 kfree(sas_info);
574 }
575 }
576
577 sas_info = kzalloc(sizeof(struct mptsas_device_info), GFP_KERNEL);
578 if (!sas_info)
579 goto out;
580
581 /*
582 * Set Firmware mapping
583 */
584 sas_info->fw.id = id;
585 sas_info->fw.channel = channel;
586
587 sas_info->sas_address = sas_address;
588 sas_info->device_info = device_info;
589 sas_info->slot = slot;
590 sas_info->enclosure_logical_id = enclosure_logical_id;
591 INIT_LIST_HEAD(&sas_info->list);
592 list_add_tail(&sas_info->list, &ioc->sas_device_info_list);
593
594 /*
595 * Set OS mapping
596 */
597 shost_for_each_device(sdev, ioc->sh) {
598 starget = scsi_target(sdev);
599 rphy = dev_to_rphy(starget->dev.parent);
600 if (rphy->identify.sas_address == sas_address) {
601 sas_info->os.id = starget->id;
602 sas_info->os.channel = starget->channel;
603 }
604 }
605
606 out:
607 mutex_unlock(&ioc->sas_device_info_mutex);
608 return;
609}
610
611/**
612 * mptsas_add_device_component_by_fw -
613 * @ioc: Pointer to MPT_ADAPTER structure
614 * @channel: fw mapped id's
615 * @id:
616 *
617 **/
618static void
619mptsas_add_device_component_by_fw(MPT_ADAPTER *ioc, u8 channel, u8 id)
620{
621 struct mptsas_devinfo sas_device;
622 struct mptsas_enclosure enclosure_info;
623 int rc;
624
625 rc = mptsas_sas_device_pg0(ioc, &sas_device,
626 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
627 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
628 (channel << 8) + id);
629 if (rc)
630 return;
631
632 memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
633 mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
634 (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
635 MPI_SAS_ENCLOS_PGAD_FORM_SHIFT),
636 sas_device.handle_enclosure);
637
638 mptsas_add_device_component(ioc, sas_device.channel,
639 sas_device.id, sas_device.sas_address, sas_device.device_info,
640 sas_device.slot, enclosure_info.enclosure_logical_id);
641}
642
643/**
644 * mptsas_add_device_component_starget_ir - Handle Integrated RAID, adding each individual device to list
645 * @ioc: Pointer to MPT_ADAPTER structure
646 * @channel: fw mapped id's
647 * @id:
648 *
649 **/
650static void
651mptsas_add_device_component_starget_ir(MPT_ADAPTER *ioc,
652 struct scsi_target *starget)
653{
654 CONFIGPARMS cfg;
655 ConfigPageHeader_t hdr;
656 dma_addr_t dma_handle;
657 pRaidVolumePage0_t buffer = NULL;
658 int i;
659 RaidPhysDiskPage0_t phys_disk;
660 struct mptsas_device_info *sas_info, *next;
661
662 memset(&cfg, 0 , sizeof(CONFIGPARMS));
663 memset(&hdr, 0 , sizeof(ConfigPageHeader_t));
664 hdr.PageType = MPI_CONFIG_PAGETYPE_RAID_VOLUME;
665 /* assumption that all volumes on channel = 0 */
666 cfg.pageAddr = starget->id;
667 cfg.cfghdr.hdr = &hdr;
668 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
669 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
670
671 if (mpt_config(ioc, &cfg) != 0)
672 goto out;
673
674 if (!hdr.PageLength)
675 goto out;
676
677 buffer = pci_alloc_consistent(ioc->pcidev, hdr.PageLength * 4,
678 &dma_handle);
679
680 if (!buffer)
681 goto out;
682
683 cfg.physAddr = dma_handle;
684 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
685
686 if (mpt_config(ioc, &cfg) != 0)
687 goto out;
688
689 if (!buffer->NumPhysDisks)
690 goto out;
691
692 /*
693 * Adding entry for hidden components
694 */
695 for (i = 0; i < buffer->NumPhysDisks; i++) {
696
697 if (mpt_raid_phys_disk_pg0(ioc,
698 buffer->PhysDisk[i].PhysDiskNum, &phys_disk) != 0)
699 continue;
700
701 mptsas_add_device_component_by_fw(ioc, phys_disk.PhysDiskBus,
702 phys_disk.PhysDiskID);
703
704 mutex_lock(&ioc->sas_device_info_mutex);
705 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
706 list) {
707 if (!sas_info->is_logical_volume &&
708 (sas_info->fw.channel == phys_disk.PhysDiskBus &&
709 sas_info->fw.id == phys_disk.PhysDiskID)) {
710 sas_info->is_hidden_raid_component = 1;
711 sas_info->volume_id = starget->id;
712 }
713 }
714 mutex_unlock(&ioc->sas_device_info_mutex);
715
716 }
717
718 /*
719 * Delete all matching devices out of the list
720 */
721 mutex_lock(&ioc->sas_device_info_mutex);
722 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
723 list) {
724 if (sas_info->is_logical_volume && sas_info->fw.id ==
725 starget->id) {
726 list_del(&sas_info->list);
727 kfree(sas_info);
728 }
729 }
730
731 sas_info = kzalloc(sizeof(struct mptsas_device_info), GFP_KERNEL);
732 if (sas_info) {
733 sas_info->fw.id = starget->id;
734 sas_info->os.id = starget->id;
735 sas_info->os.channel = starget->channel;
736 sas_info->is_logical_volume = 1;
737 INIT_LIST_HEAD(&sas_info->list);
738 list_add_tail(&sas_info->list, &ioc->sas_device_info_list);
739 }
740 mutex_unlock(&ioc->sas_device_info_mutex);
741
742 out:
743 if (buffer)
744 pci_free_consistent(ioc->pcidev, hdr.PageLength * 4, buffer,
745 dma_handle);
746}
747
748/**
749 * mptsas_add_device_component_starget -
750 * @ioc: Pointer to MPT_ADAPTER structure
751 * @starget:
752 *
753 **/
754static void
755mptsas_add_device_component_starget(MPT_ADAPTER *ioc,
756 struct scsi_target *starget)
757{
758 VirtTarget *vtarget;
759 struct sas_rphy *rphy;
760 struct mptsas_phyinfo *phy_info = NULL;
761 struct mptsas_enclosure enclosure_info;
762
763 rphy = dev_to_rphy(starget->dev.parent);
764 vtarget = starget->hostdata;
765 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
766 rphy->identify.sas_address);
767 if (!phy_info)
768 return;
769
770 memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
771 mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
772 (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
773 MPI_SAS_ENCLOS_PGAD_FORM_SHIFT),
774 phy_info->attached.handle_enclosure);
775
776 mptsas_add_device_component(ioc, phy_info->attached.channel,
777 phy_info->attached.id, phy_info->attached.sas_address,
778 phy_info->attached.device_info,
779 phy_info->attached.slot, enclosure_info.enclosure_logical_id);
780}
781
782/**
783 * mptsas_del_device_component_by_os - Once a device has been removed, we mark the entry in the list as being cached
784 * @ioc: Pointer to MPT_ADAPTER structure
785 * @channel: os mapped id's
786 * @id:
787 *
788 **/
789static void
790mptsas_del_device_component_by_os(MPT_ADAPTER *ioc, u8 channel, u8 id)
791{
792 struct mptsas_device_info *sas_info, *next;
793
794 /*
795 * Set is_cached flag
796 */
797 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
798 list) {
799 if (sas_info->os.channel == channel && sas_info->os.id == id)
800 sas_info->is_cached = 1;
801 }
802}
803
804/**
805 * mptsas_del_device_components - Cleaning the list
806 * @ioc: Pointer to MPT_ADAPTER structure
807 *
808 **/
809static void
810mptsas_del_device_components(MPT_ADAPTER *ioc)
811{
812 struct mptsas_device_info *sas_info, *next;
813
814 mutex_lock(&ioc->sas_device_info_mutex);
815 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
816 list) {
817 list_del(&sas_info->list);
818 kfree(sas_info);
819 }
820 mutex_unlock(&ioc->sas_device_info_mutex);
821}
822
823
824/*
825 * mptsas_setup_wide_ports
826 *
827 * Updates for new and existing narrow/wide port configuration
828 * in the sas_topology
829 */
830static void
831mptsas_setup_wide_ports(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
832{
833 struct mptsas_portinfo_details * port_details;
834 struct mptsas_phyinfo *phy_info, *phy_info_cmp;
835 u64 sas_address;
836 int i, j;
837
838 mutex_lock(&ioc->sas_topology_mutex);
839
840 phy_info = port_info->phy_info;
841 for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
842 if (phy_info->attached.handle)
843 continue;
844 port_details = phy_info->port_details;
845 if (!port_details)
846 continue;
847 if (port_details->num_phys < 2)
848 continue;
849 /*
850 * Removing a phy from a port, letting the last
851 * phy be removed by firmware events.
852 */
853 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
854 "%s: [%p]: deleting phy = %d\n",
855 ioc->name, __func__, port_details, i));
856 port_details->num_phys--;
857 port_details->phy_bitmask &= ~ (1 << phy_info->phy_id);
858 memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
859 if (phy_info->phy) {
860 devtprintk(ioc, dev_printk(KERN_DEBUG,
861 &phy_info->phy->dev, MYIOC_s_FMT
862 "delete phy %d, phy-obj (0x%p)\n", ioc->name,
863 phy_info->phy_id, phy_info->phy));
864 sas_port_delete_phy(port_details->port, phy_info->phy);
865 }
866 phy_info->port_details = NULL;
867 }
868
869 /*
870 * Populate and refresh the tree
871 */
872 phy_info = port_info->phy_info;
873 for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
874 sas_address = phy_info->attached.sas_address;
875 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "phy_id=%d sas_address=0x%018llX\n",
876 ioc->name, i, (unsigned long long)sas_address));
877 if (!sas_address)
878 continue;
879 port_details = phy_info->port_details;
880 /*
881 * Forming a port
882 */
883 if (!port_details) {
884 port_details = kzalloc(sizeof(struct
885 mptsas_portinfo_details), GFP_KERNEL);
886 if (!port_details)
887 goto out;
888 port_details->num_phys = 1;
889 port_details->port_info = port_info;
890 if (phy_info->phy_id < 64 )
891 port_details->phy_bitmask |=
892 (1 << phy_info->phy_id);
893 phy_info->sas_port_add_phy=1;
894 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tForming port\n\t\t"
895 "phy_id=%d sas_address=0x%018llX\n",
896 ioc->name, i, (unsigned long long)sas_address));
897 phy_info->port_details = port_details;
898 }
899
900 if (i == port_info->num_phys - 1)
901 continue;
902 phy_info_cmp = &port_info->phy_info[i + 1];
903 for (j = i + 1 ; j < port_info->num_phys ; j++,
904 phy_info_cmp++) {
905 if (!phy_info_cmp->attached.sas_address)
906 continue;
907 if (sas_address != phy_info_cmp->attached.sas_address)
908 continue;
909 if (phy_info_cmp->port_details == port_details )
910 continue;
911 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
912 "\t\tphy_id=%d sas_address=0x%018llX\n",
913 ioc->name, j, (unsigned long long)
914 phy_info_cmp->attached.sas_address));
915 if (phy_info_cmp->port_details) {
916 port_details->rphy =
917 mptsas_get_rphy(phy_info_cmp);
918 port_details->port =
919 mptsas_get_port(phy_info_cmp);
920 port_details->starget =
921 mptsas_get_starget(phy_info_cmp);
922 port_details->num_phys =
923 phy_info_cmp->port_details->num_phys;
924 if (!phy_info_cmp->port_details->num_phys)
925 kfree(phy_info_cmp->port_details);
926 } else
927 phy_info_cmp->sas_port_add_phy=1;
928 /*
929 * Adding a phy to a port
930 */
931 phy_info_cmp->port_details = port_details;
932 if (phy_info_cmp->phy_id < 64 )
933 port_details->phy_bitmask |=
934 (1 << phy_info_cmp->phy_id);
935 port_details->num_phys++;
936 }
937 }
938
939 out:
940
941 for (i = 0; i < port_info->num_phys; i++) {
942 port_details = port_info->phy_info[i].port_details;
943 if (!port_details)
944 continue;
945 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
946 "%s: [%p]: phy_id=%02d num_phys=%02d "
947 "bitmask=0x%016llX\n", ioc->name, __func__,
948 port_details, i, port_details->num_phys,
949 (unsigned long long)port_details->phy_bitmask));
950 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tport = %p rphy=%p\n",
951 ioc->name, port_details->port, port_details->rphy));
952 }
953 dsaswideprintk(ioc, printk("\n"));
954 mutex_unlock(&ioc->sas_topology_mutex);
955}
956
957/**
958 * csmisas_find_vtarget
959 *
960 * @ioc
961 * @volume_id
962 * @volume_bus
963 *
964 **/
965static VirtTarget *
966mptsas_find_vtarget(MPT_ADAPTER *ioc, u8 channel, u8 id)
967{
968 struct scsi_device *sdev;
969 VirtDevice *vdevice;
970 VirtTarget *vtarget = NULL;
971
972 shost_for_each_device(sdev, ioc->sh) {
973 vdevice = sdev->hostdata;
974 if ((vdevice == NULL) ||
975 (vdevice->vtarget == NULL))
976 continue;
977 if ((vdevice->vtarget->tflags &
978 MPT_TARGET_FLAGS_RAID_COMPONENT ||
979 vdevice->vtarget->raidVolume))
980 continue;
981 if (vdevice->vtarget->id == id &&
982 vdevice->vtarget->channel == channel)
983 vtarget = vdevice->vtarget;
984 }
985 return vtarget;
986}
987
988static void
989mptsas_queue_device_delete(MPT_ADAPTER *ioc,
990 MpiEventDataSasDeviceStatusChange_t *sas_event_data)
991{
992 struct fw_event_work *fw_event;
993
994 fw_event = kzalloc(sizeof(*fw_event) +
995 sizeof(MpiEventDataSasDeviceStatusChange_t),
996 GFP_ATOMIC);
997 if (!fw_event) {
998 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n",
999 ioc->name, __func__, __LINE__);
1000 return;
1001 }
1002 memcpy(fw_event->event_data, sas_event_data,
1003 sizeof(MpiEventDataSasDeviceStatusChange_t));
1004 fw_event->event = MPI_EVENT_SAS_DEVICE_STATUS_CHANGE;
1005 fw_event->ioc = ioc;
1006 mptsas_add_fw_event(ioc, fw_event, msecs_to_jiffies(1));
1007}
1008
1009static void
1010mptsas_queue_rescan(MPT_ADAPTER *ioc)
1011{
1012 struct fw_event_work *fw_event;
1013
1014 fw_event = kzalloc(sizeof(*fw_event), GFP_ATOMIC);
1015 if (!fw_event) {
1016 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n",
1017 ioc->name, __func__, __LINE__);
1018 return;
1019 }
1020 fw_event->event = -1;
1021 fw_event->ioc = ioc;
1022 mptsas_add_fw_event(ioc, fw_event, msecs_to_jiffies(1));
1023}
1024
1025
1026/**
1027 * mptsas_target_reset
1028 *
1029 * Issues TARGET_RESET to end device using handshaking method
1030 *
1031 * @ioc
1032 * @channel
1033 * @id
1034 *
1035 * Returns (1) success
1036 * (0) failure
1037 *
1038 **/
1039static int
1040mptsas_target_reset(MPT_ADAPTER *ioc, u8 channel, u8 id)
1041{
1042 MPT_FRAME_HDR *mf;
1043 SCSITaskMgmt_t *pScsiTm;
1044 if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0)
1045 return 0;
1046
1047
1048 mf = mpt_get_msg_frame(mptsasDeviceResetCtx, ioc);
1049 if (mf == NULL) {
1050 dfailprintk(ioc, printk(MYIOC_s_WARN_FMT
1051 "%s, no msg frames @%d!!\n", ioc->name,
1052 __func__, __LINE__));
1053 goto out_fail;
1054 }
1055
1056 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt request (mf=%p)\n",
1057 ioc->name, mf));
1058
1059 /* Format the Request
1060 */
1061 pScsiTm = (SCSITaskMgmt_t *) mf;
1062 memset (pScsiTm, 0, sizeof(SCSITaskMgmt_t));
1063 pScsiTm->TargetID = id;
1064 pScsiTm->Bus = channel;
1065 pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
1066 pScsiTm->TaskType = MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET;
1067 pScsiTm->MsgFlags = MPI_SCSITASKMGMT_MSGFLAGS_LIPRESET_RESET_OPTION;
1068
1069 DBG_DUMP_TM_REQUEST_FRAME(ioc, (u32 *)mf);
1070
1071 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1072 "TaskMgmt type=%d (sas device delete) fw_channel = %d fw_id = %d)\n",
1073 ioc->name, MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET, channel, id));
1074
1075 mpt_put_msg_frame_hi_pri(mptsasDeviceResetCtx, ioc, mf);
1076
1077 return 1;
1078
1079 out_fail:
1080
1081 mpt_clear_taskmgmt_in_progress_flag(ioc);
1082 return 0;
1083}
1084
1085static void
1086mptsas_block_io_sdev(struct scsi_device *sdev, void *data)
1087{
1088 scsi_device_set_state(sdev, SDEV_BLOCK);
1089}
1090
1091static void
1092mptsas_block_io_starget(struct scsi_target *starget)
1093{
1094 if (starget)
1095 starget_for_each_device(starget, NULL, mptsas_block_io_sdev);
1096}
1097
1098/**
1099 * mptsas_target_reset_queue
1100 *
1101 * Receive request for TARGET_RESET after receiving an firmware
1102 * event NOT_RESPONDING_EVENT, then put command in link list
1103 * and queue if task_queue already in use.
1104 *
1105 * @ioc
1106 * @sas_event_data
1107 *
1108 **/
1109static void
1110mptsas_target_reset_queue(MPT_ADAPTER *ioc,
1111 EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data)
1112{
1113 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
1114 VirtTarget *vtarget = NULL;
1115 struct mptsas_target_reset_event *target_reset_list;
1116 u8 id, channel;
1117
1118 id = sas_event_data->TargetID;
1119 channel = sas_event_data->Bus;
1120
1121 vtarget = mptsas_find_vtarget(ioc, channel, id);
1122 if (vtarget) {
1123 mptsas_block_io_starget(vtarget->starget);
1124 vtarget->deleted = 1; /* block IO */
1125 }
1126
1127 target_reset_list = kzalloc(sizeof(struct mptsas_target_reset_event),
1128 GFP_ATOMIC);
1129 if (!target_reset_list) {
1130 dfailprintk(ioc, printk(MYIOC_s_WARN_FMT
1131 "%s, failed to allocate mem @%d..!!\n",
1132 ioc->name, __func__, __LINE__));
1133 return;
1134 }
1135
1136 memcpy(&target_reset_list->sas_event_data, sas_event_data,
1137 sizeof(*sas_event_data));
1138 list_add_tail(&target_reset_list->list, &hd->target_reset_list);
1139
1140 target_reset_list->time_count = jiffies;
1141
1142 if (mptsas_target_reset(ioc, channel, id)) {
1143 target_reset_list->target_reset_issued = 1;
1144 }
1145}
1146
1147/**
1148 * mptsas_schedule_target_reset- send pending target reset
1149 * @iocp: per adapter object
1150 *
1151 * This function will delete scheduled target reset from the list and
1152 * try to send next target reset. This will be called from completion
1153 * context of any Task management command.
1154 */
1155
1156void
1157mptsas_schedule_target_reset(void *iocp)
1158{
1159 MPT_ADAPTER *ioc = (MPT_ADAPTER *)(iocp);
1160 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
1161 struct list_head *head = &hd->target_reset_list;
1162 struct mptsas_target_reset_event *target_reset_list;
1163 u8 id, channel;
1164 /*
1165 * issue target reset to next device in the queue
1166 */
1167
1168 head = &hd->target_reset_list;
1169 if (list_empty(head))
1170 return;
1171
1172 target_reset_list = list_entry(head->next,
1173 struct mptsas_target_reset_event, list);
1174
1175 id = target_reset_list->sas_event_data.TargetID;
1176 channel = target_reset_list->sas_event_data.Bus;
1177 target_reset_list->time_count = jiffies;
1178
1179 if (mptsas_target_reset(ioc, channel, id))
1180 target_reset_list->target_reset_issued = 1;
1181 return;
1182}
1183
1184
1185/**
1186 * mptsas_taskmgmt_complete - complete SAS task management function
1187 * @ioc: Pointer to MPT_ADAPTER structure
1188 *
1189 * Completion for TARGET_RESET after NOT_RESPONDING_EVENT, enable work
1190 * queue to finish off removing device from upper layers. then send next
1191 * TARGET_RESET in the queue.
1192 **/
1193static int
1194mptsas_taskmgmt_complete(MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf, MPT_FRAME_HDR *mr)
1195{
1196 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
1197 struct list_head *head = &hd->target_reset_list;
1198 u8 id, channel;
1199 struct mptsas_target_reset_event *target_reset_list;
1200 SCSITaskMgmtReply_t *pScsiTmReply;
1201
1202 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt completed: "
1203 "(mf = %p, mr = %p)\n", ioc->name, mf, mr));
1204
1205 pScsiTmReply = (SCSITaskMgmtReply_t *)mr;
1206 if (!pScsiTmReply)
1207 return 0;
1208
1209 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1210 "\tTaskMgmt completed: fw_channel = %d, fw_id = %d,\n"
1211 "\ttask_type = 0x%02X, iocstatus = 0x%04X "
1212 "loginfo = 0x%08X,\n\tresponse_code = 0x%02X, "
1213 "term_cmnds = %d\n", ioc->name,
1214 pScsiTmReply->Bus, pScsiTmReply->TargetID,
1215 pScsiTmReply->TaskType,
1216 le16_to_cpu(pScsiTmReply->IOCStatus),
1217 le32_to_cpu(pScsiTmReply->IOCLogInfo),
1218 pScsiTmReply->ResponseCode,
1219 le32_to_cpu(pScsiTmReply->TerminationCount)));
1220
1221 if (pScsiTmReply->ResponseCode)
1222 mptscsih_taskmgmt_response_code(ioc,
1223 pScsiTmReply->ResponseCode);
1224
1225 if (pScsiTmReply->TaskType ==
1226 MPI_SCSITASKMGMT_TASKTYPE_QUERY_TASK || pScsiTmReply->TaskType ==
1227 MPI_SCSITASKMGMT_TASKTYPE_ABRT_TASK_SET) {
1228 ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
1229 ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_RF_VALID;
1230 memcpy(ioc->taskmgmt_cmds.reply, mr,
1231 min(MPT_DEFAULT_FRAME_SIZE, 4 * mr->u.reply.MsgLength));
1232 if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_PENDING) {
1233 ioc->taskmgmt_cmds.status &= ~MPT_MGMT_STATUS_PENDING;
1234 complete(&ioc->taskmgmt_cmds.done);
1235 return 1;
1236 }
1237 return 0;
1238 }
1239
1240 mpt_clear_taskmgmt_in_progress_flag(ioc);
1241
1242 if (list_empty(head))
1243 return 1;
1244
1245 target_reset_list = list_entry(head->next,
1246 struct mptsas_target_reset_event, list);
1247
1248 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1249 "TaskMgmt: completed (%d seconds)\n",
1250 ioc->name, jiffies_to_msecs(jiffies -
1251 target_reset_list->time_count)/1000));
1252
1253 id = pScsiTmReply->TargetID;
1254 channel = pScsiTmReply->Bus;
1255 target_reset_list->time_count = jiffies;
1256
1257 /*
1258 * retry target reset
1259 */
1260 if (!target_reset_list->target_reset_issued) {
1261 if (mptsas_target_reset(ioc, channel, id))
1262 target_reset_list->target_reset_issued = 1;
1263 return 1;
1264 }
1265
1266 /*
1267 * enable work queue to remove device from upper layers
1268 */
1269 list_del(&target_reset_list->list);
1270 if (!ioc->fw_events_off)
1271 mptsas_queue_device_delete(ioc,
1272 &target_reset_list->sas_event_data);
1273
1274
1275 ioc->schedule_target_reset(ioc);
1276
1277 return 1;
1278}
1279
1280/**
1281 * mptscsih_ioc_reset
1282 *
1283 * @ioc
1284 * @reset_phase
1285 *
1286 **/
1287static int
1288mptsas_ioc_reset(MPT_ADAPTER *ioc, int reset_phase)
1289{
1290 MPT_SCSI_HOST *hd;
1291 int rc;
1292
1293 rc = mptscsih_ioc_reset(ioc, reset_phase);
1294 if ((ioc->bus_type != SAS) || (!rc))
1295 return rc;
1296
1297 hd = shost_priv(ioc->sh);
1298 if (!hd->ioc)
1299 goto out;
1300
1301 switch (reset_phase) {
1302 case MPT_IOC_SETUP_RESET:
1303 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1304 "%s: MPT_IOC_SETUP_RESET\n", ioc->name, __func__));
1305 mptsas_fw_event_off(ioc);
1306 break;
1307 case MPT_IOC_PRE_RESET:
1308 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1309 "%s: MPT_IOC_PRE_RESET\n", ioc->name, __func__));
1310 break;
1311 case MPT_IOC_POST_RESET:
1312 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1313 "%s: MPT_IOC_POST_RESET\n", ioc->name, __func__));
1314 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_PENDING) {
1315 ioc->sas_mgmt.status |= MPT_MGMT_STATUS_DID_IOCRESET;
1316 complete(&ioc->sas_mgmt.done);
1317 }
1318 mptsas_cleanup_fw_event_q(ioc);
1319 mptsas_queue_rescan(ioc);
1320 break;
1321 default:
1322 break;
1323 }
1324
1325 out:
1326 return rc;
1327}
1328
1329
1330/**
1331 * enum device_state -
1332 * @DEVICE_RETRY: need to retry the TUR
1333 * @DEVICE_ERROR: TUR return error, don't add device
1334 * @DEVICE_READY: device can be added
1335 *
1336 */
1337enum device_state{
1338 DEVICE_RETRY,
1339 DEVICE_ERROR,
1340 DEVICE_READY,
1341};
1342
1343static int
1344mptsas_sas_enclosure_pg0(MPT_ADAPTER *ioc, struct mptsas_enclosure *enclosure,
1345 u32 form, u32 form_specific)
1346{
1347 ConfigExtendedPageHeader_t hdr;
1348 CONFIGPARMS cfg;
1349 SasEnclosurePage0_t *buffer;
1350 dma_addr_t dma_handle;
1351 int error;
1352 __le64 le_identifier;
1353
1354 memset(&hdr, 0, sizeof(hdr));
1355 hdr.PageVersion = MPI_SASENCLOSURE0_PAGEVERSION;
1356 hdr.PageNumber = 0;
1357 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
1358 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_ENCLOSURE;
1359
1360 cfg.cfghdr.ehdr = &hdr;
1361 cfg.physAddr = -1;
1362 cfg.pageAddr = form + form_specific;
1363 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
1364 cfg.dir = 0; /* read */
1365 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
1366
1367 error = mpt_config(ioc, &cfg);
1368 if (error)
1369 goto out;
1370 if (!hdr.ExtPageLength) {
1371 error = -ENXIO;
1372 goto out;
1373 }
1374
1375 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
1376 &dma_handle);
1377 if (!buffer) {
1378 error = -ENOMEM;
1379 goto out;
1380 }
1381
1382 cfg.physAddr = dma_handle;
1383 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
1384
1385 error = mpt_config(ioc, &cfg);
1386 if (error)
1387 goto out_free_consistent;
1388
1389 /* save config data */
1390 memcpy(&le_identifier, &buffer->EnclosureLogicalID, sizeof(__le64));
1391 enclosure->enclosure_logical_id = le64_to_cpu(le_identifier);
1392 enclosure->enclosure_handle = le16_to_cpu(buffer->EnclosureHandle);
1393 enclosure->flags = le16_to_cpu(buffer->Flags);
1394 enclosure->num_slot = le16_to_cpu(buffer->NumSlots);
1395 enclosure->start_slot = le16_to_cpu(buffer->StartSlot);
1396 enclosure->start_id = buffer->StartTargetID;
1397 enclosure->start_channel = buffer->StartBus;
1398 enclosure->sep_id = buffer->SEPTargetID;
1399 enclosure->sep_channel = buffer->SEPBus;
1400
1401 out_free_consistent:
1402 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
1403 buffer, dma_handle);
1404 out:
1405 return error;
1406}
1407
1408/**
1409 * mptsas_add_end_device - report a new end device to sas transport layer
1410 * @ioc: Pointer to MPT_ADAPTER structure
1411 * @phy_info: describes attached device
1412 *
1413 * return (0) success (1) failure
1414 *
1415 **/
1416static int
1417mptsas_add_end_device(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info)
1418{
1419 struct sas_rphy *rphy;
1420 struct sas_port *port;
1421 struct sas_identify identify;
1422 char *ds = NULL;
1423 u8 fw_id;
1424
1425 if (!phy_info) {
1426 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1427 "%s: exit at line=%d\n", ioc->name,
1428 __func__, __LINE__));
1429 return 1;
1430 }
1431
1432 fw_id = phy_info->attached.id;
1433
1434 if (mptsas_get_rphy(phy_info)) {
1435 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1436 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1437 __func__, fw_id, __LINE__));
1438 return 2;
1439 }
1440
1441 port = mptsas_get_port(phy_info);
1442 if (!port) {
1443 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1444 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1445 __func__, fw_id, __LINE__));
1446 return 3;
1447 }
1448
1449 if (phy_info->attached.device_info &
1450 MPI_SAS_DEVICE_INFO_SSP_TARGET)
1451 ds = "ssp";
1452 if (phy_info->attached.device_info &
1453 MPI_SAS_DEVICE_INFO_STP_TARGET)
1454 ds = "stp";
1455 if (phy_info->attached.device_info &
1456 MPI_SAS_DEVICE_INFO_SATA_DEVICE)
1457 ds = "sata";
1458
1459 printk(MYIOC_s_INFO_FMT "attaching %s device: fw_channel %d, fw_id %d,"
1460 " phy %d, sas_addr 0x%llx\n", ioc->name, ds,
1461 phy_info->attached.channel, phy_info->attached.id,
1462 phy_info->attached.phy_id, (unsigned long long)
1463 phy_info->attached.sas_address);
1464
1465 mptsas_parse_device_info(&identify, &phy_info->attached);
1466 rphy = sas_end_device_alloc(port);
1467 if (!rphy) {
1468 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1469 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1470 __func__, fw_id, __LINE__));
1471 return 5; /* non-fatal: an rphy can be added later */
1472 }
1473
1474 rphy->identify = identify;
1475 if (sas_rphy_add(rphy)) {
1476 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1477 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1478 __func__, fw_id, __LINE__));
1479 sas_rphy_free(rphy);
1480 return 6;
1481 }
1482 mptsas_set_rphy(ioc, phy_info, rphy);
1483 return 0;
1484}
1485
1486/**
1487 * mptsas_del_end_device - report a deleted end device to sas transport layer
1488 * @ioc: Pointer to MPT_ADAPTER structure
1489 * @phy_info: describes attached device
1490 *
1491 **/
1492static void
1493mptsas_del_end_device(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info)
1494{
1495 struct sas_rphy *rphy;
1496 struct sas_port *port;
1497 struct mptsas_portinfo *port_info;
1498 struct mptsas_phyinfo *phy_info_parent;
1499 int i;
1500 char *ds = NULL;
1501 u8 fw_id;
1502 u64 sas_address;
1503
1504 if (!phy_info)
1505 return;
1506
1507 fw_id = phy_info->attached.id;
1508 sas_address = phy_info->attached.sas_address;
1509
1510 if (!phy_info->port_details) {
1511 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1512 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1513 __func__, fw_id, __LINE__));
1514 return;
1515 }
1516 rphy = mptsas_get_rphy(phy_info);
1517 if (!rphy) {
1518 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1519 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1520 __func__, fw_id, __LINE__));
1521 return;
1522 }
1523
1524 if (phy_info->attached.device_info & MPI_SAS_DEVICE_INFO_SSP_INITIATOR
1525 || phy_info->attached.device_info
1526 & MPI_SAS_DEVICE_INFO_SMP_INITIATOR
1527 || phy_info->attached.device_info
1528 & MPI_SAS_DEVICE_INFO_STP_INITIATOR)
1529 ds = "initiator";
1530 if (phy_info->attached.device_info &
1531 MPI_SAS_DEVICE_INFO_SSP_TARGET)
1532 ds = "ssp";
1533 if (phy_info->attached.device_info &
1534 MPI_SAS_DEVICE_INFO_STP_TARGET)
1535 ds = "stp";
1536 if (phy_info->attached.device_info &
1537 MPI_SAS_DEVICE_INFO_SATA_DEVICE)
1538 ds = "sata";
1539
1540 dev_printk(KERN_DEBUG, &rphy->dev, MYIOC_s_FMT
1541 "removing %s device: fw_channel %d, fw_id %d, phy %d,"
1542 "sas_addr 0x%llx\n", ioc->name, ds, phy_info->attached.channel,
1543 phy_info->attached.id, phy_info->attached.phy_id,
1544 (unsigned long long) sas_address);
1545
1546 port = mptsas_get_port(phy_info);
1547 if (!port) {
1548 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1549 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1550 __func__, fw_id, __LINE__));
1551 return;
1552 }
1553 port_info = phy_info->portinfo;
1554 phy_info_parent = port_info->phy_info;
1555 for (i = 0; i < port_info->num_phys; i++, phy_info_parent++) {
1556 if (!phy_info_parent->phy)
1557 continue;
1558 if (phy_info_parent->attached.sas_address !=
1559 sas_address)
1560 continue;
1561 dev_printk(KERN_DEBUG, &phy_info_parent->phy->dev,
1562 MYIOC_s_FMT "delete phy %d, phy-obj (0x%p)\n",
1563 ioc->name, phy_info_parent->phy_id,
1564 phy_info_parent->phy);
1565 sas_port_delete_phy(port, phy_info_parent->phy);
1566 }
1567
1568 dev_printk(KERN_DEBUG, &port->dev, MYIOC_s_FMT
1569 "delete port %d, sas_addr (0x%llx)\n", ioc->name,
1570 port->port_identifier, (unsigned long long)sas_address);
1571 sas_port_delete(port);
1572 mptsas_set_port(ioc, phy_info, NULL);
1573 mptsas_port_delete(ioc, phy_info->port_details);
1574}
1575
1576static struct mptsas_phyinfo *
1577mptsas_refreshing_device_handles(MPT_ADAPTER *ioc,
1578 struct mptsas_devinfo *sas_device)
1579{
1580 struct mptsas_phyinfo *phy_info;
1581 struct mptsas_portinfo *port_info;
1582 int i;
1583
1584 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
1585 sas_device->sas_address);
1586 if (!phy_info)
1587 goto out;
1588 port_info = phy_info->portinfo;
1589 if (!port_info)
1590 goto out;
1591 mutex_lock(&ioc->sas_topology_mutex);
1592 for (i = 0; i < port_info->num_phys; i++) {
1593 if (port_info->phy_info[i].attached.sas_address !=
1594 sas_device->sas_address)
1595 continue;
1596 port_info->phy_info[i].attached.channel = sas_device->channel;
1597 port_info->phy_info[i].attached.id = sas_device->id;
1598 port_info->phy_info[i].attached.sas_address =
1599 sas_device->sas_address;
1600 port_info->phy_info[i].attached.handle = sas_device->handle;
1601 port_info->phy_info[i].attached.handle_parent =
1602 sas_device->handle_parent;
1603 port_info->phy_info[i].attached.handle_enclosure =
1604 sas_device->handle_enclosure;
1605 }
1606 mutex_unlock(&ioc->sas_topology_mutex);
1607 out:
1608 return phy_info;
1609}
1610
1611/**
1612 * mptsas_firmware_event_work - work thread for processing fw events
1613 * @work: work queue payload containing info describing the event
1614 * Context: user
1615 *
1616 */
1617static void
1618mptsas_firmware_event_work(struct work_struct *work)
1619{
1620 struct fw_event_work *fw_event =
1621 container_of(work, struct fw_event_work, work.work);
1622 MPT_ADAPTER *ioc = fw_event->ioc;
1623
1624 /* special rescan topology handling */
1625 if (fw_event->event == -1) {
1626 if (ioc->in_rescan) {
1627 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1628 "%s: rescan ignored as it is in progress\n",
1629 ioc->name, __func__));
1630 return;
1631 }
1632 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: rescan after "
1633 "reset\n", ioc->name, __func__));
1634 ioc->in_rescan = 1;
1635 mptsas_not_responding_devices(ioc);
1636 mptsas_scan_sas_topology(ioc);
1637 ioc->in_rescan = 0;
1638 mptsas_free_fw_event(ioc, fw_event);
1639 mptsas_fw_event_on(ioc);
1640 return;
1641 }
1642
1643 /* events handling turned off during host reset */
1644 if (ioc->fw_events_off) {
1645 mptsas_free_fw_event(ioc, fw_event);
1646 return;
1647 }
1648
1649 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: fw_event=(0x%p), "
1650 "event = (0x%02x)\n", ioc->name, __func__, fw_event,
1651 (fw_event->event & 0xFF)));
1652
1653 switch (fw_event->event) {
1654 case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
1655 mptsas_send_sas_event(fw_event);
1656 break;
1657 case MPI_EVENT_INTEGRATED_RAID:
1658 mptsas_send_raid_event(fw_event);
1659 break;
1660 case MPI_EVENT_IR2:
1661 mptsas_send_ir2_event(fw_event);
1662 break;
1663 case MPI_EVENT_PERSISTENT_TABLE_FULL:
1664 mptbase_sas_persist_operation(ioc,
1665 MPI_SAS_OP_CLEAR_NOT_PRESENT);
1666 mptsas_free_fw_event(ioc, fw_event);
1667 break;
1668 case MPI_EVENT_SAS_BROADCAST_PRIMITIVE:
1669 mptsas_broadcast_primative_work(fw_event);
1670 break;
1671 case MPI_EVENT_SAS_EXPANDER_STATUS_CHANGE:
1672 mptsas_send_expander_event(fw_event);
1673 break;
1674 case MPI_EVENT_SAS_PHY_LINK_STATUS:
1675 mptsas_send_link_status_event(fw_event);
1676 break;
1677 case MPI_EVENT_QUEUE_FULL:
1678 mptsas_handle_queue_full_event(fw_event);
1679 break;
1680 }
1681}
1682
1683
1684
1685static int
1686mptsas_slave_configure(struct scsi_device *sdev)
1687{
1688 struct Scsi_Host *host = sdev->host;
1689 MPT_SCSI_HOST *hd = shost_priv(host);
1690 MPT_ADAPTER *ioc = hd->ioc;
1691 VirtDevice *vdevice = sdev->hostdata;
1692
1693 if (vdevice->vtarget->deleted) {
1694 sdev_printk(KERN_INFO, sdev, "clearing deleted flag\n");
1695 vdevice->vtarget->deleted = 0;
1696 }
1697
1698 /*
1699 * RAID volumes placed beyond the last expected port.
1700 * Ignore sending sas mode pages in that case..
1701 */
1702 if (sdev->channel == MPTSAS_RAID_CHANNEL) {
1703 mptsas_add_device_component_starget_ir(ioc, scsi_target(sdev));
1704 goto out;
1705 }
1706
1707 sas_read_port_mode_page(sdev);
1708
1709 mptsas_add_device_component_starget(ioc, scsi_target(sdev));
1710
1711 out:
1712 return mptscsih_slave_configure(sdev);
1713}
1714
1715static int
1716mptsas_target_alloc(struct scsi_target *starget)
1717{
1718 struct Scsi_Host *host = dev_to_shost(&starget->dev);
1719 MPT_SCSI_HOST *hd = shost_priv(host);
1720 VirtTarget *vtarget;
1721 u8 id, channel;
1722 struct sas_rphy *rphy;
1723 struct mptsas_portinfo *p;
1724 int i;
1725 MPT_ADAPTER *ioc = hd->ioc;
1726
1727 vtarget = kzalloc(sizeof(VirtTarget), GFP_KERNEL);
1728 if (!vtarget)
1729 return -ENOMEM;
1730
1731 vtarget->starget = starget;
1732 vtarget->ioc_id = ioc->id;
1733 vtarget->tflags = MPT_TARGET_FLAGS_Q_YES;
1734 id = starget->id;
1735 channel = 0;
1736
1737 /*
1738 * RAID volumes placed beyond the last expected port.
1739 */
1740 if (starget->channel == MPTSAS_RAID_CHANNEL) {
1741 if (!ioc->raid_data.pIocPg2) {
1742 kfree(vtarget);
1743 return -ENXIO;
1744 }
1745 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
1746 if (id == ioc->raid_data.pIocPg2->
1747 RaidVolume[i].VolumeID) {
1748 channel = ioc->raid_data.pIocPg2->
1749 RaidVolume[i].VolumeBus;
1750 }
1751 }
1752 vtarget->raidVolume = 1;
1753 goto out;
1754 }
1755
1756 rphy = dev_to_rphy(starget->dev.parent);
1757 mutex_lock(&ioc->sas_topology_mutex);
1758 list_for_each_entry(p, &ioc->sas_topology, list) {
1759 for (i = 0; i < p->num_phys; i++) {
1760 if (p->phy_info[i].attached.sas_address !=
1761 rphy->identify.sas_address)
1762 continue;
1763 id = p->phy_info[i].attached.id;
1764 channel = p->phy_info[i].attached.channel;
1765 mptsas_set_starget(&p->phy_info[i], starget);
1766
1767 /*
1768 * Exposing hidden raid components
1769 */
1770 if (mptscsih_is_phys_disk(ioc, channel, id)) {
1771 id = mptscsih_raid_id_to_num(ioc,
1772 channel, id);
1773 vtarget->tflags |=
1774 MPT_TARGET_FLAGS_RAID_COMPONENT;
1775 p->phy_info[i].attached.phys_disk_num = id;
1776 }
1777 mutex_unlock(&ioc->sas_topology_mutex);
1778 goto out;
1779 }
1780 }
1781 mutex_unlock(&ioc->sas_topology_mutex);
1782
1783 kfree(vtarget);
1784 return -ENXIO;
1785
1786 out:
1787 vtarget->id = id;
1788 vtarget->channel = channel;
1789 starget->hostdata = vtarget;
1790 return 0;
1791}
1792
1793static void
1794mptsas_target_destroy(struct scsi_target *starget)
1795{
1796 struct Scsi_Host *host = dev_to_shost(&starget->dev);
1797 MPT_SCSI_HOST *hd = shost_priv(host);
1798 struct sas_rphy *rphy;
1799 struct mptsas_portinfo *p;
1800 int i;
1801 MPT_ADAPTER *ioc = hd->ioc;
1802 VirtTarget *vtarget;
1803
1804 if (!starget->hostdata)
1805 return;
1806
1807 vtarget = starget->hostdata;
1808
1809 mptsas_del_device_component_by_os(ioc, starget->channel,
1810 starget->id);
1811
1812
1813 if (starget->channel == MPTSAS_RAID_CHANNEL)
1814 goto out;
1815
1816 rphy = dev_to_rphy(starget->dev.parent);
1817 list_for_each_entry(p, &ioc->sas_topology, list) {
1818 for (i = 0; i < p->num_phys; i++) {
1819 if (p->phy_info[i].attached.sas_address !=
1820 rphy->identify.sas_address)
1821 continue;
1822
1823 starget_printk(KERN_INFO, starget, MYIOC_s_FMT
1824 "delete device: fw_channel %d, fw_id %d, phy %d, "
1825 "sas_addr 0x%llx\n", ioc->name,
1826 p->phy_info[i].attached.channel,
1827 p->phy_info[i].attached.id,
1828 p->phy_info[i].attached.phy_id, (unsigned long long)
1829 p->phy_info[i].attached.sas_address);
1830
1831 mptsas_set_starget(&p->phy_info[i], NULL);
1832 }
1833 }
1834
1835 out:
1836 vtarget->starget = NULL;
1837 kfree(starget->hostdata);
1838 starget->hostdata = NULL;
1839}
1840
1841
1842static int
1843mptsas_slave_alloc(struct scsi_device *sdev)
1844{
1845 struct Scsi_Host *host = sdev->host;
1846 MPT_SCSI_HOST *hd = shost_priv(host);
1847 struct sas_rphy *rphy;
1848 struct mptsas_portinfo *p;
1849 VirtDevice *vdevice;
1850 struct scsi_target *starget;
1851 int i;
1852 MPT_ADAPTER *ioc = hd->ioc;
1853
1854 vdevice = kzalloc(sizeof(VirtDevice), GFP_KERNEL);
1855 if (!vdevice) {
1856 printk(MYIOC_s_ERR_FMT "slave_alloc kzalloc(%zd) FAILED!\n",
1857 ioc->name, sizeof(VirtDevice));
1858 return -ENOMEM;
1859 }
1860 starget = scsi_target(sdev);
1861 vdevice->vtarget = starget->hostdata;
1862
1863 if (sdev->channel == MPTSAS_RAID_CHANNEL)
1864 goto out;
1865
1866 rphy = dev_to_rphy(sdev->sdev_target->dev.parent);
1867 mutex_lock(&ioc->sas_topology_mutex);
1868 list_for_each_entry(p, &ioc->sas_topology, list) {
1869 for (i = 0; i < p->num_phys; i++) {
1870 if (p->phy_info[i].attached.sas_address !=
1871 rphy->identify.sas_address)
1872 continue;
1873 vdevice->lun = sdev->lun;
1874 /*
1875 * Exposing hidden raid components
1876 */
1877 if (mptscsih_is_phys_disk(ioc,
1878 p->phy_info[i].attached.channel,
1879 p->phy_info[i].attached.id))
1880 sdev->no_uld_attach = 1;
1881 mutex_unlock(&ioc->sas_topology_mutex);
1882 goto out;
1883 }
1884 }
1885 mutex_unlock(&ioc->sas_topology_mutex);
1886
1887 kfree(vdevice);
1888 return -ENXIO;
1889
1890 out:
1891 vdevice->vtarget->num_luns++;
1892 sdev->hostdata = vdevice;
1893 return 0;
1894}
1895
1896static int
1897mptsas_qcmd(struct Scsi_Host *shost, struct scsi_cmnd *SCpnt)
1898{
1899 MPT_SCSI_HOST *hd;
1900 MPT_ADAPTER *ioc;
1901 VirtDevice *vdevice = SCpnt->device->hostdata;
1902
1903 if (!vdevice || !vdevice->vtarget || vdevice->vtarget->deleted) {
1904 SCpnt->result = DID_NO_CONNECT << 16;
1905 SCpnt->scsi_done(SCpnt);
1906 return 0;
1907 }
1908
1909 hd = shost_priv(shost);
1910 ioc = hd->ioc;
1911
1912 if (ioc->sas_discovery_quiesce_io)
1913 return SCSI_MLQUEUE_HOST_BUSY;
1914
1915 if (ioc->debug_level & MPT_DEBUG_SCSI)
1916 scsi_print_command(SCpnt);
1917
1918 return mptscsih_qcmd(SCpnt);
1919}
1920
1921/**
1922 * mptsas_mptsas_eh_timed_out - resets the scsi_cmnd timeout
1923 * if the device under question is currently in the
1924 * device removal delay.
1925 * @sc: scsi command that the midlayer is about to time out
1926 *
1927 **/
1928static enum blk_eh_timer_return mptsas_eh_timed_out(struct scsi_cmnd *sc)
1929{
1930 MPT_SCSI_HOST *hd;
1931 MPT_ADAPTER *ioc;
1932 VirtDevice *vdevice;
1933 enum blk_eh_timer_return rc = BLK_EH_NOT_HANDLED;
1934
1935 hd = shost_priv(sc->device->host);
1936 if (hd == NULL) {
1937 printk(KERN_ERR MYNAM ": %s: Can't locate host! (sc=%p)\n",
1938 __func__, sc);
1939 goto done;
1940 }
1941
1942 ioc = hd->ioc;
1943 if (ioc->bus_type != SAS) {
1944 printk(KERN_ERR MYNAM ": %s: Wrong bus type (sc=%p)\n",
1945 __func__, sc);
1946 goto done;
1947 }
1948
1949 /* In case if IOC is in reset from internal context.
1950 * Do not execute EEH for the same IOC. SML should to reset timer.
1951 */
1952 if (ioc->ioc_reset_in_progress) {
1953 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT ": %s: ioc is in reset,"
1954 "SML need to reset the timer (sc=%p)\n",
1955 ioc->name, __func__, sc));
1956 rc = BLK_EH_RESET_TIMER;
1957 }
1958 vdevice = sc->device->hostdata;
1959 if (vdevice && vdevice->vtarget && (vdevice->vtarget->inDMD
1960 || vdevice->vtarget->deleted)) {
1961 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT ": %s: target removed "
1962 "or in device removal delay (sc=%p)\n",
1963 ioc->name, __func__, sc));
1964 rc = BLK_EH_RESET_TIMER;
1965 goto done;
1966 }
1967
1968done:
1969 return rc;
1970}
1971
1972
1973static struct scsi_host_template mptsas_driver_template = {
1974 .module = THIS_MODULE,
1975 .proc_name = "mptsas",
1976 .show_info = mptscsih_show_info,
1977 .name = "MPT SAS Host",
1978 .info = mptscsih_info,
1979 .queuecommand = mptsas_qcmd,
1980 .target_alloc = mptsas_target_alloc,
1981 .slave_alloc = mptsas_slave_alloc,
1982 .slave_configure = mptsas_slave_configure,
1983 .target_destroy = mptsas_target_destroy,
1984 .slave_destroy = mptscsih_slave_destroy,
1985 .change_queue_depth = mptscsih_change_queue_depth,
1986 .eh_abort_handler = mptscsih_abort,
1987 .eh_device_reset_handler = mptscsih_dev_reset,
1988 .eh_host_reset_handler = mptscsih_host_reset,
1989 .bios_param = mptscsih_bios_param,
1990 .can_queue = MPT_SAS_CAN_QUEUE,
1991 .this_id = -1,
1992 .sg_tablesize = MPT_SCSI_SG_DEPTH,
1993 .max_sectors = 8192,
1994 .cmd_per_lun = 7,
1995 .use_clustering = ENABLE_CLUSTERING,
1996 .shost_attrs = mptscsih_host_attrs,
1997};
1998
1999static int mptsas_get_linkerrors(struct sas_phy *phy)
2000{
2001 MPT_ADAPTER *ioc = phy_to_ioc(phy);
2002 ConfigExtendedPageHeader_t hdr;
2003 CONFIGPARMS cfg;
2004 SasPhyPage1_t *buffer;
2005 dma_addr_t dma_handle;
2006 int error;
2007
2008 /* FIXME: only have link errors on local phys */
2009 if (!scsi_is_sas_phy_local(phy))
2010 return -EINVAL;
2011
2012 hdr.PageVersion = MPI_SASPHY1_PAGEVERSION;
2013 hdr.ExtPageLength = 0;
2014 hdr.PageNumber = 1 /* page number 1*/;
2015 hdr.Reserved1 = 0;
2016 hdr.Reserved2 = 0;
2017 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2018 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
2019
2020 cfg.cfghdr.ehdr = &hdr;
2021 cfg.physAddr = -1;
2022 cfg.pageAddr = phy->identify.phy_identifier;
2023 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2024 cfg.dir = 0; /* read */
2025 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2026
2027 error = mpt_config(ioc, &cfg);
2028 if (error)
2029 return error;
2030 if (!hdr.ExtPageLength)
2031 return -ENXIO;
2032
2033 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2034 &dma_handle);
2035 if (!buffer)
2036 return -ENOMEM;
2037
2038 cfg.physAddr = dma_handle;
2039 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2040
2041 error = mpt_config(ioc, &cfg);
2042 if (error)
2043 goto out_free_consistent;
2044
2045 mptsas_print_phy_pg1(ioc, buffer);
2046
2047 phy->invalid_dword_count = le32_to_cpu(buffer->InvalidDwordCount);
2048 phy->running_disparity_error_count =
2049 le32_to_cpu(buffer->RunningDisparityErrorCount);
2050 phy->loss_of_dword_sync_count =
2051 le32_to_cpu(buffer->LossDwordSynchCount);
2052 phy->phy_reset_problem_count =
2053 le32_to_cpu(buffer->PhyResetProblemCount);
2054
2055 out_free_consistent:
2056 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2057 buffer, dma_handle);
2058 return error;
2059}
2060
2061static int mptsas_mgmt_done(MPT_ADAPTER *ioc, MPT_FRAME_HDR *req,
2062 MPT_FRAME_HDR *reply)
2063{
2064 ioc->sas_mgmt.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
2065 if (reply != NULL) {
2066 ioc->sas_mgmt.status |= MPT_MGMT_STATUS_RF_VALID;
2067 memcpy(ioc->sas_mgmt.reply, reply,
2068 min(ioc->reply_sz, 4 * reply->u.reply.MsgLength));
2069 }
2070
2071 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_PENDING) {
2072 ioc->sas_mgmt.status &= ~MPT_MGMT_STATUS_PENDING;
2073 complete(&ioc->sas_mgmt.done);
2074 return 1;
2075 }
2076 return 0;
2077}
2078
2079static int mptsas_phy_reset(struct sas_phy *phy, int hard_reset)
2080{
2081 MPT_ADAPTER *ioc = phy_to_ioc(phy);
2082 SasIoUnitControlRequest_t *req;
2083 SasIoUnitControlReply_t *reply;
2084 MPT_FRAME_HDR *mf;
2085 MPIHeader_t *hdr;
2086 unsigned long timeleft;
2087 int error = -ERESTARTSYS;
2088
2089 /* FIXME: fusion doesn't allow non-local phy reset */
2090 if (!scsi_is_sas_phy_local(phy))
2091 return -EINVAL;
2092
2093 /* not implemented for expanders */
2094 if (phy->identify.target_port_protocols & SAS_PROTOCOL_SMP)
2095 return -ENXIO;
2096
2097 if (mutex_lock_interruptible(&ioc->sas_mgmt.mutex))
2098 goto out;
2099
2100 mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2101 if (!mf) {
2102 error = -ENOMEM;
2103 goto out_unlock;
2104 }
2105
2106 hdr = (MPIHeader_t *) mf;
2107 req = (SasIoUnitControlRequest_t *)mf;
2108 memset(req, 0, sizeof(SasIoUnitControlRequest_t));
2109 req->Function = MPI_FUNCTION_SAS_IO_UNIT_CONTROL;
2110 req->MsgContext = hdr->MsgContext;
2111 req->Operation = hard_reset ?
2112 MPI_SAS_OP_PHY_HARD_RESET : MPI_SAS_OP_PHY_LINK_RESET;
2113 req->PhyNum = phy->identify.phy_identifier;
2114
2115 INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2116 mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2117
2118 timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done,
2119 10 * HZ);
2120 if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2121 error = -ETIME;
2122 mpt_free_msg_frame(ioc, mf);
2123 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2124 goto out_unlock;
2125 if (!timeleft)
2126 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2127 goto out_unlock;
2128 }
2129
2130 /* a reply frame is expected */
2131 if ((ioc->sas_mgmt.status &
2132 MPT_MGMT_STATUS_RF_VALID) == 0) {
2133 error = -ENXIO;
2134 goto out_unlock;
2135 }
2136
2137 /* process the completed Reply Message Frame */
2138 reply = (SasIoUnitControlReply_t *)ioc->sas_mgmt.reply;
2139 if (reply->IOCStatus != MPI_IOCSTATUS_SUCCESS) {
2140 printk(MYIOC_s_INFO_FMT "%s: IOCStatus=0x%X IOCLogInfo=0x%X\n",
2141 ioc->name, __func__, reply->IOCStatus, reply->IOCLogInfo);
2142 error = -ENXIO;
2143 goto out_unlock;
2144 }
2145
2146 error = 0;
2147
2148 out_unlock:
2149 CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2150 mutex_unlock(&ioc->sas_mgmt.mutex);
2151 out:
2152 return error;
2153}
2154
2155static int
2156mptsas_get_enclosure_identifier(struct sas_rphy *rphy, u64 *identifier)
2157{
2158 MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
2159 int i, error;
2160 struct mptsas_portinfo *p;
2161 struct mptsas_enclosure enclosure_info;
2162 u64 enclosure_handle;
2163
2164 mutex_lock(&ioc->sas_topology_mutex);
2165 list_for_each_entry(p, &ioc->sas_topology, list) {
2166 for (i = 0; i < p->num_phys; i++) {
2167 if (p->phy_info[i].attached.sas_address ==
2168 rphy->identify.sas_address) {
2169 enclosure_handle = p->phy_info[i].
2170 attached.handle_enclosure;
2171 goto found_info;
2172 }
2173 }
2174 }
2175 mutex_unlock(&ioc->sas_topology_mutex);
2176 return -ENXIO;
2177
2178 found_info:
2179 mutex_unlock(&ioc->sas_topology_mutex);
2180 memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
2181 error = mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
2182 (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
2183 MPI_SAS_ENCLOS_PGAD_FORM_SHIFT), enclosure_handle);
2184 if (!error)
2185 *identifier = enclosure_info.enclosure_logical_id;
2186 return error;
2187}
2188
2189static int
2190mptsas_get_bay_identifier(struct sas_rphy *rphy)
2191{
2192 MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
2193 struct mptsas_portinfo *p;
2194 int i, rc;
2195
2196 mutex_lock(&ioc->sas_topology_mutex);
2197 list_for_each_entry(p, &ioc->sas_topology, list) {
2198 for (i = 0; i < p->num_phys; i++) {
2199 if (p->phy_info[i].attached.sas_address ==
2200 rphy->identify.sas_address) {
2201 rc = p->phy_info[i].attached.slot;
2202 goto out;
2203 }
2204 }
2205 }
2206 rc = -ENXIO;
2207 out:
2208 mutex_unlock(&ioc->sas_topology_mutex);
2209 return rc;
2210}
2211
2212static int mptsas_smp_handler(struct Scsi_Host *shost, struct sas_rphy *rphy,
2213 struct request *req)
2214{
2215 MPT_ADAPTER *ioc = ((MPT_SCSI_HOST *) shost->hostdata)->ioc;
2216 MPT_FRAME_HDR *mf;
2217 SmpPassthroughRequest_t *smpreq;
2218 struct request *rsp = req->next_rq;
2219 int ret;
2220 int flagsLength;
2221 unsigned long timeleft;
2222 char *psge;
2223 dma_addr_t dma_addr_in = 0;
2224 dma_addr_t dma_addr_out = 0;
2225 u64 sas_address = 0;
2226
2227 if (!rsp) {
2228 printk(MYIOC_s_ERR_FMT "%s: the smp response space is missing\n",
2229 ioc->name, __func__);
2230 return -EINVAL;
2231 }
2232
2233 /* do we need to support multiple segments? */
2234 if (bio_multiple_segments(req->bio) ||
2235 bio_multiple_segments(rsp->bio)) {
2236 printk(MYIOC_s_ERR_FMT "%s: multiple segments req %u, rsp %u\n",
2237 ioc->name, __func__, blk_rq_bytes(req), blk_rq_bytes(rsp));
2238 return -EINVAL;
2239 }
2240
2241 ret = mutex_lock_interruptible(&ioc->sas_mgmt.mutex);
2242 if (ret)
2243 goto out;
2244
2245 mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2246 if (!mf) {
2247 ret = -ENOMEM;
2248 goto out_unlock;
2249 }
2250
2251 smpreq = (SmpPassthroughRequest_t *)mf;
2252 memset(smpreq, 0, sizeof(*smpreq));
2253
2254 smpreq->RequestDataLength = cpu_to_le16(blk_rq_bytes(req) - 4);
2255 smpreq->Function = MPI_FUNCTION_SMP_PASSTHROUGH;
2256
2257 if (rphy)
2258 sas_address = rphy->identify.sas_address;
2259 else {
2260 struct mptsas_portinfo *port_info;
2261
2262 mutex_lock(&ioc->sas_topology_mutex);
2263 port_info = ioc->hba_port_info;
2264 if (port_info && port_info->phy_info)
2265 sas_address =
2266 port_info->phy_info[0].phy->identify.sas_address;
2267 mutex_unlock(&ioc->sas_topology_mutex);
2268 }
2269
2270 *((u64 *)&smpreq->SASAddress) = cpu_to_le64(sas_address);
2271
2272 psge = (char *)
2273 (((int *) mf) + (offsetof(SmpPassthroughRequest_t, SGL) / 4));
2274
2275 /* request */
2276 flagsLength = (MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2277 MPI_SGE_FLAGS_END_OF_BUFFER |
2278 MPI_SGE_FLAGS_DIRECTION)
2279 << MPI_SGE_FLAGS_SHIFT;
2280 flagsLength |= (blk_rq_bytes(req) - 4);
2281
2282 dma_addr_out = pci_map_single(ioc->pcidev, bio_data(req->bio),
2283 blk_rq_bytes(req), PCI_DMA_BIDIRECTIONAL);
2284 if (!dma_addr_out)
2285 goto put_mf;
2286 ioc->add_sge(psge, flagsLength, dma_addr_out);
2287 psge += ioc->SGE_size;
2288
2289 /* response */
2290 flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2291 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2292 MPI_SGE_FLAGS_IOC_TO_HOST |
2293 MPI_SGE_FLAGS_END_OF_BUFFER;
2294
2295 flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2296 flagsLength |= blk_rq_bytes(rsp) + 4;
2297 dma_addr_in = pci_map_single(ioc->pcidev, bio_data(rsp->bio),
2298 blk_rq_bytes(rsp), PCI_DMA_BIDIRECTIONAL);
2299 if (!dma_addr_in)
2300 goto unmap;
2301 ioc->add_sge(psge, flagsLength, dma_addr_in);
2302
2303 INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2304 mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2305
2306 timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done, 10 * HZ);
2307 if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2308 ret = -ETIME;
2309 mpt_free_msg_frame(ioc, mf);
2310 mf = NULL;
2311 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2312 goto unmap;
2313 if (!timeleft)
2314 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2315 goto unmap;
2316 }
2317 mf = NULL;
2318
2319 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_RF_VALID) {
2320 SmpPassthroughReply_t *smprep;
2321
2322 smprep = (SmpPassthroughReply_t *)ioc->sas_mgmt.reply;
2323 memcpy(req->sense, smprep, sizeof(*smprep));
2324 req->sense_len = sizeof(*smprep);
2325 req->resid_len = 0;
2326 rsp->resid_len -= smprep->ResponseDataLength;
2327 } else {
2328 printk(MYIOC_s_ERR_FMT
2329 "%s: smp passthru reply failed to be returned\n",
2330 ioc->name, __func__);
2331 ret = -ENXIO;
2332 }
2333unmap:
2334 if (dma_addr_out)
2335 pci_unmap_single(ioc->pcidev, dma_addr_out, blk_rq_bytes(req),
2336 PCI_DMA_BIDIRECTIONAL);
2337 if (dma_addr_in)
2338 pci_unmap_single(ioc->pcidev, dma_addr_in, blk_rq_bytes(rsp),
2339 PCI_DMA_BIDIRECTIONAL);
2340put_mf:
2341 if (mf)
2342 mpt_free_msg_frame(ioc, mf);
2343out_unlock:
2344 CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2345 mutex_unlock(&ioc->sas_mgmt.mutex);
2346out:
2347 return ret;
2348}
2349
2350static struct sas_function_template mptsas_transport_functions = {
2351 .get_linkerrors = mptsas_get_linkerrors,
2352 .get_enclosure_identifier = mptsas_get_enclosure_identifier,
2353 .get_bay_identifier = mptsas_get_bay_identifier,
2354 .phy_reset = mptsas_phy_reset,
2355 .smp_handler = mptsas_smp_handler,
2356};
2357
2358static struct scsi_transport_template *mptsas_transport_template;
2359
2360static int
2361mptsas_sas_io_unit_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
2362{
2363 ConfigExtendedPageHeader_t hdr;
2364 CONFIGPARMS cfg;
2365 SasIOUnitPage0_t *buffer;
2366 dma_addr_t dma_handle;
2367 int error, i;
2368
2369 hdr.PageVersion = MPI_SASIOUNITPAGE0_PAGEVERSION;
2370 hdr.ExtPageLength = 0;
2371 hdr.PageNumber = 0;
2372 hdr.Reserved1 = 0;
2373 hdr.Reserved2 = 0;
2374 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2375 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
2376
2377 cfg.cfghdr.ehdr = &hdr;
2378 cfg.physAddr = -1;
2379 cfg.pageAddr = 0;
2380 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2381 cfg.dir = 0; /* read */
2382 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2383
2384 error = mpt_config(ioc, &cfg);
2385 if (error)
2386 goto out;
2387 if (!hdr.ExtPageLength) {
2388 error = -ENXIO;
2389 goto out;
2390 }
2391
2392 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2393 &dma_handle);
2394 if (!buffer) {
2395 error = -ENOMEM;
2396 goto out;
2397 }
2398
2399 cfg.physAddr = dma_handle;
2400 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2401
2402 error = mpt_config(ioc, &cfg);
2403 if (error)
2404 goto out_free_consistent;
2405
2406 port_info->num_phys = buffer->NumPhys;
2407 port_info->phy_info = kcalloc(port_info->num_phys,
2408 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
2409 if (!port_info->phy_info) {
2410 error = -ENOMEM;
2411 goto out_free_consistent;
2412 }
2413
2414 ioc->nvdata_version_persistent =
2415 le16_to_cpu(buffer->NvdataVersionPersistent);
2416 ioc->nvdata_version_default =
2417 le16_to_cpu(buffer->NvdataVersionDefault);
2418
2419 for (i = 0; i < port_info->num_phys; i++) {
2420 mptsas_print_phy_data(ioc, &buffer->PhyData[i]);
2421 port_info->phy_info[i].phy_id = i;
2422 port_info->phy_info[i].port_id =
2423 buffer->PhyData[i].Port;
2424 port_info->phy_info[i].negotiated_link_rate =
2425 buffer->PhyData[i].NegotiatedLinkRate;
2426 port_info->phy_info[i].portinfo = port_info;
2427 port_info->phy_info[i].handle =
2428 le16_to_cpu(buffer->PhyData[i].ControllerDevHandle);
2429 }
2430
2431 out_free_consistent:
2432 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2433 buffer, dma_handle);
2434 out:
2435 return error;
2436}
2437
2438static int
2439mptsas_sas_io_unit_pg1(MPT_ADAPTER *ioc)
2440{
2441 ConfigExtendedPageHeader_t hdr;
2442 CONFIGPARMS cfg;
2443 SasIOUnitPage1_t *buffer;
2444 dma_addr_t dma_handle;
2445 int error;
2446 u8 device_missing_delay;
2447
2448 memset(&hdr, 0, sizeof(ConfigExtendedPageHeader_t));
2449 memset(&cfg, 0, sizeof(CONFIGPARMS));
2450
2451 cfg.cfghdr.ehdr = &hdr;
2452 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2453 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2454 cfg.cfghdr.ehdr->PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2455 cfg.cfghdr.ehdr->ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
2456 cfg.cfghdr.ehdr->PageVersion = MPI_SASIOUNITPAGE1_PAGEVERSION;
2457 cfg.cfghdr.ehdr->PageNumber = 1;
2458
2459 error = mpt_config(ioc, &cfg);
2460 if (error)
2461 goto out;
2462 if (!hdr.ExtPageLength) {
2463 error = -ENXIO;
2464 goto out;
2465 }
2466
2467 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2468 &dma_handle);
2469 if (!buffer) {
2470 error = -ENOMEM;
2471 goto out;
2472 }
2473
2474 cfg.physAddr = dma_handle;
2475 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2476
2477 error = mpt_config(ioc, &cfg);
2478 if (error)
2479 goto out_free_consistent;
2480
2481 ioc->io_missing_delay =
2482 le16_to_cpu(buffer->IODeviceMissingDelay);
2483 device_missing_delay = buffer->ReportDeviceMissingDelay;
2484 ioc->device_missing_delay = (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_UNIT_16) ?
2485 (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK) * 16 :
2486 device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK;
2487
2488 out_free_consistent:
2489 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2490 buffer, dma_handle);
2491 out:
2492 return error;
2493}
2494
2495static int
2496mptsas_sas_phy_pg0(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
2497 u32 form, u32 form_specific)
2498{
2499 ConfigExtendedPageHeader_t hdr;
2500 CONFIGPARMS cfg;
2501 SasPhyPage0_t *buffer;
2502 dma_addr_t dma_handle;
2503 int error;
2504
2505 hdr.PageVersion = MPI_SASPHY0_PAGEVERSION;
2506 hdr.ExtPageLength = 0;
2507 hdr.PageNumber = 0;
2508 hdr.Reserved1 = 0;
2509 hdr.Reserved2 = 0;
2510 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2511 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
2512
2513 cfg.cfghdr.ehdr = &hdr;
2514 cfg.dir = 0; /* read */
2515 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2516
2517 /* Get Phy Pg 0 for each Phy. */
2518 cfg.physAddr = -1;
2519 cfg.pageAddr = form + form_specific;
2520 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2521
2522 error = mpt_config(ioc, &cfg);
2523 if (error)
2524 goto out;
2525
2526 if (!hdr.ExtPageLength) {
2527 error = -ENXIO;
2528 goto out;
2529 }
2530
2531 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2532 &dma_handle);
2533 if (!buffer) {
2534 error = -ENOMEM;
2535 goto out;
2536 }
2537
2538 cfg.physAddr = dma_handle;
2539 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2540
2541 error = mpt_config(ioc, &cfg);
2542 if (error)
2543 goto out_free_consistent;
2544
2545 mptsas_print_phy_pg0(ioc, buffer);
2546
2547 phy_info->hw_link_rate = buffer->HwLinkRate;
2548 phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
2549 phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
2550 phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
2551
2552 out_free_consistent:
2553 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2554 buffer, dma_handle);
2555 out:
2556 return error;
2557}
2558
2559static int
2560mptsas_sas_device_pg0(MPT_ADAPTER *ioc, struct mptsas_devinfo *device_info,
2561 u32 form, u32 form_specific)
2562{
2563 ConfigExtendedPageHeader_t hdr;
2564 CONFIGPARMS cfg;
2565 SasDevicePage0_t *buffer;
2566 dma_addr_t dma_handle;
2567 __le64 sas_address;
2568 int error=0;
2569
2570 hdr.PageVersion = MPI_SASDEVICE0_PAGEVERSION;
2571 hdr.ExtPageLength = 0;
2572 hdr.PageNumber = 0;
2573 hdr.Reserved1 = 0;
2574 hdr.Reserved2 = 0;
2575 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2576 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE;
2577
2578 cfg.cfghdr.ehdr = &hdr;
2579 cfg.pageAddr = form + form_specific;
2580 cfg.physAddr = -1;
2581 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2582 cfg.dir = 0; /* read */
2583 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2584
2585 memset(device_info, 0, sizeof(struct mptsas_devinfo));
2586 error = mpt_config(ioc, &cfg);
2587 if (error)
2588 goto out;
2589 if (!hdr.ExtPageLength) {
2590 error = -ENXIO;
2591 goto out;
2592 }
2593
2594 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2595 &dma_handle);
2596 if (!buffer) {
2597 error = -ENOMEM;
2598 goto out;
2599 }
2600
2601 cfg.physAddr = dma_handle;
2602 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2603
2604 error = mpt_config(ioc, &cfg);
2605
2606 if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2607 error = -ENODEV;
2608 goto out_free_consistent;
2609 }
2610
2611 if (error)
2612 goto out_free_consistent;
2613
2614 mptsas_print_device_pg0(ioc, buffer);
2615
2616 memset(device_info, 0, sizeof(struct mptsas_devinfo));
2617 device_info->handle = le16_to_cpu(buffer->DevHandle);
2618 device_info->handle_parent = le16_to_cpu(buffer->ParentDevHandle);
2619 device_info->handle_enclosure =
2620 le16_to_cpu(buffer->EnclosureHandle);
2621 device_info->slot = le16_to_cpu(buffer->Slot);
2622 device_info->phy_id = buffer->PhyNum;
2623 device_info->port_id = buffer->PhysicalPort;
2624 device_info->id = buffer->TargetID;
2625 device_info->phys_disk_num = ~0;
2626 device_info->channel = buffer->Bus;
2627 memcpy(&sas_address, &buffer->SASAddress, sizeof(__le64));
2628 device_info->sas_address = le64_to_cpu(sas_address);
2629 device_info->device_info =
2630 le32_to_cpu(buffer->DeviceInfo);
2631 device_info->flags = le16_to_cpu(buffer->Flags);
2632
2633 out_free_consistent:
2634 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2635 buffer, dma_handle);
2636 out:
2637 return error;
2638}
2639
2640static int
2641mptsas_sas_expander_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info,
2642 u32 form, u32 form_specific)
2643{
2644 ConfigExtendedPageHeader_t hdr;
2645 CONFIGPARMS cfg;
2646 SasExpanderPage0_t *buffer;
2647 dma_addr_t dma_handle;
2648 int i, error;
2649 __le64 sas_address;
2650
2651 memset(port_info, 0, sizeof(struct mptsas_portinfo));
2652 hdr.PageVersion = MPI_SASEXPANDER0_PAGEVERSION;
2653 hdr.ExtPageLength = 0;
2654 hdr.PageNumber = 0;
2655 hdr.Reserved1 = 0;
2656 hdr.Reserved2 = 0;
2657 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2658 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
2659
2660 cfg.cfghdr.ehdr = &hdr;
2661 cfg.physAddr = -1;
2662 cfg.pageAddr = form + form_specific;
2663 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2664 cfg.dir = 0; /* read */
2665 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2666
2667 memset(port_info, 0, sizeof(struct mptsas_portinfo));
2668 error = mpt_config(ioc, &cfg);
2669 if (error)
2670 goto out;
2671
2672 if (!hdr.ExtPageLength) {
2673 error = -ENXIO;
2674 goto out;
2675 }
2676
2677 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2678 &dma_handle);
2679 if (!buffer) {
2680 error = -ENOMEM;
2681 goto out;
2682 }
2683
2684 cfg.physAddr = dma_handle;
2685 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2686
2687 error = mpt_config(ioc, &cfg);
2688 if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2689 error = -ENODEV;
2690 goto out_free_consistent;
2691 }
2692
2693 if (error)
2694 goto out_free_consistent;
2695
2696 /* save config data */
2697 port_info->num_phys = (buffer->NumPhys) ? buffer->NumPhys : 1;
2698 port_info->phy_info = kcalloc(port_info->num_phys,
2699 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
2700 if (!port_info->phy_info) {
2701 error = -ENOMEM;
2702 goto out_free_consistent;
2703 }
2704
2705 memcpy(&sas_address, &buffer->SASAddress, sizeof(__le64));
2706 for (i = 0; i < port_info->num_phys; i++) {
2707 port_info->phy_info[i].portinfo = port_info;
2708 port_info->phy_info[i].handle =
2709 le16_to_cpu(buffer->DevHandle);
2710 port_info->phy_info[i].identify.sas_address =
2711 le64_to_cpu(sas_address);
2712 port_info->phy_info[i].identify.handle_parent =
2713 le16_to_cpu(buffer->ParentDevHandle);
2714 }
2715
2716 out_free_consistent:
2717 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2718 buffer, dma_handle);
2719 out:
2720 return error;
2721}
2722
2723static int
2724mptsas_sas_expander_pg1(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
2725 u32 form, u32 form_specific)
2726{
2727 ConfigExtendedPageHeader_t hdr;
2728 CONFIGPARMS cfg;
2729 SasExpanderPage1_t *buffer;
2730 dma_addr_t dma_handle;
2731 int error=0;
2732
2733 hdr.PageVersion = MPI_SASEXPANDER1_PAGEVERSION;
2734 hdr.ExtPageLength = 0;
2735 hdr.PageNumber = 1;
2736 hdr.Reserved1 = 0;
2737 hdr.Reserved2 = 0;
2738 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2739 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
2740
2741 cfg.cfghdr.ehdr = &hdr;
2742 cfg.physAddr = -1;
2743 cfg.pageAddr = form + form_specific;
2744 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2745 cfg.dir = 0; /* read */
2746 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2747
2748 error = mpt_config(ioc, &cfg);
2749 if (error)
2750 goto out;
2751
2752 if (!hdr.ExtPageLength) {
2753 error = -ENXIO;
2754 goto out;
2755 }
2756
2757 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2758 &dma_handle);
2759 if (!buffer) {
2760 error = -ENOMEM;
2761 goto out;
2762 }
2763
2764 cfg.physAddr = dma_handle;
2765 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2766
2767 error = mpt_config(ioc, &cfg);
2768
2769 if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2770 error = -ENODEV;
2771 goto out_free_consistent;
2772 }
2773
2774 if (error)
2775 goto out_free_consistent;
2776
2777
2778 mptsas_print_expander_pg1(ioc, buffer);
2779
2780 /* save config data */
2781 phy_info->phy_id = buffer->PhyIdentifier;
2782 phy_info->port_id = buffer->PhysicalPort;
2783 phy_info->negotiated_link_rate = buffer->NegotiatedLinkRate;
2784 phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
2785 phy_info->hw_link_rate = buffer->HwLinkRate;
2786 phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
2787 phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
2788
2789 out_free_consistent:
2790 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2791 buffer, dma_handle);
2792 out:
2793 return error;
2794}
2795
2796struct rep_manu_request{
2797 u8 smp_frame_type;
2798 u8 function;
2799 u8 reserved;
2800 u8 request_length;
2801};
2802
2803struct rep_manu_reply{
2804 u8 smp_frame_type; /* 0x41 */
2805 u8 function; /* 0x01 */
2806 u8 function_result;
2807 u8 response_length;
2808 u16 expander_change_count;
2809 u8 reserved0[2];
2810 u8 sas_format:1;
2811 u8 reserved1:7;
2812 u8 reserved2[3];
2813 u8 vendor_id[SAS_EXPANDER_VENDOR_ID_LEN];
2814 u8 product_id[SAS_EXPANDER_PRODUCT_ID_LEN];
2815 u8 product_rev[SAS_EXPANDER_PRODUCT_REV_LEN];
2816 u8 component_vendor_id[SAS_EXPANDER_COMPONENT_VENDOR_ID_LEN];
2817 u16 component_id;
2818 u8 component_revision_id;
2819 u8 reserved3;
2820 u8 vendor_specific[8];
2821};
2822
2823/**
2824 * mptsas_exp_repmanufacture_info -
2825 * @ioc: per adapter object
2826 * @sas_address: expander sas address
2827 * @edev: the sas_expander_device object
2828 *
2829 * Fills in the sas_expander_device object when SMP port is created.
2830 *
2831 * Returns 0 for success, non-zero for failure.
2832 */
2833static int
2834mptsas_exp_repmanufacture_info(MPT_ADAPTER *ioc,
2835 u64 sas_address, struct sas_expander_device *edev)
2836{
2837 MPT_FRAME_HDR *mf;
2838 SmpPassthroughRequest_t *smpreq;
2839 SmpPassthroughReply_t *smprep;
2840 struct rep_manu_reply *manufacture_reply;
2841 struct rep_manu_request *manufacture_request;
2842 int ret;
2843 int flagsLength;
2844 unsigned long timeleft;
2845 char *psge;
2846 unsigned long flags;
2847 void *data_out = NULL;
2848 dma_addr_t data_out_dma = 0;
2849 u32 sz;
2850
2851 spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
2852 if (ioc->ioc_reset_in_progress) {
2853 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
2854 printk(MYIOC_s_INFO_FMT "%s: host reset in progress!\n",
2855 __func__, ioc->name);
2856 return -EFAULT;
2857 }
2858 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
2859
2860 ret = mutex_lock_interruptible(&ioc->sas_mgmt.mutex);
2861 if (ret)
2862 goto out;
2863
2864 mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2865 if (!mf) {
2866 ret = -ENOMEM;
2867 goto out_unlock;
2868 }
2869
2870 smpreq = (SmpPassthroughRequest_t *)mf;
2871 memset(smpreq, 0, sizeof(*smpreq));
2872
2873 sz = sizeof(struct rep_manu_request) + sizeof(struct rep_manu_reply);
2874
2875 data_out = pci_alloc_consistent(ioc->pcidev, sz, &data_out_dma);
2876 if (!data_out) {
2877 printk(KERN_ERR "Memory allocation failure at %s:%d/%s()!\n",
2878 __FILE__, __LINE__, __func__);
2879 ret = -ENOMEM;
2880 goto put_mf;
2881 }
2882
2883 manufacture_request = data_out;
2884 manufacture_request->smp_frame_type = 0x40;
2885 manufacture_request->function = 1;
2886 manufacture_request->reserved = 0;
2887 manufacture_request->request_length = 0;
2888
2889 smpreq->Function = MPI_FUNCTION_SMP_PASSTHROUGH;
2890 smpreq->PhysicalPort = 0xFF;
2891 *((u64 *)&smpreq->SASAddress) = cpu_to_le64(sas_address);
2892 smpreq->RequestDataLength = sizeof(struct rep_manu_request);
2893
2894 psge = (char *)
2895 (((int *) mf) + (offsetof(SmpPassthroughRequest_t, SGL) / 4));
2896
2897 flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2898 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2899 MPI_SGE_FLAGS_HOST_TO_IOC |
2900 MPI_SGE_FLAGS_END_OF_BUFFER;
2901 flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2902 flagsLength |= sizeof(struct rep_manu_request);
2903
2904 ioc->add_sge(psge, flagsLength, data_out_dma);
2905 psge += ioc->SGE_size;
2906
2907 flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2908 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2909 MPI_SGE_FLAGS_IOC_TO_HOST |
2910 MPI_SGE_FLAGS_END_OF_BUFFER;
2911 flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2912 flagsLength |= sizeof(struct rep_manu_reply);
2913 ioc->add_sge(psge, flagsLength, data_out_dma +
2914 sizeof(struct rep_manu_request));
2915
2916 INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2917 mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2918
2919 timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done, 10 * HZ);
2920 if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2921 ret = -ETIME;
2922 mpt_free_msg_frame(ioc, mf);
2923 mf = NULL;
2924 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2925 goto out_free;
2926 if (!timeleft)
2927 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2928 goto out_free;
2929 }
2930
2931 mf = NULL;
2932
2933 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_RF_VALID) {
2934 u8 *tmp;
2935
2936 smprep = (SmpPassthroughReply_t *)ioc->sas_mgmt.reply;
2937 if (le16_to_cpu(smprep->ResponseDataLength) !=
2938 sizeof(struct rep_manu_reply))
2939 goto out_free;
2940
2941 manufacture_reply = data_out + sizeof(struct rep_manu_request);
2942 strncpy(edev->vendor_id, manufacture_reply->vendor_id,
2943 SAS_EXPANDER_VENDOR_ID_LEN);
2944 strncpy(edev->product_id, manufacture_reply->product_id,
2945 SAS_EXPANDER_PRODUCT_ID_LEN);
2946 strncpy(edev->product_rev, manufacture_reply->product_rev,
2947 SAS_EXPANDER_PRODUCT_REV_LEN);
2948 edev->level = manufacture_reply->sas_format;
2949 if (manufacture_reply->sas_format) {
2950 strncpy(edev->component_vendor_id,
2951 manufacture_reply->component_vendor_id,
2952 SAS_EXPANDER_COMPONENT_VENDOR_ID_LEN);
2953 tmp = (u8 *)&manufacture_reply->component_id;
2954 edev->component_id = tmp[0] << 8 | tmp[1];
2955 edev->component_revision_id =
2956 manufacture_reply->component_revision_id;
2957 }
2958 } else {
2959 printk(MYIOC_s_ERR_FMT
2960 "%s: smp passthru reply failed to be returned\n",
2961 ioc->name, __func__);
2962 ret = -ENXIO;
2963 }
2964out_free:
2965 if (data_out_dma)
2966 pci_free_consistent(ioc->pcidev, sz, data_out, data_out_dma);
2967put_mf:
2968 if (mf)
2969 mpt_free_msg_frame(ioc, mf);
2970out_unlock:
2971 CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2972 mutex_unlock(&ioc->sas_mgmt.mutex);
2973out:
2974 return ret;
2975 }
2976
2977static void
2978mptsas_parse_device_info(struct sas_identify *identify,
2979 struct mptsas_devinfo *device_info)
2980{
2981 u16 protocols;
2982
2983 identify->sas_address = device_info->sas_address;
2984 identify->phy_identifier = device_info->phy_id;
2985
2986 /*
2987 * Fill in Phy Initiator Port Protocol.
2988 * Bits 6:3, more than one bit can be set, fall through cases.
2989 */
2990 protocols = device_info->device_info & 0x78;
2991 identify->initiator_port_protocols = 0;
2992 if (protocols & MPI_SAS_DEVICE_INFO_SSP_INITIATOR)
2993 identify->initiator_port_protocols |= SAS_PROTOCOL_SSP;
2994 if (protocols & MPI_SAS_DEVICE_INFO_STP_INITIATOR)
2995 identify->initiator_port_protocols |= SAS_PROTOCOL_STP;
2996 if (protocols & MPI_SAS_DEVICE_INFO_SMP_INITIATOR)
2997 identify->initiator_port_protocols |= SAS_PROTOCOL_SMP;
2998 if (protocols & MPI_SAS_DEVICE_INFO_SATA_HOST)
2999 identify->initiator_port_protocols |= SAS_PROTOCOL_SATA;
3000
3001 /*
3002 * Fill in Phy Target Port Protocol.
3003 * Bits 10:7, more than one bit can be set, fall through cases.
3004 */
3005 protocols = device_info->device_info & 0x780;
3006 identify->target_port_protocols = 0;
3007 if (protocols & MPI_SAS_DEVICE_INFO_SSP_TARGET)
3008 identify->target_port_protocols |= SAS_PROTOCOL_SSP;
3009 if (protocols & MPI_SAS_DEVICE_INFO_STP_TARGET)
3010 identify->target_port_protocols |= SAS_PROTOCOL_STP;
3011 if (protocols & MPI_SAS_DEVICE_INFO_SMP_TARGET)
3012 identify->target_port_protocols |= SAS_PROTOCOL_SMP;
3013 if (protocols & MPI_SAS_DEVICE_INFO_SATA_DEVICE)
3014 identify->target_port_protocols |= SAS_PROTOCOL_SATA;
3015
3016 /*
3017 * Fill in Attached device type.
3018 */
3019 switch (device_info->device_info &
3020 MPI_SAS_DEVICE_INFO_MASK_DEVICE_TYPE) {
3021 case MPI_SAS_DEVICE_INFO_NO_DEVICE:
3022 identify->device_type = SAS_PHY_UNUSED;
3023 break;
3024 case MPI_SAS_DEVICE_INFO_END_DEVICE:
3025 identify->device_type = SAS_END_DEVICE;
3026 break;
3027 case MPI_SAS_DEVICE_INFO_EDGE_EXPANDER:
3028 identify->device_type = SAS_EDGE_EXPANDER_DEVICE;
3029 break;
3030 case MPI_SAS_DEVICE_INFO_FANOUT_EXPANDER:
3031 identify->device_type = SAS_FANOUT_EXPANDER_DEVICE;
3032 break;
3033 }
3034}
3035
3036static int mptsas_probe_one_phy(struct device *dev,
3037 struct mptsas_phyinfo *phy_info, int index, int local)
3038{
3039 MPT_ADAPTER *ioc;
3040 struct sas_phy *phy;
3041 struct sas_port *port;
3042 int error = 0;
3043 VirtTarget *vtarget;
3044
3045 if (!dev) {
3046 error = -ENODEV;
3047 goto out;
3048 }
3049
3050 if (!phy_info->phy) {
3051 phy = sas_phy_alloc(dev, index);
3052 if (!phy) {
3053 error = -ENOMEM;
3054 goto out;
3055 }
3056 } else
3057 phy = phy_info->phy;
3058
3059 mptsas_parse_device_info(&phy->identify, &phy_info->identify);
3060
3061 /*
3062 * Set Negotiated link rate.
3063 */
3064 switch (phy_info->negotiated_link_rate) {
3065 case MPI_SAS_IOUNIT0_RATE_PHY_DISABLED:
3066 phy->negotiated_linkrate = SAS_PHY_DISABLED;
3067 break;
3068 case MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION:
3069 phy->negotiated_linkrate = SAS_LINK_RATE_FAILED;
3070 break;
3071 case MPI_SAS_IOUNIT0_RATE_1_5:
3072 phy->negotiated_linkrate = SAS_LINK_RATE_1_5_GBPS;
3073 break;
3074 case MPI_SAS_IOUNIT0_RATE_3_0:
3075 phy->negotiated_linkrate = SAS_LINK_RATE_3_0_GBPS;
3076 break;
3077 case MPI_SAS_IOUNIT0_RATE_6_0:
3078 phy->negotiated_linkrate = SAS_LINK_RATE_6_0_GBPS;
3079 break;
3080 case MPI_SAS_IOUNIT0_RATE_SATA_OOB_COMPLETE:
3081 case MPI_SAS_IOUNIT0_RATE_UNKNOWN:
3082 default:
3083 phy->negotiated_linkrate = SAS_LINK_RATE_UNKNOWN;
3084 break;
3085 }
3086
3087 /*
3088 * Set Max hardware link rate.
3089 */
3090 switch (phy_info->hw_link_rate & MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
3091 case MPI_SAS_PHY0_HWRATE_MAX_RATE_1_5:
3092 phy->maximum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
3093 break;
3094 case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
3095 phy->maximum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
3096 break;
3097 default:
3098 break;
3099 }
3100
3101 /*
3102 * Set Max programmed link rate.
3103 */
3104 switch (phy_info->programmed_link_rate &
3105 MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
3106 case MPI_SAS_PHY0_PRATE_MAX_RATE_1_5:
3107 phy->maximum_linkrate = SAS_LINK_RATE_1_5_GBPS;
3108 break;
3109 case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
3110 phy->maximum_linkrate = SAS_LINK_RATE_3_0_GBPS;
3111 break;
3112 default:
3113 break;
3114 }
3115
3116 /*
3117 * Set Min hardware link rate.
3118 */
3119 switch (phy_info->hw_link_rate & MPI_SAS_PHY0_HWRATE_MIN_RATE_MASK) {
3120 case MPI_SAS_PHY0_HWRATE_MIN_RATE_1_5:
3121 phy->minimum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
3122 break;
3123 case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
3124 phy->minimum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
3125 break;
3126 default:
3127 break;
3128 }
3129
3130 /*
3131 * Set Min programmed link rate.
3132 */
3133 switch (phy_info->programmed_link_rate &
3134 MPI_SAS_PHY0_PRATE_MIN_RATE_MASK) {
3135 case MPI_SAS_PHY0_PRATE_MIN_RATE_1_5:
3136 phy->minimum_linkrate = SAS_LINK_RATE_1_5_GBPS;
3137 break;
3138 case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
3139 phy->minimum_linkrate = SAS_LINK_RATE_3_0_GBPS;
3140 break;
3141 default:
3142 break;
3143 }
3144
3145 if (!phy_info->phy) {
3146
3147 error = sas_phy_add(phy);
3148 if (error) {
3149 sas_phy_free(phy);
3150 goto out;
3151 }
3152 phy_info->phy = phy;
3153 }
3154
3155 if (!phy_info->attached.handle ||
3156 !phy_info->port_details)
3157 goto out;
3158
3159 port = mptsas_get_port(phy_info);
3160 ioc = phy_to_ioc(phy_info->phy);
3161
3162 if (phy_info->sas_port_add_phy) {
3163
3164 if (!port) {
3165 port = sas_port_alloc_num(dev);
3166 if (!port) {
3167 error = -ENOMEM;
3168 goto out;
3169 }
3170 error = sas_port_add(port);
3171 if (error) {
3172 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3173 "%s: exit at line=%d\n", ioc->name,
3174 __func__, __LINE__));
3175 goto out;
3176 }
3177 mptsas_set_port(ioc, phy_info, port);
3178 devtprintk(ioc, dev_printk(KERN_DEBUG, &port->dev,
3179 MYIOC_s_FMT "add port %d, sas_addr (0x%llx)\n",
3180 ioc->name, port->port_identifier,
3181 (unsigned long long)phy_info->
3182 attached.sas_address));
3183 }
3184 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3185 "sas_port_add_phy: phy_id=%d\n",
3186 ioc->name, phy_info->phy_id));
3187 sas_port_add_phy(port, phy_info->phy);
3188 phy_info->sas_port_add_phy = 0;
3189 devtprintk(ioc, dev_printk(KERN_DEBUG, &phy_info->phy->dev,
3190 MYIOC_s_FMT "add phy %d, phy-obj (0x%p)\n", ioc->name,
3191 phy_info->phy_id, phy_info->phy));
3192 }
3193 if (!mptsas_get_rphy(phy_info) && port && !port->rphy) {
3194
3195 struct sas_rphy *rphy;
3196 struct device *parent;
3197 struct sas_identify identify;
3198
3199 parent = dev->parent->parent;
3200 /*
3201 * Let the hotplug_work thread handle processing
3202 * the adding/removing of devices that occur
3203 * after start of day.
3204 */
3205 if (mptsas_is_end_device(&phy_info->attached) &&
3206 phy_info->attached.handle_parent) {
3207 goto out;
3208 }
3209
3210 mptsas_parse_device_info(&identify, &phy_info->attached);
3211 if (scsi_is_host_device(parent)) {
3212 struct mptsas_portinfo *port_info;
3213 int i;
3214
3215 port_info = ioc->hba_port_info;
3216
3217 for (i = 0; i < port_info->num_phys; i++)
3218 if (port_info->phy_info[i].identify.sas_address ==
3219 identify.sas_address) {
3220 sas_port_mark_backlink(port);
3221 goto out;
3222 }
3223
3224 } else if (scsi_is_sas_rphy(parent)) {
3225 struct sas_rphy *parent_rphy = dev_to_rphy(parent);
3226 if (identify.sas_address ==
3227 parent_rphy->identify.sas_address) {
3228 sas_port_mark_backlink(port);
3229 goto out;
3230 }
3231 }
3232
3233 switch (identify.device_type) {
3234 case SAS_END_DEVICE:
3235 rphy = sas_end_device_alloc(port);
3236 break;
3237 case SAS_EDGE_EXPANDER_DEVICE:
3238 case SAS_FANOUT_EXPANDER_DEVICE:
3239 rphy = sas_expander_alloc(port, identify.device_type);
3240 break;
3241 default:
3242 rphy = NULL;
3243 break;
3244 }
3245 if (!rphy) {
3246 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3247 "%s: exit at line=%d\n", ioc->name,
3248 __func__, __LINE__));
3249 goto out;
3250 }
3251
3252 rphy->identify = identify;
3253 error = sas_rphy_add(rphy);
3254 if (error) {
3255 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3256 "%s: exit at line=%d\n", ioc->name,
3257 __func__, __LINE__));
3258 sas_rphy_free(rphy);
3259 goto out;
3260 }
3261 mptsas_set_rphy(ioc, phy_info, rphy);
3262 if (identify.device_type == SAS_EDGE_EXPANDER_DEVICE ||
3263 identify.device_type == SAS_FANOUT_EXPANDER_DEVICE)
3264 mptsas_exp_repmanufacture_info(ioc,
3265 identify.sas_address,
3266 rphy_to_expander_device(rphy));
3267 }
3268
3269 /* If the device exists,verify it wasn't previously flagged
3270 as a missing device. If so, clear it */
3271 vtarget = mptsas_find_vtarget(ioc,
3272 phy_info->attached.channel,
3273 phy_info->attached.id);
3274 if (vtarget && vtarget->inDMD) {
3275 printk(KERN_INFO "Device returned, unsetting inDMD\n");
3276 vtarget->inDMD = 0;
3277 }
3278
3279 out:
3280 return error;
3281}
3282
3283static int
3284mptsas_probe_hba_phys(MPT_ADAPTER *ioc)
3285{
3286 struct mptsas_portinfo *port_info, *hba;
3287 int error = -ENOMEM, i;
3288
3289 hba = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3290 if (! hba)
3291 goto out;
3292
3293 error = mptsas_sas_io_unit_pg0(ioc, hba);
3294 if (error)
3295 goto out_free_port_info;
3296
3297 mptsas_sas_io_unit_pg1(ioc);
3298 mutex_lock(&ioc->sas_topology_mutex);
3299 port_info = ioc->hba_port_info;
3300 if (!port_info) {
3301 ioc->hba_port_info = port_info = hba;
3302 ioc->hba_port_num_phy = port_info->num_phys;
3303 list_add_tail(&port_info->list, &ioc->sas_topology);
3304 } else {
3305 for (i = 0; i < hba->num_phys; i++) {
3306 port_info->phy_info[i].negotiated_link_rate =
3307 hba->phy_info[i].negotiated_link_rate;
3308 port_info->phy_info[i].handle =
3309 hba->phy_info[i].handle;
3310 port_info->phy_info[i].port_id =
3311 hba->phy_info[i].port_id;
3312 }
3313 kfree(hba->phy_info);
3314 kfree(hba);
3315 hba = NULL;
3316 }
3317 mutex_unlock(&ioc->sas_topology_mutex);
3318#if defined(CPQ_CIM)
3319 ioc->num_ports = port_info->num_phys;
3320#endif
3321 for (i = 0; i < port_info->num_phys; i++) {
3322 mptsas_sas_phy_pg0(ioc, &port_info->phy_info[i],
3323 (MPI_SAS_PHY_PGAD_FORM_PHY_NUMBER <<
3324 MPI_SAS_PHY_PGAD_FORM_SHIFT), i);
3325 port_info->phy_info[i].identify.handle =
3326 port_info->phy_info[i].handle;
3327 mptsas_sas_device_pg0(ioc, &port_info->phy_info[i].identify,
3328 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3329 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3330 port_info->phy_info[i].identify.handle);
3331 if (!ioc->hba_port_sas_addr)
3332 ioc->hba_port_sas_addr =
3333 port_info->phy_info[i].identify.sas_address;
3334 port_info->phy_info[i].identify.phy_id =
3335 port_info->phy_info[i].phy_id = i;
3336 if (port_info->phy_info[i].attached.handle)
3337 mptsas_sas_device_pg0(ioc,
3338 &port_info->phy_info[i].attached,
3339 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3340 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3341 port_info->phy_info[i].attached.handle);
3342 }
3343
3344 mptsas_setup_wide_ports(ioc, port_info);
3345
3346 for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
3347 mptsas_probe_one_phy(&ioc->sh->shost_gendev,
3348 &port_info->phy_info[i], ioc->sas_index, 1);
3349
3350 return 0;
3351
3352 out_free_port_info:
3353 kfree(hba);
3354 out:
3355 return error;
3356}
3357
3358static void
3359mptsas_expander_refresh(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
3360{
3361 struct mptsas_portinfo *parent;
3362 struct device *parent_dev;
3363 struct sas_rphy *rphy;
3364 int i;
3365 u64 sas_address; /* expander sas address */
3366 u32 handle;
3367
3368 handle = port_info->phy_info[0].handle;
3369 sas_address = port_info->phy_info[0].identify.sas_address;
3370 for (i = 0; i < port_info->num_phys; i++) {
3371 mptsas_sas_expander_pg1(ioc, &port_info->phy_info[i],
3372 (MPI_SAS_EXPAND_PGAD_FORM_HANDLE_PHY_NUM <<
3373 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), (i << 16) + handle);
3374
3375 mptsas_sas_device_pg0(ioc,
3376 &port_info->phy_info[i].identify,
3377 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3378 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3379 port_info->phy_info[i].identify.handle);
3380 port_info->phy_info[i].identify.phy_id =
3381 port_info->phy_info[i].phy_id;
3382
3383 if (port_info->phy_info[i].attached.handle) {
3384 mptsas_sas_device_pg0(ioc,
3385 &port_info->phy_info[i].attached,
3386 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3387 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3388 port_info->phy_info[i].attached.handle);
3389 port_info->phy_info[i].attached.phy_id =
3390 port_info->phy_info[i].phy_id;
3391 }
3392 }
3393
3394 mutex_lock(&ioc->sas_topology_mutex);
3395 parent = mptsas_find_portinfo_by_handle(ioc,
3396 port_info->phy_info[0].identify.handle_parent);
3397 if (!parent) {
3398 mutex_unlock(&ioc->sas_topology_mutex);
3399 return;
3400 }
3401 for (i = 0, parent_dev = NULL; i < parent->num_phys && !parent_dev;
3402 i++) {
3403 if (parent->phy_info[i].attached.sas_address == sas_address) {
3404 rphy = mptsas_get_rphy(&parent->phy_info[i]);
3405 parent_dev = &rphy->dev;
3406 }
3407 }
3408 mutex_unlock(&ioc->sas_topology_mutex);
3409
3410 mptsas_setup_wide_ports(ioc, port_info);
3411 for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
3412 mptsas_probe_one_phy(parent_dev, &port_info->phy_info[i],
3413 ioc->sas_index, 0);
3414}
3415
3416static void
3417mptsas_expander_event_add(MPT_ADAPTER *ioc,
3418 MpiEventDataSasExpanderStatusChange_t *expander_data)
3419{
3420 struct mptsas_portinfo *port_info;
3421 int i;
3422 __le64 sas_address;
3423
3424 port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3425 if (!port_info)
3426 BUG();
3427 port_info->num_phys = (expander_data->NumPhys) ?
3428 expander_data->NumPhys : 1;
3429 port_info->phy_info = kcalloc(port_info->num_phys,
3430 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
3431 if (!port_info->phy_info)
3432 BUG();
3433 memcpy(&sas_address, &expander_data->SASAddress, sizeof(__le64));
3434 for (i = 0; i < port_info->num_phys; i++) {
3435 port_info->phy_info[i].portinfo = port_info;
3436 port_info->phy_info[i].handle =
3437 le16_to_cpu(expander_data->DevHandle);
3438 port_info->phy_info[i].identify.sas_address =
3439 le64_to_cpu(sas_address);
3440 port_info->phy_info[i].identify.handle_parent =
3441 le16_to_cpu(expander_data->ParentDevHandle);
3442 }
3443
3444 mutex_lock(&ioc->sas_topology_mutex);
3445 list_add_tail(&port_info->list, &ioc->sas_topology);
3446 mutex_unlock(&ioc->sas_topology_mutex);
3447
3448 printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3449 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3450 (unsigned long long)sas_address);
3451
3452 mptsas_expander_refresh(ioc, port_info);
3453}
3454
3455/**
3456 * mptsas_delete_expander_siblings - remove siblings attached to expander
3457 * @ioc: Pointer to MPT_ADAPTER structure
3458 * @parent: the parent port_info object
3459 * @expander: the expander port_info object
3460 **/
3461static void
3462mptsas_delete_expander_siblings(MPT_ADAPTER *ioc, struct mptsas_portinfo
3463 *parent, struct mptsas_portinfo *expander)
3464{
3465 struct mptsas_phyinfo *phy_info;
3466 struct mptsas_portinfo *port_info;
3467 struct sas_rphy *rphy;
3468 int i;
3469
3470 phy_info = expander->phy_info;
3471 for (i = 0; i < expander->num_phys; i++, phy_info++) {
3472 rphy = mptsas_get_rphy(phy_info);
3473 if (!rphy)
3474 continue;
3475 if (rphy->identify.device_type == SAS_END_DEVICE)
3476 mptsas_del_end_device(ioc, phy_info);
3477 }
3478
3479 phy_info = expander->phy_info;
3480 for (i = 0; i < expander->num_phys; i++, phy_info++) {
3481 rphy = mptsas_get_rphy(phy_info);
3482 if (!rphy)
3483 continue;
3484 if (rphy->identify.device_type ==
3485 MPI_SAS_DEVICE_INFO_EDGE_EXPANDER ||
3486 rphy->identify.device_type ==
3487 MPI_SAS_DEVICE_INFO_FANOUT_EXPANDER) {
3488 port_info = mptsas_find_portinfo_by_sas_address(ioc,
3489 rphy->identify.sas_address);
3490 if (!port_info)
3491 continue;
3492 if (port_info == parent) /* backlink rphy */
3493 continue;
3494 /*
3495 Delete this expander even if the expdevpage is exists
3496 because the parent expander is already deleted
3497 */
3498 mptsas_expander_delete(ioc, port_info, 1);
3499 }
3500 }
3501}
3502
3503
3504/**
3505 * mptsas_expander_delete - remove this expander
3506 * @ioc: Pointer to MPT_ADAPTER structure
3507 * @port_info: expander port_info struct
3508 * @force: Flag to forcefully delete the expander
3509 *
3510 **/
3511
3512static void mptsas_expander_delete(MPT_ADAPTER *ioc,
3513 struct mptsas_portinfo *port_info, u8 force)
3514{
3515
3516 struct mptsas_portinfo *parent;
3517 int i;
3518 u64 expander_sas_address;
3519 struct mptsas_phyinfo *phy_info;
3520 struct mptsas_portinfo buffer;
3521 struct mptsas_portinfo_details *port_details;
3522 struct sas_port *port;
3523
3524 if (!port_info)
3525 return;
3526
3527 /* see if expander is still there before deleting */
3528 mptsas_sas_expander_pg0(ioc, &buffer,
3529 (MPI_SAS_EXPAND_PGAD_FORM_HANDLE <<
3530 MPI_SAS_EXPAND_PGAD_FORM_SHIFT),
3531 port_info->phy_info[0].identify.handle);
3532
3533 if (buffer.num_phys) {
3534 kfree(buffer.phy_info);
3535 if (!force)
3536 return;
3537 }
3538
3539
3540 /*
3541 * Obtain the port_info instance to the parent port
3542 */
3543 port_details = NULL;
3544 expander_sas_address =
3545 port_info->phy_info[0].identify.sas_address;
3546 parent = mptsas_find_portinfo_by_handle(ioc,
3547 port_info->phy_info[0].identify.handle_parent);
3548 mptsas_delete_expander_siblings(ioc, parent, port_info);
3549 if (!parent)
3550 goto out;
3551
3552 /*
3553 * Delete rphys in the parent that point
3554 * to this expander.
3555 */
3556 phy_info = parent->phy_info;
3557 port = NULL;
3558 for (i = 0; i < parent->num_phys; i++, phy_info++) {
3559 if (!phy_info->phy)
3560 continue;
3561 if (phy_info->attached.sas_address !=
3562 expander_sas_address)
3563 continue;
3564 if (!port) {
3565 port = mptsas_get_port(phy_info);
3566 port_details = phy_info->port_details;
3567 }
3568 dev_printk(KERN_DEBUG, &phy_info->phy->dev,
3569 MYIOC_s_FMT "delete phy %d, phy-obj (0x%p)\n", ioc->name,
3570 phy_info->phy_id, phy_info->phy);
3571 sas_port_delete_phy(port, phy_info->phy);
3572 }
3573 if (port) {
3574 dev_printk(KERN_DEBUG, &port->dev,
3575 MYIOC_s_FMT "delete port %d, sas_addr (0x%llx)\n",
3576 ioc->name, port->port_identifier,
3577 (unsigned long long)expander_sas_address);
3578 sas_port_delete(port);
3579 mptsas_port_delete(ioc, port_details);
3580 }
3581 out:
3582
3583 printk(MYIOC_s_INFO_FMT "delete expander: num_phys %d, "
3584 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3585 (unsigned long long)expander_sas_address);
3586
3587 /*
3588 * free link
3589 */
3590 list_del(&port_info->list);
3591 kfree(port_info->phy_info);
3592 kfree(port_info);
3593}
3594
3595
3596/**
3597 * mptsas_send_expander_event - expanders events
3598 * @ioc: Pointer to MPT_ADAPTER structure
3599 * @expander_data: event data
3600 *
3601 *
3602 * This function handles adding, removing, and refreshing
3603 * device handles within the expander objects.
3604 */
3605static void
3606mptsas_send_expander_event(struct fw_event_work *fw_event)
3607{
3608 MPT_ADAPTER *ioc;
3609 MpiEventDataSasExpanderStatusChange_t *expander_data;
3610 struct mptsas_portinfo *port_info;
3611 __le64 sas_address;
3612 int i;
3613
3614 ioc = fw_event->ioc;
3615 expander_data = (MpiEventDataSasExpanderStatusChange_t *)
3616 fw_event->event_data;
3617 memcpy(&sas_address, &expander_data->SASAddress, sizeof(__le64));
3618 sas_address = le64_to_cpu(sas_address);
3619 port_info = mptsas_find_portinfo_by_sas_address(ioc, sas_address);
3620
3621 if (expander_data->ReasonCode == MPI_EVENT_SAS_EXP_RC_ADDED) {
3622 if (port_info) {
3623 for (i = 0; i < port_info->num_phys; i++) {
3624 port_info->phy_info[i].portinfo = port_info;
3625 port_info->phy_info[i].handle =
3626 le16_to_cpu(expander_data->DevHandle);
3627 port_info->phy_info[i].identify.sas_address =
3628 le64_to_cpu(sas_address);
3629 port_info->phy_info[i].identify.handle_parent =
3630 le16_to_cpu(expander_data->ParentDevHandle);
3631 }
3632 mptsas_expander_refresh(ioc, port_info);
3633 } else if (!port_info && expander_data->NumPhys)
3634 mptsas_expander_event_add(ioc, expander_data);
3635 } else if (expander_data->ReasonCode ==
3636 MPI_EVENT_SAS_EXP_RC_NOT_RESPONDING)
3637 mptsas_expander_delete(ioc, port_info, 0);
3638
3639 mptsas_free_fw_event(ioc, fw_event);
3640}
3641
3642
3643/**
3644 * mptsas_expander_add -
3645 * @ioc: Pointer to MPT_ADAPTER structure
3646 * @handle:
3647 *
3648 */
3649static struct mptsas_portinfo *
3650mptsas_expander_add(MPT_ADAPTER *ioc, u16 handle)
3651{
3652 struct mptsas_portinfo buffer, *port_info;
3653 int i;
3654
3655 if ((mptsas_sas_expander_pg0(ioc, &buffer,
3656 (MPI_SAS_EXPAND_PGAD_FORM_HANDLE <<
3657 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle)))
3658 return NULL;
3659
3660 port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_ATOMIC);
3661 if (!port_info) {
3662 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3663 "%s: exit at line=%d\n", ioc->name,
3664 __func__, __LINE__));
3665 return NULL;
3666 }
3667 port_info->num_phys = buffer.num_phys;
3668 port_info->phy_info = buffer.phy_info;
3669 for (i = 0; i < port_info->num_phys; i++)
3670 port_info->phy_info[i].portinfo = port_info;
3671 mutex_lock(&ioc->sas_topology_mutex);
3672 list_add_tail(&port_info->list, &ioc->sas_topology);
3673 mutex_unlock(&ioc->sas_topology_mutex);
3674 printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3675 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3676 (unsigned long long)buffer.phy_info[0].identify.sas_address);
3677 mptsas_expander_refresh(ioc, port_info);
3678 return port_info;
3679}
3680
3681static void
3682mptsas_send_link_status_event(struct fw_event_work *fw_event)
3683{
3684 MPT_ADAPTER *ioc;
3685 MpiEventDataSasPhyLinkStatus_t *link_data;
3686 struct mptsas_portinfo *port_info;
3687 struct mptsas_phyinfo *phy_info = NULL;
3688 __le64 sas_address;
3689 u8 phy_num;
3690 u8 link_rate;
3691
3692 ioc = fw_event->ioc;
3693 link_data = (MpiEventDataSasPhyLinkStatus_t *)fw_event->event_data;
3694
3695 memcpy(&sas_address, &link_data->SASAddress, sizeof(__le64));
3696 sas_address = le64_to_cpu(sas_address);
3697 link_rate = link_data->LinkRates >> 4;
3698 phy_num = link_data->PhyNum;
3699
3700 port_info = mptsas_find_portinfo_by_sas_address(ioc, sas_address);
3701 if (port_info) {
3702 phy_info = &port_info->phy_info[phy_num];
3703 if (phy_info)
3704 phy_info->negotiated_link_rate = link_rate;
3705 }
3706
3707 if (link_rate == MPI_SAS_IOUNIT0_RATE_1_5 ||
3708 link_rate == MPI_SAS_IOUNIT0_RATE_3_0 ||
3709 link_rate == MPI_SAS_IOUNIT0_RATE_6_0) {
3710
3711 if (!port_info) {
3712 if (ioc->old_sas_discovery_protocal) {
3713 port_info = mptsas_expander_add(ioc,
3714 le16_to_cpu(link_data->DevHandle));
3715 if (port_info)
3716 goto out;
3717 }
3718 goto out;
3719 }
3720
3721 if (port_info == ioc->hba_port_info)
3722 mptsas_probe_hba_phys(ioc);
3723 else
3724 mptsas_expander_refresh(ioc, port_info);
3725 } else if (phy_info && phy_info->phy) {
3726 if (link_rate == MPI_SAS_IOUNIT0_RATE_PHY_DISABLED)
3727 phy_info->phy->negotiated_linkrate =
3728 SAS_PHY_DISABLED;
3729 else if (link_rate ==
3730 MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION)
3731 phy_info->phy->negotiated_linkrate =
3732 SAS_LINK_RATE_FAILED;
3733 else {
3734 phy_info->phy->negotiated_linkrate =
3735 SAS_LINK_RATE_UNKNOWN;
3736 if (ioc->device_missing_delay &&
3737 mptsas_is_end_device(&phy_info->attached)) {
3738 struct scsi_device *sdev;
3739 VirtDevice *vdevice;
3740 u8 channel, id;
3741 id = phy_info->attached.id;
3742 channel = phy_info->attached.channel;
3743 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3744 "Link down for fw_id %d:fw_channel %d\n",
3745 ioc->name, phy_info->attached.id,
3746 phy_info->attached.channel));
3747
3748 shost_for_each_device(sdev, ioc->sh) {
3749 vdevice = sdev->hostdata;
3750 if ((vdevice == NULL) ||
3751 (vdevice->vtarget == NULL))
3752 continue;
3753 if ((vdevice->vtarget->tflags &
3754 MPT_TARGET_FLAGS_RAID_COMPONENT ||
3755 vdevice->vtarget->raidVolume))
3756 continue;
3757 if (vdevice->vtarget->id == id &&
3758 vdevice->vtarget->channel ==
3759 channel)
3760 devtprintk(ioc,
3761 printk(MYIOC_s_DEBUG_FMT
3762 "SDEV OUTSTANDING CMDS"
3763 "%d\n", ioc->name,
3764 atomic_read(&sdev->device_busy)));
3765 }
3766
3767 }
3768 }
3769 }
3770 out:
3771 mptsas_free_fw_event(ioc, fw_event);
3772}
3773
3774static void
3775mptsas_not_responding_devices(MPT_ADAPTER *ioc)
3776{
3777 struct mptsas_portinfo buffer, *port_info;
3778 struct mptsas_device_info *sas_info;
3779 struct mptsas_devinfo sas_device;
3780 u32 handle;
3781 VirtTarget *vtarget = NULL;
3782 struct mptsas_phyinfo *phy_info;
3783 u8 found_expander;
3784 int retval, retry_count;
3785 unsigned long flags;
3786
3787 mpt_findImVolumes(ioc);
3788
3789 spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
3790 if (ioc->ioc_reset_in_progress) {
3791 dfailprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3792 "%s: exiting due to a parallel reset \n", ioc->name,
3793 __func__));
3794 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
3795 return;
3796 }
3797 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
3798
3799 /* devices, logical volumes */
3800 mutex_lock(&ioc->sas_device_info_mutex);
3801 redo_device_scan:
3802 list_for_each_entry(sas_info, &ioc->sas_device_info_list, list) {
3803 if (sas_info->is_cached)
3804 continue;
3805 if (!sas_info->is_logical_volume) {
3806 sas_device.handle = 0;
3807 retry_count = 0;
3808retry_page:
3809 retval = mptsas_sas_device_pg0(ioc, &sas_device,
3810 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID
3811 << MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3812 (sas_info->fw.channel << 8) +
3813 sas_info->fw.id);
3814
3815 if (sas_device.handle)
3816 continue;
3817 if (retval == -EBUSY) {
3818 spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
3819 if (ioc->ioc_reset_in_progress) {
3820 dfailprintk(ioc,
3821 printk(MYIOC_s_DEBUG_FMT
3822 "%s: exiting due to reset\n",
3823 ioc->name, __func__));
3824 spin_unlock_irqrestore
3825 (&ioc->taskmgmt_lock, flags);
3826 mutex_unlock(&ioc->
3827 sas_device_info_mutex);
3828 return;
3829 }
3830 spin_unlock_irqrestore(&ioc->taskmgmt_lock,
3831 flags);
3832 }
3833
3834 if (retval && (retval != -ENODEV)) {
3835 if (retry_count < 10) {
3836 retry_count++;
3837 goto retry_page;
3838 } else {
3839 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3840 "%s: Config page retry exceeded retry "
3841 "count deleting device 0x%llx\n",
3842 ioc->name, __func__,
3843 sas_info->sas_address));
3844 }
3845 }
3846
3847 /* delete device */
3848 vtarget = mptsas_find_vtarget(ioc,
3849 sas_info->fw.channel, sas_info->fw.id);
3850
3851 if (vtarget)
3852 vtarget->deleted = 1;
3853
3854 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
3855 sas_info->sas_address);
3856
3857 mptsas_del_end_device(ioc, phy_info);
3858 goto redo_device_scan;
3859 } else
3860 mptsas_volume_delete(ioc, sas_info->fw.id);
3861 }
3862 mutex_unlock(&ioc->sas_device_info_mutex);
3863
3864 /* expanders */
3865 mutex_lock(&ioc->sas_topology_mutex);
3866 redo_expander_scan:
3867 list_for_each_entry(port_info, &ioc->sas_topology, list) {
3868
3869 if (!(port_info->phy_info[0].identify.device_info &
3870 MPI_SAS_DEVICE_INFO_SMP_TARGET))
3871 continue;
3872 found_expander = 0;
3873 handle = 0xFFFF;
3874 while (!mptsas_sas_expander_pg0(ioc, &buffer,
3875 (MPI_SAS_EXPAND_PGAD_FORM_GET_NEXT_HANDLE <<
3876 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle) &&
3877 !found_expander) {
3878
3879 handle = buffer.phy_info[0].handle;
3880 if (buffer.phy_info[0].identify.sas_address ==
3881 port_info->phy_info[0].identify.sas_address) {
3882 found_expander = 1;
3883 }
3884 kfree(buffer.phy_info);
3885 }
3886
3887 if (!found_expander) {
3888 mptsas_expander_delete(ioc, port_info, 0);
3889 goto redo_expander_scan;
3890 }
3891 }
3892 mutex_unlock(&ioc->sas_topology_mutex);
3893}
3894
3895/**
3896 * mptsas_probe_expanders - adding expanders
3897 * @ioc: Pointer to MPT_ADAPTER structure
3898 *
3899 **/
3900static void
3901mptsas_probe_expanders(MPT_ADAPTER *ioc)
3902{
3903 struct mptsas_portinfo buffer, *port_info;
3904 u32 handle;
3905 int i;
3906
3907 handle = 0xFFFF;
3908 while (!mptsas_sas_expander_pg0(ioc, &buffer,
3909 (MPI_SAS_EXPAND_PGAD_FORM_GET_NEXT_HANDLE <<
3910 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle)) {
3911
3912 handle = buffer.phy_info[0].handle;
3913 port_info = mptsas_find_portinfo_by_sas_address(ioc,
3914 buffer.phy_info[0].identify.sas_address);
3915
3916 if (port_info) {
3917 /* refreshing handles */
3918 for (i = 0; i < buffer.num_phys; i++) {
3919 port_info->phy_info[i].handle = handle;
3920 port_info->phy_info[i].identify.handle_parent =
3921 buffer.phy_info[0].identify.handle_parent;
3922 }
3923 mptsas_expander_refresh(ioc, port_info);
3924 kfree(buffer.phy_info);
3925 continue;
3926 }
3927
3928 port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3929 if (!port_info) {
3930 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3931 "%s: exit at line=%d\n", ioc->name,
3932 __func__, __LINE__));
3933 return;
3934 }
3935 port_info->num_phys = buffer.num_phys;
3936 port_info->phy_info = buffer.phy_info;
3937 for (i = 0; i < port_info->num_phys; i++)
3938 port_info->phy_info[i].portinfo = port_info;
3939 mutex_lock(&ioc->sas_topology_mutex);
3940 list_add_tail(&port_info->list, &ioc->sas_topology);
3941 mutex_unlock(&ioc->sas_topology_mutex);
3942 printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3943 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3944 (unsigned long long)buffer.phy_info[0].identify.sas_address);
3945 mptsas_expander_refresh(ioc, port_info);
3946 }
3947}
3948
3949static void
3950mptsas_probe_devices(MPT_ADAPTER *ioc)
3951{
3952 u16 handle;
3953 struct mptsas_devinfo sas_device;
3954 struct mptsas_phyinfo *phy_info;
3955
3956 handle = 0xFFFF;
3957 while (!(mptsas_sas_device_pg0(ioc, &sas_device,
3958 MPI_SAS_DEVICE_PGAD_FORM_GET_NEXT_HANDLE, handle))) {
3959
3960 handle = sas_device.handle;
3961
3962 if ((sas_device.device_info &
3963 (MPI_SAS_DEVICE_INFO_SSP_TARGET |
3964 MPI_SAS_DEVICE_INFO_STP_TARGET |
3965 MPI_SAS_DEVICE_INFO_SATA_DEVICE)) == 0)
3966 continue;
3967
3968 /* If there is no FW B_T mapping for this device then continue
3969 * */
3970 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
3971 || !(sas_device.flags &
3972 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
3973 continue;
3974
3975 phy_info = mptsas_refreshing_device_handles(ioc, &sas_device);
3976 if (!phy_info)
3977 continue;
3978
3979 if (mptsas_get_rphy(phy_info))
3980 continue;
3981
3982 mptsas_add_end_device(ioc, phy_info);
3983 }
3984}
3985
3986/**
3987 * mptsas_scan_sas_topology -
3988 * @ioc: Pointer to MPT_ADAPTER structure
3989 * @sas_address:
3990 *
3991 **/
3992static void
3993mptsas_scan_sas_topology(MPT_ADAPTER *ioc)
3994{
3995 struct scsi_device *sdev;
3996 int i;
3997
3998 mptsas_probe_hba_phys(ioc);
3999 mptsas_probe_expanders(ioc);
4000 mptsas_probe_devices(ioc);
4001
4002 /*
4003 Reporting RAID volumes.
4004 */
4005 if (!ioc->ir_firmware || !ioc->raid_data.pIocPg2 ||
4006 !ioc->raid_data.pIocPg2->NumActiveVolumes)
4007 return;
4008 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
4009 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
4010 ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID, 0);
4011 if (sdev) {
4012 scsi_device_put(sdev);
4013 continue;
4014 }
4015 printk(MYIOC_s_INFO_FMT "attaching raid volume, channel %d, "
4016 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4017 ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID);
4018 scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL,
4019 ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID, 0);
4020 }
4021}
4022
4023
4024static void
4025mptsas_handle_queue_full_event(struct fw_event_work *fw_event)
4026{
4027 MPT_ADAPTER *ioc;
4028 EventDataQueueFull_t *qfull_data;
4029 struct mptsas_device_info *sas_info;
4030 struct scsi_device *sdev;
4031 int depth;
4032 int id = -1;
4033 int channel = -1;
4034 int fw_id, fw_channel;
4035 u16 current_depth;
4036
4037
4038 ioc = fw_event->ioc;
4039 qfull_data = (EventDataQueueFull_t *)fw_event->event_data;
4040 fw_id = qfull_data->TargetID;
4041 fw_channel = qfull_data->Bus;
4042 current_depth = le16_to_cpu(qfull_data->CurrentDepth);
4043
4044 /* if hidden raid component, look for the volume id */
4045 mutex_lock(&ioc->sas_device_info_mutex);
4046 if (mptscsih_is_phys_disk(ioc, fw_channel, fw_id)) {
4047 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
4048 list) {
4049 if (sas_info->is_cached ||
4050 sas_info->is_logical_volume)
4051 continue;
4052 if (sas_info->is_hidden_raid_component &&
4053 (sas_info->fw.channel == fw_channel &&
4054 sas_info->fw.id == fw_id)) {
4055 id = sas_info->volume_id;
4056 channel = MPTSAS_RAID_CHANNEL;
4057 goto out;
4058 }
4059 }
4060 } else {
4061 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
4062 list) {
4063 if (sas_info->is_cached ||
4064 sas_info->is_hidden_raid_component ||
4065 sas_info->is_logical_volume)
4066 continue;
4067 if (sas_info->fw.channel == fw_channel &&
4068 sas_info->fw.id == fw_id) {
4069 id = sas_info->os.id;
4070 channel = sas_info->os.channel;
4071 goto out;
4072 }
4073 }
4074
4075 }
4076
4077 out:
4078 mutex_unlock(&ioc->sas_device_info_mutex);
4079
4080 if (id != -1) {
4081 shost_for_each_device(sdev, ioc->sh) {
4082 if (sdev->id == id && sdev->channel == channel) {
4083 if (current_depth > sdev->queue_depth) {
4084 sdev_printk(KERN_INFO, sdev,
4085 "strange observation, the queue "
4086 "depth is (%d) meanwhile fw queue "
4087 "depth (%d)\n", sdev->queue_depth,
4088 current_depth);
4089 continue;
4090 }
4091 depth = scsi_track_queue_full(sdev,
4092 sdev->queue_depth - 1);
4093 if (depth > 0)
4094 sdev_printk(KERN_INFO, sdev,
4095 "Queue depth reduced to (%d)\n",
4096 depth);
4097 else if (depth < 0)
4098 sdev_printk(KERN_INFO, sdev,
4099 "Tagged Command Queueing is being "
4100 "disabled\n");
4101 else if (depth == 0)
4102 sdev_printk(KERN_DEBUG, sdev,
4103 "Queue depth not changed yet\n");
4104 }
4105 }
4106 }
4107
4108 mptsas_free_fw_event(ioc, fw_event);
4109}
4110
4111
4112static struct mptsas_phyinfo *
4113mptsas_find_phyinfo_by_sas_address(MPT_ADAPTER *ioc, u64 sas_address)
4114{
4115 struct mptsas_portinfo *port_info;
4116 struct mptsas_phyinfo *phy_info = NULL;
4117 int i;
4118
4119 mutex_lock(&ioc->sas_topology_mutex);
4120 list_for_each_entry(port_info, &ioc->sas_topology, list) {
4121 for (i = 0; i < port_info->num_phys; i++) {
4122 if (!mptsas_is_end_device(
4123 &port_info->phy_info[i].attached))
4124 continue;
4125 if (port_info->phy_info[i].attached.sas_address
4126 != sas_address)
4127 continue;
4128 phy_info = &port_info->phy_info[i];
4129 break;
4130 }
4131 }
4132 mutex_unlock(&ioc->sas_topology_mutex);
4133 return phy_info;
4134}
4135
4136/**
4137 * mptsas_find_phyinfo_by_phys_disk_num -
4138 * @ioc: Pointer to MPT_ADAPTER structure
4139 * @phys_disk_num:
4140 * @channel:
4141 * @id:
4142 *
4143 **/
4144static struct mptsas_phyinfo *
4145mptsas_find_phyinfo_by_phys_disk_num(MPT_ADAPTER *ioc, u8 phys_disk_num,
4146 u8 channel, u8 id)
4147{
4148 struct mptsas_phyinfo *phy_info = NULL;
4149 struct mptsas_portinfo *port_info;
4150 RaidPhysDiskPage1_t *phys_disk = NULL;
4151 int num_paths;
4152 u64 sas_address = 0;
4153 int i;
4154
4155 phy_info = NULL;
4156 if (!ioc->raid_data.pIocPg3)
4157 return NULL;
4158 /* dual port support */
4159 num_paths = mpt_raid_phys_disk_get_num_paths(ioc, phys_disk_num);
4160 if (!num_paths)
4161 goto out;
4162 phys_disk = kzalloc(offsetof(RaidPhysDiskPage1_t, Path) +
4163 (num_paths * sizeof(RAID_PHYS_DISK1_PATH)), GFP_KERNEL);
4164 if (!phys_disk)
4165 goto out;
4166 mpt_raid_phys_disk_pg1(ioc, phys_disk_num, phys_disk);
4167 for (i = 0; i < num_paths; i++) {
4168 if ((phys_disk->Path[i].Flags & 1) != 0)
4169 /* entry no longer valid */
4170 continue;
4171 if ((id == phys_disk->Path[i].PhysDiskID) &&
4172 (channel == phys_disk->Path[i].PhysDiskBus)) {
4173 memcpy(&sas_address, &phys_disk->Path[i].WWID,
4174 sizeof(u64));
4175 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4176 sas_address);
4177 goto out;
4178 }
4179 }
4180
4181 out:
4182 kfree(phys_disk);
4183 if (phy_info)
4184 return phy_info;
4185
4186 /*
4187 * Extra code to handle RAID0 case, where the sas_address is not updated
4188 * in phys_disk_page_1 when hotswapped
4189 */
4190 mutex_lock(&ioc->sas_topology_mutex);
4191 list_for_each_entry(port_info, &ioc->sas_topology, list) {
4192 for (i = 0; i < port_info->num_phys && !phy_info; i++) {
4193 if (!mptsas_is_end_device(
4194 &port_info->phy_info[i].attached))
4195 continue;
4196 if (port_info->phy_info[i].attached.phys_disk_num == ~0)
4197 continue;
4198 if ((port_info->phy_info[i].attached.phys_disk_num ==
4199 phys_disk_num) &&
4200 (port_info->phy_info[i].attached.id == id) &&
4201 (port_info->phy_info[i].attached.channel ==
4202 channel))
4203 phy_info = &port_info->phy_info[i];
4204 }
4205 }
4206 mutex_unlock(&ioc->sas_topology_mutex);
4207 return phy_info;
4208}
4209
4210static void
4211mptsas_reprobe_lun(struct scsi_device *sdev, void *data)
4212{
4213 int rc;
4214
4215 sdev->no_uld_attach = data ? 1 : 0;
4216 rc = scsi_device_reprobe(sdev);
4217}
4218
4219static void
4220mptsas_reprobe_target(struct scsi_target *starget, int uld_attach)
4221{
4222 starget_for_each_device(starget, uld_attach ? (void *)1 : NULL,
4223 mptsas_reprobe_lun);
4224}
4225
4226static void
4227mptsas_adding_inactive_raid_components(MPT_ADAPTER *ioc, u8 channel, u8 id)
4228{
4229 CONFIGPARMS cfg;
4230 ConfigPageHeader_t hdr;
4231 dma_addr_t dma_handle;
4232 pRaidVolumePage0_t buffer = NULL;
4233 RaidPhysDiskPage0_t phys_disk;
4234 int i;
4235 struct mptsas_phyinfo *phy_info;
4236 struct mptsas_devinfo sas_device;
4237
4238 memset(&cfg, 0 , sizeof(CONFIGPARMS));
4239 memset(&hdr, 0 , sizeof(ConfigPageHeader_t));
4240 hdr.PageType = MPI_CONFIG_PAGETYPE_RAID_VOLUME;
4241 cfg.pageAddr = (channel << 8) + id;
4242 cfg.cfghdr.hdr = &hdr;
4243 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
4244 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
4245
4246 if (mpt_config(ioc, &cfg) != 0)
4247 goto out;
4248
4249 if (!hdr.PageLength)
4250 goto out;
4251
4252 buffer = pci_alloc_consistent(ioc->pcidev, hdr.PageLength * 4,
4253 &dma_handle);
4254
4255 if (!buffer)
4256 goto out;
4257
4258 cfg.physAddr = dma_handle;
4259 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
4260
4261 if (mpt_config(ioc, &cfg) != 0)
4262 goto out;
4263
4264 if (!(buffer->VolumeStatus.Flags &
4265 MPI_RAIDVOL0_STATUS_FLAG_VOLUME_INACTIVE))
4266 goto out;
4267
4268 if (!buffer->NumPhysDisks)
4269 goto out;
4270
4271 for (i = 0; i < buffer->NumPhysDisks; i++) {
4272
4273 if (mpt_raid_phys_disk_pg0(ioc,
4274 buffer->PhysDisk[i].PhysDiskNum, &phys_disk) != 0)
4275 continue;
4276
4277 if (mptsas_sas_device_pg0(ioc, &sas_device,
4278 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4279 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4280 (phys_disk.PhysDiskBus << 8) +
4281 phys_disk.PhysDiskID))
4282 continue;
4283
4284 /* If there is no FW B_T mapping for this device then continue
4285 * */
4286 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4287 || !(sas_device.flags &
4288 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4289 continue;
4290
4291
4292 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4293 sas_device.sas_address);
4294 mptsas_add_end_device(ioc, phy_info);
4295 }
4296
4297 out:
4298 if (buffer)
4299 pci_free_consistent(ioc->pcidev, hdr.PageLength * 4, buffer,
4300 dma_handle);
4301}
4302/*
4303 * Work queue thread to handle SAS hotplug events
4304 */
4305static void
4306mptsas_hotplug_work(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
4307 struct mptsas_hotplug_event *hot_plug_info)
4308{
4309 struct mptsas_phyinfo *phy_info;
4310 struct scsi_target * starget;
4311 struct mptsas_devinfo sas_device;
4312 VirtTarget *vtarget;
4313 int i;
4314 struct mptsas_portinfo *port_info;
4315
4316 switch (hot_plug_info->event_type) {
4317
4318 case MPTSAS_ADD_PHYSDISK:
4319
4320 if (!ioc->raid_data.pIocPg2)
4321 break;
4322
4323 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
4324 if (ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID ==
4325 hot_plug_info->id) {
4326 printk(MYIOC_s_WARN_FMT "firmware bug: unable "
4327 "to add hidden disk - target_id matchs "
4328 "volume_id\n", ioc->name);
4329 mptsas_free_fw_event(ioc, fw_event);
4330 return;
4331 }
4332 }
4333 mpt_findImVolumes(ioc);
4334
4335 case MPTSAS_ADD_DEVICE:
4336 memset(&sas_device, 0, sizeof(struct mptsas_devinfo));
4337 mptsas_sas_device_pg0(ioc, &sas_device,
4338 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4339 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4340 (hot_plug_info->channel << 8) +
4341 hot_plug_info->id);
4342
4343 /* If there is no FW B_T mapping for this device then break
4344 * */
4345 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4346 || !(sas_device.flags &
4347 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4348 break;
4349
4350 if (!sas_device.handle)
4351 return;
4352
4353 phy_info = mptsas_refreshing_device_handles(ioc, &sas_device);
4354 /* Only For SATA Device ADD */
4355 if (!phy_info && (sas_device.device_info &
4356 MPI_SAS_DEVICE_INFO_SATA_DEVICE)) {
4357 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4358 "%s %d SATA HOT PLUG: "
4359 "parent handle of device %x\n", ioc->name,
4360 __func__, __LINE__, sas_device.handle_parent));
4361 port_info = mptsas_find_portinfo_by_handle(ioc,
4362 sas_device.handle_parent);
4363
4364 if (port_info == ioc->hba_port_info)
4365 mptsas_probe_hba_phys(ioc);
4366 else if (port_info)
4367 mptsas_expander_refresh(ioc, port_info);
4368 else {
4369 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4370 "%s %d port info is NULL\n",
4371 ioc->name, __func__, __LINE__));
4372 break;
4373 }
4374 phy_info = mptsas_refreshing_device_handles
4375 (ioc, &sas_device);
4376 }
4377
4378 if (!phy_info) {
4379 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4380 "%s %d phy info is NULL\n",
4381 ioc->name, __func__, __LINE__));
4382 break;
4383 }
4384
4385 if (mptsas_get_rphy(phy_info))
4386 break;
4387
4388 mptsas_add_end_device(ioc, phy_info);
4389 break;
4390
4391 case MPTSAS_DEL_DEVICE:
4392 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4393 hot_plug_info->sas_address);
4394 mptsas_del_end_device(ioc, phy_info);
4395 break;
4396
4397 case MPTSAS_DEL_PHYSDISK:
4398
4399 mpt_findImVolumes(ioc);
4400
4401 phy_info = mptsas_find_phyinfo_by_phys_disk_num(
4402 ioc, hot_plug_info->phys_disk_num,
4403 hot_plug_info->channel,
4404 hot_plug_info->id);
4405 mptsas_del_end_device(ioc, phy_info);
4406 break;
4407
4408 case MPTSAS_ADD_PHYSDISK_REPROBE:
4409
4410 if (mptsas_sas_device_pg0(ioc, &sas_device,
4411 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4412 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4413 (hot_plug_info->channel << 8) + hot_plug_info->id)) {
4414 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4415 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4416 __func__, hot_plug_info->id, __LINE__));
4417 break;
4418 }
4419
4420 /* If there is no FW B_T mapping for this device then break
4421 * */
4422 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4423 || !(sas_device.flags &
4424 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4425 break;
4426
4427 phy_info = mptsas_find_phyinfo_by_sas_address(
4428 ioc, sas_device.sas_address);
4429
4430 if (!phy_info) {
4431 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4432 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4433 __func__, hot_plug_info->id, __LINE__));
4434 break;
4435 }
4436
4437 starget = mptsas_get_starget(phy_info);
4438 if (!starget) {
4439 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4440 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4441 __func__, hot_plug_info->id, __LINE__));
4442 break;
4443 }
4444
4445 vtarget = starget->hostdata;
4446 if (!vtarget) {
4447 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4448 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4449 __func__, hot_plug_info->id, __LINE__));
4450 break;
4451 }
4452
4453 mpt_findImVolumes(ioc);
4454
4455 starget_printk(KERN_INFO, starget, MYIOC_s_FMT "RAID Hidding: "
4456 "fw_channel=%d, fw_id=%d, physdsk %d, sas_addr 0x%llx\n",
4457 ioc->name, hot_plug_info->channel, hot_plug_info->id,
4458 hot_plug_info->phys_disk_num, (unsigned long long)
4459 sas_device.sas_address);
4460
4461 vtarget->id = hot_plug_info->phys_disk_num;
4462 vtarget->tflags |= MPT_TARGET_FLAGS_RAID_COMPONENT;
4463 phy_info->attached.phys_disk_num = hot_plug_info->phys_disk_num;
4464 mptsas_reprobe_target(starget, 1);
4465 break;
4466
4467 case MPTSAS_DEL_PHYSDISK_REPROBE:
4468
4469 if (mptsas_sas_device_pg0(ioc, &sas_device,
4470 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4471 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4472 (hot_plug_info->channel << 8) + hot_plug_info->id)) {
4473 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4474 "%s: fw_id=%d exit at line=%d\n",
4475 ioc->name, __func__,
4476 hot_plug_info->id, __LINE__));
4477 break;
4478 }
4479
4480 /* If there is no FW B_T mapping for this device then break
4481 * */
4482 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4483 || !(sas_device.flags &
4484 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4485 break;
4486
4487 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4488 sas_device.sas_address);
4489 if (!phy_info) {
4490 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4491 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4492 __func__, hot_plug_info->id, __LINE__));
4493 break;
4494 }
4495
4496 starget = mptsas_get_starget(phy_info);
4497 if (!starget) {
4498 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4499 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4500 __func__, hot_plug_info->id, __LINE__));
4501 break;
4502 }
4503
4504 vtarget = starget->hostdata;
4505 if (!vtarget) {
4506 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4507 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4508 __func__, hot_plug_info->id, __LINE__));
4509 break;
4510 }
4511
4512 if (!(vtarget->tflags & MPT_TARGET_FLAGS_RAID_COMPONENT)) {
4513 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4514 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4515 __func__, hot_plug_info->id, __LINE__));
4516 break;
4517 }
4518
4519 mpt_findImVolumes(ioc);
4520
4521 starget_printk(KERN_INFO, starget, MYIOC_s_FMT "RAID Exposing:"
4522 " fw_channel=%d, fw_id=%d, physdsk %d, sas_addr 0x%llx\n",
4523 ioc->name, hot_plug_info->channel, hot_plug_info->id,
4524 hot_plug_info->phys_disk_num, (unsigned long long)
4525 sas_device.sas_address);
4526
4527 vtarget->tflags &= ~MPT_TARGET_FLAGS_RAID_COMPONENT;
4528 vtarget->id = hot_plug_info->id;
4529 phy_info->attached.phys_disk_num = ~0;
4530 mptsas_reprobe_target(starget, 0);
4531 mptsas_add_device_component_by_fw(ioc,
4532 hot_plug_info->channel, hot_plug_info->id);
4533 break;
4534
4535 case MPTSAS_ADD_RAID:
4536
4537 mpt_findImVolumes(ioc);
4538 printk(MYIOC_s_INFO_FMT "attaching raid volume, channel %d, "
4539 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4540 hot_plug_info->id);
4541 scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL,
4542 hot_plug_info->id, 0);
4543 break;
4544
4545 case MPTSAS_DEL_RAID:
4546
4547 mpt_findImVolumes(ioc);
4548 printk(MYIOC_s_INFO_FMT "removing raid volume, channel %d, "
4549 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4550 hot_plug_info->id);
4551 scsi_remove_device(hot_plug_info->sdev);
4552 scsi_device_put(hot_plug_info->sdev);
4553 break;
4554
4555 case MPTSAS_ADD_INACTIVE_VOLUME:
4556
4557 mpt_findImVolumes(ioc);
4558 mptsas_adding_inactive_raid_components(ioc,
4559 hot_plug_info->channel, hot_plug_info->id);
4560 break;
4561
4562 default:
4563 break;
4564 }
4565
4566 mptsas_free_fw_event(ioc, fw_event);
4567}
4568
4569static void
4570mptsas_send_sas_event(struct fw_event_work *fw_event)
4571{
4572 MPT_ADAPTER *ioc;
4573 struct mptsas_hotplug_event hot_plug_info;
4574 EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data;
4575 u32 device_info;
4576 u64 sas_address;
4577
4578 ioc = fw_event->ioc;
4579 sas_event_data = (EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *)
4580 fw_event->event_data;
4581 device_info = le32_to_cpu(sas_event_data->DeviceInfo);
4582
4583 if ((device_info &
4584 (MPI_SAS_DEVICE_INFO_SSP_TARGET |
4585 MPI_SAS_DEVICE_INFO_STP_TARGET |
4586 MPI_SAS_DEVICE_INFO_SATA_DEVICE)) == 0) {
4587 mptsas_free_fw_event(ioc, fw_event);
4588 return;
4589 }
4590
4591 if (sas_event_data->ReasonCode ==
4592 MPI_EVENT_SAS_DEV_STAT_RC_NO_PERSIST_ADDED) {
4593 mptbase_sas_persist_operation(ioc,
4594 MPI_SAS_OP_CLEAR_NOT_PRESENT);
4595 mptsas_free_fw_event(ioc, fw_event);
4596 return;
4597 }
4598
4599 switch (sas_event_data->ReasonCode) {
4600 case MPI_EVENT_SAS_DEV_STAT_RC_NOT_RESPONDING:
4601 case MPI_EVENT_SAS_DEV_STAT_RC_ADDED:
4602 memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4603 hot_plug_info.handle = le16_to_cpu(sas_event_data->DevHandle);
4604 hot_plug_info.channel = sas_event_data->Bus;
4605 hot_plug_info.id = sas_event_data->TargetID;
4606 hot_plug_info.phy_id = sas_event_data->PhyNum;
4607 memcpy(&sas_address, &sas_event_data->SASAddress,
4608 sizeof(u64));
4609 hot_plug_info.sas_address = le64_to_cpu(sas_address);
4610 hot_plug_info.device_info = device_info;
4611 if (sas_event_data->ReasonCode &
4612 MPI_EVENT_SAS_DEV_STAT_RC_ADDED)
4613 hot_plug_info.event_type = MPTSAS_ADD_DEVICE;
4614 else
4615 hot_plug_info.event_type = MPTSAS_DEL_DEVICE;
4616 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4617 break;
4618
4619 case MPI_EVENT_SAS_DEV_STAT_RC_NO_PERSIST_ADDED:
4620 mptbase_sas_persist_operation(ioc,
4621 MPI_SAS_OP_CLEAR_NOT_PRESENT);
4622 mptsas_free_fw_event(ioc, fw_event);
4623 break;
4624
4625 case MPI_EVENT_SAS_DEV_STAT_RC_SMART_DATA:
4626 /* TODO */
4627 case MPI_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET:
4628 /* TODO */
4629 default:
4630 mptsas_free_fw_event(ioc, fw_event);
4631 break;
4632 }
4633}
4634
4635static void
4636mptsas_send_raid_event(struct fw_event_work *fw_event)
4637{
4638 MPT_ADAPTER *ioc;
4639 EVENT_DATA_RAID *raid_event_data;
4640 struct mptsas_hotplug_event hot_plug_info;
4641 int status;
4642 int state;
4643 struct scsi_device *sdev = NULL;
4644 VirtDevice *vdevice = NULL;
4645 RaidPhysDiskPage0_t phys_disk;
4646
4647 ioc = fw_event->ioc;
4648 raid_event_data = (EVENT_DATA_RAID *)fw_event->event_data;
4649 status = le32_to_cpu(raid_event_data->SettingsStatus);
4650 state = (status >> 8) & 0xff;
4651
4652 memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4653 hot_plug_info.id = raid_event_data->VolumeID;
4654 hot_plug_info.channel = raid_event_data->VolumeBus;
4655 hot_plug_info.phys_disk_num = raid_event_data->PhysDiskNum;
4656
4657 if (raid_event_data->ReasonCode == MPI_EVENT_RAID_RC_VOLUME_DELETED ||
4658 raid_event_data->ReasonCode == MPI_EVENT_RAID_RC_VOLUME_CREATED ||
4659 raid_event_data->ReasonCode ==
4660 MPI_EVENT_RAID_RC_VOLUME_STATUS_CHANGED) {
4661 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
4662 hot_plug_info.id, 0);
4663 hot_plug_info.sdev = sdev;
4664 if (sdev)
4665 vdevice = sdev->hostdata;
4666 }
4667
4668 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Entering %s: "
4669 "ReasonCode=%02x\n", ioc->name, __func__,
4670 raid_event_data->ReasonCode));
4671
4672 switch (raid_event_data->ReasonCode) {
4673 case MPI_EVENT_RAID_RC_PHYSDISK_DELETED:
4674 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK_REPROBE;
4675 break;
4676 case MPI_EVENT_RAID_RC_PHYSDISK_CREATED:
4677 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK_REPROBE;
4678 break;
4679 case MPI_EVENT_RAID_RC_PHYSDISK_STATUS_CHANGED:
4680 switch (state) {
4681 case MPI_PD_STATE_ONLINE:
4682 case MPI_PD_STATE_NOT_COMPATIBLE:
4683 mpt_raid_phys_disk_pg0(ioc,
4684 raid_event_data->PhysDiskNum, &phys_disk);
4685 hot_plug_info.id = phys_disk.PhysDiskID;
4686 hot_plug_info.channel = phys_disk.PhysDiskBus;
4687 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK;
4688 break;
4689 case MPI_PD_STATE_FAILED:
4690 case MPI_PD_STATE_MISSING:
4691 case MPI_PD_STATE_OFFLINE_AT_HOST_REQUEST:
4692 case MPI_PD_STATE_FAILED_AT_HOST_REQUEST:
4693 case MPI_PD_STATE_OFFLINE_FOR_ANOTHER_REASON:
4694 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK;
4695 break;
4696 default:
4697 break;
4698 }
4699 break;
4700 case MPI_EVENT_RAID_RC_VOLUME_DELETED:
4701 if (!sdev)
4702 break;
4703 vdevice->vtarget->deleted = 1; /* block IO */
4704 hot_plug_info.event_type = MPTSAS_DEL_RAID;
4705 break;
4706 case MPI_EVENT_RAID_RC_VOLUME_CREATED:
4707 if (sdev) {
4708 scsi_device_put(sdev);
4709 break;
4710 }
4711 hot_plug_info.event_type = MPTSAS_ADD_RAID;
4712 break;
4713 case MPI_EVENT_RAID_RC_VOLUME_STATUS_CHANGED:
4714 if (!(status & MPI_RAIDVOL0_STATUS_FLAG_ENABLED)) {
4715 if (!sdev)
4716 break;
4717 vdevice->vtarget->deleted = 1; /* block IO */
4718 hot_plug_info.event_type = MPTSAS_DEL_RAID;
4719 break;
4720 }
4721 switch (state) {
4722 case MPI_RAIDVOL0_STATUS_STATE_FAILED:
4723 case MPI_RAIDVOL0_STATUS_STATE_MISSING:
4724 if (!sdev)
4725 break;
4726 vdevice->vtarget->deleted = 1; /* block IO */
4727 hot_plug_info.event_type = MPTSAS_DEL_RAID;
4728 break;
4729 case MPI_RAIDVOL0_STATUS_STATE_OPTIMAL:
4730 case MPI_RAIDVOL0_STATUS_STATE_DEGRADED:
4731 if (sdev) {
4732 scsi_device_put(sdev);
4733 break;
4734 }
4735 hot_plug_info.event_type = MPTSAS_ADD_RAID;
4736 break;
4737 default:
4738 break;
4739 }
4740 break;
4741 default:
4742 break;
4743 }
4744
4745 if (hot_plug_info.event_type != MPTSAS_IGNORE_EVENT)
4746 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4747 else
4748 mptsas_free_fw_event(ioc, fw_event);
4749}
4750
4751/**
4752 * mptsas_issue_tm - send mptsas internal tm request
4753 * @ioc: Pointer to MPT_ADAPTER structure
4754 * @type: Task Management type
4755 * @channel: channel number for task management
4756 * @id: Logical Target ID for reset (if appropriate)
4757 * @lun: Logical unit for reset (if appropriate)
4758 * @task_context: Context for the task to be aborted
4759 * @timeout: timeout for task management control
4760 *
4761 * return 0 on success and -1 on failure:
4762 *
4763 */
4764static int
4765mptsas_issue_tm(MPT_ADAPTER *ioc, u8 type, u8 channel, u8 id, u64 lun,
4766 int task_context, ulong timeout, u8 *issue_reset)
4767{
4768 MPT_FRAME_HDR *mf;
4769 SCSITaskMgmt_t *pScsiTm;
4770 int retval;
4771 unsigned long timeleft;
4772
4773 *issue_reset = 0;
4774 mf = mpt_get_msg_frame(mptsasDeviceResetCtx, ioc);
4775 if (mf == NULL) {
4776 retval = -1; /* return failure */
4777 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT "TaskMgmt request: no "
4778 "msg frames!!\n", ioc->name));
4779 goto out;
4780 }
4781
4782 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt request: mr = %p, "
4783 "task_type = 0x%02X,\n\t timeout = %ld, fw_channel = %d, "
4784 "fw_id = %d, lun = %lld,\n\t task_context = 0x%x\n", ioc->name, mf,
4785 type, timeout, channel, id, (unsigned long long)lun,
4786 task_context));
4787
4788 pScsiTm = (SCSITaskMgmt_t *) mf;
4789 memset(pScsiTm, 0, sizeof(SCSITaskMgmt_t));
4790 pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
4791 pScsiTm->TaskType = type;
4792 pScsiTm->MsgFlags = 0;
4793 pScsiTm->TargetID = id;
4794 pScsiTm->Bus = channel;
4795 pScsiTm->ChainOffset = 0;
4796 pScsiTm->Reserved = 0;
4797 pScsiTm->Reserved1 = 0;
4798 pScsiTm->TaskMsgContext = task_context;
4799 int_to_scsilun(lun, (struct scsi_lun *)pScsiTm->LUN);
4800
4801 INITIALIZE_MGMT_STATUS(ioc->taskmgmt_cmds.status)
4802 CLEAR_MGMT_STATUS(ioc->internal_cmds.status)
4803 retval = 0;
4804 mpt_put_msg_frame_hi_pri(mptsasDeviceResetCtx, ioc, mf);
4805
4806 /* Now wait for the command to complete */
4807 timeleft = wait_for_completion_timeout(&ioc->taskmgmt_cmds.done,
4808 timeout*HZ);
4809 if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
4810 retval = -1; /* return failure */
4811 dtmprintk(ioc, printk(MYIOC_s_ERR_FMT
4812 "TaskMgmt request: TIMED OUT!(mr=%p)\n", ioc->name, mf));
4813 mpt_free_msg_frame(ioc, mf);
4814 if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_DID_IOCRESET)
4815 goto out;
4816 *issue_reset = 1;
4817 goto out;
4818 }
4819
4820 if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_RF_VALID)) {
4821 retval = -1; /* return failure */
4822 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4823 "TaskMgmt request: failed with no reply\n", ioc->name));
4824 goto out;
4825 }
4826
4827 out:
4828 CLEAR_MGMT_STATUS(ioc->taskmgmt_cmds.status)
4829 return retval;
4830}
4831
4832/**
4833 * mptsas_broadcast_primative_work - Handle broadcast primitives
4834 * @work: work queue payload containing info describing the event
4835 *
4836 * this will be handled in workqueue context.
4837 */
4838static void
4839mptsas_broadcast_primative_work(struct fw_event_work *fw_event)
4840{
4841 MPT_ADAPTER *ioc = fw_event->ioc;
4842 MPT_FRAME_HDR *mf;
4843 VirtDevice *vdevice;
4844 int ii;
4845 struct scsi_cmnd *sc;
4846 SCSITaskMgmtReply_t *pScsiTmReply;
4847 u8 issue_reset;
4848 int task_context;
4849 u8 channel, id;
4850 int lun;
4851 u32 termination_count;
4852 u32 query_count;
4853
4854 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4855 "%s - enter\n", ioc->name, __func__));
4856
4857 mutex_lock(&ioc->taskmgmt_cmds.mutex);
4858 if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0) {
4859 mutex_unlock(&ioc->taskmgmt_cmds.mutex);
4860 mptsas_requeue_fw_event(ioc, fw_event, 1000);
4861 return;
4862 }
4863
4864 issue_reset = 0;
4865 termination_count = 0;
4866 query_count = 0;
4867 mpt_findImVolumes(ioc);
4868 pScsiTmReply = (SCSITaskMgmtReply_t *) ioc->taskmgmt_cmds.reply;
4869
4870 for (ii = 0; ii < ioc->req_depth; ii++) {
4871 if (ioc->fw_events_off)
4872 goto out;
4873 sc = mptscsih_get_scsi_lookup(ioc, ii);
4874 if (!sc)
4875 continue;
4876 mf = MPT_INDEX_2_MFPTR(ioc, ii);
4877 if (!mf)
4878 continue;
4879 task_context = mf->u.frame.hwhdr.msgctxu.MsgContext;
4880 vdevice = sc->device->hostdata;
4881 if (!vdevice || !vdevice->vtarget)
4882 continue;
4883 if (vdevice->vtarget->tflags & MPT_TARGET_FLAGS_RAID_COMPONENT)
4884 continue; /* skip hidden raid components */
4885 if (vdevice->vtarget->raidVolume)
4886 continue; /* skip hidden raid components */
4887 channel = vdevice->vtarget->channel;
4888 id = vdevice->vtarget->id;
4889 lun = vdevice->lun;
4890 if (mptsas_issue_tm(ioc, MPI_SCSITASKMGMT_TASKTYPE_QUERY_TASK,
4891 channel, id, (u64)lun, task_context, 30, &issue_reset))
4892 goto out;
4893 query_count++;
4894 termination_count +=
4895 le32_to_cpu(pScsiTmReply->TerminationCount);
4896 if ((pScsiTmReply->IOCStatus == MPI_IOCSTATUS_SUCCESS) &&
4897 (pScsiTmReply->ResponseCode ==
4898 MPI_SCSITASKMGMT_RSP_TM_SUCCEEDED ||
4899 pScsiTmReply->ResponseCode ==
4900 MPI_SCSITASKMGMT_RSP_IO_QUEUED_ON_IOC))
4901 continue;
4902 if (mptsas_issue_tm(ioc,
4903 MPI_SCSITASKMGMT_TASKTYPE_ABRT_TASK_SET,
4904 channel, id, (u64)lun, 0, 30, &issue_reset))
4905 goto out;
4906 termination_count +=
4907 le32_to_cpu(pScsiTmReply->TerminationCount);
4908 }
4909
4910 out:
4911 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4912 "%s - exit, query_count = %d termination_count = %d\n",
4913 ioc->name, __func__, query_count, termination_count));
4914
4915 ioc->broadcast_aen_busy = 0;
4916 mpt_clear_taskmgmt_in_progress_flag(ioc);
4917 mutex_unlock(&ioc->taskmgmt_cmds.mutex);
4918
4919 if (issue_reset) {
4920 printk(MYIOC_s_WARN_FMT
4921 "Issuing Reset from %s!! doorbell=0x%08x\n",
4922 ioc->name, __func__, mpt_GetIocState(ioc, 0));
4923 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
4924 }
4925 mptsas_free_fw_event(ioc, fw_event);
4926}
4927
4928/*
4929 * mptsas_send_ir2_event - handle exposing hidden disk when
4930 * an inactive raid volume is added
4931 *
4932 * @ioc: Pointer to MPT_ADAPTER structure
4933 * @ir2_data
4934 *
4935 */
4936static void
4937mptsas_send_ir2_event(struct fw_event_work *fw_event)
4938{
4939 MPT_ADAPTER *ioc;
4940 struct mptsas_hotplug_event hot_plug_info;
4941 MPI_EVENT_DATA_IR2 *ir2_data;
4942 u8 reasonCode;
4943 RaidPhysDiskPage0_t phys_disk;
4944
4945 ioc = fw_event->ioc;
4946 ir2_data = (MPI_EVENT_DATA_IR2 *)fw_event->event_data;
4947 reasonCode = ir2_data->ReasonCode;
4948
4949 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Entering %s: "
4950 "ReasonCode=%02x\n", ioc->name, __func__, reasonCode));
4951
4952 memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4953 hot_plug_info.id = ir2_data->TargetID;
4954 hot_plug_info.channel = ir2_data->Bus;
4955 switch (reasonCode) {
4956 case MPI_EVENT_IR2_RC_FOREIGN_CFG_DETECTED:
4957 hot_plug_info.event_type = MPTSAS_ADD_INACTIVE_VOLUME;
4958 break;
4959 case MPI_EVENT_IR2_RC_DUAL_PORT_REMOVED:
4960 hot_plug_info.phys_disk_num = ir2_data->PhysDiskNum;
4961 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK;
4962 break;
4963 case MPI_EVENT_IR2_RC_DUAL_PORT_ADDED:
4964 hot_plug_info.phys_disk_num = ir2_data->PhysDiskNum;
4965 mpt_raid_phys_disk_pg0(ioc,
4966 ir2_data->PhysDiskNum, &phys_disk);
4967 hot_plug_info.id = phys_disk.PhysDiskID;
4968 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK;
4969 break;
4970 default:
4971 mptsas_free_fw_event(ioc, fw_event);
4972 return;
4973 }
4974 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4975}
4976
4977static int
4978mptsas_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *reply)
4979{
4980 u32 event = le32_to_cpu(reply->Event);
4981 int event_data_sz;
4982 struct fw_event_work *fw_event;
4983 unsigned long delay;
4984
4985 if (ioc->bus_type != SAS)
4986 return 0;
4987
4988 /* events turned off due to host reset or driver unloading */
4989 if (ioc->fw_events_off)
4990 return 0;
4991
4992 delay = msecs_to_jiffies(1);
4993 switch (event) {
4994 case MPI_EVENT_SAS_BROADCAST_PRIMITIVE:
4995 {
4996 EVENT_DATA_SAS_BROADCAST_PRIMITIVE *broadcast_event_data =
4997 (EVENT_DATA_SAS_BROADCAST_PRIMITIVE *)reply->Data;
4998 if (broadcast_event_data->Primitive !=
4999 MPI_EVENT_PRIMITIVE_ASYNCHRONOUS_EVENT)
5000 return 0;
5001 if (ioc->broadcast_aen_busy)
5002 return 0;
5003 ioc->broadcast_aen_busy = 1;
5004 break;
5005 }
5006 case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
5007 {
5008 EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data =
5009 (EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *)reply->Data;
5010 u16 ioc_stat;
5011 ioc_stat = le16_to_cpu(reply->IOCStatus);
5012
5013 if (sas_event_data->ReasonCode ==
5014 MPI_EVENT_SAS_DEV_STAT_RC_NOT_RESPONDING) {
5015 mptsas_target_reset_queue(ioc, sas_event_data);
5016 return 0;
5017 }
5018 if (sas_event_data->ReasonCode ==
5019 MPI_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET &&
5020 ioc->device_missing_delay &&
5021 (ioc_stat & MPI_IOCSTATUS_FLAG_LOG_INFO_AVAILABLE)) {
5022 VirtTarget *vtarget = NULL;
5023 u8 id, channel;
5024
5025 id = sas_event_data->TargetID;
5026 channel = sas_event_data->Bus;
5027
5028 vtarget = mptsas_find_vtarget(ioc, channel, id);
5029 if (vtarget) {
5030 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5031 "LogInfo (0x%x) available for "
5032 "INTERNAL_DEVICE_RESET"
5033 "fw_id %d fw_channel %d\n", ioc->name,
5034 le32_to_cpu(reply->IOCLogInfo),
5035 id, channel));
5036 if (vtarget->raidVolume) {
5037 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5038 "Skipping Raid Volume for inDMD\n",
5039 ioc->name));
5040 } else {
5041 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5042 "Setting device flag inDMD\n",
5043 ioc->name));
5044 vtarget->inDMD = 1;
5045 }
5046
5047 }
5048
5049 }
5050
5051 break;
5052 }
5053 case MPI_EVENT_SAS_EXPANDER_STATUS_CHANGE:
5054 {
5055 MpiEventDataSasExpanderStatusChange_t *expander_data =
5056 (MpiEventDataSasExpanderStatusChange_t *)reply->Data;
5057
5058 if (ioc->old_sas_discovery_protocal)
5059 return 0;
5060
5061 if (expander_data->ReasonCode ==
5062 MPI_EVENT_SAS_EXP_RC_NOT_RESPONDING &&
5063 ioc->device_missing_delay)
5064 delay = HZ * ioc->device_missing_delay;
5065 break;
5066 }
5067 case MPI_EVENT_SAS_DISCOVERY:
5068 {
5069 u32 discovery_status;
5070 EventDataSasDiscovery_t *discovery_data =
5071 (EventDataSasDiscovery_t *)reply->Data;
5072
5073 discovery_status = le32_to_cpu(discovery_data->DiscoveryStatus);
5074 ioc->sas_discovery_quiesce_io = discovery_status ? 1 : 0;
5075 if (ioc->old_sas_discovery_protocal && !discovery_status)
5076 mptsas_queue_rescan(ioc);
5077 return 0;
5078 }
5079 case MPI_EVENT_INTEGRATED_RAID:
5080 case MPI_EVENT_PERSISTENT_TABLE_FULL:
5081 case MPI_EVENT_IR2:
5082 case MPI_EVENT_SAS_PHY_LINK_STATUS:
5083 case MPI_EVENT_QUEUE_FULL:
5084 break;
5085 default:
5086 return 0;
5087 }
5088
5089 event_data_sz = ((reply->MsgLength * 4) -
5090 offsetof(EventNotificationReply_t, Data));
5091 fw_event = kzalloc(sizeof(*fw_event) + event_data_sz, GFP_ATOMIC);
5092 if (!fw_event) {
5093 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n", ioc->name,
5094 __func__, __LINE__);
5095 return 0;
5096 }
5097 memcpy(fw_event->event_data, reply->Data, event_data_sz);
5098 fw_event->event = event;
5099 fw_event->ioc = ioc;
5100 mptsas_add_fw_event(ioc, fw_event, delay);
5101 return 0;
5102}
5103
5104/* Delete a volume when no longer listed in ioc pg2
5105 */
5106static void mptsas_volume_delete(MPT_ADAPTER *ioc, u8 id)
5107{
5108 struct scsi_device *sdev;
5109 int i;
5110
5111 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL, id, 0);
5112 if (!sdev)
5113 return;
5114 if (!ioc->raid_data.pIocPg2)
5115 goto out;
5116 if (!ioc->raid_data.pIocPg2->NumActiveVolumes)
5117 goto out;
5118 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++)
5119 if (ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID == id)
5120 goto release_sdev;
5121 out:
5122 printk(MYIOC_s_INFO_FMT "removing raid volume, channel %d, "
5123 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL, id);
5124 scsi_remove_device(sdev);
5125 release_sdev:
5126 scsi_device_put(sdev);
5127}
5128
5129static int
5130mptsas_probe(struct pci_dev *pdev, const struct pci_device_id *id)
5131{
5132 struct Scsi_Host *sh;
5133 MPT_SCSI_HOST *hd;
5134 MPT_ADAPTER *ioc;
5135 unsigned long flags;
5136 int ii;
5137 int numSGE = 0;
5138 int scale;
5139 int ioc_cap;
5140 int error=0;
5141 int r;
5142
5143 r = mpt_attach(pdev,id);
5144 if (r)
5145 return r;
5146
5147 ioc = pci_get_drvdata(pdev);
5148 mptsas_fw_event_off(ioc);
5149 ioc->DoneCtx = mptsasDoneCtx;
5150 ioc->TaskCtx = mptsasTaskCtx;
5151 ioc->InternalCtx = mptsasInternalCtx;
5152 ioc->schedule_target_reset = &mptsas_schedule_target_reset;
5153 ioc->schedule_dead_ioc_flush_running_cmds =
5154 &mptscsih_flush_running_cmds;
5155 /* Added sanity check on readiness of the MPT adapter.
5156 */
5157 if (ioc->last_state != MPI_IOC_STATE_OPERATIONAL) {
5158 printk(MYIOC_s_WARN_FMT
5159 "Skipping because it's not operational!\n",
5160 ioc->name);
5161 error = -ENODEV;
5162 goto out_mptsas_probe;
5163 }
5164
5165 if (!ioc->active) {
5166 printk(MYIOC_s_WARN_FMT "Skipping because it's disabled!\n",
5167 ioc->name);
5168 error = -ENODEV;
5169 goto out_mptsas_probe;
5170 }
5171
5172 /* Sanity check - ensure at least 1 port is INITIATOR capable
5173 */
5174 ioc_cap = 0;
5175 for (ii = 0; ii < ioc->facts.NumberOfPorts; ii++) {
5176 if (ioc->pfacts[ii].ProtocolFlags &
5177 MPI_PORTFACTS_PROTOCOL_INITIATOR)
5178 ioc_cap++;
5179 }
5180
5181 if (!ioc_cap) {
5182 printk(MYIOC_s_WARN_FMT
5183 "Skipping ioc=%p because SCSI Initiator mode "
5184 "is NOT enabled!\n", ioc->name, ioc);
5185 return 0;
5186 }
5187
5188 sh = scsi_host_alloc(&mptsas_driver_template, sizeof(MPT_SCSI_HOST));
5189 if (!sh) {
5190 printk(MYIOC_s_WARN_FMT
5191 "Unable to register controller with SCSI subsystem\n",
5192 ioc->name);
5193 error = -1;
5194 goto out_mptsas_probe;
5195 }
5196
5197 spin_lock_irqsave(&ioc->FreeQlock, flags);
5198
5199 /* Attach the SCSI Host to the IOC structure
5200 */
5201 ioc->sh = sh;
5202
5203 sh->io_port = 0;
5204 sh->n_io_port = 0;
5205 sh->irq = 0;
5206
5207 /* set 16 byte cdb's */
5208 sh->max_cmd_len = 16;
5209 sh->can_queue = min_t(int, ioc->req_depth - 10, sh->can_queue);
5210 sh->max_id = -1;
5211 sh->max_lun = max_lun;
5212 sh->transportt = mptsas_transport_template;
5213
5214 /* Required entry.
5215 */
5216 sh->unique_id = ioc->id;
5217
5218 INIT_LIST_HEAD(&ioc->sas_topology);
5219 mutex_init(&ioc->sas_topology_mutex);
5220 mutex_init(&ioc->sas_discovery_mutex);
5221 mutex_init(&ioc->sas_mgmt.mutex);
5222 init_completion(&ioc->sas_mgmt.done);
5223
5224 /* Verify that we won't exceed the maximum
5225 * number of chain buffers
5226 * We can optimize: ZZ = req_sz/sizeof(SGE)
5227 * For 32bit SGE's:
5228 * numSGE = 1 + (ZZ-1)*(maxChain -1) + ZZ
5229 * + (req_sz - 64)/sizeof(SGE)
5230 * A slightly different algorithm is required for
5231 * 64bit SGEs.
5232 */
5233 scale = ioc->req_sz/ioc->SGE_size;
5234 if (ioc->sg_addr_size == sizeof(u64)) {
5235 numSGE = (scale - 1) *
5236 (ioc->facts.MaxChainDepth-1) + scale +
5237 (ioc->req_sz - 60) / ioc->SGE_size;
5238 } else {
5239 numSGE = 1 + (scale - 1) *
5240 (ioc->facts.MaxChainDepth-1) + scale +
5241 (ioc->req_sz - 64) / ioc->SGE_size;
5242 }
5243
5244 if (numSGE < sh->sg_tablesize) {
5245 /* Reset this value */
5246 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5247 "Resetting sg_tablesize to %d from %d\n",
5248 ioc->name, numSGE, sh->sg_tablesize));
5249 sh->sg_tablesize = numSGE;
5250 }
5251
5252 if (mpt_loadtime_max_sectors) {
5253 if (mpt_loadtime_max_sectors < 64 ||
5254 mpt_loadtime_max_sectors > 8192) {
5255 printk(MYIOC_s_INFO_FMT "Invalid value passed for"
5256 "mpt_loadtime_max_sectors %d."
5257 "Range from 64 to 8192\n", ioc->name,
5258 mpt_loadtime_max_sectors);
5259 }
5260 mpt_loadtime_max_sectors &= 0xFFFFFFFE;
5261 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5262 "Resetting max sector to %d from %d\n",
5263 ioc->name, mpt_loadtime_max_sectors, sh->max_sectors));
5264 sh->max_sectors = mpt_loadtime_max_sectors;
5265 }
5266
5267 hd = shost_priv(sh);
5268 hd->ioc = ioc;
5269
5270 /* SCSI needs scsi_cmnd lookup table!
5271 * (with size equal to req_depth*PtrSz!)
5272 */
5273 ioc->ScsiLookup = kcalloc(ioc->req_depth, sizeof(void *), GFP_ATOMIC);
5274 if (!ioc->ScsiLookup) {
5275 error = -ENOMEM;
5276 spin_unlock_irqrestore(&ioc->FreeQlock, flags);
5277 goto out_mptsas_probe;
5278 }
5279 spin_lock_init(&ioc->scsi_lookup_lock);
5280
5281 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT "ScsiLookup @ %p\n",
5282 ioc->name, ioc->ScsiLookup));
5283
5284 ioc->sas_data.ptClear = mpt_pt_clear;
5285
5286 hd->last_queue_full = 0;
5287 INIT_LIST_HEAD(&hd->target_reset_list);
5288 INIT_LIST_HEAD(&ioc->sas_device_info_list);
5289 mutex_init(&ioc->sas_device_info_mutex);
5290
5291 spin_unlock_irqrestore(&ioc->FreeQlock, flags);
5292
5293 if (ioc->sas_data.ptClear==1) {
5294 mptbase_sas_persist_operation(
5295 ioc, MPI_SAS_OP_CLEAR_ALL_PERSISTENT);
5296 }
5297
5298 error = scsi_add_host(sh, &ioc->pcidev->dev);
5299 if (error) {
5300 dprintk(ioc, printk(MYIOC_s_ERR_FMT
5301 "scsi_add_host failed\n", ioc->name));
5302 goto out_mptsas_probe;
5303 }
5304
5305 /* older firmware doesn't support expander events */
5306 if ((ioc->facts.HeaderVersion >> 8) < 0xE)
5307 ioc->old_sas_discovery_protocal = 1;
5308 mptsas_scan_sas_topology(ioc);
5309 mptsas_fw_event_on(ioc);
5310 return 0;
5311
5312 out_mptsas_probe:
5313
5314 mptscsih_remove(pdev);
5315 return error;
5316}
5317
5318static void
5319mptsas_shutdown(struct pci_dev *pdev)
5320{
5321 MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
5322
5323 mptsas_fw_event_off(ioc);
5324 mptsas_cleanup_fw_event_q(ioc);
5325}
5326
5327static void mptsas_remove(struct pci_dev *pdev)
5328{
5329 MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
5330 struct mptsas_portinfo *p, *n;
5331 int i;
5332
5333 if (!ioc->sh) {
5334 printk(MYIOC_s_INFO_FMT "IOC is in Target mode\n", ioc->name);
5335 mpt_detach(pdev);
5336 return;
5337 }
5338
5339 mptsas_shutdown(pdev);
5340
5341 mptsas_del_device_components(ioc);
5342
5343 ioc->sas_discovery_ignore_events = 1;
5344 sas_remove_host(ioc->sh);
5345
5346 mutex_lock(&ioc->sas_topology_mutex);
5347 list_for_each_entry_safe(p, n, &ioc->sas_topology, list) {
5348 list_del(&p->list);
5349 for (i = 0 ; i < p->num_phys ; i++)
5350 mptsas_port_delete(ioc, p->phy_info[i].port_details);
5351
5352 kfree(p->phy_info);
5353 kfree(p);
5354 }
5355 mutex_unlock(&ioc->sas_topology_mutex);
5356 ioc->hba_port_info = NULL;
5357 mptscsih_remove(pdev);
5358}
5359
5360static struct pci_device_id mptsas_pci_table[] = {
5361 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064,
5362 PCI_ANY_ID, PCI_ANY_ID },
5363 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068,
5364 PCI_ANY_ID, PCI_ANY_ID },
5365 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064E,
5366 PCI_ANY_ID, PCI_ANY_ID },
5367 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068E,
5368 PCI_ANY_ID, PCI_ANY_ID },
5369 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1078,
5370 PCI_ANY_ID, PCI_ANY_ID },
5371 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068_820XELP,
5372 PCI_ANY_ID, PCI_ANY_ID },
5373 {0} /* Terminating entry */
5374};
5375MODULE_DEVICE_TABLE(pci, mptsas_pci_table);
5376
5377
5378static struct pci_driver mptsas_driver = {
5379 .name = "mptsas",
5380 .id_table = mptsas_pci_table,
5381 .probe = mptsas_probe,
5382 .remove = mptsas_remove,
5383 .shutdown = mptsas_shutdown,
5384#ifdef CONFIG_PM
5385 .suspend = mptscsih_suspend,
5386 .resume = mptscsih_resume,
5387#endif
5388};
5389
5390static int __init
5391mptsas_init(void)
5392{
5393 int error;
5394
5395 show_mptmod_ver(my_NAME, my_VERSION);
5396
5397 mptsas_transport_template =
5398 sas_attach_transport(&mptsas_transport_functions);
5399 if (!mptsas_transport_template)
5400 return -ENODEV;
5401 mptsas_transport_template->eh_timed_out = mptsas_eh_timed_out;
5402
5403 mptsasDoneCtx = mpt_register(mptscsih_io_done, MPTSAS_DRIVER,
5404 "mptscsih_io_done");
5405 mptsasTaskCtx = mpt_register(mptscsih_taskmgmt_complete, MPTSAS_DRIVER,
5406 "mptscsih_taskmgmt_complete");
5407 mptsasInternalCtx =
5408 mpt_register(mptscsih_scandv_complete, MPTSAS_DRIVER,
5409 "mptscsih_scandv_complete");
5410 mptsasMgmtCtx = mpt_register(mptsas_mgmt_done, MPTSAS_DRIVER,
5411 "mptsas_mgmt_done");
5412 mptsasDeviceResetCtx =
5413 mpt_register(mptsas_taskmgmt_complete, MPTSAS_DRIVER,
5414 "mptsas_taskmgmt_complete");
5415
5416 mpt_event_register(mptsasDoneCtx, mptsas_event_process);
5417 mpt_reset_register(mptsasDoneCtx, mptsas_ioc_reset);
5418
5419 error = pci_register_driver(&mptsas_driver);
5420 if (error)
5421 sas_release_transport(mptsas_transport_template);
5422
5423 return error;
5424}
5425
5426static void __exit
5427mptsas_exit(void)
5428{
5429 pci_unregister_driver(&mptsas_driver);
5430 sas_release_transport(mptsas_transport_template);
5431
5432 mpt_reset_deregister(mptsasDoneCtx);
5433 mpt_event_deregister(mptsasDoneCtx);
5434
5435 mpt_deregister(mptsasMgmtCtx);
5436 mpt_deregister(mptsasInternalCtx);
5437 mpt_deregister(mptsasTaskCtx);
5438 mpt_deregister(mptsasDoneCtx);
5439 mpt_deregister(mptsasDeviceResetCtx);
5440}
5441
5442module_init(mptsas_init);
5443module_exit(mptsas_exit);
1/*
2 * linux/drivers/message/fusion/mptsas.c
3 * For use with LSI PCI chip/adapter(s)
4 * running LSI Fusion MPT (Message Passing Technology) firmware.
5 *
6 * Copyright (c) 1999-2008 LSI Corporation
7 * (mailto:DL-MPTFusionLinux@lsi.com)
8 */
9/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
10/*
11 This program is free software; you can redistribute it and/or modify
12 it under the terms of the GNU General Public License as published by
13 the Free Software Foundation; version 2 of the License.
14
15 This program is distributed in the hope that it will be useful,
16 but WITHOUT ANY WARRANTY; without even the implied warranty of
17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 GNU General Public License for more details.
19
20 NO WARRANTY
21 THE PROGRAM IS PROVIDED ON AN "AS IS" BASIS, WITHOUT WARRANTIES OR
22 CONDITIONS OF ANY KIND, EITHER EXPRESS OR IMPLIED INCLUDING, WITHOUT
23 LIMITATION, ANY WARRANTIES OR CONDITIONS OF TITLE, NON-INFRINGEMENT,
24 MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE. Each Recipient is
25 solely responsible for determining the appropriateness of using and
26 distributing the Program and assumes all risks associated with its
27 exercise of rights under this Agreement, including but not limited to
28 the risks and costs of program errors, damage to or loss of data,
29 programs or equipment, and unavailability or interruption of operations.
30
31 DISCLAIMER OF LIABILITY
32 NEITHER RECIPIENT NOR ANY CONTRIBUTORS SHALL HAVE ANY LIABILITY FOR ANY
33 DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
34 DAMAGES (INCLUDING WITHOUT LIMITATION LOST PROFITS), HOWEVER CAUSED AND
35 ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR
36 TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE
37 USE OR DISTRIBUTION OF THE PROGRAM OR THE EXERCISE OF ANY RIGHTS GRANTED
38 HEREUNDER, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGES
39
40 You should have received a copy of the GNU General Public License
41 along with this program; if not, write to the Free Software
42 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
43*/
44/*=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=-=*/
45
46#include <linux/module.h>
47#include <linux/kernel.h>
48#include <linux/slab.h>
49#include <linux/init.h>
50#include <linux/errno.h>
51#include <linux/jiffies.h>
52#include <linux/workqueue.h>
53#include <linux/delay.h> /* for mdelay */
54
55#include <scsi/scsi.h>
56#include <scsi/scsi_cmnd.h>
57#include <scsi/scsi_device.h>
58#include <scsi/scsi_host.h>
59#include <scsi/scsi_transport_sas.h>
60#include <scsi/scsi_transport.h>
61#include <scsi/scsi_dbg.h>
62
63#include "mptbase.h"
64#include "mptscsih.h"
65#include "mptsas.h"
66
67
68#define my_NAME "Fusion MPT SAS Host driver"
69#define my_VERSION MPT_LINUX_VERSION_COMMON
70#define MYNAM "mptsas"
71
72/*
73 * Reserved channel for integrated raid
74 */
75#define MPTSAS_RAID_CHANNEL 1
76
77#define SAS_CONFIG_PAGE_TIMEOUT 30
78MODULE_AUTHOR(MODULEAUTHOR);
79MODULE_DESCRIPTION(my_NAME);
80MODULE_LICENSE("GPL");
81MODULE_VERSION(my_VERSION);
82
83static int mpt_pt_clear;
84module_param(mpt_pt_clear, int, 0);
85MODULE_PARM_DESC(mpt_pt_clear,
86 " Clear persistency table: enable=1 "
87 "(default=MPTSCSIH_PT_CLEAR=0)");
88
89/* scsi-mid layer global parameter is max_report_luns, which is 511 */
90#define MPTSAS_MAX_LUN (16895)
91static int max_lun = MPTSAS_MAX_LUN;
92module_param(max_lun, int, 0);
93MODULE_PARM_DESC(max_lun, " max lun, default=16895 ");
94
95static int mpt_loadtime_max_sectors = 8192;
96module_param(mpt_loadtime_max_sectors, int, 0);
97MODULE_PARM_DESC(mpt_loadtime_max_sectors,
98 " Maximum sector define for Host Bus Adaptor.Range 64 to 8192 default=8192");
99
100static u8 mptsasDoneCtx = MPT_MAX_PROTOCOL_DRIVERS;
101static u8 mptsasTaskCtx = MPT_MAX_PROTOCOL_DRIVERS;
102static u8 mptsasInternalCtx = MPT_MAX_PROTOCOL_DRIVERS; /* Used only for internal commands */
103static u8 mptsasMgmtCtx = MPT_MAX_PROTOCOL_DRIVERS;
104static u8 mptsasDeviceResetCtx = MPT_MAX_PROTOCOL_DRIVERS;
105
106static void mptsas_firmware_event_work(struct work_struct *work);
107static void mptsas_send_sas_event(struct fw_event_work *fw_event);
108static void mptsas_send_raid_event(struct fw_event_work *fw_event);
109static void mptsas_send_ir2_event(struct fw_event_work *fw_event);
110static void mptsas_parse_device_info(struct sas_identify *identify,
111 struct mptsas_devinfo *device_info);
112static inline void mptsas_set_rphy(MPT_ADAPTER *ioc,
113 struct mptsas_phyinfo *phy_info, struct sas_rphy *rphy);
114static struct mptsas_phyinfo *mptsas_find_phyinfo_by_sas_address
115 (MPT_ADAPTER *ioc, u64 sas_address);
116static int mptsas_sas_device_pg0(MPT_ADAPTER *ioc,
117 struct mptsas_devinfo *device_info, u32 form, u32 form_specific);
118static int mptsas_sas_enclosure_pg0(MPT_ADAPTER *ioc,
119 struct mptsas_enclosure *enclosure, u32 form, u32 form_specific);
120static int mptsas_add_end_device(MPT_ADAPTER *ioc,
121 struct mptsas_phyinfo *phy_info);
122static void mptsas_del_end_device(MPT_ADAPTER *ioc,
123 struct mptsas_phyinfo *phy_info);
124static void mptsas_send_link_status_event(struct fw_event_work *fw_event);
125static struct mptsas_portinfo *mptsas_find_portinfo_by_sas_address
126 (MPT_ADAPTER *ioc, u64 sas_address);
127static void mptsas_expander_delete(MPT_ADAPTER *ioc,
128 struct mptsas_portinfo *port_info, u8 force);
129static void mptsas_send_expander_event(struct fw_event_work *fw_event);
130static void mptsas_not_responding_devices(MPT_ADAPTER *ioc);
131static void mptsas_scan_sas_topology(MPT_ADAPTER *ioc);
132static void mptsas_broadcast_primitive_work(struct fw_event_work *fw_event);
133static void mptsas_handle_queue_full_event(struct fw_event_work *fw_event);
134static void mptsas_volume_delete(MPT_ADAPTER *ioc, u8 id);
135void mptsas_schedule_target_reset(void *ioc);
136
137static void mptsas_print_phy_data(MPT_ADAPTER *ioc,
138 MPI_SAS_IO_UNIT0_PHY_DATA *phy_data)
139{
140 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
141 "---- IO UNIT PAGE 0 ------------\n", ioc->name));
142 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
143 ioc->name, le16_to_cpu(phy_data->AttachedDeviceHandle)));
144 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Controller Handle=0x%X\n",
145 ioc->name, le16_to_cpu(phy_data->ControllerDevHandle)));
146 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port=0x%X\n",
147 ioc->name, phy_data->Port));
148 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Port Flags=0x%X\n",
149 ioc->name, phy_data->PortFlags));
150 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Flags=0x%X\n",
151 ioc->name, phy_data->PhyFlags));
152 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
153 ioc->name, phy_data->NegotiatedLinkRate));
154 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
155 "Controller PHY Device Info=0x%X\n", ioc->name,
156 le32_to_cpu(phy_data->ControllerPhyDeviceInfo)));
157 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "DiscoveryStatus=0x%X\n\n",
158 ioc->name, le32_to_cpu(phy_data->DiscoveryStatus)));
159}
160
161static void mptsas_print_phy_pg0(MPT_ADAPTER *ioc, SasPhyPage0_t *pg0)
162{
163 __le64 sas_address;
164
165 memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
166
167 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
168 "---- SAS PHY PAGE 0 ------------\n", ioc->name));
169 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
170 "Attached Device Handle=0x%X\n", ioc->name,
171 le16_to_cpu(pg0->AttachedDevHandle)));
172 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
173 ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
174 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
175 "Attached PHY Identifier=0x%X\n", ioc->name,
176 pg0->AttachedPhyIdentifier));
177 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Attached Device Info=0x%X\n",
178 ioc->name, le32_to_cpu(pg0->AttachedDeviceInfo)));
179 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
180 ioc->name, pg0->ProgrammedLinkRate));
181 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Change Count=0x%X\n",
182 ioc->name, pg0->ChangeCount));
183 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Info=0x%X\n\n",
184 ioc->name, le32_to_cpu(pg0->PhyInfo)));
185}
186
187static void mptsas_print_phy_pg1(MPT_ADAPTER *ioc, SasPhyPage1_t *pg1)
188{
189 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
190 "---- SAS PHY PAGE 1 ------------\n", ioc->name));
191 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Invalid Dword Count=0x%x\n",
192 ioc->name, pg1->InvalidDwordCount));
193 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
194 "Running Disparity Error Count=0x%x\n", ioc->name,
195 pg1->RunningDisparityErrorCount));
196 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
197 "Loss Dword Synch Count=0x%x\n", ioc->name,
198 pg1->LossDwordSynchCount));
199 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
200 "PHY Reset Problem Count=0x%x\n\n", ioc->name,
201 pg1->PhyResetProblemCount));
202}
203
204static void mptsas_print_device_pg0(MPT_ADAPTER *ioc, SasDevicePage0_t *pg0)
205{
206 __le64 sas_address;
207
208 memcpy(&sas_address, &pg0->SASAddress, sizeof(__le64));
209
210 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
211 "---- SAS DEVICE PAGE 0 ---------\n", ioc->name));
212 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Handle=0x%X\n",
213 ioc->name, le16_to_cpu(pg0->DevHandle)));
214 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Handle=0x%X\n",
215 ioc->name, le16_to_cpu(pg0->ParentDevHandle)));
216 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Enclosure Handle=0x%X\n",
217 ioc->name, le16_to_cpu(pg0->EnclosureHandle)));
218 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Slot=0x%X\n",
219 ioc->name, le16_to_cpu(pg0->Slot)));
220 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "SAS Address=0x%llX\n",
221 ioc->name, (unsigned long long)le64_to_cpu(sas_address)));
222 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Target ID=0x%X\n",
223 ioc->name, pg0->TargetID));
224 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Bus=0x%X\n",
225 ioc->name, pg0->Bus));
226 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Parent Phy Num=0x%X\n",
227 ioc->name, pg0->PhyNum));
228 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Access Status=0x%X\n",
229 ioc->name, le16_to_cpu(pg0->AccessStatus)));
230 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Device Info=0x%X\n",
231 ioc->name, le32_to_cpu(pg0->DeviceInfo)));
232 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Flags=0x%X\n",
233 ioc->name, le16_to_cpu(pg0->Flags)));
234 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n\n",
235 ioc->name, pg0->PhysicalPort));
236}
237
238static void mptsas_print_expander_pg1(MPT_ADAPTER *ioc, SasExpanderPage1_t *pg1)
239{
240 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
241 "---- SAS EXPANDER PAGE 1 ------------\n", ioc->name));
242 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Physical Port=0x%X\n",
243 ioc->name, pg1->PhysicalPort));
244 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "PHY Identifier=0x%X\n",
245 ioc->name, pg1->PhyIdentifier));
246 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Negotiated Link Rate=0x%X\n",
247 ioc->name, pg1->NegotiatedLinkRate));
248 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Programmed Link Rate=0x%X\n",
249 ioc->name, pg1->ProgrammedLinkRate));
250 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Hardware Link Rate=0x%X\n",
251 ioc->name, pg1->HwLinkRate));
252 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Owner Device Handle=0x%X\n",
253 ioc->name, le16_to_cpu(pg1->OwnerDevHandle)));
254 dsasprintk(ioc, printk(MYIOC_s_DEBUG_FMT
255 "Attached Device Handle=0x%X\n\n", ioc->name,
256 le16_to_cpu(pg1->AttachedDevHandle)));
257}
258
259/* inhibit sas firmware event handling */
260static void
261mptsas_fw_event_off(MPT_ADAPTER *ioc)
262{
263 unsigned long flags;
264
265 spin_lock_irqsave(&ioc->fw_event_lock, flags);
266 ioc->fw_events_off = 1;
267 ioc->sas_discovery_quiesce_io = 0;
268 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
269
270}
271
272/* enable sas firmware event handling */
273static void
274mptsas_fw_event_on(MPT_ADAPTER *ioc)
275{
276 unsigned long flags;
277
278 spin_lock_irqsave(&ioc->fw_event_lock, flags);
279 ioc->fw_events_off = 0;
280 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
281}
282
283/* queue a sas firmware event */
284static void
285mptsas_add_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
286 unsigned long delay)
287{
288 unsigned long flags;
289
290 spin_lock_irqsave(&ioc->fw_event_lock, flags);
291 list_add_tail(&fw_event->list, &ioc->fw_event_list);
292 fw_event->users = 1;
293 INIT_DELAYED_WORK(&fw_event->work, mptsas_firmware_event_work);
294 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: add (fw_event=0x%p)"
295 "on cpuid %d\n", ioc->name, __func__,
296 fw_event, smp_processor_id()));
297 queue_delayed_work_on(smp_processor_id(), ioc->fw_event_q,
298 &fw_event->work, delay);
299 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
300}
301
302/* requeue a sas firmware event */
303static void
304mptsas_requeue_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
305 unsigned long delay)
306{
307 unsigned long flags;
308 spin_lock_irqsave(&ioc->fw_event_lock, flags);
309 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: reschedule task "
310 "(fw_event=0x%p)on cpuid %d\n", ioc->name, __func__,
311 fw_event, smp_processor_id()));
312 fw_event->retries++;
313 queue_delayed_work_on(smp_processor_id(), ioc->fw_event_q,
314 &fw_event->work, msecs_to_jiffies(delay));
315 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
316}
317
318static void __mptsas_free_fw_event(MPT_ADAPTER *ioc,
319 struct fw_event_work *fw_event)
320{
321 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: kfree (fw_event=0x%p)\n",
322 ioc->name, __func__, fw_event));
323 list_del(&fw_event->list);
324 kfree(fw_event);
325}
326
327/* free memory associated to a sas firmware event */
328static void
329mptsas_free_fw_event(MPT_ADAPTER *ioc, struct fw_event_work *fw_event)
330{
331 unsigned long flags;
332
333 spin_lock_irqsave(&ioc->fw_event_lock, flags);
334 fw_event->users--;
335 if (!fw_event->users)
336 __mptsas_free_fw_event(ioc, fw_event);
337 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
338}
339
340/* walk the firmware event queue, and either stop or wait for
341 * outstanding events to complete */
342static void
343mptsas_cleanup_fw_event_q(MPT_ADAPTER *ioc)
344{
345 struct fw_event_work *fw_event;
346 struct mptsas_target_reset_event *target_reset_list, *n;
347 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
348 unsigned long flags;
349
350 /* flush the target_reset_list */
351 if (!list_empty(&hd->target_reset_list)) {
352 list_for_each_entry_safe(target_reset_list, n,
353 &hd->target_reset_list, list) {
354 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
355 "%s: removing target reset for id=%d\n",
356 ioc->name, __func__,
357 target_reset_list->sas_event_data.TargetID));
358 list_del(&target_reset_list->list);
359 kfree(target_reset_list);
360 }
361 }
362
363 if (list_empty(&ioc->fw_event_list) || !ioc->fw_event_q)
364 return;
365
366 spin_lock_irqsave(&ioc->fw_event_lock, flags);
367
368 while (!list_empty(&ioc->fw_event_list)) {
369 bool canceled = false;
370
371 fw_event = list_first_entry(&ioc->fw_event_list,
372 struct fw_event_work, list);
373 fw_event->users++;
374 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
375 if (cancel_delayed_work_sync(&fw_event->work))
376 canceled = true;
377
378 spin_lock_irqsave(&ioc->fw_event_lock, flags);
379 if (canceled)
380 fw_event->users--;
381 fw_event->users--;
382 WARN_ON_ONCE(fw_event->users);
383 __mptsas_free_fw_event(ioc, fw_event);
384 }
385 spin_unlock_irqrestore(&ioc->fw_event_lock, flags);
386}
387
388
389static inline MPT_ADAPTER *phy_to_ioc(struct sas_phy *phy)
390{
391 struct Scsi_Host *shost = dev_to_shost(phy->dev.parent);
392 return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
393}
394
395static inline MPT_ADAPTER *rphy_to_ioc(struct sas_rphy *rphy)
396{
397 struct Scsi_Host *shost = dev_to_shost(rphy->dev.parent->parent);
398 return ((MPT_SCSI_HOST *)shost->hostdata)->ioc;
399}
400
401/*
402 * mptsas_find_portinfo_by_handle
403 *
404 * This function should be called with the sas_topology_mutex already held
405 */
406static struct mptsas_portinfo *
407mptsas_find_portinfo_by_handle(MPT_ADAPTER *ioc, u16 handle)
408{
409 struct mptsas_portinfo *port_info, *rc=NULL;
410 int i;
411
412 list_for_each_entry(port_info, &ioc->sas_topology, list)
413 for (i = 0; i < port_info->num_phys; i++)
414 if (port_info->phy_info[i].identify.handle == handle) {
415 rc = port_info;
416 goto out;
417 }
418 out:
419 return rc;
420}
421
422/**
423 * mptsas_find_portinfo_by_sas_address - find and return portinfo for
424 * this sas_address
425 * @ioc: Pointer to MPT_ADAPTER structure
426 * @sas_address: expander sas address
427 *
428 * This function should be called with the sas_topology_mutex already held.
429 *
430 * Return: %NULL if not found.
431 **/
432static struct mptsas_portinfo *
433mptsas_find_portinfo_by_sas_address(MPT_ADAPTER *ioc, u64 sas_address)
434{
435 struct mptsas_portinfo *port_info, *rc = NULL;
436 int i;
437
438 if (sas_address >= ioc->hba_port_sas_addr &&
439 sas_address < (ioc->hba_port_sas_addr +
440 ioc->hba_port_num_phy))
441 return ioc->hba_port_info;
442
443 mutex_lock(&ioc->sas_topology_mutex);
444 list_for_each_entry(port_info, &ioc->sas_topology, list)
445 for (i = 0; i < port_info->num_phys; i++)
446 if (port_info->phy_info[i].identify.sas_address ==
447 sas_address) {
448 rc = port_info;
449 goto out;
450 }
451 out:
452 mutex_unlock(&ioc->sas_topology_mutex);
453 return rc;
454}
455
456/*
457 * Returns true if there is a scsi end device
458 */
459static inline int
460mptsas_is_end_device(struct mptsas_devinfo * attached)
461{
462 if ((attached->sas_address) &&
463 (attached->device_info &
464 MPI_SAS_DEVICE_INFO_END_DEVICE) &&
465 ((attached->device_info &
466 MPI_SAS_DEVICE_INFO_SSP_TARGET) |
467 (attached->device_info &
468 MPI_SAS_DEVICE_INFO_STP_TARGET) |
469 (attached->device_info &
470 MPI_SAS_DEVICE_INFO_SATA_DEVICE)))
471 return 1;
472 else
473 return 0;
474}
475
476/* no mutex */
477static void
478mptsas_port_delete(MPT_ADAPTER *ioc, struct mptsas_portinfo_details * port_details)
479{
480 struct mptsas_portinfo *port_info;
481 struct mptsas_phyinfo *phy_info;
482 u8 i;
483
484 if (!port_details)
485 return;
486
487 port_info = port_details->port_info;
488 phy_info = port_info->phy_info;
489
490 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: [%p]: num_phys=%02d "
491 "bitmask=0x%016llX\n", ioc->name, __func__, port_details,
492 port_details->num_phys, (unsigned long long)
493 port_details->phy_bitmask));
494
495 for (i = 0; i < port_info->num_phys; i++, phy_info++) {
496 if(phy_info->port_details != port_details)
497 continue;
498 memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
499 mptsas_set_rphy(ioc, phy_info, NULL);
500 phy_info->port_details = NULL;
501 }
502 kfree(port_details);
503}
504
505static inline struct sas_rphy *
506mptsas_get_rphy(struct mptsas_phyinfo *phy_info)
507{
508 if (phy_info->port_details)
509 return phy_info->port_details->rphy;
510 else
511 return NULL;
512}
513
514static inline void
515mptsas_set_rphy(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_rphy *rphy)
516{
517 if (phy_info->port_details) {
518 phy_info->port_details->rphy = rphy;
519 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "sas_rphy_add: rphy=%p\n",
520 ioc->name, rphy));
521 }
522
523 if (rphy) {
524 dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
525 &rphy->dev, MYIOC_s_FMT "add:", ioc->name));
526 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "rphy=%p release=%p\n",
527 ioc->name, rphy, rphy->dev.release));
528 }
529}
530
531static inline struct sas_port *
532mptsas_get_port(struct mptsas_phyinfo *phy_info)
533{
534 if (phy_info->port_details)
535 return phy_info->port_details->port;
536 else
537 return NULL;
538}
539
540static inline void
541mptsas_set_port(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info, struct sas_port *port)
542{
543 if (phy_info->port_details)
544 phy_info->port_details->port = port;
545
546 if (port) {
547 dsaswideprintk(ioc, dev_printk(KERN_DEBUG,
548 &port->dev, MYIOC_s_FMT "add:", ioc->name));
549 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "port=%p release=%p\n",
550 ioc->name, port, port->dev.release));
551 }
552}
553
554static inline struct scsi_target *
555mptsas_get_starget(struct mptsas_phyinfo *phy_info)
556{
557 if (phy_info->port_details)
558 return phy_info->port_details->starget;
559 else
560 return NULL;
561}
562
563static inline void
564mptsas_set_starget(struct mptsas_phyinfo *phy_info, struct scsi_target *
565starget)
566{
567 if (phy_info->port_details)
568 phy_info->port_details->starget = starget;
569}
570
571/**
572 * mptsas_add_device_component - adds a new device component to our lists
573 * @ioc: Pointer to MPT_ADAPTER structure
574 * @channel: channel number
575 * @id: Logical Target ID for reset (if appropriate)
576 * @sas_address: expander sas address
577 * @device_info: specific bits (flags) for devices
578 * @slot: enclosure slot ID
579 * @enclosure_logical_id: enclosure WWN
580 *
581 **/
582static void
583mptsas_add_device_component(MPT_ADAPTER *ioc, u8 channel, u8 id,
584 u64 sas_address, u32 device_info, u16 slot, u64 enclosure_logical_id)
585{
586 struct mptsas_device_info *sas_info, *next;
587 struct scsi_device *sdev;
588 struct scsi_target *starget;
589 struct sas_rphy *rphy;
590
591 /*
592 * Delete all matching devices out of the list
593 */
594 mutex_lock(&ioc->sas_device_info_mutex);
595 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
596 list) {
597 if (!sas_info->is_logical_volume &&
598 (sas_info->sas_address == sas_address ||
599 (sas_info->fw.channel == channel &&
600 sas_info->fw.id == id))) {
601 list_del(&sas_info->list);
602 kfree(sas_info);
603 }
604 }
605
606 sas_info = kzalloc(sizeof(struct mptsas_device_info), GFP_KERNEL);
607 if (!sas_info)
608 goto out;
609
610 /*
611 * Set Firmware mapping
612 */
613 sas_info->fw.id = id;
614 sas_info->fw.channel = channel;
615
616 sas_info->sas_address = sas_address;
617 sas_info->device_info = device_info;
618 sas_info->slot = slot;
619 sas_info->enclosure_logical_id = enclosure_logical_id;
620 INIT_LIST_HEAD(&sas_info->list);
621 list_add_tail(&sas_info->list, &ioc->sas_device_info_list);
622
623 /*
624 * Set OS mapping
625 */
626 shost_for_each_device(sdev, ioc->sh) {
627 starget = scsi_target(sdev);
628 rphy = dev_to_rphy(starget->dev.parent);
629 if (rphy->identify.sas_address == sas_address) {
630 sas_info->os.id = starget->id;
631 sas_info->os.channel = starget->channel;
632 }
633 }
634
635 out:
636 mutex_unlock(&ioc->sas_device_info_mutex);
637 return;
638}
639
640/**
641 * mptsas_add_device_component_by_fw - adds a new device component by FW ID
642 * @ioc: Pointer to MPT_ADAPTER structure
643 * @channel: channel number
644 * @id: Logical Target ID
645 *
646 **/
647static void
648mptsas_add_device_component_by_fw(MPT_ADAPTER *ioc, u8 channel, u8 id)
649{
650 struct mptsas_devinfo sas_device;
651 struct mptsas_enclosure enclosure_info;
652 int rc;
653
654 rc = mptsas_sas_device_pg0(ioc, &sas_device,
655 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
656 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
657 (channel << 8) + id);
658 if (rc)
659 return;
660
661 memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
662 mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
663 (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
664 MPI_SAS_ENCLOS_PGAD_FORM_SHIFT),
665 sas_device.handle_enclosure);
666
667 mptsas_add_device_component(ioc, sas_device.channel,
668 sas_device.id, sas_device.sas_address, sas_device.device_info,
669 sas_device.slot, enclosure_info.enclosure_logical_id);
670}
671
672/**
673 * mptsas_add_device_component_starget_ir - Handle Integrated RAID, adding each individual device to list
674 * @ioc: Pointer to MPT_ADAPTER structure
675 * @starget: SCSI target for this SCSI device
676 *
677 **/
678static void
679mptsas_add_device_component_starget_ir(MPT_ADAPTER *ioc,
680 struct scsi_target *starget)
681{
682 CONFIGPARMS cfg;
683 ConfigPageHeader_t hdr;
684 dma_addr_t dma_handle;
685 pRaidVolumePage0_t buffer = NULL;
686 int i;
687 RaidPhysDiskPage0_t phys_disk;
688 struct mptsas_device_info *sas_info, *next;
689
690 memset(&cfg, 0 , sizeof(CONFIGPARMS));
691 memset(&hdr, 0 , sizeof(ConfigPageHeader_t));
692 hdr.PageType = MPI_CONFIG_PAGETYPE_RAID_VOLUME;
693 /* assumption that all volumes on channel = 0 */
694 cfg.pageAddr = starget->id;
695 cfg.cfghdr.hdr = &hdr;
696 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
697 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
698
699 if (mpt_config(ioc, &cfg) != 0)
700 goto out;
701
702 if (!hdr.PageLength)
703 goto out;
704
705 buffer = pci_alloc_consistent(ioc->pcidev, hdr.PageLength * 4,
706 &dma_handle);
707
708 if (!buffer)
709 goto out;
710
711 cfg.physAddr = dma_handle;
712 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
713
714 if (mpt_config(ioc, &cfg) != 0)
715 goto out;
716
717 if (!buffer->NumPhysDisks)
718 goto out;
719
720 /*
721 * Adding entry for hidden components
722 */
723 for (i = 0; i < buffer->NumPhysDisks; i++) {
724
725 if (mpt_raid_phys_disk_pg0(ioc,
726 buffer->PhysDisk[i].PhysDiskNum, &phys_disk) != 0)
727 continue;
728
729 mptsas_add_device_component_by_fw(ioc, phys_disk.PhysDiskBus,
730 phys_disk.PhysDiskID);
731
732 mutex_lock(&ioc->sas_device_info_mutex);
733 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
734 list) {
735 if (!sas_info->is_logical_volume &&
736 (sas_info->fw.channel == phys_disk.PhysDiskBus &&
737 sas_info->fw.id == phys_disk.PhysDiskID)) {
738 sas_info->is_hidden_raid_component = 1;
739 sas_info->volume_id = starget->id;
740 }
741 }
742 mutex_unlock(&ioc->sas_device_info_mutex);
743
744 }
745
746 /*
747 * Delete all matching devices out of the list
748 */
749 mutex_lock(&ioc->sas_device_info_mutex);
750 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
751 list) {
752 if (sas_info->is_logical_volume && sas_info->fw.id ==
753 starget->id) {
754 list_del(&sas_info->list);
755 kfree(sas_info);
756 }
757 }
758
759 sas_info = kzalloc(sizeof(struct mptsas_device_info), GFP_KERNEL);
760 if (sas_info) {
761 sas_info->fw.id = starget->id;
762 sas_info->os.id = starget->id;
763 sas_info->os.channel = starget->channel;
764 sas_info->is_logical_volume = 1;
765 INIT_LIST_HEAD(&sas_info->list);
766 list_add_tail(&sas_info->list, &ioc->sas_device_info_list);
767 }
768 mutex_unlock(&ioc->sas_device_info_mutex);
769
770 out:
771 if (buffer)
772 pci_free_consistent(ioc->pcidev, hdr.PageLength * 4, buffer,
773 dma_handle);
774}
775
776/**
777 * mptsas_add_device_component_starget - adds a SCSI target device component
778 * @ioc: Pointer to MPT_ADAPTER structure
779 * @starget: SCSI target for this SCSI device
780 *
781 **/
782static void
783mptsas_add_device_component_starget(MPT_ADAPTER *ioc,
784 struct scsi_target *starget)
785{
786 struct sas_rphy *rphy;
787 struct mptsas_phyinfo *phy_info = NULL;
788 struct mptsas_enclosure enclosure_info;
789
790 rphy = dev_to_rphy(starget->dev.parent);
791 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
792 rphy->identify.sas_address);
793 if (!phy_info)
794 return;
795
796 memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
797 mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
798 (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
799 MPI_SAS_ENCLOS_PGAD_FORM_SHIFT),
800 phy_info->attached.handle_enclosure);
801
802 mptsas_add_device_component(ioc, phy_info->attached.channel,
803 phy_info->attached.id, phy_info->attached.sas_address,
804 phy_info->attached.device_info,
805 phy_info->attached.slot, enclosure_info.enclosure_logical_id);
806}
807
808/**
809 * mptsas_del_device_component_by_os - Once a device has been removed, we mark the entry in the list as being cached
810 * @ioc: Pointer to MPT_ADAPTER structure
811 * @channel: os mapped id's
812 * @id: Logical Target ID
813 *
814 **/
815static void
816mptsas_del_device_component_by_os(MPT_ADAPTER *ioc, u8 channel, u8 id)
817{
818 struct mptsas_device_info *sas_info, *next;
819
820 /*
821 * Set is_cached flag
822 */
823 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
824 list) {
825 if (sas_info->os.channel == channel && sas_info->os.id == id)
826 sas_info->is_cached = 1;
827 }
828}
829
830/**
831 * mptsas_del_device_components - Cleaning the list
832 * @ioc: Pointer to MPT_ADAPTER structure
833 *
834 **/
835static void
836mptsas_del_device_components(MPT_ADAPTER *ioc)
837{
838 struct mptsas_device_info *sas_info, *next;
839
840 mutex_lock(&ioc->sas_device_info_mutex);
841 list_for_each_entry_safe(sas_info, next, &ioc->sas_device_info_list,
842 list) {
843 list_del(&sas_info->list);
844 kfree(sas_info);
845 }
846 mutex_unlock(&ioc->sas_device_info_mutex);
847}
848
849
850/*
851 * mptsas_setup_wide_ports
852 *
853 * Updates for new and existing narrow/wide port configuration
854 * in the sas_topology
855 */
856static void
857mptsas_setup_wide_ports(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
858{
859 struct mptsas_portinfo_details * port_details;
860 struct mptsas_phyinfo *phy_info, *phy_info_cmp;
861 u64 sas_address;
862 int i, j;
863
864 mutex_lock(&ioc->sas_topology_mutex);
865
866 phy_info = port_info->phy_info;
867 for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
868 if (phy_info->attached.handle)
869 continue;
870 port_details = phy_info->port_details;
871 if (!port_details)
872 continue;
873 if (port_details->num_phys < 2)
874 continue;
875 /*
876 * Removing a phy from a port, letting the last
877 * phy be removed by firmware events.
878 */
879 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
880 "%s: [%p]: deleting phy = %d\n",
881 ioc->name, __func__, port_details, i));
882 port_details->num_phys--;
883 port_details->phy_bitmask &= ~ (1 << phy_info->phy_id);
884 memset(&phy_info->attached, 0, sizeof(struct mptsas_devinfo));
885 if (phy_info->phy) {
886 devtprintk(ioc, dev_printk(KERN_DEBUG,
887 &phy_info->phy->dev, MYIOC_s_FMT
888 "delete phy %d, phy-obj (0x%p)\n", ioc->name,
889 phy_info->phy_id, phy_info->phy));
890 sas_port_delete_phy(port_details->port, phy_info->phy);
891 }
892 phy_info->port_details = NULL;
893 }
894
895 /*
896 * Populate and refresh the tree
897 */
898 phy_info = port_info->phy_info;
899 for (i = 0 ; i < port_info->num_phys ; i++, phy_info++) {
900 sas_address = phy_info->attached.sas_address;
901 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "phy_id=%d sas_address=0x%018llX\n",
902 ioc->name, i, (unsigned long long)sas_address));
903 if (!sas_address)
904 continue;
905 port_details = phy_info->port_details;
906 /*
907 * Forming a port
908 */
909 if (!port_details) {
910 port_details = kzalloc(sizeof(struct
911 mptsas_portinfo_details), GFP_KERNEL);
912 if (!port_details)
913 goto out;
914 port_details->num_phys = 1;
915 port_details->port_info = port_info;
916 if (phy_info->phy_id < 64 )
917 port_details->phy_bitmask |=
918 (1 << phy_info->phy_id);
919 phy_info->sas_port_add_phy=1;
920 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tForming port\n\t\t"
921 "phy_id=%d sas_address=0x%018llX\n",
922 ioc->name, i, (unsigned long long)sas_address));
923 phy_info->port_details = port_details;
924 }
925
926 if (i == port_info->num_phys - 1)
927 continue;
928 phy_info_cmp = &port_info->phy_info[i + 1];
929 for (j = i + 1 ; j < port_info->num_phys ; j++,
930 phy_info_cmp++) {
931 if (!phy_info_cmp->attached.sas_address)
932 continue;
933 if (sas_address != phy_info_cmp->attached.sas_address)
934 continue;
935 if (phy_info_cmp->port_details == port_details )
936 continue;
937 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
938 "\t\tphy_id=%d sas_address=0x%018llX\n",
939 ioc->name, j, (unsigned long long)
940 phy_info_cmp->attached.sas_address));
941 if (phy_info_cmp->port_details) {
942 port_details->rphy =
943 mptsas_get_rphy(phy_info_cmp);
944 port_details->port =
945 mptsas_get_port(phy_info_cmp);
946 port_details->starget =
947 mptsas_get_starget(phy_info_cmp);
948 port_details->num_phys =
949 phy_info_cmp->port_details->num_phys;
950 if (!phy_info_cmp->port_details->num_phys)
951 kfree(phy_info_cmp->port_details);
952 } else
953 phy_info_cmp->sas_port_add_phy=1;
954 /*
955 * Adding a phy to a port
956 */
957 phy_info_cmp->port_details = port_details;
958 if (phy_info_cmp->phy_id < 64 )
959 port_details->phy_bitmask |=
960 (1 << phy_info_cmp->phy_id);
961 port_details->num_phys++;
962 }
963 }
964
965 out:
966
967 for (i = 0; i < port_info->num_phys; i++) {
968 port_details = port_info->phy_info[i].port_details;
969 if (!port_details)
970 continue;
971 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
972 "%s: [%p]: phy_id=%02d num_phys=%02d "
973 "bitmask=0x%016llX\n", ioc->name, __func__,
974 port_details, i, port_details->num_phys,
975 (unsigned long long)port_details->phy_bitmask));
976 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT "\t\tport = %p rphy=%p\n",
977 ioc->name, port_details->port, port_details->rphy));
978 }
979 dsaswideprintk(ioc, printk("\n"));
980 mutex_unlock(&ioc->sas_topology_mutex);
981}
982
983/**
984 * mptsas_find_vtarget - find a virtual target device (FC LUN device or
985 * SCSI target device)
986 *
987 * @ioc: Pointer to MPT_ADAPTER structure
988 * @channel: channel number
989 * @id: Logical Target ID
990 *
991 **/
992static VirtTarget *
993mptsas_find_vtarget(MPT_ADAPTER *ioc, u8 channel, u8 id)
994{
995 struct scsi_device *sdev;
996 VirtDevice *vdevice;
997 VirtTarget *vtarget = NULL;
998
999 shost_for_each_device(sdev, ioc->sh) {
1000 vdevice = sdev->hostdata;
1001 if ((vdevice == NULL) ||
1002 (vdevice->vtarget == NULL))
1003 continue;
1004 if ((vdevice->vtarget->tflags &
1005 MPT_TARGET_FLAGS_RAID_COMPONENT ||
1006 vdevice->vtarget->raidVolume))
1007 continue;
1008 if (vdevice->vtarget->id == id &&
1009 vdevice->vtarget->channel == channel)
1010 vtarget = vdevice->vtarget;
1011 }
1012 return vtarget;
1013}
1014
1015static void
1016mptsas_queue_device_delete(MPT_ADAPTER *ioc,
1017 MpiEventDataSasDeviceStatusChange_t *sas_event_data)
1018{
1019 struct fw_event_work *fw_event;
1020
1021 fw_event = kzalloc(sizeof(*fw_event) +
1022 sizeof(MpiEventDataSasDeviceStatusChange_t),
1023 GFP_ATOMIC);
1024 if (!fw_event) {
1025 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n",
1026 ioc->name, __func__, __LINE__);
1027 return;
1028 }
1029 memcpy(fw_event->event_data, sas_event_data,
1030 sizeof(MpiEventDataSasDeviceStatusChange_t));
1031 fw_event->event = MPI_EVENT_SAS_DEVICE_STATUS_CHANGE;
1032 fw_event->ioc = ioc;
1033 mptsas_add_fw_event(ioc, fw_event, msecs_to_jiffies(1));
1034}
1035
1036static void
1037mptsas_queue_rescan(MPT_ADAPTER *ioc)
1038{
1039 struct fw_event_work *fw_event;
1040
1041 fw_event = kzalloc(sizeof(*fw_event), GFP_ATOMIC);
1042 if (!fw_event) {
1043 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n",
1044 ioc->name, __func__, __LINE__);
1045 return;
1046 }
1047 fw_event->event = -1;
1048 fw_event->ioc = ioc;
1049 mptsas_add_fw_event(ioc, fw_event, msecs_to_jiffies(1));
1050}
1051
1052
1053/**
1054 * mptsas_target_reset - Issues TARGET_RESET to end device using
1055 * handshaking method
1056 *
1057 * @ioc: Pointer to MPT_ADAPTER structure
1058 * @channel: channel number
1059 * @id: Logical Target ID for reset
1060 *
1061 * Return: (1) success
1062 * (0) failure
1063 *
1064 **/
1065static int
1066mptsas_target_reset(MPT_ADAPTER *ioc, u8 channel, u8 id)
1067{
1068 MPT_FRAME_HDR *mf;
1069 SCSITaskMgmt_t *pScsiTm;
1070 if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0)
1071 return 0;
1072
1073
1074 mf = mpt_get_msg_frame(mptsasDeviceResetCtx, ioc);
1075 if (mf == NULL) {
1076 dfailprintk(ioc, printk(MYIOC_s_WARN_FMT
1077 "%s, no msg frames @%d!!\n", ioc->name,
1078 __func__, __LINE__));
1079 goto out_fail;
1080 }
1081
1082 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt request (mf=%p)\n",
1083 ioc->name, mf));
1084
1085 /* Format the Request
1086 */
1087 pScsiTm = (SCSITaskMgmt_t *) mf;
1088 memset (pScsiTm, 0, sizeof(SCSITaskMgmt_t));
1089 pScsiTm->TargetID = id;
1090 pScsiTm->Bus = channel;
1091 pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
1092 pScsiTm->TaskType = MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET;
1093 pScsiTm->MsgFlags = MPI_SCSITASKMGMT_MSGFLAGS_LIPRESET_RESET_OPTION;
1094
1095 DBG_DUMP_TM_REQUEST_FRAME(ioc, (u32 *)mf);
1096
1097 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1098 "TaskMgmt type=%d (sas device delete) fw_channel = %d fw_id = %d)\n",
1099 ioc->name, MPI_SCSITASKMGMT_TASKTYPE_TARGET_RESET, channel, id));
1100
1101 mpt_put_msg_frame_hi_pri(mptsasDeviceResetCtx, ioc, mf);
1102
1103 return 1;
1104
1105 out_fail:
1106
1107 mpt_clear_taskmgmt_in_progress_flag(ioc);
1108 return 0;
1109}
1110
1111static void
1112mptsas_block_io_sdev(struct scsi_device *sdev, void *data)
1113{
1114 scsi_device_set_state(sdev, SDEV_BLOCK);
1115}
1116
1117static void
1118mptsas_block_io_starget(struct scsi_target *starget)
1119{
1120 if (starget)
1121 starget_for_each_device(starget, NULL, mptsas_block_io_sdev);
1122}
1123
1124/**
1125 * mptsas_target_reset_queue - queue a target reset
1126 *
1127 * @ioc: Pointer to MPT_ADAPTER structure
1128 * @sas_event_data: SAS Device Status Change Event data
1129 *
1130 * Receive request for TARGET_RESET after receiving a firmware
1131 * event NOT_RESPONDING_EVENT, then put command in link list
1132 * and queue if task_queue already in use.
1133 *
1134 **/
1135static void
1136mptsas_target_reset_queue(MPT_ADAPTER *ioc,
1137 EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data)
1138{
1139 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
1140 VirtTarget *vtarget = NULL;
1141 struct mptsas_target_reset_event *target_reset_list;
1142 u8 id, channel;
1143
1144 id = sas_event_data->TargetID;
1145 channel = sas_event_data->Bus;
1146
1147 vtarget = mptsas_find_vtarget(ioc, channel, id);
1148 if (vtarget) {
1149 mptsas_block_io_starget(vtarget->starget);
1150 vtarget->deleted = 1; /* block IO */
1151 }
1152
1153 target_reset_list = kzalloc(sizeof(struct mptsas_target_reset_event),
1154 GFP_ATOMIC);
1155 if (!target_reset_list) {
1156 dfailprintk(ioc, printk(MYIOC_s_WARN_FMT
1157 "%s, failed to allocate mem @%d..!!\n",
1158 ioc->name, __func__, __LINE__));
1159 return;
1160 }
1161
1162 memcpy(&target_reset_list->sas_event_data, sas_event_data,
1163 sizeof(*sas_event_data));
1164 list_add_tail(&target_reset_list->list, &hd->target_reset_list);
1165
1166 target_reset_list->time_count = jiffies;
1167
1168 if (mptsas_target_reset(ioc, channel, id)) {
1169 target_reset_list->target_reset_issued = 1;
1170 }
1171}
1172
1173/**
1174 * mptsas_schedule_target_reset- send pending target reset
1175 * @iocp: per adapter object
1176 *
1177 * This function will delete scheduled target reset from the list and
1178 * try to send next target reset. This will be called from completion
1179 * context of any Task management command.
1180 */
1181
1182void
1183mptsas_schedule_target_reset(void *iocp)
1184{
1185 MPT_ADAPTER *ioc = (MPT_ADAPTER *)(iocp);
1186 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
1187 struct list_head *head = &hd->target_reset_list;
1188 struct mptsas_target_reset_event *target_reset_list;
1189 u8 id, channel;
1190 /*
1191 * issue target reset to next device in the queue
1192 */
1193
1194 if (list_empty(head))
1195 return;
1196
1197 target_reset_list = list_entry(head->next,
1198 struct mptsas_target_reset_event, list);
1199
1200 id = target_reset_list->sas_event_data.TargetID;
1201 channel = target_reset_list->sas_event_data.Bus;
1202 target_reset_list->time_count = jiffies;
1203
1204 if (mptsas_target_reset(ioc, channel, id))
1205 target_reset_list->target_reset_issued = 1;
1206 return;
1207}
1208
1209
1210/**
1211 * mptsas_taskmgmt_complete - complete SAS task management function
1212 * @ioc: Pointer to MPT_ADAPTER structure
1213 * @mf: MPT message frame
1214 * @mr: SCSI Task Management Reply structure ptr (may be %NULL)
1215 *
1216 * Completion for TARGET_RESET after NOT_RESPONDING_EVENT, enable work
1217 * queue to finish off removing device from upper layers, then send next
1218 * TARGET_RESET in the queue.
1219 **/
1220static int
1221mptsas_taskmgmt_complete(MPT_ADAPTER *ioc, MPT_FRAME_HDR *mf, MPT_FRAME_HDR *mr)
1222{
1223 MPT_SCSI_HOST *hd = shost_priv(ioc->sh);
1224 struct list_head *head = &hd->target_reset_list;
1225 u8 id, channel;
1226 struct mptsas_target_reset_event *target_reset_list;
1227 SCSITaskMgmtReply_t *pScsiTmReply;
1228
1229 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt completed: "
1230 "(mf = %p, mr = %p)\n", ioc->name, mf, mr));
1231
1232 pScsiTmReply = (SCSITaskMgmtReply_t *)mr;
1233 if (!pScsiTmReply)
1234 return 0;
1235
1236 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1237 "\tTaskMgmt completed: fw_channel = %d, fw_id = %d,\n"
1238 "\ttask_type = 0x%02X, iocstatus = 0x%04X "
1239 "loginfo = 0x%08X,\n\tresponse_code = 0x%02X, "
1240 "term_cmnds = %d\n", ioc->name,
1241 pScsiTmReply->Bus, pScsiTmReply->TargetID,
1242 pScsiTmReply->TaskType,
1243 le16_to_cpu(pScsiTmReply->IOCStatus),
1244 le32_to_cpu(pScsiTmReply->IOCLogInfo),
1245 pScsiTmReply->ResponseCode,
1246 le32_to_cpu(pScsiTmReply->TerminationCount)));
1247
1248 if (pScsiTmReply->ResponseCode)
1249 mptscsih_taskmgmt_response_code(ioc,
1250 pScsiTmReply->ResponseCode);
1251
1252 if (pScsiTmReply->TaskType ==
1253 MPI_SCSITASKMGMT_TASKTYPE_QUERY_TASK || pScsiTmReply->TaskType ==
1254 MPI_SCSITASKMGMT_TASKTYPE_ABRT_TASK_SET) {
1255 ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
1256 ioc->taskmgmt_cmds.status |= MPT_MGMT_STATUS_RF_VALID;
1257 memcpy(ioc->taskmgmt_cmds.reply, mr,
1258 min(MPT_DEFAULT_FRAME_SIZE, 4 * mr->u.reply.MsgLength));
1259 if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_PENDING) {
1260 ioc->taskmgmt_cmds.status &= ~MPT_MGMT_STATUS_PENDING;
1261 complete(&ioc->taskmgmt_cmds.done);
1262 return 1;
1263 }
1264 return 0;
1265 }
1266
1267 mpt_clear_taskmgmt_in_progress_flag(ioc);
1268
1269 if (list_empty(head))
1270 return 1;
1271
1272 target_reset_list = list_entry(head->next,
1273 struct mptsas_target_reset_event, list);
1274
1275 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1276 "TaskMgmt: completed (%d seconds)\n",
1277 ioc->name, jiffies_to_msecs(jiffies -
1278 target_reset_list->time_count)/1000));
1279
1280 id = pScsiTmReply->TargetID;
1281 channel = pScsiTmReply->Bus;
1282 target_reset_list->time_count = jiffies;
1283
1284 /*
1285 * retry target reset
1286 */
1287 if (!target_reset_list->target_reset_issued) {
1288 if (mptsas_target_reset(ioc, channel, id))
1289 target_reset_list->target_reset_issued = 1;
1290 return 1;
1291 }
1292
1293 /*
1294 * enable work queue to remove device from upper layers
1295 */
1296 list_del(&target_reset_list->list);
1297 if (!ioc->fw_events_off)
1298 mptsas_queue_device_delete(ioc,
1299 &target_reset_list->sas_event_data);
1300
1301
1302 ioc->schedule_target_reset(ioc);
1303
1304 return 1;
1305}
1306
1307/**
1308 * mptsas_ioc_reset - issue an IOC reset for this reset phase
1309 *
1310 * @ioc: Pointer to MPT_ADAPTER structure
1311 * @reset_phase: id of phase of reset
1312 *
1313 **/
1314static int
1315mptsas_ioc_reset(MPT_ADAPTER *ioc, int reset_phase)
1316{
1317 MPT_SCSI_HOST *hd;
1318 int rc;
1319
1320 rc = mptscsih_ioc_reset(ioc, reset_phase);
1321 if ((ioc->bus_type != SAS) || (!rc))
1322 return rc;
1323
1324 hd = shost_priv(ioc->sh);
1325 if (!hd->ioc)
1326 goto out;
1327
1328 switch (reset_phase) {
1329 case MPT_IOC_SETUP_RESET:
1330 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1331 "%s: MPT_IOC_SETUP_RESET\n", ioc->name, __func__));
1332 mptsas_fw_event_off(ioc);
1333 break;
1334 case MPT_IOC_PRE_RESET:
1335 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1336 "%s: MPT_IOC_PRE_RESET\n", ioc->name, __func__));
1337 break;
1338 case MPT_IOC_POST_RESET:
1339 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1340 "%s: MPT_IOC_POST_RESET\n", ioc->name, __func__));
1341 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_PENDING) {
1342 ioc->sas_mgmt.status |= MPT_MGMT_STATUS_DID_IOCRESET;
1343 complete(&ioc->sas_mgmt.done);
1344 }
1345 mptsas_cleanup_fw_event_q(ioc);
1346 mptsas_queue_rescan(ioc);
1347 break;
1348 default:
1349 break;
1350 }
1351
1352 out:
1353 return rc;
1354}
1355
1356
1357/**
1358 * enum device_state - TUR device state
1359 * @DEVICE_RETRY: need to retry the TUR
1360 * @DEVICE_ERROR: TUR return error, don't add device
1361 * @DEVICE_READY: device can be added
1362 *
1363 */
1364enum device_state{
1365 DEVICE_RETRY,
1366 DEVICE_ERROR,
1367 DEVICE_READY,
1368};
1369
1370static int
1371mptsas_sas_enclosure_pg0(MPT_ADAPTER *ioc, struct mptsas_enclosure *enclosure,
1372 u32 form, u32 form_specific)
1373{
1374 ConfigExtendedPageHeader_t hdr;
1375 CONFIGPARMS cfg;
1376 SasEnclosurePage0_t *buffer;
1377 dma_addr_t dma_handle;
1378 int error;
1379 __le64 le_identifier;
1380
1381 memset(&hdr, 0, sizeof(hdr));
1382 hdr.PageVersion = MPI_SASENCLOSURE0_PAGEVERSION;
1383 hdr.PageNumber = 0;
1384 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
1385 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_ENCLOSURE;
1386
1387 cfg.cfghdr.ehdr = &hdr;
1388 cfg.physAddr = -1;
1389 cfg.pageAddr = form + form_specific;
1390 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
1391 cfg.dir = 0; /* read */
1392 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
1393
1394 error = mpt_config(ioc, &cfg);
1395 if (error)
1396 goto out;
1397 if (!hdr.ExtPageLength) {
1398 error = -ENXIO;
1399 goto out;
1400 }
1401
1402 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
1403 &dma_handle);
1404 if (!buffer) {
1405 error = -ENOMEM;
1406 goto out;
1407 }
1408
1409 cfg.physAddr = dma_handle;
1410 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
1411
1412 error = mpt_config(ioc, &cfg);
1413 if (error)
1414 goto out_free_consistent;
1415
1416 /* save config data */
1417 memcpy(&le_identifier, &buffer->EnclosureLogicalID, sizeof(__le64));
1418 enclosure->enclosure_logical_id = le64_to_cpu(le_identifier);
1419 enclosure->enclosure_handle = le16_to_cpu(buffer->EnclosureHandle);
1420 enclosure->flags = le16_to_cpu(buffer->Flags);
1421 enclosure->num_slot = le16_to_cpu(buffer->NumSlots);
1422 enclosure->start_slot = le16_to_cpu(buffer->StartSlot);
1423 enclosure->start_id = buffer->StartTargetID;
1424 enclosure->start_channel = buffer->StartBus;
1425 enclosure->sep_id = buffer->SEPTargetID;
1426 enclosure->sep_channel = buffer->SEPBus;
1427
1428 out_free_consistent:
1429 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
1430 buffer, dma_handle);
1431 out:
1432 return error;
1433}
1434
1435/**
1436 * mptsas_add_end_device - report a new end device to sas transport layer
1437 * @ioc: Pointer to MPT_ADAPTER structure
1438 * @phy_info: describes attached device
1439 *
1440 * return (0) success (1) failure
1441 *
1442 **/
1443static int
1444mptsas_add_end_device(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info)
1445{
1446 struct sas_rphy *rphy;
1447 struct sas_port *port;
1448 struct sas_identify identify;
1449 char *ds = NULL;
1450 u8 fw_id;
1451
1452 if (!phy_info) {
1453 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1454 "%s: exit at line=%d\n", ioc->name,
1455 __func__, __LINE__));
1456 return 1;
1457 }
1458
1459 fw_id = phy_info->attached.id;
1460
1461 if (mptsas_get_rphy(phy_info)) {
1462 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1463 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1464 __func__, fw_id, __LINE__));
1465 return 2;
1466 }
1467
1468 port = mptsas_get_port(phy_info);
1469 if (!port) {
1470 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1471 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1472 __func__, fw_id, __LINE__));
1473 return 3;
1474 }
1475
1476 if (phy_info->attached.device_info &
1477 MPI_SAS_DEVICE_INFO_SSP_TARGET)
1478 ds = "ssp";
1479 if (phy_info->attached.device_info &
1480 MPI_SAS_DEVICE_INFO_STP_TARGET)
1481 ds = "stp";
1482 if (phy_info->attached.device_info &
1483 MPI_SAS_DEVICE_INFO_SATA_DEVICE)
1484 ds = "sata";
1485
1486 printk(MYIOC_s_INFO_FMT "attaching %s device: fw_channel %d, fw_id %d,"
1487 " phy %d, sas_addr 0x%llx\n", ioc->name, ds,
1488 phy_info->attached.channel, phy_info->attached.id,
1489 phy_info->attached.phy_id, (unsigned long long)
1490 phy_info->attached.sas_address);
1491
1492 mptsas_parse_device_info(&identify, &phy_info->attached);
1493 rphy = sas_end_device_alloc(port);
1494 if (!rphy) {
1495 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1496 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1497 __func__, fw_id, __LINE__));
1498 return 5; /* non-fatal: an rphy can be added later */
1499 }
1500
1501 rphy->identify = identify;
1502 if (sas_rphy_add(rphy)) {
1503 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1504 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1505 __func__, fw_id, __LINE__));
1506 sas_rphy_free(rphy);
1507 return 6;
1508 }
1509 mptsas_set_rphy(ioc, phy_info, rphy);
1510 return 0;
1511}
1512
1513/**
1514 * mptsas_del_end_device - report a deleted end device to sas transport layer
1515 * @ioc: Pointer to MPT_ADAPTER structure
1516 * @phy_info: describes attached device
1517 *
1518 **/
1519static void
1520mptsas_del_end_device(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info)
1521{
1522 struct sas_rphy *rphy;
1523 struct sas_port *port;
1524 struct mptsas_portinfo *port_info;
1525 struct mptsas_phyinfo *phy_info_parent;
1526 int i;
1527 char *ds = NULL;
1528 u8 fw_id;
1529 u64 sas_address;
1530
1531 if (!phy_info)
1532 return;
1533
1534 fw_id = phy_info->attached.id;
1535 sas_address = phy_info->attached.sas_address;
1536
1537 if (!phy_info->port_details) {
1538 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1539 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1540 __func__, fw_id, __LINE__));
1541 return;
1542 }
1543 rphy = mptsas_get_rphy(phy_info);
1544 if (!rphy) {
1545 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1546 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1547 __func__, fw_id, __LINE__));
1548 return;
1549 }
1550
1551 if (phy_info->attached.device_info & MPI_SAS_DEVICE_INFO_SSP_INITIATOR
1552 || phy_info->attached.device_info
1553 & MPI_SAS_DEVICE_INFO_SMP_INITIATOR
1554 || phy_info->attached.device_info
1555 & MPI_SAS_DEVICE_INFO_STP_INITIATOR)
1556 ds = "initiator";
1557 if (phy_info->attached.device_info &
1558 MPI_SAS_DEVICE_INFO_SSP_TARGET)
1559 ds = "ssp";
1560 if (phy_info->attached.device_info &
1561 MPI_SAS_DEVICE_INFO_STP_TARGET)
1562 ds = "stp";
1563 if (phy_info->attached.device_info &
1564 MPI_SAS_DEVICE_INFO_SATA_DEVICE)
1565 ds = "sata";
1566
1567 dev_printk(KERN_DEBUG, &rphy->dev, MYIOC_s_FMT
1568 "removing %s device: fw_channel %d, fw_id %d, phy %d,"
1569 "sas_addr 0x%llx\n", ioc->name, ds, phy_info->attached.channel,
1570 phy_info->attached.id, phy_info->attached.phy_id,
1571 (unsigned long long) sas_address);
1572
1573 port = mptsas_get_port(phy_info);
1574 if (!port) {
1575 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
1576 "%s: fw_id=%d exit at line=%d\n", ioc->name,
1577 __func__, fw_id, __LINE__));
1578 return;
1579 }
1580 port_info = phy_info->portinfo;
1581 phy_info_parent = port_info->phy_info;
1582 for (i = 0; i < port_info->num_phys; i++, phy_info_parent++) {
1583 if (!phy_info_parent->phy)
1584 continue;
1585 if (phy_info_parent->attached.sas_address !=
1586 sas_address)
1587 continue;
1588 dev_printk(KERN_DEBUG, &phy_info_parent->phy->dev,
1589 MYIOC_s_FMT "delete phy %d, phy-obj (0x%p)\n",
1590 ioc->name, phy_info_parent->phy_id,
1591 phy_info_parent->phy);
1592 sas_port_delete_phy(port, phy_info_parent->phy);
1593 }
1594
1595 dev_printk(KERN_DEBUG, &port->dev, MYIOC_s_FMT
1596 "delete port %d, sas_addr (0x%llx)\n", ioc->name,
1597 port->port_identifier, (unsigned long long)sas_address);
1598 sas_port_delete(port);
1599 mptsas_set_port(ioc, phy_info, NULL);
1600 mptsas_port_delete(ioc, phy_info->port_details);
1601}
1602
1603static struct mptsas_phyinfo *
1604mptsas_refreshing_device_handles(MPT_ADAPTER *ioc,
1605 struct mptsas_devinfo *sas_device)
1606{
1607 struct mptsas_phyinfo *phy_info;
1608 struct mptsas_portinfo *port_info;
1609 int i;
1610
1611 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
1612 sas_device->sas_address);
1613 if (!phy_info)
1614 goto out;
1615 port_info = phy_info->portinfo;
1616 if (!port_info)
1617 goto out;
1618 mutex_lock(&ioc->sas_topology_mutex);
1619 for (i = 0; i < port_info->num_phys; i++) {
1620 if (port_info->phy_info[i].attached.sas_address !=
1621 sas_device->sas_address)
1622 continue;
1623 port_info->phy_info[i].attached.channel = sas_device->channel;
1624 port_info->phy_info[i].attached.id = sas_device->id;
1625 port_info->phy_info[i].attached.sas_address =
1626 sas_device->sas_address;
1627 port_info->phy_info[i].attached.handle = sas_device->handle;
1628 port_info->phy_info[i].attached.handle_parent =
1629 sas_device->handle_parent;
1630 port_info->phy_info[i].attached.handle_enclosure =
1631 sas_device->handle_enclosure;
1632 }
1633 mutex_unlock(&ioc->sas_topology_mutex);
1634 out:
1635 return phy_info;
1636}
1637
1638/**
1639 * mptsas_firmware_event_work - work thread for processing fw events
1640 * @work: work queue payload containing info describing the event
1641 * Context: user
1642 *
1643 */
1644static void
1645mptsas_firmware_event_work(struct work_struct *work)
1646{
1647 struct fw_event_work *fw_event =
1648 container_of(work, struct fw_event_work, work.work);
1649 MPT_ADAPTER *ioc = fw_event->ioc;
1650
1651 /* special rescan topology handling */
1652 if (fw_event->event == -1) {
1653 if (ioc->in_rescan) {
1654 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
1655 "%s: rescan ignored as it is in progress\n",
1656 ioc->name, __func__));
1657 return;
1658 }
1659 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: rescan after "
1660 "reset\n", ioc->name, __func__));
1661 ioc->in_rescan = 1;
1662 mptsas_not_responding_devices(ioc);
1663 mptsas_scan_sas_topology(ioc);
1664 ioc->in_rescan = 0;
1665 mptsas_free_fw_event(ioc, fw_event);
1666 mptsas_fw_event_on(ioc);
1667 return;
1668 }
1669
1670 /* events handling turned off during host reset */
1671 if (ioc->fw_events_off) {
1672 mptsas_free_fw_event(ioc, fw_event);
1673 return;
1674 }
1675
1676 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "%s: fw_event=(0x%p), "
1677 "event = (0x%02x)\n", ioc->name, __func__, fw_event,
1678 (fw_event->event & 0xFF)));
1679
1680 switch (fw_event->event) {
1681 case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
1682 mptsas_send_sas_event(fw_event);
1683 break;
1684 case MPI_EVENT_INTEGRATED_RAID:
1685 mptsas_send_raid_event(fw_event);
1686 break;
1687 case MPI_EVENT_IR2:
1688 mptsas_send_ir2_event(fw_event);
1689 break;
1690 case MPI_EVENT_PERSISTENT_TABLE_FULL:
1691 mptbase_sas_persist_operation(ioc,
1692 MPI_SAS_OP_CLEAR_NOT_PRESENT);
1693 mptsas_free_fw_event(ioc, fw_event);
1694 break;
1695 case MPI_EVENT_SAS_BROADCAST_PRIMITIVE:
1696 mptsas_broadcast_primitive_work(fw_event);
1697 break;
1698 case MPI_EVENT_SAS_EXPANDER_STATUS_CHANGE:
1699 mptsas_send_expander_event(fw_event);
1700 break;
1701 case MPI_EVENT_SAS_PHY_LINK_STATUS:
1702 mptsas_send_link_status_event(fw_event);
1703 break;
1704 case MPI_EVENT_QUEUE_FULL:
1705 mptsas_handle_queue_full_event(fw_event);
1706 break;
1707 }
1708}
1709
1710
1711
1712static int
1713mptsas_slave_configure(struct scsi_device *sdev)
1714{
1715 struct Scsi_Host *host = sdev->host;
1716 MPT_SCSI_HOST *hd = shost_priv(host);
1717 MPT_ADAPTER *ioc = hd->ioc;
1718 VirtDevice *vdevice = sdev->hostdata;
1719
1720 if (vdevice->vtarget->deleted) {
1721 sdev_printk(KERN_INFO, sdev, "clearing deleted flag\n");
1722 vdevice->vtarget->deleted = 0;
1723 }
1724
1725 /*
1726 * RAID volumes placed beyond the last expected port.
1727 * Ignore sending sas mode pages in that case..
1728 */
1729 if (sdev->channel == MPTSAS_RAID_CHANNEL) {
1730 mptsas_add_device_component_starget_ir(ioc, scsi_target(sdev));
1731 goto out;
1732 }
1733
1734 sas_read_port_mode_page(sdev);
1735
1736 mptsas_add_device_component_starget(ioc, scsi_target(sdev));
1737
1738 out:
1739 return mptscsih_slave_configure(sdev);
1740}
1741
1742static int
1743mptsas_target_alloc(struct scsi_target *starget)
1744{
1745 struct Scsi_Host *host = dev_to_shost(&starget->dev);
1746 MPT_SCSI_HOST *hd = shost_priv(host);
1747 VirtTarget *vtarget;
1748 u8 id, channel;
1749 struct sas_rphy *rphy;
1750 struct mptsas_portinfo *p;
1751 int i;
1752 MPT_ADAPTER *ioc = hd->ioc;
1753
1754 vtarget = kzalloc(sizeof(VirtTarget), GFP_KERNEL);
1755 if (!vtarget)
1756 return -ENOMEM;
1757
1758 vtarget->starget = starget;
1759 vtarget->ioc_id = ioc->id;
1760 vtarget->tflags = MPT_TARGET_FLAGS_Q_YES;
1761 id = starget->id;
1762 channel = 0;
1763
1764 /*
1765 * RAID volumes placed beyond the last expected port.
1766 */
1767 if (starget->channel == MPTSAS_RAID_CHANNEL) {
1768 if (!ioc->raid_data.pIocPg2) {
1769 kfree(vtarget);
1770 return -ENXIO;
1771 }
1772 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
1773 if (id == ioc->raid_data.pIocPg2->
1774 RaidVolume[i].VolumeID) {
1775 channel = ioc->raid_data.pIocPg2->
1776 RaidVolume[i].VolumeBus;
1777 }
1778 }
1779 vtarget->raidVolume = 1;
1780 goto out;
1781 }
1782
1783 rphy = dev_to_rphy(starget->dev.parent);
1784 mutex_lock(&ioc->sas_topology_mutex);
1785 list_for_each_entry(p, &ioc->sas_topology, list) {
1786 for (i = 0; i < p->num_phys; i++) {
1787 if (p->phy_info[i].attached.sas_address !=
1788 rphy->identify.sas_address)
1789 continue;
1790 id = p->phy_info[i].attached.id;
1791 channel = p->phy_info[i].attached.channel;
1792 mptsas_set_starget(&p->phy_info[i], starget);
1793
1794 /*
1795 * Exposing hidden raid components
1796 */
1797 if (mptscsih_is_phys_disk(ioc, channel, id)) {
1798 id = mptscsih_raid_id_to_num(ioc,
1799 channel, id);
1800 vtarget->tflags |=
1801 MPT_TARGET_FLAGS_RAID_COMPONENT;
1802 p->phy_info[i].attached.phys_disk_num = id;
1803 }
1804 mutex_unlock(&ioc->sas_topology_mutex);
1805 goto out;
1806 }
1807 }
1808 mutex_unlock(&ioc->sas_topology_mutex);
1809
1810 kfree(vtarget);
1811 return -ENXIO;
1812
1813 out:
1814 vtarget->id = id;
1815 vtarget->channel = channel;
1816 starget->hostdata = vtarget;
1817 return 0;
1818}
1819
1820static void
1821mptsas_target_destroy(struct scsi_target *starget)
1822{
1823 struct Scsi_Host *host = dev_to_shost(&starget->dev);
1824 MPT_SCSI_HOST *hd = shost_priv(host);
1825 struct sas_rphy *rphy;
1826 struct mptsas_portinfo *p;
1827 int i;
1828 MPT_ADAPTER *ioc = hd->ioc;
1829 VirtTarget *vtarget;
1830
1831 if (!starget->hostdata)
1832 return;
1833
1834 vtarget = starget->hostdata;
1835
1836 mptsas_del_device_component_by_os(ioc, starget->channel,
1837 starget->id);
1838
1839
1840 if (starget->channel == MPTSAS_RAID_CHANNEL)
1841 goto out;
1842
1843 rphy = dev_to_rphy(starget->dev.parent);
1844 list_for_each_entry(p, &ioc->sas_topology, list) {
1845 for (i = 0; i < p->num_phys; i++) {
1846 if (p->phy_info[i].attached.sas_address !=
1847 rphy->identify.sas_address)
1848 continue;
1849
1850 starget_printk(KERN_INFO, starget, MYIOC_s_FMT
1851 "delete device: fw_channel %d, fw_id %d, phy %d, "
1852 "sas_addr 0x%llx\n", ioc->name,
1853 p->phy_info[i].attached.channel,
1854 p->phy_info[i].attached.id,
1855 p->phy_info[i].attached.phy_id, (unsigned long long)
1856 p->phy_info[i].attached.sas_address);
1857
1858 mptsas_set_starget(&p->phy_info[i], NULL);
1859 }
1860 }
1861
1862 out:
1863 vtarget->starget = NULL;
1864 kfree(starget->hostdata);
1865 starget->hostdata = NULL;
1866}
1867
1868
1869static int
1870mptsas_slave_alloc(struct scsi_device *sdev)
1871{
1872 struct Scsi_Host *host = sdev->host;
1873 MPT_SCSI_HOST *hd = shost_priv(host);
1874 struct sas_rphy *rphy;
1875 struct mptsas_portinfo *p;
1876 VirtDevice *vdevice;
1877 struct scsi_target *starget;
1878 int i;
1879 MPT_ADAPTER *ioc = hd->ioc;
1880
1881 vdevice = kzalloc(sizeof(VirtDevice), GFP_KERNEL);
1882 if (!vdevice) {
1883 printk(MYIOC_s_ERR_FMT "slave_alloc kzalloc(%zd) FAILED!\n",
1884 ioc->name, sizeof(VirtDevice));
1885 return -ENOMEM;
1886 }
1887 starget = scsi_target(sdev);
1888 vdevice->vtarget = starget->hostdata;
1889
1890 if (sdev->channel == MPTSAS_RAID_CHANNEL)
1891 goto out;
1892
1893 rphy = dev_to_rphy(sdev->sdev_target->dev.parent);
1894 mutex_lock(&ioc->sas_topology_mutex);
1895 list_for_each_entry(p, &ioc->sas_topology, list) {
1896 for (i = 0; i < p->num_phys; i++) {
1897 if (p->phy_info[i].attached.sas_address !=
1898 rphy->identify.sas_address)
1899 continue;
1900 vdevice->lun = sdev->lun;
1901 /*
1902 * Exposing hidden raid components
1903 */
1904 if (mptscsih_is_phys_disk(ioc,
1905 p->phy_info[i].attached.channel,
1906 p->phy_info[i].attached.id))
1907 sdev->no_uld_attach = 1;
1908 mutex_unlock(&ioc->sas_topology_mutex);
1909 goto out;
1910 }
1911 }
1912 mutex_unlock(&ioc->sas_topology_mutex);
1913
1914 kfree(vdevice);
1915 return -ENXIO;
1916
1917 out:
1918 vdevice->vtarget->num_luns++;
1919 sdev->hostdata = vdevice;
1920 return 0;
1921}
1922
1923static int
1924mptsas_qcmd(struct Scsi_Host *shost, struct scsi_cmnd *SCpnt)
1925{
1926 MPT_SCSI_HOST *hd;
1927 MPT_ADAPTER *ioc;
1928 VirtDevice *vdevice = SCpnt->device->hostdata;
1929
1930 if (!vdevice || !vdevice->vtarget || vdevice->vtarget->deleted) {
1931 SCpnt->result = DID_NO_CONNECT << 16;
1932 SCpnt->scsi_done(SCpnt);
1933 return 0;
1934 }
1935
1936 hd = shost_priv(shost);
1937 ioc = hd->ioc;
1938
1939 if (ioc->sas_discovery_quiesce_io)
1940 return SCSI_MLQUEUE_HOST_BUSY;
1941
1942 if (ioc->debug_level & MPT_DEBUG_SCSI)
1943 scsi_print_command(SCpnt);
1944
1945 return mptscsih_qcmd(SCpnt);
1946}
1947
1948/**
1949 * mptsas_eh_timed_out - resets the scsi_cmnd timeout
1950 * if the device under question is currently in the
1951 * device removal delay.
1952 * @sc: scsi command that the midlayer is about to time out
1953 *
1954 **/
1955static enum blk_eh_timer_return mptsas_eh_timed_out(struct scsi_cmnd *sc)
1956{
1957 MPT_SCSI_HOST *hd;
1958 MPT_ADAPTER *ioc;
1959 VirtDevice *vdevice;
1960 enum blk_eh_timer_return rc = BLK_EH_DONE;
1961
1962 hd = shost_priv(sc->device->host);
1963 if (hd == NULL) {
1964 printk(KERN_ERR MYNAM ": %s: Can't locate host! (sc=%p)\n",
1965 __func__, sc);
1966 goto done;
1967 }
1968
1969 ioc = hd->ioc;
1970 if (ioc->bus_type != SAS) {
1971 printk(KERN_ERR MYNAM ": %s: Wrong bus type (sc=%p)\n",
1972 __func__, sc);
1973 goto done;
1974 }
1975
1976 /* In case if IOC is in reset from internal context.
1977 * Do not execute EEH for the same IOC. SML should to reset timer.
1978 */
1979 if (ioc->ioc_reset_in_progress) {
1980 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT ": %s: ioc is in reset,"
1981 "SML need to reset the timer (sc=%p)\n",
1982 ioc->name, __func__, sc));
1983 rc = BLK_EH_RESET_TIMER;
1984 }
1985 vdevice = sc->device->hostdata;
1986 if (vdevice && vdevice->vtarget && (vdevice->vtarget->inDMD
1987 || vdevice->vtarget->deleted)) {
1988 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT ": %s: target removed "
1989 "or in device removal delay (sc=%p)\n",
1990 ioc->name, __func__, sc));
1991 rc = BLK_EH_RESET_TIMER;
1992 goto done;
1993 }
1994
1995done:
1996 return rc;
1997}
1998
1999
2000static struct scsi_host_template mptsas_driver_template = {
2001 .module = THIS_MODULE,
2002 .proc_name = "mptsas",
2003 .show_info = mptscsih_show_info,
2004 .name = "MPT SAS Host",
2005 .info = mptscsih_info,
2006 .queuecommand = mptsas_qcmd,
2007 .target_alloc = mptsas_target_alloc,
2008 .slave_alloc = mptsas_slave_alloc,
2009 .slave_configure = mptsas_slave_configure,
2010 .target_destroy = mptsas_target_destroy,
2011 .slave_destroy = mptscsih_slave_destroy,
2012 .change_queue_depth = mptscsih_change_queue_depth,
2013 .eh_timed_out = mptsas_eh_timed_out,
2014 .eh_abort_handler = mptscsih_abort,
2015 .eh_device_reset_handler = mptscsih_dev_reset,
2016 .eh_host_reset_handler = mptscsih_host_reset,
2017 .bios_param = mptscsih_bios_param,
2018 .can_queue = MPT_SAS_CAN_QUEUE,
2019 .this_id = -1,
2020 .sg_tablesize = MPT_SCSI_SG_DEPTH,
2021 .max_sectors = 8192,
2022 .cmd_per_lun = 7,
2023 .shost_attrs = mptscsih_host_attrs,
2024 .no_write_same = 1,
2025};
2026
2027static int mptsas_get_linkerrors(struct sas_phy *phy)
2028{
2029 MPT_ADAPTER *ioc = phy_to_ioc(phy);
2030 ConfigExtendedPageHeader_t hdr;
2031 CONFIGPARMS cfg;
2032 SasPhyPage1_t *buffer;
2033 dma_addr_t dma_handle;
2034 int error;
2035
2036 /* FIXME: only have link errors on local phys */
2037 if (!scsi_is_sas_phy_local(phy))
2038 return -EINVAL;
2039
2040 hdr.PageVersion = MPI_SASPHY1_PAGEVERSION;
2041 hdr.ExtPageLength = 0;
2042 hdr.PageNumber = 1 /* page number 1*/;
2043 hdr.Reserved1 = 0;
2044 hdr.Reserved2 = 0;
2045 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2046 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
2047
2048 cfg.cfghdr.ehdr = &hdr;
2049 cfg.physAddr = -1;
2050 cfg.pageAddr = phy->identify.phy_identifier;
2051 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2052 cfg.dir = 0; /* read */
2053 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2054
2055 error = mpt_config(ioc, &cfg);
2056 if (error)
2057 return error;
2058 if (!hdr.ExtPageLength)
2059 return -ENXIO;
2060
2061 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2062 &dma_handle);
2063 if (!buffer)
2064 return -ENOMEM;
2065
2066 cfg.physAddr = dma_handle;
2067 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2068
2069 error = mpt_config(ioc, &cfg);
2070 if (error)
2071 goto out_free_consistent;
2072
2073 mptsas_print_phy_pg1(ioc, buffer);
2074
2075 phy->invalid_dword_count = le32_to_cpu(buffer->InvalidDwordCount);
2076 phy->running_disparity_error_count =
2077 le32_to_cpu(buffer->RunningDisparityErrorCount);
2078 phy->loss_of_dword_sync_count =
2079 le32_to_cpu(buffer->LossDwordSynchCount);
2080 phy->phy_reset_problem_count =
2081 le32_to_cpu(buffer->PhyResetProblemCount);
2082
2083 out_free_consistent:
2084 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2085 buffer, dma_handle);
2086 return error;
2087}
2088
2089static int mptsas_mgmt_done(MPT_ADAPTER *ioc, MPT_FRAME_HDR *req,
2090 MPT_FRAME_HDR *reply)
2091{
2092 ioc->sas_mgmt.status |= MPT_MGMT_STATUS_COMMAND_GOOD;
2093 if (reply != NULL) {
2094 ioc->sas_mgmt.status |= MPT_MGMT_STATUS_RF_VALID;
2095 memcpy(ioc->sas_mgmt.reply, reply,
2096 min(ioc->reply_sz, 4 * reply->u.reply.MsgLength));
2097 }
2098
2099 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_PENDING) {
2100 ioc->sas_mgmt.status &= ~MPT_MGMT_STATUS_PENDING;
2101 complete(&ioc->sas_mgmt.done);
2102 return 1;
2103 }
2104 return 0;
2105}
2106
2107static int mptsas_phy_reset(struct sas_phy *phy, int hard_reset)
2108{
2109 MPT_ADAPTER *ioc = phy_to_ioc(phy);
2110 SasIoUnitControlRequest_t *req;
2111 SasIoUnitControlReply_t *reply;
2112 MPT_FRAME_HDR *mf;
2113 MPIHeader_t *hdr;
2114 unsigned long timeleft;
2115 int error = -ERESTARTSYS;
2116
2117 /* FIXME: fusion doesn't allow non-local phy reset */
2118 if (!scsi_is_sas_phy_local(phy))
2119 return -EINVAL;
2120
2121 /* not implemented for expanders */
2122 if (phy->identify.target_port_protocols & SAS_PROTOCOL_SMP)
2123 return -ENXIO;
2124
2125 if (mutex_lock_interruptible(&ioc->sas_mgmt.mutex))
2126 goto out;
2127
2128 mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2129 if (!mf) {
2130 error = -ENOMEM;
2131 goto out_unlock;
2132 }
2133
2134 hdr = (MPIHeader_t *) mf;
2135 req = (SasIoUnitControlRequest_t *)mf;
2136 memset(req, 0, sizeof(SasIoUnitControlRequest_t));
2137 req->Function = MPI_FUNCTION_SAS_IO_UNIT_CONTROL;
2138 req->MsgContext = hdr->MsgContext;
2139 req->Operation = hard_reset ?
2140 MPI_SAS_OP_PHY_HARD_RESET : MPI_SAS_OP_PHY_LINK_RESET;
2141 req->PhyNum = phy->identify.phy_identifier;
2142
2143 INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2144 mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2145
2146 timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done,
2147 10 * HZ);
2148 if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2149 error = -ETIME;
2150 mpt_free_msg_frame(ioc, mf);
2151 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2152 goto out_unlock;
2153 if (!timeleft)
2154 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2155 goto out_unlock;
2156 }
2157
2158 /* a reply frame is expected */
2159 if ((ioc->sas_mgmt.status &
2160 MPT_MGMT_STATUS_RF_VALID) == 0) {
2161 error = -ENXIO;
2162 goto out_unlock;
2163 }
2164
2165 /* process the completed Reply Message Frame */
2166 reply = (SasIoUnitControlReply_t *)ioc->sas_mgmt.reply;
2167 if (reply->IOCStatus != MPI_IOCSTATUS_SUCCESS) {
2168 printk(MYIOC_s_INFO_FMT "%s: IOCStatus=0x%X IOCLogInfo=0x%X\n",
2169 ioc->name, __func__, reply->IOCStatus, reply->IOCLogInfo);
2170 error = -ENXIO;
2171 goto out_unlock;
2172 }
2173
2174 error = 0;
2175
2176 out_unlock:
2177 CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2178 mutex_unlock(&ioc->sas_mgmt.mutex);
2179 out:
2180 return error;
2181}
2182
2183static int
2184mptsas_get_enclosure_identifier(struct sas_rphy *rphy, u64 *identifier)
2185{
2186 MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
2187 int i, error;
2188 struct mptsas_portinfo *p;
2189 struct mptsas_enclosure enclosure_info;
2190 u64 enclosure_handle;
2191
2192 mutex_lock(&ioc->sas_topology_mutex);
2193 list_for_each_entry(p, &ioc->sas_topology, list) {
2194 for (i = 0; i < p->num_phys; i++) {
2195 if (p->phy_info[i].attached.sas_address ==
2196 rphy->identify.sas_address) {
2197 enclosure_handle = p->phy_info[i].
2198 attached.handle_enclosure;
2199 goto found_info;
2200 }
2201 }
2202 }
2203 mutex_unlock(&ioc->sas_topology_mutex);
2204 return -ENXIO;
2205
2206 found_info:
2207 mutex_unlock(&ioc->sas_topology_mutex);
2208 memset(&enclosure_info, 0, sizeof(struct mptsas_enclosure));
2209 error = mptsas_sas_enclosure_pg0(ioc, &enclosure_info,
2210 (MPI_SAS_ENCLOS_PGAD_FORM_HANDLE <<
2211 MPI_SAS_ENCLOS_PGAD_FORM_SHIFT), enclosure_handle);
2212 if (!error)
2213 *identifier = enclosure_info.enclosure_logical_id;
2214 return error;
2215}
2216
2217static int
2218mptsas_get_bay_identifier(struct sas_rphy *rphy)
2219{
2220 MPT_ADAPTER *ioc = rphy_to_ioc(rphy);
2221 struct mptsas_portinfo *p;
2222 int i, rc;
2223
2224 mutex_lock(&ioc->sas_topology_mutex);
2225 list_for_each_entry(p, &ioc->sas_topology, list) {
2226 for (i = 0; i < p->num_phys; i++) {
2227 if (p->phy_info[i].attached.sas_address ==
2228 rphy->identify.sas_address) {
2229 rc = p->phy_info[i].attached.slot;
2230 goto out;
2231 }
2232 }
2233 }
2234 rc = -ENXIO;
2235 out:
2236 mutex_unlock(&ioc->sas_topology_mutex);
2237 return rc;
2238}
2239
2240static void mptsas_smp_handler(struct bsg_job *job, struct Scsi_Host *shost,
2241 struct sas_rphy *rphy)
2242{
2243 MPT_ADAPTER *ioc = ((MPT_SCSI_HOST *) shost->hostdata)->ioc;
2244 MPT_FRAME_HDR *mf;
2245 SmpPassthroughRequest_t *smpreq;
2246 int flagsLength;
2247 unsigned long timeleft;
2248 char *psge;
2249 u64 sas_address = 0;
2250 unsigned int reslen = 0;
2251 int ret = -EINVAL;
2252
2253 /* do we need to support multiple segments? */
2254 if (job->request_payload.sg_cnt > 1 ||
2255 job->reply_payload.sg_cnt > 1) {
2256 printk(MYIOC_s_ERR_FMT "%s: multiple segments req %u, rsp %u\n",
2257 ioc->name, __func__, job->request_payload.payload_len,
2258 job->reply_payload.payload_len);
2259 goto out;
2260 }
2261
2262 ret = mutex_lock_interruptible(&ioc->sas_mgmt.mutex);
2263 if (ret)
2264 goto out;
2265
2266 mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2267 if (!mf) {
2268 ret = -ENOMEM;
2269 goto out_unlock;
2270 }
2271
2272 smpreq = (SmpPassthroughRequest_t *)mf;
2273 memset(smpreq, 0, sizeof(*smpreq));
2274
2275 smpreq->RequestDataLength =
2276 cpu_to_le16(job->request_payload.payload_len - 4);
2277 smpreq->Function = MPI_FUNCTION_SMP_PASSTHROUGH;
2278
2279 if (rphy)
2280 sas_address = rphy->identify.sas_address;
2281 else {
2282 struct mptsas_portinfo *port_info;
2283
2284 mutex_lock(&ioc->sas_topology_mutex);
2285 port_info = ioc->hba_port_info;
2286 if (port_info && port_info->phy_info)
2287 sas_address =
2288 port_info->phy_info[0].phy->identify.sas_address;
2289 mutex_unlock(&ioc->sas_topology_mutex);
2290 }
2291
2292 *((u64 *)&smpreq->SASAddress) = cpu_to_le64(sas_address);
2293
2294 psge = (char *)
2295 (((int *) mf) + (offsetof(SmpPassthroughRequest_t, SGL) / 4));
2296
2297 /* request */
2298 flagsLength = (MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2299 MPI_SGE_FLAGS_END_OF_BUFFER |
2300 MPI_SGE_FLAGS_DIRECTION)
2301 << MPI_SGE_FLAGS_SHIFT;
2302
2303 if (!dma_map_sg(&ioc->pcidev->dev, job->request_payload.sg_list,
2304 1, PCI_DMA_BIDIRECTIONAL))
2305 goto put_mf;
2306
2307 flagsLength |= (sg_dma_len(job->request_payload.sg_list) - 4);
2308 ioc->add_sge(psge, flagsLength,
2309 sg_dma_address(job->request_payload.sg_list));
2310 psge += ioc->SGE_size;
2311
2312 /* response */
2313 flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2314 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2315 MPI_SGE_FLAGS_IOC_TO_HOST |
2316 MPI_SGE_FLAGS_END_OF_BUFFER;
2317
2318 flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2319
2320 if (!dma_map_sg(&ioc->pcidev->dev, job->reply_payload.sg_list,
2321 1, PCI_DMA_BIDIRECTIONAL))
2322 goto unmap_out;
2323 flagsLength |= sg_dma_len(job->reply_payload.sg_list) + 4;
2324 ioc->add_sge(psge, flagsLength,
2325 sg_dma_address(job->reply_payload.sg_list));
2326
2327 INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2328 mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2329
2330 timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done, 10 * HZ);
2331 if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2332 ret = -ETIME;
2333 mpt_free_msg_frame(ioc, mf);
2334 mf = NULL;
2335 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2336 goto unmap_in;
2337 if (!timeleft)
2338 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2339 goto unmap_in;
2340 }
2341 mf = NULL;
2342
2343 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_RF_VALID) {
2344 SmpPassthroughReply_t *smprep;
2345
2346 smprep = (SmpPassthroughReply_t *)ioc->sas_mgmt.reply;
2347 memcpy(job->reply, smprep, sizeof(*smprep));
2348 job->reply_len = sizeof(*smprep);
2349 reslen = smprep->ResponseDataLength;
2350 } else {
2351 printk(MYIOC_s_ERR_FMT
2352 "%s: smp passthru reply failed to be returned\n",
2353 ioc->name, __func__);
2354 ret = -ENXIO;
2355 }
2356
2357unmap_in:
2358 dma_unmap_sg(&ioc->pcidev->dev, job->reply_payload.sg_list, 1,
2359 PCI_DMA_BIDIRECTIONAL);
2360unmap_out:
2361 dma_unmap_sg(&ioc->pcidev->dev, job->request_payload.sg_list, 1,
2362 PCI_DMA_BIDIRECTIONAL);
2363put_mf:
2364 if (mf)
2365 mpt_free_msg_frame(ioc, mf);
2366out_unlock:
2367 CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2368 mutex_unlock(&ioc->sas_mgmt.mutex);
2369out:
2370 bsg_job_done(job, ret, reslen);
2371}
2372
2373static struct sas_function_template mptsas_transport_functions = {
2374 .get_linkerrors = mptsas_get_linkerrors,
2375 .get_enclosure_identifier = mptsas_get_enclosure_identifier,
2376 .get_bay_identifier = mptsas_get_bay_identifier,
2377 .phy_reset = mptsas_phy_reset,
2378 .smp_handler = mptsas_smp_handler,
2379};
2380
2381static struct scsi_transport_template *mptsas_transport_template;
2382
2383static int
2384mptsas_sas_io_unit_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
2385{
2386 ConfigExtendedPageHeader_t hdr;
2387 CONFIGPARMS cfg;
2388 SasIOUnitPage0_t *buffer;
2389 dma_addr_t dma_handle;
2390 int error, i;
2391
2392 hdr.PageVersion = MPI_SASIOUNITPAGE0_PAGEVERSION;
2393 hdr.ExtPageLength = 0;
2394 hdr.PageNumber = 0;
2395 hdr.Reserved1 = 0;
2396 hdr.Reserved2 = 0;
2397 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2398 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
2399
2400 cfg.cfghdr.ehdr = &hdr;
2401 cfg.physAddr = -1;
2402 cfg.pageAddr = 0;
2403 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2404 cfg.dir = 0; /* read */
2405 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2406
2407 error = mpt_config(ioc, &cfg);
2408 if (error)
2409 goto out;
2410 if (!hdr.ExtPageLength) {
2411 error = -ENXIO;
2412 goto out;
2413 }
2414
2415 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2416 &dma_handle);
2417 if (!buffer) {
2418 error = -ENOMEM;
2419 goto out;
2420 }
2421
2422 cfg.physAddr = dma_handle;
2423 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2424
2425 error = mpt_config(ioc, &cfg);
2426 if (error)
2427 goto out_free_consistent;
2428
2429 port_info->num_phys = buffer->NumPhys;
2430 port_info->phy_info = kcalloc(port_info->num_phys,
2431 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
2432 if (!port_info->phy_info) {
2433 error = -ENOMEM;
2434 goto out_free_consistent;
2435 }
2436
2437 ioc->nvdata_version_persistent =
2438 le16_to_cpu(buffer->NvdataVersionPersistent);
2439 ioc->nvdata_version_default =
2440 le16_to_cpu(buffer->NvdataVersionDefault);
2441
2442 for (i = 0; i < port_info->num_phys; i++) {
2443 mptsas_print_phy_data(ioc, &buffer->PhyData[i]);
2444 port_info->phy_info[i].phy_id = i;
2445 port_info->phy_info[i].port_id =
2446 buffer->PhyData[i].Port;
2447 port_info->phy_info[i].negotiated_link_rate =
2448 buffer->PhyData[i].NegotiatedLinkRate;
2449 port_info->phy_info[i].portinfo = port_info;
2450 port_info->phy_info[i].handle =
2451 le16_to_cpu(buffer->PhyData[i].ControllerDevHandle);
2452 }
2453
2454 out_free_consistent:
2455 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2456 buffer, dma_handle);
2457 out:
2458 return error;
2459}
2460
2461static int
2462mptsas_sas_io_unit_pg1(MPT_ADAPTER *ioc)
2463{
2464 ConfigExtendedPageHeader_t hdr;
2465 CONFIGPARMS cfg;
2466 SasIOUnitPage1_t *buffer;
2467 dma_addr_t dma_handle;
2468 int error;
2469 u8 device_missing_delay;
2470
2471 memset(&hdr, 0, sizeof(ConfigExtendedPageHeader_t));
2472 memset(&cfg, 0, sizeof(CONFIGPARMS));
2473
2474 cfg.cfghdr.ehdr = &hdr;
2475 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2476 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2477 cfg.cfghdr.ehdr->PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2478 cfg.cfghdr.ehdr->ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_IO_UNIT;
2479 cfg.cfghdr.ehdr->PageVersion = MPI_SASIOUNITPAGE1_PAGEVERSION;
2480 cfg.cfghdr.ehdr->PageNumber = 1;
2481
2482 error = mpt_config(ioc, &cfg);
2483 if (error)
2484 goto out;
2485 if (!hdr.ExtPageLength) {
2486 error = -ENXIO;
2487 goto out;
2488 }
2489
2490 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2491 &dma_handle);
2492 if (!buffer) {
2493 error = -ENOMEM;
2494 goto out;
2495 }
2496
2497 cfg.physAddr = dma_handle;
2498 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2499
2500 error = mpt_config(ioc, &cfg);
2501 if (error)
2502 goto out_free_consistent;
2503
2504 ioc->io_missing_delay =
2505 le16_to_cpu(buffer->IODeviceMissingDelay);
2506 device_missing_delay = buffer->ReportDeviceMissingDelay;
2507 ioc->device_missing_delay = (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_UNIT_16) ?
2508 (device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK) * 16 :
2509 device_missing_delay & MPI_SAS_IOUNIT1_REPORT_MISSING_TIMEOUT_MASK;
2510
2511 out_free_consistent:
2512 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2513 buffer, dma_handle);
2514 out:
2515 return error;
2516}
2517
2518static int
2519mptsas_sas_phy_pg0(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
2520 u32 form, u32 form_specific)
2521{
2522 ConfigExtendedPageHeader_t hdr;
2523 CONFIGPARMS cfg;
2524 SasPhyPage0_t *buffer;
2525 dma_addr_t dma_handle;
2526 int error;
2527
2528 hdr.PageVersion = MPI_SASPHY0_PAGEVERSION;
2529 hdr.ExtPageLength = 0;
2530 hdr.PageNumber = 0;
2531 hdr.Reserved1 = 0;
2532 hdr.Reserved2 = 0;
2533 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2534 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_PHY;
2535
2536 cfg.cfghdr.ehdr = &hdr;
2537 cfg.dir = 0; /* read */
2538 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2539
2540 /* Get Phy Pg 0 for each Phy. */
2541 cfg.physAddr = -1;
2542 cfg.pageAddr = form + form_specific;
2543 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2544
2545 error = mpt_config(ioc, &cfg);
2546 if (error)
2547 goto out;
2548
2549 if (!hdr.ExtPageLength) {
2550 error = -ENXIO;
2551 goto out;
2552 }
2553
2554 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2555 &dma_handle);
2556 if (!buffer) {
2557 error = -ENOMEM;
2558 goto out;
2559 }
2560
2561 cfg.physAddr = dma_handle;
2562 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2563
2564 error = mpt_config(ioc, &cfg);
2565 if (error)
2566 goto out_free_consistent;
2567
2568 mptsas_print_phy_pg0(ioc, buffer);
2569
2570 phy_info->hw_link_rate = buffer->HwLinkRate;
2571 phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
2572 phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
2573 phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
2574
2575 out_free_consistent:
2576 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2577 buffer, dma_handle);
2578 out:
2579 return error;
2580}
2581
2582static int
2583mptsas_sas_device_pg0(MPT_ADAPTER *ioc, struct mptsas_devinfo *device_info,
2584 u32 form, u32 form_specific)
2585{
2586 ConfigExtendedPageHeader_t hdr;
2587 CONFIGPARMS cfg;
2588 SasDevicePage0_t *buffer;
2589 dma_addr_t dma_handle;
2590 __le64 sas_address;
2591 int error=0;
2592
2593 hdr.PageVersion = MPI_SASDEVICE0_PAGEVERSION;
2594 hdr.ExtPageLength = 0;
2595 hdr.PageNumber = 0;
2596 hdr.Reserved1 = 0;
2597 hdr.Reserved2 = 0;
2598 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2599 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_DEVICE;
2600
2601 cfg.cfghdr.ehdr = &hdr;
2602 cfg.pageAddr = form + form_specific;
2603 cfg.physAddr = -1;
2604 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2605 cfg.dir = 0; /* read */
2606 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2607
2608 memset(device_info, 0, sizeof(struct mptsas_devinfo));
2609 error = mpt_config(ioc, &cfg);
2610 if (error)
2611 goto out;
2612 if (!hdr.ExtPageLength) {
2613 error = -ENXIO;
2614 goto out;
2615 }
2616
2617 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2618 &dma_handle);
2619 if (!buffer) {
2620 error = -ENOMEM;
2621 goto out;
2622 }
2623
2624 cfg.physAddr = dma_handle;
2625 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2626
2627 error = mpt_config(ioc, &cfg);
2628
2629 if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2630 error = -ENODEV;
2631 goto out_free_consistent;
2632 }
2633
2634 if (error)
2635 goto out_free_consistent;
2636
2637 mptsas_print_device_pg0(ioc, buffer);
2638
2639 memset(device_info, 0, sizeof(struct mptsas_devinfo));
2640 device_info->handle = le16_to_cpu(buffer->DevHandle);
2641 device_info->handle_parent = le16_to_cpu(buffer->ParentDevHandle);
2642 device_info->handle_enclosure =
2643 le16_to_cpu(buffer->EnclosureHandle);
2644 device_info->slot = le16_to_cpu(buffer->Slot);
2645 device_info->phy_id = buffer->PhyNum;
2646 device_info->port_id = buffer->PhysicalPort;
2647 device_info->id = buffer->TargetID;
2648 device_info->phys_disk_num = ~0;
2649 device_info->channel = buffer->Bus;
2650 memcpy(&sas_address, &buffer->SASAddress, sizeof(__le64));
2651 device_info->sas_address = le64_to_cpu(sas_address);
2652 device_info->device_info =
2653 le32_to_cpu(buffer->DeviceInfo);
2654 device_info->flags = le16_to_cpu(buffer->Flags);
2655
2656 out_free_consistent:
2657 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2658 buffer, dma_handle);
2659 out:
2660 return error;
2661}
2662
2663static int
2664mptsas_sas_expander_pg0(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info,
2665 u32 form, u32 form_specific)
2666{
2667 ConfigExtendedPageHeader_t hdr;
2668 CONFIGPARMS cfg;
2669 SasExpanderPage0_t *buffer;
2670 dma_addr_t dma_handle;
2671 int i, error;
2672 __le64 sas_address;
2673
2674 memset(port_info, 0, sizeof(struct mptsas_portinfo));
2675 hdr.PageVersion = MPI_SASEXPANDER0_PAGEVERSION;
2676 hdr.ExtPageLength = 0;
2677 hdr.PageNumber = 0;
2678 hdr.Reserved1 = 0;
2679 hdr.Reserved2 = 0;
2680 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2681 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
2682
2683 cfg.cfghdr.ehdr = &hdr;
2684 cfg.physAddr = -1;
2685 cfg.pageAddr = form + form_specific;
2686 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2687 cfg.dir = 0; /* read */
2688 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2689
2690 memset(port_info, 0, sizeof(struct mptsas_portinfo));
2691 error = mpt_config(ioc, &cfg);
2692 if (error)
2693 goto out;
2694
2695 if (!hdr.ExtPageLength) {
2696 error = -ENXIO;
2697 goto out;
2698 }
2699
2700 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2701 &dma_handle);
2702 if (!buffer) {
2703 error = -ENOMEM;
2704 goto out;
2705 }
2706
2707 cfg.physAddr = dma_handle;
2708 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2709
2710 error = mpt_config(ioc, &cfg);
2711 if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2712 error = -ENODEV;
2713 goto out_free_consistent;
2714 }
2715
2716 if (error)
2717 goto out_free_consistent;
2718
2719 /* save config data */
2720 port_info->num_phys = (buffer->NumPhys) ? buffer->NumPhys : 1;
2721 port_info->phy_info = kcalloc(port_info->num_phys,
2722 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
2723 if (!port_info->phy_info) {
2724 error = -ENOMEM;
2725 goto out_free_consistent;
2726 }
2727
2728 memcpy(&sas_address, &buffer->SASAddress, sizeof(__le64));
2729 for (i = 0; i < port_info->num_phys; i++) {
2730 port_info->phy_info[i].portinfo = port_info;
2731 port_info->phy_info[i].handle =
2732 le16_to_cpu(buffer->DevHandle);
2733 port_info->phy_info[i].identify.sas_address =
2734 le64_to_cpu(sas_address);
2735 port_info->phy_info[i].identify.handle_parent =
2736 le16_to_cpu(buffer->ParentDevHandle);
2737 }
2738
2739 out_free_consistent:
2740 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2741 buffer, dma_handle);
2742 out:
2743 return error;
2744}
2745
2746static int
2747mptsas_sas_expander_pg1(MPT_ADAPTER *ioc, struct mptsas_phyinfo *phy_info,
2748 u32 form, u32 form_specific)
2749{
2750 ConfigExtendedPageHeader_t hdr;
2751 CONFIGPARMS cfg;
2752 SasExpanderPage1_t *buffer;
2753 dma_addr_t dma_handle;
2754 int error=0;
2755
2756 hdr.PageVersion = MPI_SASEXPANDER1_PAGEVERSION;
2757 hdr.ExtPageLength = 0;
2758 hdr.PageNumber = 1;
2759 hdr.Reserved1 = 0;
2760 hdr.Reserved2 = 0;
2761 hdr.PageType = MPI_CONFIG_PAGETYPE_EXTENDED;
2762 hdr.ExtPageType = MPI_CONFIG_EXTPAGETYPE_SAS_EXPANDER;
2763
2764 cfg.cfghdr.ehdr = &hdr;
2765 cfg.physAddr = -1;
2766 cfg.pageAddr = form + form_specific;
2767 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
2768 cfg.dir = 0; /* read */
2769 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
2770
2771 error = mpt_config(ioc, &cfg);
2772 if (error)
2773 goto out;
2774
2775 if (!hdr.ExtPageLength) {
2776 error = -ENXIO;
2777 goto out;
2778 }
2779
2780 buffer = pci_alloc_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2781 &dma_handle);
2782 if (!buffer) {
2783 error = -ENOMEM;
2784 goto out;
2785 }
2786
2787 cfg.physAddr = dma_handle;
2788 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
2789
2790 error = mpt_config(ioc, &cfg);
2791
2792 if (error == MPI_IOCSTATUS_CONFIG_INVALID_PAGE) {
2793 error = -ENODEV;
2794 goto out_free_consistent;
2795 }
2796
2797 if (error)
2798 goto out_free_consistent;
2799
2800
2801 mptsas_print_expander_pg1(ioc, buffer);
2802
2803 /* save config data */
2804 phy_info->phy_id = buffer->PhyIdentifier;
2805 phy_info->port_id = buffer->PhysicalPort;
2806 phy_info->negotiated_link_rate = buffer->NegotiatedLinkRate;
2807 phy_info->programmed_link_rate = buffer->ProgrammedLinkRate;
2808 phy_info->hw_link_rate = buffer->HwLinkRate;
2809 phy_info->identify.handle = le16_to_cpu(buffer->OwnerDevHandle);
2810 phy_info->attached.handle = le16_to_cpu(buffer->AttachedDevHandle);
2811
2812 out_free_consistent:
2813 pci_free_consistent(ioc->pcidev, hdr.ExtPageLength * 4,
2814 buffer, dma_handle);
2815 out:
2816 return error;
2817}
2818
2819struct rep_manu_request{
2820 u8 smp_frame_type;
2821 u8 function;
2822 u8 reserved;
2823 u8 request_length;
2824};
2825
2826struct rep_manu_reply{
2827 u8 smp_frame_type; /* 0x41 */
2828 u8 function; /* 0x01 */
2829 u8 function_result;
2830 u8 response_length;
2831 u16 expander_change_count;
2832 u8 reserved0[2];
2833 u8 sas_format:1;
2834 u8 reserved1:7;
2835 u8 reserved2[3];
2836 u8 vendor_id[SAS_EXPANDER_VENDOR_ID_LEN];
2837 u8 product_id[SAS_EXPANDER_PRODUCT_ID_LEN];
2838 u8 product_rev[SAS_EXPANDER_PRODUCT_REV_LEN];
2839 u8 component_vendor_id[SAS_EXPANDER_COMPONENT_VENDOR_ID_LEN];
2840 u16 component_id;
2841 u8 component_revision_id;
2842 u8 reserved3;
2843 u8 vendor_specific[8];
2844};
2845
2846/**
2847 * mptsas_exp_repmanufacture_info - sets expander manufacturer info
2848 * @ioc: per adapter object
2849 * @sas_address: expander sas address
2850 * @edev: the sas_expander_device object
2851 *
2852 * For an edge expander or a fanout expander:
2853 * fills in the sas_expander_device object when SMP port is created.
2854 *
2855 * Return: 0 for success, non-zero for failure.
2856 */
2857static int
2858mptsas_exp_repmanufacture_info(MPT_ADAPTER *ioc,
2859 u64 sas_address, struct sas_expander_device *edev)
2860{
2861 MPT_FRAME_HDR *mf;
2862 SmpPassthroughRequest_t *smpreq;
2863 SmpPassthroughReply_t *smprep;
2864 struct rep_manu_reply *manufacture_reply;
2865 struct rep_manu_request *manufacture_request;
2866 int ret;
2867 int flagsLength;
2868 unsigned long timeleft;
2869 char *psge;
2870 unsigned long flags;
2871 void *data_out = NULL;
2872 dma_addr_t data_out_dma = 0;
2873 u32 sz;
2874
2875 spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
2876 if (ioc->ioc_reset_in_progress) {
2877 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
2878 printk(MYIOC_s_INFO_FMT "%s: host reset in progress!\n",
2879 __func__, ioc->name);
2880 return -EFAULT;
2881 }
2882 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
2883
2884 ret = mutex_lock_interruptible(&ioc->sas_mgmt.mutex);
2885 if (ret)
2886 goto out;
2887
2888 mf = mpt_get_msg_frame(mptsasMgmtCtx, ioc);
2889 if (!mf) {
2890 ret = -ENOMEM;
2891 goto out_unlock;
2892 }
2893
2894 smpreq = (SmpPassthroughRequest_t *)mf;
2895 memset(smpreq, 0, sizeof(*smpreq));
2896
2897 sz = sizeof(struct rep_manu_request) + sizeof(struct rep_manu_reply);
2898
2899 data_out = pci_alloc_consistent(ioc->pcidev, sz, &data_out_dma);
2900 if (!data_out) {
2901 printk(KERN_ERR "Memory allocation failure at %s:%d/%s()!\n",
2902 __FILE__, __LINE__, __func__);
2903 ret = -ENOMEM;
2904 goto put_mf;
2905 }
2906
2907 manufacture_request = data_out;
2908 manufacture_request->smp_frame_type = 0x40;
2909 manufacture_request->function = 1;
2910 manufacture_request->reserved = 0;
2911 manufacture_request->request_length = 0;
2912
2913 smpreq->Function = MPI_FUNCTION_SMP_PASSTHROUGH;
2914 smpreq->PhysicalPort = 0xFF;
2915 *((u64 *)&smpreq->SASAddress) = cpu_to_le64(sas_address);
2916 smpreq->RequestDataLength = sizeof(struct rep_manu_request);
2917
2918 psge = (char *)
2919 (((int *) mf) + (offsetof(SmpPassthroughRequest_t, SGL) / 4));
2920
2921 flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2922 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2923 MPI_SGE_FLAGS_HOST_TO_IOC |
2924 MPI_SGE_FLAGS_END_OF_BUFFER;
2925 flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2926 flagsLength |= sizeof(struct rep_manu_request);
2927
2928 ioc->add_sge(psge, flagsLength, data_out_dma);
2929 psge += ioc->SGE_size;
2930
2931 flagsLength = MPI_SGE_FLAGS_SIMPLE_ELEMENT |
2932 MPI_SGE_FLAGS_SYSTEM_ADDRESS |
2933 MPI_SGE_FLAGS_IOC_TO_HOST |
2934 MPI_SGE_FLAGS_END_OF_BUFFER;
2935 flagsLength = flagsLength << MPI_SGE_FLAGS_SHIFT;
2936 flagsLength |= sizeof(struct rep_manu_reply);
2937 ioc->add_sge(psge, flagsLength, data_out_dma +
2938 sizeof(struct rep_manu_request));
2939
2940 INITIALIZE_MGMT_STATUS(ioc->sas_mgmt.status)
2941 mpt_put_msg_frame(mptsasMgmtCtx, ioc, mf);
2942
2943 timeleft = wait_for_completion_timeout(&ioc->sas_mgmt.done, 10 * HZ);
2944 if (!(ioc->sas_mgmt.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
2945 ret = -ETIME;
2946 mpt_free_msg_frame(ioc, mf);
2947 mf = NULL;
2948 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_DID_IOCRESET)
2949 goto out_free;
2950 if (!timeleft)
2951 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
2952 goto out_free;
2953 }
2954
2955 mf = NULL;
2956
2957 if (ioc->sas_mgmt.status & MPT_MGMT_STATUS_RF_VALID) {
2958 u8 *tmp;
2959
2960 smprep = (SmpPassthroughReply_t *)ioc->sas_mgmt.reply;
2961 if (le16_to_cpu(smprep->ResponseDataLength) !=
2962 sizeof(struct rep_manu_reply))
2963 goto out_free;
2964
2965 manufacture_reply = data_out + sizeof(struct rep_manu_request);
2966 strncpy(edev->vendor_id, manufacture_reply->vendor_id,
2967 SAS_EXPANDER_VENDOR_ID_LEN);
2968 strncpy(edev->product_id, manufacture_reply->product_id,
2969 SAS_EXPANDER_PRODUCT_ID_LEN);
2970 strncpy(edev->product_rev, manufacture_reply->product_rev,
2971 SAS_EXPANDER_PRODUCT_REV_LEN);
2972 edev->level = manufacture_reply->sas_format;
2973 if (manufacture_reply->sas_format) {
2974 strncpy(edev->component_vendor_id,
2975 manufacture_reply->component_vendor_id,
2976 SAS_EXPANDER_COMPONENT_VENDOR_ID_LEN);
2977 tmp = (u8 *)&manufacture_reply->component_id;
2978 edev->component_id = tmp[0] << 8 | tmp[1];
2979 edev->component_revision_id =
2980 manufacture_reply->component_revision_id;
2981 }
2982 } else {
2983 printk(MYIOC_s_ERR_FMT
2984 "%s: smp passthru reply failed to be returned\n",
2985 ioc->name, __func__);
2986 ret = -ENXIO;
2987 }
2988out_free:
2989 if (data_out_dma)
2990 pci_free_consistent(ioc->pcidev, sz, data_out, data_out_dma);
2991put_mf:
2992 if (mf)
2993 mpt_free_msg_frame(ioc, mf);
2994out_unlock:
2995 CLEAR_MGMT_STATUS(ioc->sas_mgmt.status)
2996 mutex_unlock(&ioc->sas_mgmt.mutex);
2997out:
2998 return ret;
2999}
3000
3001static void
3002mptsas_parse_device_info(struct sas_identify *identify,
3003 struct mptsas_devinfo *device_info)
3004{
3005 u16 protocols;
3006
3007 identify->sas_address = device_info->sas_address;
3008 identify->phy_identifier = device_info->phy_id;
3009
3010 /*
3011 * Fill in Phy Initiator Port Protocol.
3012 * Bits 6:3, more than one bit can be set, fall through cases.
3013 */
3014 protocols = device_info->device_info & 0x78;
3015 identify->initiator_port_protocols = 0;
3016 if (protocols & MPI_SAS_DEVICE_INFO_SSP_INITIATOR)
3017 identify->initiator_port_protocols |= SAS_PROTOCOL_SSP;
3018 if (protocols & MPI_SAS_DEVICE_INFO_STP_INITIATOR)
3019 identify->initiator_port_protocols |= SAS_PROTOCOL_STP;
3020 if (protocols & MPI_SAS_DEVICE_INFO_SMP_INITIATOR)
3021 identify->initiator_port_protocols |= SAS_PROTOCOL_SMP;
3022 if (protocols & MPI_SAS_DEVICE_INFO_SATA_HOST)
3023 identify->initiator_port_protocols |= SAS_PROTOCOL_SATA;
3024
3025 /*
3026 * Fill in Phy Target Port Protocol.
3027 * Bits 10:7, more than one bit can be set, fall through cases.
3028 */
3029 protocols = device_info->device_info & 0x780;
3030 identify->target_port_protocols = 0;
3031 if (protocols & MPI_SAS_DEVICE_INFO_SSP_TARGET)
3032 identify->target_port_protocols |= SAS_PROTOCOL_SSP;
3033 if (protocols & MPI_SAS_DEVICE_INFO_STP_TARGET)
3034 identify->target_port_protocols |= SAS_PROTOCOL_STP;
3035 if (protocols & MPI_SAS_DEVICE_INFO_SMP_TARGET)
3036 identify->target_port_protocols |= SAS_PROTOCOL_SMP;
3037 if (protocols & MPI_SAS_DEVICE_INFO_SATA_DEVICE)
3038 identify->target_port_protocols |= SAS_PROTOCOL_SATA;
3039
3040 /*
3041 * Fill in Attached device type.
3042 */
3043 switch (device_info->device_info &
3044 MPI_SAS_DEVICE_INFO_MASK_DEVICE_TYPE) {
3045 case MPI_SAS_DEVICE_INFO_NO_DEVICE:
3046 identify->device_type = SAS_PHY_UNUSED;
3047 break;
3048 case MPI_SAS_DEVICE_INFO_END_DEVICE:
3049 identify->device_type = SAS_END_DEVICE;
3050 break;
3051 case MPI_SAS_DEVICE_INFO_EDGE_EXPANDER:
3052 identify->device_type = SAS_EDGE_EXPANDER_DEVICE;
3053 break;
3054 case MPI_SAS_DEVICE_INFO_FANOUT_EXPANDER:
3055 identify->device_type = SAS_FANOUT_EXPANDER_DEVICE;
3056 break;
3057 }
3058}
3059
3060static int mptsas_probe_one_phy(struct device *dev,
3061 struct mptsas_phyinfo *phy_info, int index, int local)
3062{
3063 MPT_ADAPTER *ioc;
3064 struct sas_phy *phy;
3065 struct sas_port *port;
3066 int error = 0;
3067 VirtTarget *vtarget;
3068
3069 if (!dev) {
3070 error = -ENODEV;
3071 goto out;
3072 }
3073
3074 if (!phy_info->phy) {
3075 phy = sas_phy_alloc(dev, index);
3076 if (!phy) {
3077 error = -ENOMEM;
3078 goto out;
3079 }
3080 } else
3081 phy = phy_info->phy;
3082
3083 mptsas_parse_device_info(&phy->identify, &phy_info->identify);
3084
3085 /*
3086 * Set Negotiated link rate.
3087 */
3088 switch (phy_info->negotiated_link_rate) {
3089 case MPI_SAS_IOUNIT0_RATE_PHY_DISABLED:
3090 phy->negotiated_linkrate = SAS_PHY_DISABLED;
3091 break;
3092 case MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION:
3093 phy->negotiated_linkrate = SAS_LINK_RATE_FAILED;
3094 break;
3095 case MPI_SAS_IOUNIT0_RATE_1_5:
3096 phy->negotiated_linkrate = SAS_LINK_RATE_1_5_GBPS;
3097 break;
3098 case MPI_SAS_IOUNIT0_RATE_3_0:
3099 phy->negotiated_linkrate = SAS_LINK_RATE_3_0_GBPS;
3100 break;
3101 case MPI_SAS_IOUNIT0_RATE_6_0:
3102 phy->negotiated_linkrate = SAS_LINK_RATE_6_0_GBPS;
3103 break;
3104 case MPI_SAS_IOUNIT0_RATE_SATA_OOB_COMPLETE:
3105 case MPI_SAS_IOUNIT0_RATE_UNKNOWN:
3106 default:
3107 phy->negotiated_linkrate = SAS_LINK_RATE_UNKNOWN;
3108 break;
3109 }
3110
3111 /*
3112 * Set Max hardware link rate.
3113 */
3114 switch (phy_info->hw_link_rate & MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
3115 case MPI_SAS_PHY0_HWRATE_MAX_RATE_1_5:
3116 phy->maximum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
3117 break;
3118 case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
3119 phy->maximum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
3120 break;
3121 default:
3122 break;
3123 }
3124
3125 /*
3126 * Set Max programmed link rate.
3127 */
3128 switch (phy_info->programmed_link_rate &
3129 MPI_SAS_PHY0_PRATE_MAX_RATE_MASK) {
3130 case MPI_SAS_PHY0_PRATE_MAX_RATE_1_5:
3131 phy->maximum_linkrate = SAS_LINK_RATE_1_5_GBPS;
3132 break;
3133 case MPI_SAS_PHY0_PRATE_MAX_RATE_3_0:
3134 phy->maximum_linkrate = SAS_LINK_RATE_3_0_GBPS;
3135 break;
3136 default:
3137 break;
3138 }
3139
3140 /*
3141 * Set Min hardware link rate.
3142 */
3143 switch (phy_info->hw_link_rate & MPI_SAS_PHY0_HWRATE_MIN_RATE_MASK) {
3144 case MPI_SAS_PHY0_HWRATE_MIN_RATE_1_5:
3145 phy->minimum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS;
3146 break;
3147 case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
3148 phy->minimum_linkrate_hw = SAS_LINK_RATE_3_0_GBPS;
3149 break;
3150 default:
3151 break;
3152 }
3153
3154 /*
3155 * Set Min programmed link rate.
3156 */
3157 switch (phy_info->programmed_link_rate &
3158 MPI_SAS_PHY0_PRATE_MIN_RATE_MASK) {
3159 case MPI_SAS_PHY0_PRATE_MIN_RATE_1_5:
3160 phy->minimum_linkrate = SAS_LINK_RATE_1_5_GBPS;
3161 break;
3162 case MPI_SAS_PHY0_PRATE_MIN_RATE_3_0:
3163 phy->minimum_linkrate = SAS_LINK_RATE_3_0_GBPS;
3164 break;
3165 default:
3166 break;
3167 }
3168
3169 if (!phy_info->phy) {
3170
3171 error = sas_phy_add(phy);
3172 if (error) {
3173 sas_phy_free(phy);
3174 goto out;
3175 }
3176 phy_info->phy = phy;
3177 }
3178
3179 if (!phy_info->attached.handle ||
3180 !phy_info->port_details)
3181 goto out;
3182
3183 port = mptsas_get_port(phy_info);
3184 ioc = phy_to_ioc(phy_info->phy);
3185
3186 if (phy_info->sas_port_add_phy) {
3187
3188 if (!port) {
3189 port = sas_port_alloc_num(dev);
3190 if (!port) {
3191 error = -ENOMEM;
3192 goto out;
3193 }
3194 error = sas_port_add(port);
3195 if (error) {
3196 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3197 "%s: exit at line=%d\n", ioc->name,
3198 __func__, __LINE__));
3199 goto out;
3200 }
3201 mptsas_set_port(ioc, phy_info, port);
3202 devtprintk(ioc, dev_printk(KERN_DEBUG, &port->dev,
3203 MYIOC_s_FMT "add port %d, sas_addr (0x%llx)\n",
3204 ioc->name, port->port_identifier,
3205 (unsigned long long)phy_info->
3206 attached.sas_address));
3207 }
3208 dsaswideprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3209 "sas_port_add_phy: phy_id=%d\n",
3210 ioc->name, phy_info->phy_id));
3211 sas_port_add_phy(port, phy_info->phy);
3212 phy_info->sas_port_add_phy = 0;
3213 devtprintk(ioc, dev_printk(KERN_DEBUG, &phy_info->phy->dev,
3214 MYIOC_s_FMT "add phy %d, phy-obj (0x%p)\n", ioc->name,
3215 phy_info->phy_id, phy_info->phy));
3216 }
3217 if (!mptsas_get_rphy(phy_info) && port && !port->rphy) {
3218
3219 struct sas_rphy *rphy;
3220 struct device *parent;
3221 struct sas_identify identify;
3222
3223 parent = dev->parent->parent;
3224 /*
3225 * Let the hotplug_work thread handle processing
3226 * the adding/removing of devices that occur
3227 * after start of day.
3228 */
3229 if (mptsas_is_end_device(&phy_info->attached) &&
3230 phy_info->attached.handle_parent) {
3231 goto out;
3232 }
3233
3234 mptsas_parse_device_info(&identify, &phy_info->attached);
3235 if (scsi_is_host_device(parent)) {
3236 struct mptsas_portinfo *port_info;
3237 int i;
3238
3239 port_info = ioc->hba_port_info;
3240
3241 for (i = 0; i < port_info->num_phys; i++)
3242 if (port_info->phy_info[i].identify.sas_address ==
3243 identify.sas_address) {
3244 sas_port_mark_backlink(port);
3245 goto out;
3246 }
3247
3248 } else if (scsi_is_sas_rphy(parent)) {
3249 struct sas_rphy *parent_rphy = dev_to_rphy(parent);
3250 if (identify.sas_address ==
3251 parent_rphy->identify.sas_address) {
3252 sas_port_mark_backlink(port);
3253 goto out;
3254 }
3255 }
3256
3257 switch (identify.device_type) {
3258 case SAS_END_DEVICE:
3259 rphy = sas_end_device_alloc(port);
3260 break;
3261 case SAS_EDGE_EXPANDER_DEVICE:
3262 case SAS_FANOUT_EXPANDER_DEVICE:
3263 rphy = sas_expander_alloc(port, identify.device_type);
3264 break;
3265 default:
3266 rphy = NULL;
3267 break;
3268 }
3269 if (!rphy) {
3270 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3271 "%s: exit at line=%d\n", ioc->name,
3272 __func__, __LINE__));
3273 goto out;
3274 }
3275
3276 rphy->identify = identify;
3277 error = sas_rphy_add(rphy);
3278 if (error) {
3279 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3280 "%s: exit at line=%d\n", ioc->name,
3281 __func__, __LINE__));
3282 sas_rphy_free(rphy);
3283 goto out;
3284 }
3285 mptsas_set_rphy(ioc, phy_info, rphy);
3286 if (identify.device_type == SAS_EDGE_EXPANDER_DEVICE ||
3287 identify.device_type == SAS_FANOUT_EXPANDER_DEVICE)
3288 mptsas_exp_repmanufacture_info(ioc,
3289 identify.sas_address,
3290 rphy_to_expander_device(rphy));
3291 }
3292
3293 /* If the device exists, verify it wasn't previously flagged
3294 as a missing device. If so, clear it */
3295 vtarget = mptsas_find_vtarget(ioc,
3296 phy_info->attached.channel,
3297 phy_info->attached.id);
3298 if (vtarget && vtarget->inDMD) {
3299 printk(KERN_INFO "Device returned, unsetting inDMD\n");
3300 vtarget->inDMD = 0;
3301 }
3302
3303 out:
3304 return error;
3305}
3306
3307static int
3308mptsas_probe_hba_phys(MPT_ADAPTER *ioc)
3309{
3310 struct mptsas_portinfo *port_info, *hba;
3311 int error = -ENOMEM, i;
3312
3313 hba = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3314 if (! hba)
3315 goto out;
3316
3317 error = mptsas_sas_io_unit_pg0(ioc, hba);
3318 if (error)
3319 goto out_free_port_info;
3320
3321 mptsas_sas_io_unit_pg1(ioc);
3322 mutex_lock(&ioc->sas_topology_mutex);
3323 port_info = ioc->hba_port_info;
3324 if (!port_info) {
3325 ioc->hba_port_info = port_info = hba;
3326 ioc->hba_port_num_phy = port_info->num_phys;
3327 list_add_tail(&port_info->list, &ioc->sas_topology);
3328 } else {
3329 for (i = 0; i < hba->num_phys; i++) {
3330 port_info->phy_info[i].negotiated_link_rate =
3331 hba->phy_info[i].negotiated_link_rate;
3332 port_info->phy_info[i].handle =
3333 hba->phy_info[i].handle;
3334 port_info->phy_info[i].port_id =
3335 hba->phy_info[i].port_id;
3336 }
3337 kfree(hba->phy_info);
3338 kfree(hba);
3339 hba = NULL;
3340 }
3341 mutex_unlock(&ioc->sas_topology_mutex);
3342#if defined(CPQ_CIM)
3343 ioc->num_ports = port_info->num_phys;
3344#endif
3345 for (i = 0; i < port_info->num_phys; i++) {
3346 mptsas_sas_phy_pg0(ioc, &port_info->phy_info[i],
3347 (MPI_SAS_PHY_PGAD_FORM_PHY_NUMBER <<
3348 MPI_SAS_PHY_PGAD_FORM_SHIFT), i);
3349 port_info->phy_info[i].identify.handle =
3350 port_info->phy_info[i].handle;
3351 mptsas_sas_device_pg0(ioc, &port_info->phy_info[i].identify,
3352 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3353 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3354 port_info->phy_info[i].identify.handle);
3355 if (!ioc->hba_port_sas_addr)
3356 ioc->hba_port_sas_addr =
3357 port_info->phy_info[i].identify.sas_address;
3358 port_info->phy_info[i].identify.phy_id =
3359 port_info->phy_info[i].phy_id = i;
3360 if (port_info->phy_info[i].attached.handle)
3361 mptsas_sas_device_pg0(ioc,
3362 &port_info->phy_info[i].attached,
3363 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3364 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3365 port_info->phy_info[i].attached.handle);
3366 }
3367
3368 mptsas_setup_wide_ports(ioc, port_info);
3369
3370 for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
3371 mptsas_probe_one_phy(&ioc->sh->shost_gendev,
3372 &port_info->phy_info[i], ioc->sas_index, 1);
3373
3374 return 0;
3375
3376 out_free_port_info:
3377 kfree(hba);
3378 out:
3379 return error;
3380}
3381
3382static void
3383mptsas_expander_refresh(MPT_ADAPTER *ioc, struct mptsas_portinfo *port_info)
3384{
3385 struct mptsas_portinfo *parent;
3386 struct device *parent_dev;
3387 struct sas_rphy *rphy;
3388 int i;
3389 u64 sas_address; /* expander sas address */
3390 u32 handle;
3391
3392 handle = port_info->phy_info[0].handle;
3393 sas_address = port_info->phy_info[0].identify.sas_address;
3394 for (i = 0; i < port_info->num_phys; i++) {
3395 mptsas_sas_expander_pg1(ioc, &port_info->phy_info[i],
3396 (MPI_SAS_EXPAND_PGAD_FORM_HANDLE_PHY_NUM <<
3397 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), (i << 16) + handle);
3398
3399 mptsas_sas_device_pg0(ioc,
3400 &port_info->phy_info[i].identify,
3401 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3402 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3403 port_info->phy_info[i].identify.handle);
3404 port_info->phy_info[i].identify.phy_id =
3405 port_info->phy_info[i].phy_id;
3406
3407 if (port_info->phy_info[i].attached.handle) {
3408 mptsas_sas_device_pg0(ioc,
3409 &port_info->phy_info[i].attached,
3410 (MPI_SAS_DEVICE_PGAD_FORM_HANDLE <<
3411 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3412 port_info->phy_info[i].attached.handle);
3413 port_info->phy_info[i].attached.phy_id =
3414 port_info->phy_info[i].phy_id;
3415 }
3416 }
3417
3418 mutex_lock(&ioc->sas_topology_mutex);
3419 parent = mptsas_find_portinfo_by_handle(ioc,
3420 port_info->phy_info[0].identify.handle_parent);
3421 if (!parent) {
3422 mutex_unlock(&ioc->sas_topology_mutex);
3423 return;
3424 }
3425 for (i = 0, parent_dev = NULL; i < parent->num_phys && !parent_dev;
3426 i++) {
3427 if (parent->phy_info[i].attached.sas_address == sas_address) {
3428 rphy = mptsas_get_rphy(&parent->phy_info[i]);
3429 parent_dev = &rphy->dev;
3430 }
3431 }
3432 mutex_unlock(&ioc->sas_topology_mutex);
3433
3434 mptsas_setup_wide_ports(ioc, port_info);
3435 for (i = 0; i < port_info->num_phys; i++, ioc->sas_index++)
3436 mptsas_probe_one_phy(parent_dev, &port_info->phy_info[i],
3437 ioc->sas_index, 0);
3438}
3439
3440static void
3441mptsas_expander_event_add(MPT_ADAPTER *ioc,
3442 MpiEventDataSasExpanderStatusChange_t *expander_data)
3443{
3444 struct mptsas_portinfo *port_info;
3445 int i;
3446 __le64 sas_address;
3447
3448 port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3449 BUG_ON(!port_info);
3450 port_info->num_phys = (expander_data->NumPhys) ?
3451 expander_data->NumPhys : 1;
3452 port_info->phy_info = kcalloc(port_info->num_phys,
3453 sizeof(struct mptsas_phyinfo), GFP_KERNEL);
3454 BUG_ON(!port_info->phy_info);
3455 memcpy(&sas_address, &expander_data->SASAddress, sizeof(__le64));
3456 for (i = 0; i < port_info->num_phys; i++) {
3457 port_info->phy_info[i].portinfo = port_info;
3458 port_info->phy_info[i].handle =
3459 le16_to_cpu(expander_data->DevHandle);
3460 port_info->phy_info[i].identify.sas_address =
3461 le64_to_cpu(sas_address);
3462 port_info->phy_info[i].identify.handle_parent =
3463 le16_to_cpu(expander_data->ParentDevHandle);
3464 }
3465
3466 mutex_lock(&ioc->sas_topology_mutex);
3467 list_add_tail(&port_info->list, &ioc->sas_topology);
3468 mutex_unlock(&ioc->sas_topology_mutex);
3469
3470 printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3471 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3472 (unsigned long long)sas_address);
3473
3474 mptsas_expander_refresh(ioc, port_info);
3475}
3476
3477/**
3478 * mptsas_delete_expander_siblings - remove siblings attached to expander
3479 * @ioc: Pointer to MPT_ADAPTER structure
3480 * @parent: the parent port_info object
3481 * @expander: the expander port_info object
3482 **/
3483static void
3484mptsas_delete_expander_siblings(MPT_ADAPTER *ioc, struct mptsas_portinfo
3485 *parent, struct mptsas_portinfo *expander)
3486{
3487 struct mptsas_phyinfo *phy_info;
3488 struct mptsas_portinfo *port_info;
3489 struct sas_rphy *rphy;
3490 int i;
3491
3492 phy_info = expander->phy_info;
3493 for (i = 0; i < expander->num_phys; i++, phy_info++) {
3494 rphy = mptsas_get_rphy(phy_info);
3495 if (!rphy)
3496 continue;
3497 if (rphy->identify.device_type == SAS_END_DEVICE)
3498 mptsas_del_end_device(ioc, phy_info);
3499 }
3500
3501 phy_info = expander->phy_info;
3502 for (i = 0; i < expander->num_phys; i++, phy_info++) {
3503 rphy = mptsas_get_rphy(phy_info);
3504 if (!rphy)
3505 continue;
3506 if (rphy->identify.device_type ==
3507 MPI_SAS_DEVICE_INFO_EDGE_EXPANDER ||
3508 rphy->identify.device_type ==
3509 MPI_SAS_DEVICE_INFO_FANOUT_EXPANDER) {
3510 port_info = mptsas_find_portinfo_by_sas_address(ioc,
3511 rphy->identify.sas_address);
3512 if (!port_info)
3513 continue;
3514 if (port_info == parent) /* backlink rphy */
3515 continue;
3516 /*
3517 Delete this expander even if the expdevpage is exists
3518 because the parent expander is already deleted
3519 */
3520 mptsas_expander_delete(ioc, port_info, 1);
3521 }
3522 }
3523}
3524
3525
3526/**
3527 * mptsas_expander_delete - remove this expander
3528 * @ioc: Pointer to MPT_ADAPTER structure
3529 * @port_info: expander port_info struct
3530 * @force: Flag to forcefully delete the expander
3531 *
3532 **/
3533
3534static void mptsas_expander_delete(MPT_ADAPTER *ioc,
3535 struct mptsas_portinfo *port_info, u8 force)
3536{
3537
3538 struct mptsas_portinfo *parent;
3539 int i;
3540 u64 expander_sas_address;
3541 struct mptsas_phyinfo *phy_info;
3542 struct mptsas_portinfo buffer;
3543 struct mptsas_portinfo_details *port_details;
3544 struct sas_port *port;
3545
3546 if (!port_info)
3547 return;
3548
3549 /* see if expander is still there before deleting */
3550 mptsas_sas_expander_pg0(ioc, &buffer,
3551 (MPI_SAS_EXPAND_PGAD_FORM_HANDLE <<
3552 MPI_SAS_EXPAND_PGAD_FORM_SHIFT),
3553 port_info->phy_info[0].identify.handle);
3554
3555 if (buffer.num_phys) {
3556 kfree(buffer.phy_info);
3557 if (!force)
3558 return;
3559 }
3560
3561
3562 /*
3563 * Obtain the port_info instance to the parent port
3564 */
3565 port_details = NULL;
3566 expander_sas_address =
3567 port_info->phy_info[0].identify.sas_address;
3568 parent = mptsas_find_portinfo_by_handle(ioc,
3569 port_info->phy_info[0].identify.handle_parent);
3570 mptsas_delete_expander_siblings(ioc, parent, port_info);
3571 if (!parent)
3572 goto out;
3573
3574 /*
3575 * Delete rphys in the parent that point
3576 * to this expander.
3577 */
3578 phy_info = parent->phy_info;
3579 port = NULL;
3580 for (i = 0; i < parent->num_phys; i++, phy_info++) {
3581 if (!phy_info->phy)
3582 continue;
3583 if (phy_info->attached.sas_address !=
3584 expander_sas_address)
3585 continue;
3586 if (!port) {
3587 port = mptsas_get_port(phy_info);
3588 port_details = phy_info->port_details;
3589 }
3590 dev_printk(KERN_DEBUG, &phy_info->phy->dev,
3591 MYIOC_s_FMT "delete phy %d, phy-obj (0x%p)\n", ioc->name,
3592 phy_info->phy_id, phy_info->phy);
3593 sas_port_delete_phy(port, phy_info->phy);
3594 }
3595 if (port) {
3596 dev_printk(KERN_DEBUG, &port->dev,
3597 MYIOC_s_FMT "delete port %d, sas_addr (0x%llx)\n",
3598 ioc->name, port->port_identifier,
3599 (unsigned long long)expander_sas_address);
3600 sas_port_delete(port);
3601 mptsas_port_delete(ioc, port_details);
3602 }
3603 out:
3604
3605 printk(MYIOC_s_INFO_FMT "delete expander: num_phys %d, "
3606 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3607 (unsigned long long)expander_sas_address);
3608
3609 /*
3610 * free link
3611 */
3612 list_del(&port_info->list);
3613 kfree(port_info->phy_info);
3614 kfree(port_info);
3615}
3616
3617
3618/**
3619 * mptsas_send_expander_event - expanders events
3620 * @fw_event: event data
3621 *
3622 *
3623 * This function handles adding, removing, and refreshing
3624 * device handles within the expander objects.
3625 */
3626static void
3627mptsas_send_expander_event(struct fw_event_work *fw_event)
3628{
3629 MPT_ADAPTER *ioc;
3630 MpiEventDataSasExpanderStatusChange_t *expander_data;
3631 struct mptsas_portinfo *port_info;
3632 __le64 sas_address;
3633 int i;
3634
3635 ioc = fw_event->ioc;
3636 expander_data = (MpiEventDataSasExpanderStatusChange_t *)
3637 fw_event->event_data;
3638 memcpy(&sas_address, &expander_data->SASAddress, sizeof(__le64));
3639 sas_address = le64_to_cpu(sas_address);
3640 port_info = mptsas_find_portinfo_by_sas_address(ioc, sas_address);
3641
3642 if (expander_data->ReasonCode == MPI_EVENT_SAS_EXP_RC_ADDED) {
3643 if (port_info) {
3644 for (i = 0; i < port_info->num_phys; i++) {
3645 port_info->phy_info[i].portinfo = port_info;
3646 port_info->phy_info[i].handle =
3647 le16_to_cpu(expander_data->DevHandle);
3648 port_info->phy_info[i].identify.sas_address =
3649 le64_to_cpu(sas_address);
3650 port_info->phy_info[i].identify.handle_parent =
3651 le16_to_cpu(expander_data->ParentDevHandle);
3652 }
3653 mptsas_expander_refresh(ioc, port_info);
3654 } else if (!port_info && expander_data->NumPhys)
3655 mptsas_expander_event_add(ioc, expander_data);
3656 } else if (expander_data->ReasonCode ==
3657 MPI_EVENT_SAS_EXP_RC_NOT_RESPONDING)
3658 mptsas_expander_delete(ioc, port_info, 0);
3659
3660 mptsas_free_fw_event(ioc, fw_event);
3661}
3662
3663
3664/**
3665 * mptsas_expander_add - adds a newly discovered expander
3666 * @ioc: Pointer to MPT_ADAPTER structure
3667 * @handle: device handle
3668 *
3669 */
3670static struct mptsas_portinfo *
3671mptsas_expander_add(MPT_ADAPTER *ioc, u16 handle)
3672{
3673 struct mptsas_portinfo buffer, *port_info;
3674 int i;
3675
3676 if ((mptsas_sas_expander_pg0(ioc, &buffer,
3677 (MPI_SAS_EXPAND_PGAD_FORM_HANDLE <<
3678 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle)))
3679 return NULL;
3680
3681 port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_ATOMIC);
3682 if (!port_info) {
3683 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3684 "%s: exit at line=%d\n", ioc->name,
3685 __func__, __LINE__));
3686 return NULL;
3687 }
3688 port_info->num_phys = buffer.num_phys;
3689 port_info->phy_info = buffer.phy_info;
3690 for (i = 0; i < port_info->num_phys; i++)
3691 port_info->phy_info[i].portinfo = port_info;
3692 mutex_lock(&ioc->sas_topology_mutex);
3693 list_add_tail(&port_info->list, &ioc->sas_topology);
3694 mutex_unlock(&ioc->sas_topology_mutex);
3695 printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3696 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3697 (unsigned long long)buffer.phy_info[0].identify.sas_address);
3698 mptsas_expander_refresh(ioc, port_info);
3699 return port_info;
3700}
3701
3702static void
3703mptsas_send_link_status_event(struct fw_event_work *fw_event)
3704{
3705 MPT_ADAPTER *ioc;
3706 MpiEventDataSasPhyLinkStatus_t *link_data;
3707 struct mptsas_portinfo *port_info;
3708 struct mptsas_phyinfo *phy_info = NULL;
3709 __le64 sas_address;
3710 u8 phy_num;
3711 u8 link_rate;
3712
3713 ioc = fw_event->ioc;
3714 link_data = (MpiEventDataSasPhyLinkStatus_t *)fw_event->event_data;
3715
3716 memcpy(&sas_address, &link_data->SASAddress, sizeof(__le64));
3717 sas_address = le64_to_cpu(sas_address);
3718 link_rate = link_data->LinkRates >> 4;
3719 phy_num = link_data->PhyNum;
3720
3721 port_info = mptsas_find_portinfo_by_sas_address(ioc, sas_address);
3722 if (port_info) {
3723 phy_info = &port_info->phy_info[phy_num];
3724 if (phy_info)
3725 phy_info->negotiated_link_rate = link_rate;
3726 }
3727
3728 if (link_rate == MPI_SAS_IOUNIT0_RATE_1_5 ||
3729 link_rate == MPI_SAS_IOUNIT0_RATE_3_0 ||
3730 link_rate == MPI_SAS_IOUNIT0_RATE_6_0) {
3731
3732 if (!port_info) {
3733 if (ioc->old_sas_discovery_protocal) {
3734 port_info = mptsas_expander_add(ioc,
3735 le16_to_cpu(link_data->DevHandle));
3736 if (port_info)
3737 goto out;
3738 }
3739 goto out;
3740 }
3741
3742 if (port_info == ioc->hba_port_info)
3743 mptsas_probe_hba_phys(ioc);
3744 else
3745 mptsas_expander_refresh(ioc, port_info);
3746 } else if (phy_info && phy_info->phy) {
3747 if (link_rate == MPI_SAS_IOUNIT0_RATE_PHY_DISABLED)
3748 phy_info->phy->negotiated_linkrate =
3749 SAS_PHY_DISABLED;
3750 else if (link_rate ==
3751 MPI_SAS_IOUNIT0_RATE_FAILED_SPEED_NEGOTIATION)
3752 phy_info->phy->negotiated_linkrate =
3753 SAS_LINK_RATE_FAILED;
3754 else {
3755 phy_info->phy->negotiated_linkrate =
3756 SAS_LINK_RATE_UNKNOWN;
3757 if (ioc->device_missing_delay &&
3758 mptsas_is_end_device(&phy_info->attached)) {
3759 struct scsi_device *sdev;
3760 VirtDevice *vdevice;
3761 u8 channel, id;
3762 id = phy_info->attached.id;
3763 channel = phy_info->attached.channel;
3764 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3765 "Link down for fw_id %d:fw_channel %d\n",
3766 ioc->name, phy_info->attached.id,
3767 phy_info->attached.channel));
3768
3769 shost_for_each_device(sdev, ioc->sh) {
3770 vdevice = sdev->hostdata;
3771 if ((vdevice == NULL) ||
3772 (vdevice->vtarget == NULL))
3773 continue;
3774 if ((vdevice->vtarget->tflags &
3775 MPT_TARGET_FLAGS_RAID_COMPONENT ||
3776 vdevice->vtarget->raidVolume))
3777 continue;
3778 if (vdevice->vtarget->id == id &&
3779 vdevice->vtarget->channel ==
3780 channel)
3781 devtprintk(ioc,
3782 printk(MYIOC_s_DEBUG_FMT
3783 "SDEV OUTSTANDING CMDS"
3784 "%d\n", ioc->name,
3785 scsi_device_busy(sdev)));
3786 }
3787
3788 }
3789 }
3790 }
3791 out:
3792 mptsas_free_fw_event(ioc, fw_event);
3793}
3794
3795static void
3796mptsas_not_responding_devices(MPT_ADAPTER *ioc)
3797{
3798 struct mptsas_portinfo buffer, *port_info;
3799 struct mptsas_device_info *sas_info;
3800 struct mptsas_devinfo sas_device;
3801 u32 handle;
3802 VirtTarget *vtarget = NULL;
3803 struct mptsas_phyinfo *phy_info;
3804 u8 found_expander;
3805 int retval, retry_count;
3806 unsigned long flags;
3807
3808 mpt_findImVolumes(ioc);
3809
3810 spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
3811 if (ioc->ioc_reset_in_progress) {
3812 dfailprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3813 "%s: exiting due to a parallel reset \n", ioc->name,
3814 __func__));
3815 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
3816 return;
3817 }
3818 spin_unlock_irqrestore(&ioc->taskmgmt_lock, flags);
3819
3820 /* devices, logical volumes */
3821 mutex_lock(&ioc->sas_device_info_mutex);
3822 redo_device_scan:
3823 list_for_each_entry(sas_info, &ioc->sas_device_info_list, list) {
3824 if (sas_info->is_cached)
3825 continue;
3826 if (!sas_info->is_logical_volume) {
3827 sas_device.handle = 0;
3828 retry_count = 0;
3829retry_page:
3830 retval = mptsas_sas_device_pg0(ioc, &sas_device,
3831 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID
3832 << MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
3833 (sas_info->fw.channel << 8) +
3834 sas_info->fw.id);
3835
3836 if (sas_device.handle)
3837 continue;
3838 if (retval == -EBUSY) {
3839 spin_lock_irqsave(&ioc->taskmgmt_lock, flags);
3840 if (ioc->ioc_reset_in_progress) {
3841 dfailprintk(ioc,
3842 printk(MYIOC_s_DEBUG_FMT
3843 "%s: exiting due to reset\n",
3844 ioc->name, __func__));
3845 spin_unlock_irqrestore
3846 (&ioc->taskmgmt_lock, flags);
3847 mutex_unlock(&ioc->
3848 sas_device_info_mutex);
3849 return;
3850 }
3851 spin_unlock_irqrestore(&ioc->taskmgmt_lock,
3852 flags);
3853 }
3854
3855 if (retval && (retval != -ENODEV)) {
3856 if (retry_count < 10) {
3857 retry_count++;
3858 goto retry_page;
3859 } else {
3860 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
3861 "%s: Config page retry exceeded retry "
3862 "count deleting device 0x%llx\n",
3863 ioc->name, __func__,
3864 sas_info->sas_address));
3865 }
3866 }
3867
3868 /* delete device */
3869 vtarget = mptsas_find_vtarget(ioc,
3870 sas_info->fw.channel, sas_info->fw.id);
3871
3872 if (vtarget)
3873 vtarget->deleted = 1;
3874
3875 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
3876 sas_info->sas_address);
3877
3878 mptsas_del_end_device(ioc, phy_info);
3879 goto redo_device_scan;
3880 } else
3881 mptsas_volume_delete(ioc, sas_info->fw.id);
3882 }
3883 mutex_unlock(&ioc->sas_device_info_mutex);
3884
3885 /* expanders */
3886 mutex_lock(&ioc->sas_topology_mutex);
3887 redo_expander_scan:
3888 list_for_each_entry(port_info, &ioc->sas_topology, list) {
3889
3890 if (!(port_info->phy_info[0].identify.device_info &
3891 MPI_SAS_DEVICE_INFO_SMP_TARGET))
3892 continue;
3893 found_expander = 0;
3894 handle = 0xFFFF;
3895 while (!mptsas_sas_expander_pg0(ioc, &buffer,
3896 (MPI_SAS_EXPAND_PGAD_FORM_GET_NEXT_HANDLE <<
3897 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle) &&
3898 !found_expander) {
3899
3900 handle = buffer.phy_info[0].handle;
3901 if (buffer.phy_info[0].identify.sas_address ==
3902 port_info->phy_info[0].identify.sas_address) {
3903 found_expander = 1;
3904 }
3905 kfree(buffer.phy_info);
3906 }
3907
3908 if (!found_expander) {
3909 mptsas_expander_delete(ioc, port_info, 0);
3910 goto redo_expander_scan;
3911 }
3912 }
3913 mutex_unlock(&ioc->sas_topology_mutex);
3914}
3915
3916/**
3917 * mptsas_probe_expanders - adding expanders
3918 * @ioc: Pointer to MPT_ADAPTER structure
3919 *
3920 **/
3921static void
3922mptsas_probe_expanders(MPT_ADAPTER *ioc)
3923{
3924 struct mptsas_portinfo buffer, *port_info;
3925 u32 handle;
3926 int i;
3927
3928 handle = 0xFFFF;
3929 while (!mptsas_sas_expander_pg0(ioc, &buffer,
3930 (MPI_SAS_EXPAND_PGAD_FORM_GET_NEXT_HANDLE <<
3931 MPI_SAS_EXPAND_PGAD_FORM_SHIFT), handle)) {
3932
3933 handle = buffer.phy_info[0].handle;
3934 port_info = mptsas_find_portinfo_by_sas_address(ioc,
3935 buffer.phy_info[0].identify.sas_address);
3936
3937 if (port_info) {
3938 /* refreshing handles */
3939 for (i = 0; i < buffer.num_phys; i++) {
3940 port_info->phy_info[i].handle = handle;
3941 port_info->phy_info[i].identify.handle_parent =
3942 buffer.phy_info[0].identify.handle_parent;
3943 }
3944 mptsas_expander_refresh(ioc, port_info);
3945 kfree(buffer.phy_info);
3946 continue;
3947 }
3948
3949 port_info = kzalloc(sizeof(struct mptsas_portinfo), GFP_KERNEL);
3950 if (!port_info) {
3951 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
3952 "%s: exit at line=%d\n", ioc->name,
3953 __func__, __LINE__));
3954 return;
3955 }
3956 port_info->num_phys = buffer.num_phys;
3957 port_info->phy_info = buffer.phy_info;
3958 for (i = 0; i < port_info->num_phys; i++)
3959 port_info->phy_info[i].portinfo = port_info;
3960 mutex_lock(&ioc->sas_topology_mutex);
3961 list_add_tail(&port_info->list, &ioc->sas_topology);
3962 mutex_unlock(&ioc->sas_topology_mutex);
3963 printk(MYIOC_s_INFO_FMT "add expander: num_phys %d, "
3964 "sas_addr (0x%llx)\n", ioc->name, port_info->num_phys,
3965 (unsigned long long)buffer.phy_info[0].identify.sas_address);
3966 mptsas_expander_refresh(ioc, port_info);
3967 }
3968}
3969
3970static void
3971mptsas_probe_devices(MPT_ADAPTER *ioc)
3972{
3973 u16 handle;
3974 struct mptsas_devinfo sas_device;
3975 struct mptsas_phyinfo *phy_info;
3976
3977 handle = 0xFFFF;
3978 while (!(mptsas_sas_device_pg0(ioc, &sas_device,
3979 MPI_SAS_DEVICE_PGAD_FORM_GET_NEXT_HANDLE, handle))) {
3980
3981 handle = sas_device.handle;
3982
3983 if ((sas_device.device_info &
3984 (MPI_SAS_DEVICE_INFO_SSP_TARGET |
3985 MPI_SAS_DEVICE_INFO_STP_TARGET |
3986 MPI_SAS_DEVICE_INFO_SATA_DEVICE)) == 0)
3987 continue;
3988
3989 /* If there is no FW B_T mapping for this device then continue
3990 * */
3991 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
3992 || !(sas_device.flags &
3993 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
3994 continue;
3995
3996 phy_info = mptsas_refreshing_device_handles(ioc, &sas_device);
3997 if (!phy_info)
3998 continue;
3999
4000 if (mptsas_get_rphy(phy_info))
4001 continue;
4002
4003 mptsas_add_end_device(ioc, phy_info);
4004 }
4005}
4006
4007/**
4008 * mptsas_scan_sas_topology - scans new SAS topology
4009 * (part of probe or rescan)
4010 * @ioc: Pointer to MPT_ADAPTER structure
4011 *
4012 **/
4013static void
4014mptsas_scan_sas_topology(MPT_ADAPTER *ioc)
4015{
4016 struct scsi_device *sdev;
4017 int i;
4018
4019 mptsas_probe_hba_phys(ioc);
4020 mptsas_probe_expanders(ioc);
4021 mptsas_probe_devices(ioc);
4022
4023 /*
4024 Reporting RAID volumes.
4025 */
4026 if (!ioc->ir_firmware || !ioc->raid_data.pIocPg2 ||
4027 !ioc->raid_data.pIocPg2->NumActiveVolumes)
4028 return;
4029 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
4030 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
4031 ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID, 0);
4032 if (sdev) {
4033 scsi_device_put(sdev);
4034 continue;
4035 }
4036 printk(MYIOC_s_INFO_FMT "attaching raid volume, channel %d, "
4037 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4038 ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID);
4039 scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL,
4040 ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID, 0);
4041 }
4042}
4043
4044
4045static void
4046mptsas_handle_queue_full_event(struct fw_event_work *fw_event)
4047{
4048 MPT_ADAPTER *ioc;
4049 EventDataQueueFull_t *qfull_data;
4050 struct mptsas_device_info *sas_info;
4051 struct scsi_device *sdev;
4052 int depth;
4053 int id = -1;
4054 int channel = -1;
4055 int fw_id, fw_channel;
4056 u16 current_depth;
4057
4058
4059 ioc = fw_event->ioc;
4060 qfull_data = (EventDataQueueFull_t *)fw_event->event_data;
4061 fw_id = qfull_data->TargetID;
4062 fw_channel = qfull_data->Bus;
4063 current_depth = le16_to_cpu(qfull_data->CurrentDepth);
4064
4065 /* if hidden raid component, look for the volume id */
4066 mutex_lock(&ioc->sas_device_info_mutex);
4067 if (mptscsih_is_phys_disk(ioc, fw_channel, fw_id)) {
4068 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
4069 list) {
4070 if (sas_info->is_cached ||
4071 sas_info->is_logical_volume)
4072 continue;
4073 if (sas_info->is_hidden_raid_component &&
4074 (sas_info->fw.channel == fw_channel &&
4075 sas_info->fw.id == fw_id)) {
4076 id = sas_info->volume_id;
4077 channel = MPTSAS_RAID_CHANNEL;
4078 goto out;
4079 }
4080 }
4081 } else {
4082 list_for_each_entry(sas_info, &ioc->sas_device_info_list,
4083 list) {
4084 if (sas_info->is_cached ||
4085 sas_info->is_hidden_raid_component ||
4086 sas_info->is_logical_volume)
4087 continue;
4088 if (sas_info->fw.channel == fw_channel &&
4089 sas_info->fw.id == fw_id) {
4090 id = sas_info->os.id;
4091 channel = sas_info->os.channel;
4092 goto out;
4093 }
4094 }
4095
4096 }
4097
4098 out:
4099 mutex_unlock(&ioc->sas_device_info_mutex);
4100
4101 if (id != -1) {
4102 shost_for_each_device(sdev, ioc->sh) {
4103 if (sdev->id == id && sdev->channel == channel) {
4104 if (current_depth > sdev->queue_depth) {
4105 sdev_printk(KERN_INFO, sdev,
4106 "strange observation, the queue "
4107 "depth is (%d) meanwhile fw queue "
4108 "depth (%d)\n", sdev->queue_depth,
4109 current_depth);
4110 continue;
4111 }
4112 depth = scsi_track_queue_full(sdev,
4113 sdev->queue_depth - 1);
4114 if (depth > 0)
4115 sdev_printk(KERN_INFO, sdev,
4116 "Queue depth reduced to (%d)\n",
4117 depth);
4118 else if (depth < 0)
4119 sdev_printk(KERN_INFO, sdev,
4120 "Tagged Command Queueing is being "
4121 "disabled\n");
4122 else if (depth == 0)
4123 sdev_printk(KERN_DEBUG, sdev,
4124 "Queue depth not changed yet\n");
4125 }
4126 }
4127 }
4128
4129 mptsas_free_fw_event(ioc, fw_event);
4130}
4131
4132
4133static struct mptsas_phyinfo *
4134mptsas_find_phyinfo_by_sas_address(MPT_ADAPTER *ioc, u64 sas_address)
4135{
4136 struct mptsas_portinfo *port_info;
4137 struct mptsas_phyinfo *phy_info = NULL;
4138 int i;
4139
4140 mutex_lock(&ioc->sas_topology_mutex);
4141 list_for_each_entry(port_info, &ioc->sas_topology, list) {
4142 for (i = 0; i < port_info->num_phys; i++) {
4143 if (!mptsas_is_end_device(
4144 &port_info->phy_info[i].attached))
4145 continue;
4146 if (port_info->phy_info[i].attached.sas_address
4147 != sas_address)
4148 continue;
4149 phy_info = &port_info->phy_info[i];
4150 break;
4151 }
4152 }
4153 mutex_unlock(&ioc->sas_topology_mutex);
4154 return phy_info;
4155}
4156
4157/**
4158 * mptsas_find_phyinfo_by_phys_disk_num - find phyinfo for the
4159 * specified @phys_disk_num
4160 * @ioc: Pointer to MPT_ADAPTER structure
4161 * @phys_disk_num: (hot plug) physical disk number (for RAID support)
4162 * @channel: channel number
4163 * @id: Logical Target ID
4164 *
4165 **/
4166static struct mptsas_phyinfo *
4167mptsas_find_phyinfo_by_phys_disk_num(MPT_ADAPTER *ioc, u8 phys_disk_num,
4168 u8 channel, u8 id)
4169{
4170 struct mptsas_phyinfo *phy_info = NULL;
4171 struct mptsas_portinfo *port_info;
4172 RaidPhysDiskPage1_t *phys_disk = NULL;
4173 int num_paths;
4174 u64 sas_address = 0;
4175 int i;
4176
4177 phy_info = NULL;
4178 if (!ioc->raid_data.pIocPg3)
4179 return NULL;
4180 /* dual port support */
4181 num_paths = mpt_raid_phys_disk_get_num_paths(ioc, phys_disk_num);
4182 if (!num_paths)
4183 goto out;
4184 phys_disk = kzalloc(offsetof(RaidPhysDiskPage1_t, Path) +
4185 (num_paths * sizeof(RAID_PHYS_DISK1_PATH)), GFP_KERNEL);
4186 if (!phys_disk)
4187 goto out;
4188 mpt_raid_phys_disk_pg1(ioc, phys_disk_num, phys_disk);
4189 for (i = 0; i < num_paths; i++) {
4190 if ((phys_disk->Path[i].Flags & 1) != 0)
4191 /* entry no longer valid */
4192 continue;
4193 if ((id == phys_disk->Path[i].PhysDiskID) &&
4194 (channel == phys_disk->Path[i].PhysDiskBus)) {
4195 memcpy(&sas_address, &phys_disk->Path[i].WWID,
4196 sizeof(u64));
4197 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4198 sas_address);
4199 goto out;
4200 }
4201 }
4202
4203 out:
4204 kfree(phys_disk);
4205 if (phy_info)
4206 return phy_info;
4207
4208 /*
4209 * Extra code to handle RAID0 case, where the sas_address is not updated
4210 * in phys_disk_page_1 when hotswapped
4211 */
4212 mutex_lock(&ioc->sas_topology_mutex);
4213 list_for_each_entry(port_info, &ioc->sas_topology, list) {
4214 for (i = 0; i < port_info->num_phys && !phy_info; i++) {
4215 if (!mptsas_is_end_device(
4216 &port_info->phy_info[i].attached))
4217 continue;
4218 if (port_info->phy_info[i].attached.phys_disk_num == ~0)
4219 continue;
4220 if ((port_info->phy_info[i].attached.phys_disk_num ==
4221 phys_disk_num) &&
4222 (port_info->phy_info[i].attached.id == id) &&
4223 (port_info->phy_info[i].attached.channel ==
4224 channel))
4225 phy_info = &port_info->phy_info[i];
4226 }
4227 }
4228 mutex_unlock(&ioc->sas_topology_mutex);
4229 return phy_info;
4230}
4231
4232static void
4233mptsas_reprobe_lun(struct scsi_device *sdev, void *data)
4234{
4235 int rc;
4236
4237 sdev->no_uld_attach = data ? 1 : 0;
4238 rc = scsi_device_reprobe(sdev);
4239}
4240
4241static void
4242mptsas_reprobe_target(struct scsi_target *starget, int uld_attach)
4243{
4244 starget_for_each_device(starget, uld_attach ? (void *)1 : NULL,
4245 mptsas_reprobe_lun);
4246}
4247
4248static void
4249mptsas_adding_inactive_raid_components(MPT_ADAPTER *ioc, u8 channel, u8 id)
4250{
4251 CONFIGPARMS cfg;
4252 ConfigPageHeader_t hdr;
4253 dma_addr_t dma_handle;
4254 pRaidVolumePage0_t buffer = NULL;
4255 RaidPhysDiskPage0_t phys_disk;
4256 int i;
4257 struct mptsas_phyinfo *phy_info;
4258 struct mptsas_devinfo sas_device;
4259
4260 memset(&cfg, 0 , sizeof(CONFIGPARMS));
4261 memset(&hdr, 0 , sizeof(ConfigPageHeader_t));
4262 hdr.PageType = MPI_CONFIG_PAGETYPE_RAID_VOLUME;
4263 cfg.pageAddr = (channel << 8) + id;
4264 cfg.cfghdr.hdr = &hdr;
4265 cfg.action = MPI_CONFIG_ACTION_PAGE_HEADER;
4266 cfg.timeout = SAS_CONFIG_PAGE_TIMEOUT;
4267
4268 if (mpt_config(ioc, &cfg) != 0)
4269 goto out;
4270
4271 if (!hdr.PageLength)
4272 goto out;
4273
4274 buffer = pci_alloc_consistent(ioc->pcidev, hdr.PageLength * 4,
4275 &dma_handle);
4276
4277 if (!buffer)
4278 goto out;
4279
4280 cfg.physAddr = dma_handle;
4281 cfg.action = MPI_CONFIG_ACTION_PAGE_READ_CURRENT;
4282
4283 if (mpt_config(ioc, &cfg) != 0)
4284 goto out;
4285
4286 if (!(buffer->VolumeStatus.Flags &
4287 MPI_RAIDVOL0_STATUS_FLAG_VOLUME_INACTIVE))
4288 goto out;
4289
4290 if (!buffer->NumPhysDisks)
4291 goto out;
4292
4293 for (i = 0; i < buffer->NumPhysDisks; i++) {
4294
4295 if (mpt_raid_phys_disk_pg0(ioc,
4296 buffer->PhysDisk[i].PhysDiskNum, &phys_disk) != 0)
4297 continue;
4298
4299 if (mptsas_sas_device_pg0(ioc, &sas_device,
4300 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4301 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4302 (phys_disk.PhysDiskBus << 8) +
4303 phys_disk.PhysDiskID))
4304 continue;
4305
4306 /* If there is no FW B_T mapping for this device then continue
4307 * */
4308 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4309 || !(sas_device.flags &
4310 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4311 continue;
4312
4313
4314 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4315 sas_device.sas_address);
4316 mptsas_add_end_device(ioc, phy_info);
4317 }
4318
4319 out:
4320 if (buffer)
4321 pci_free_consistent(ioc->pcidev, hdr.PageLength * 4, buffer,
4322 dma_handle);
4323}
4324/*
4325 * Work queue thread to handle SAS hotplug events
4326 */
4327static void
4328mptsas_hotplug_work(MPT_ADAPTER *ioc, struct fw_event_work *fw_event,
4329 struct mptsas_hotplug_event *hot_plug_info)
4330{
4331 struct mptsas_phyinfo *phy_info;
4332 struct scsi_target * starget;
4333 struct mptsas_devinfo sas_device;
4334 VirtTarget *vtarget;
4335 int i;
4336 struct mptsas_portinfo *port_info;
4337
4338 switch (hot_plug_info->event_type) {
4339
4340 case MPTSAS_ADD_PHYSDISK:
4341
4342 if (!ioc->raid_data.pIocPg2)
4343 break;
4344
4345 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++) {
4346 if (ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID ==
4347 hot_plug_info->id) {
4348 printk(MYIOC_s_WARN_FMT "firmware bug: unable "
4349 "to add hidden disk - target_id matches "
4350 "volume_id\n", ioc->name);
4351 mptsas_free_fw_event(ioc, fw_event);
4352 return;
4353 }
4354 }
4355 mpt_findImVolumes(ioc);
4356 fallthrough;
4357
4358 case MPTSAS_ADD_DEVICE:
4359 memset(&sas_device, 0, sizeof(struct mptsas_devinfo));
4360 mptsas_sas_device_pg0(ioc, &sas_device,
4361 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4362 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4363 (hot_plug_info->channel << 8) +
4364 hot_plug_info->id);
4365
4366 /* If there is no FW B_T mapping for this device then break
4367 * */
4368 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4369 || !(sas_device.flags &
4370 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4371 break;
4372
4373 if (!sas_device.handle)
4374 return;
4375
4376 phy_info = mptsas_refreshing_device_handles(ioc, &sas_device);
4377 /* Device hot plug */
4378 if (!phy_info) {
4379 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4380 "%s %d HOT PLUG: "
4381 "parent handle of device %x\n", ioc->name,
4382 __func__, __LINE__, sas_device.handle_parent));
4383 port_info = mptsas_find_portinfo_by_handle(ioc,
4384 sas_device.handle_parent);
4385
4386 if (port_info == ioc->hba_port_info)
4387 mptsas_probe_hba_phys(ioc);
4388 else if (port_info)
4389 mptsas_expander_refresh(ioc, port_info);
4390 else {
4391 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4392 "%s %d port info is NULL\n",
4393 ioc->name, __func__, __LINE__));
4394 break;
4395 }
4396 phy_info = mptsas_refreshing_device_handles
4397 (ioc, &sas_device);
4398 }
4399
4400 if (!phy_info) {
4401 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4402 "%s %d phy info is NULL\n",
4403 ioc->name, __func__, __LINE__));
4404 break;
4405 }
4406
4407 if (mptsas_get_rphy(phy_info))
4408 break;
4409
4410 mptsas_add_end_device(ioc, phy_info);
4411 break;
4412
4413 case MPTSAS_DEL_DEVICE:
4414 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4415 hot_plug_info->sas_address);
4416 mptsas_del_end_device(ioc, phy_info);
4417 break;
4418
4419 case MPTSAS_DEL_PHYSDISK:
4420
4421 mpt_findImVolumes(ioc);
4422
4423 phy_info = mptsas_find_phyinfo_by_phys_disk_num(
4424 ioc, hot_plug_info->phys_disk_num,
4425 hot_plug_info->channel,
4426 hot_plug_info->id);
4427 mptsas_del_end_device(ioc, phy_info);
4428 break;
4429
4430 case MPTSAS_ADD_PHYSDISK_REPROBE:
4431
4432 if (mptsas_sas_device_pg0(ioc, &sas_device,
4433 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4434 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4435 (hot_plug_info->channel << 8) + hot_plug_info->id)) {
4436 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4437 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4438 __func__, hot_plug_info->id, __LINE__));
4439 break;
4440 }
4441
4442 /* If there is no FW B_T mapping for this device then break
4443 * */
4444 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4445 || !(sas_device.flags &
4446 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4447 break;
4448
4449 phy_info = mptsas_find_phyinfo_by_sas_address(
4450 ioc, sas_device.sas_address);
4451
4452 if (!phy_info) {
4453 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4454 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4455 __func__, hot_plug_info->id, __LINE__));
4456 break;
4457 }
4458
4459 starget = mptsas_get_starget(phy_info);
4460 if (!starget) {
4461 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4462 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4463 __func__, hot_plug_info->id, __LINE__));
4464 break;
4465 }
4466
4467 vtarget = starget->hostdata;
4468 if (!vtarget) {
4469 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4470 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4471 __func__, hot_plug_info->id, __LINE__));
4472 break;
4473 }
4474
4475 mpt_findImVolumes(ioc);
4476
4477 starget_printk(KERN_INFO, starget, MYIOC_s_FMT "RAID Hidding: "
4478 "fw_channel=%d, fw_id=%d, physdsk %d, sas_addr 0x%llx\n",
4479 ioc->name, hot_plug_info->channel, hot_plug_info->id,
4480 hot_plug_info->phys_disk_num, (unsigned long long)
4481 sas_device.sas_address);
4482
4483 vtarget->id = hot_plug_info->phys_disk_num;
4484 vtarget->tflags |= MPT_TARGET_FLAGS_RAID_COMPONENT;
4485 phy_info->attached.phys_disk_num = hot_plug_info->phys_disk_num;
4486 mptsas_reprobe_target(starget, 1);
4487 break;
4488
4489 case MPTSAS_DEL_PHYSDISK_REPROBE:
4490
4491 if (mptsas_sas_device_pg0(ioc, &sas_device,
4492 (MPI_SAS_DEVICE_PGAD_FORM_BUS_TARGET_ID <<
4493 MPI_SAS_DEVICE_PGAD_FORM_SHIFT),
4494 (hot_plug_info->channel << 8) + hot_plug_info->id)) {
4495 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4496 "%s: fw_id=%d exit at line=%d\n",
4497 ioc->name, __func__,
4498 hot_plug_info->id, __LINE__));
4499 break;
4500 }
4501
4502 /* If there is no FW B_T mapping for this device then break
4503 * */
4504 if (!(sas_device.flags & MPI_SAS_DEVICE0_FLAGS_DEVICE_PRESENT)
4505 || !(sas_device.flags &
4506 MPI_SAS_DEVICE0_FLAGS_DEVICE_MAPPED))
4507 break;
4508
4509 phy_info = mptsas_find_phyinfo_by_sas_address(ioc,
4510 sas_device.sas_address);
4511 if (!phy_info) {
4512 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4513 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4514 __func__, hot_plug_info->id, __LINE__));
4515 break;
4516 }
4517
4518 starget = mptsas_get_starget(phy_info);
4519 if (!starget) {
4520 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4521 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4522 __func__, hot_plug_info->id, __LINE__));
4523 break;
4524 }
4525
4526 vtarget = starget->hostdata;
4527 if (!vtarget) {
4528 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4529 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4530 __func__, hot_plug_info->id, __LINE__));
4531 break;
4532 }
4533
4534 if (!(vtarget->tflags & MPT_TARGET_FLAGS_RAID_COMPONENT)) {
4535 dfailprintk(ioc, printk(MYIOC_s_ERR_FMT
4536 "%s: fw_id=%d exit at line=%d\n", ioc->name,
4537 __func__, hot_plug_info->id, __LINE__));
4538 break;
4539 }
4540
4541 mpt_findImVolumes(ioc);
4542
4543 starget_printk(KERN_INFO, starget, MYIOC_s_FMT "RAID Exposing:"
4544 " fw_channel=%d, fw_id=%d, physdsk %d, sas_addr 0x%llx\n",
4545 ioc->name, hot_plug_info->channel, hot_plug_info->id,
4546 hot_plug_info->phys_disk_num, (unsigned long long)
4547 sas_device.sas_address);
4548
4549 vtarget->tflags &= ~MPT_TARGET_FLAGS_RAID_COMPONENT;
4550 vtarget->id = hot_plug_info->id;
4551 phy_info->attached.phys_disk_num = ~0;
4552 mptsas_reprobe_target(starget, 0);
4553 mptsas_add_device_component_by_fw(ioc,
4554 hot_plug_info->channel, hot_plug_info->id);
4555 break;
4556
4557 case MPTSAS_ADD_RAID:
4558
4559 mpt_findImVolumes(ioc);
4560 printk(MYIOC_s_INFO_FMT "attaching raid volume, channel %d, "
4561 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4562 hot_plug_info->id);
4563 scsi_add_device(ioc->sh, MPTSAS_RAID_CHANNEL,
4564 hot_plug_info->id, 0);
4565 break;
4566
4567 case MPTSAS_DEL_RAID:
4568
4569 mpt_findImVolumes(ioc);
4570 printk(MYIOC_s_INFO_FMT "removing raid volume, channel %d, "
4571 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL,
4572 hot_plug_info->id);
4573 scsi_remove_device(hot_plug_info->sdev);
4574 scsi_device_put(hot_plug_info->sdev);
4575 break;
4576
4577 case MPTSAS_ADD_INACTIVE_VOLUME:
4578
4579 mpt_findImVolumes(ioc);
4580 mptsas_adding_inactive_raid_components(ioc,
4581 hot_plug_info->channel, hot_plug_info->id);
4582 break;
4583
4584 default:
4585 break;
4586 }
4587
4588 mptsas_free_fw_event(ioc, fw_event);
4589}
4590
4591static void
4592mptsas_send_sas_event(struct fw_event_work *fw_event)
4593{
4594 MPT_ADAPTER *ioc;
4595 struct mptsas_hotplug_event hot_plug_info;
4596 EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data;
4597 u32 device_info;
4598 u64 sas_address;
4599
4600 ioc = fw_event->ioc;
4601 sas_event_data = (EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *)
4602 fw_event->event_data;
4603 device_info = le32_to_cpu(sas_event_data->DeviceInfo);
4604
4605 if ((device_info &
4606 (MPI_SAS_DEVICE_INFO_SSP_TARGET |
4607 MPI_SAS_DEVICE_INFO_STP_TARGET |
4608 MPI_SAS_DEVICE_INFO_SATA_DEVICE)) == 0) {
4609 mptsas_free_fw_event(ioc, fw_event);
4610 return;
4611 }
4612
4613 if (sas_event_data->ReasonCode ==
4614 MPI_EVENT_SAS_DEV_STAT_RC_NO_PERSIST_ADDED) {
4615 mptbase_sas_persist_operation(ioc,
4616 MPI_SAS_OP_CLEAR_NOT_PRESENT);
4617 mptsas_free_fw_event(ioc, fw_event);
4618 return;
4619 }
4620
4621 switch (sas_event_data->ReasonCode) {
4622 case MPI_EVENT_SAS_DEV_STAT_RC_NOT_RESPONDING:
4623 case MPI_EVENT_SAS_DEV_STAT_RC_ADDED:
4624 memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4625 hot_plug_info.handle = le16_to_cpu(sas_event_data->DevHandle);
4626 hot_plug_info.channel = sas_event_data->Bus;
4627 hot_plug_info.id = sas_event_data->TargetID;
4628 hot_plug_info.phy_id = sas_event_data->PhyNum;
4629 memcpy(&sas_address, &sas_event_data->SASAddress,
4630 sizeof(u64));
4631 hot_plug_info.sas_address = le64_to_cpu(sas_address);
4632 hot_plug_info.device_info = device_info;
4633 if (sas_event_data->ReasonCode &
4634 MPI_EVENT_SAS_DEV_STAT_RC_ADDED)
4635 hot_plug_info.event_type = MPTSAS_ADD_DEVICE;
4636 else
4637 hot_plug_info.event_type = MPTSAS_DEL_DEVICE;
4638 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4639 break;
4640
4641 case MPI_EVENT_SAS_DEV_STAT_RC_NO_PERSIST_ADDED:
4642 mptbase_sas_persist_operation(ioc,
4643 MPI_SAS_OP_CLEAR_NOT_PRESENT);
4644 mptsas_free_fw_event(ioc, fw_event);
4645 break;
4646
4647 case MPI_EVENT_SAS_DEV_STAT_RC_SMART_DATA:
4648 /* TODO */
4649 case MPI_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET:
4650 /* TODO */
4651 default:
4652 mptsas_free_fw_event(ioc, fw_event);
4653 break;
4654 }
4655}
4656
4657static void
4658mptsas_send_raid_event(struct fw_event_work *fw_event)
4659{
4660 MPT_ADAPTER *ioc;
4661 EVENT_DATA_RAID *raid_event_data;
4662 struct mptsas_hotplug_event hot_plug_info;
4663 int status;
4664 int state;
4665 struct scsi_device *sdev = NULL;
4666 VirtDevice *vdevice = NULL;
4667 RaidPhysDiskPage0_t phys_disk;
4668
4669 ioc = fw_event->ioc;
4670 raid_event_data = (EVENT_DATA_RAID *)fw_event->event_data;
4671 status = le32_to_cpu(raid_event_data->SettingsStatus);
4672 state = (status >> 8) & 0xff;
4673
4674 memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4675 hot_plug_info.id = raid_event_data->VolumeID;
4676 hot_plug_info.channel = raid_event_data->VolumeBus;
4677 hot_plug_info.phys_disk_num = raid_event_data->PhysDiskNum;
4678
4679 if (raid_event_data->ReasonCode == MPI_EVENT_RAID_RC_VOLUME_DELETED ||
4680 raid_event_data->ReasonCode == MPI_EVENT_RAID_RC_VOLUME_CREATED ||
4681 raid_event_data->ReasonCode ==
4682 MPI_EVENT_RAID_RC_VOLUME_STATUS_CHANGED) {
4683 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL,
4684 hot_plug_info.id, 0);
4685 hot_plug_info.sdev = sdev;
4686 if (sdev)
4687 vdevice = sdev->hostdata;
4688 }
4689
4690 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Entering %s: "
4691 "ReasonCode=%02x\n", ioc->name, __func__,
4692 raid_event_data->ReasonCode));
4693
4694 switch (raid_event_data->ReasonCode) {
4695 case MPI_EVENT_RAID_RC_PHYSDISK_DELETED:
4696 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK_REPROBE;
4697 break;
4698 case MPI_EVENT_RAID_RC_PHYSDISK_CREATED:
4699 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK_REPROBE;
4700 break;
4701 case MPI_EVENT_RAID_RC_PHYSDISK_STATUS_CHANGED:
4702 switch (state) {
4703 case MPI_PD_STATE_ONLINE:
4704 case MPI_PD_STATE_NOT_COMPATIBLE:
4705 mpt_raid_phys_disk_pg0(ioc,
4706 raid_event_data->PhysDiskNum, &phys_disk);
4707 hot_plug_info.id = phys_disk.PhysDiskID;
4708 hot_plug_info.channel = phys_disk.PhysDiskBus;
4709 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK;
4710 break;
4711 case MPI_PD_STATE_FAILED:
4712 case MPI_PD_STATE_MISSING:
4713 case MPI_PD_STATE_OFFLINE_AT_HOST_REQUEST:
4714 case MPI_PD_STATE_FAILED_AT_HOST_REQUEST:
4715 case MPI_PD_STATE_OFFLINE_FOR_ANOTHER_REASON:
4716 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK;
4717 break;
4718 default:
4719 break;
4720 }
4721 break;
4722 case MPI_EVENT_RAID_RC_VOLUME_DELETED:
4723 if (!sdev)
4724 break;
4725 vdevice->vtarget->deleted = 1; /* block IO */
4726 hot_plug_info.event_type = MPTSAS_DEL_RAID;
4727 break;
4728 case MPI_EVENT_RAID_RC_VOLUME_CREATED:
4729 if (sdev) {
4730 scsi_device_put(sdev);
4731 break;
4732 }
4733 hot_plug_info.event_type = MPTSAS_ADD_RAID;
4734 break;
4735 case MPI_EVENT_RAID_RC_VOLUME_STATUS_CHANGED:
4736 if (!(status & MPI_RAIDVOL0_STATUS_FLAG_ENABLED)) {
4737 if (!sdev)
4738 break;
4739 vdevice->vtarget->deleted = 1; /* block IO */
4740 hot_plug_info.event_type = MPTSAS_DEL_RAID;
4741 break;
4742 }
4743 switch (state) {
4744 case MPI_RAIDVOL0_STATUS_STATE_FAILED:
4745 case MPI_RAIDVOL0_STATUS_STATE_MISSING:
4746 if (!sdev)
4747 break;
4748 vdevice->vtarget->deleted = 1; /* block IO */
4749 hot_plug_info.event_type = MPTSAS_DEL_RAID;
4750 break;
4751 case MPI_RAIDVOL0_STATUS_STATE_OPTIMAL:
4752 case MPI_RAIDVOL0_STATUS_STATE_DEGRADED:
4753 if (sdev) {
4754 scsi_device_put(sdev);
4755 break;
4756 }
4757 hot_plug_info.event_type = MPTSAS_ADD_RAID;
4758 break;
4759 default:
4760 break;
4761 }
4762 break;
4763 default:
4764 break;
4765 }
4766
4767 if (hot_plug_info.event_type != MPTSAS_IGNORE_EVENT)
4768 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4769 else
4770 mptsas_free_fw_event(ioc, fw_event);
4771}
4772
4773/**
4774 * mptsas_issue_tm - send mptsas internal tm request
4775 * @ioc: Pointer to MPT_ADAPTER structure
4776 * @type: Task Management type
4777 * @channel: channel number for task management
4778 * @id: Logical Target ID for reset (if appropriate)
4779 * @lun: Logical unit for reset (if appropriate)
4780 * @task_context: Context for the task to be aborted
4781 * @timeout: timeout for task management control
4782 * @issue_reset: set to 1 on return if reset is needed, else 0
4783 *
4784 * Return: 0 on success or -1 on failure.
4785 *
4786 */
4787static int
4788mptsas_issue_tm(MPT_ADAPTER *ioc, u8 type, u8 channel, u8 id, u64 lun,
4789 int task_context, ulong timeout, u8 *issue_reset)
4790{
4791 MPT_FRAME_HDR *mf;
4792 SCSITaskMgmt_t *pScsiTm;
4793 int retval;
4794 unsigned long timeleft;
4795
4796 *issue_reset = 0;
4797 mf = mpt_get_msg_frame(mptsasDeviceResetCtx, ioc);
4798 if (mf == NULL) {
4799 retval = -1; /* return failure */
4800 dtmprintk(ioc, printk(MYIOC_s_WARN_FMT "TaskMgmt request: no "
4801 "msg frames!!\n", ioc->name));
4802 goto out;
4803 }
4804
4805 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT "TaskMgmt request: mr = %p, "
4806 "task_type = 0x%02X,\n\t timeout = %ld, fw_channel = %d, "
4807 "fw_id = %d, lun = %lld,\n\t task_context = 0x%x\n", ioc->name, mf,
4808 type, timeout, channel, id, (unsigned long long)lun,
4809 task_context));
4810
4811 pScsiTm = (SCSITaskMgmt_t *) mf;
4812 memset(pScsiTm, 0, sizeof(SCSITaskMgmt_t));
4813 pScsiTm->Function = MPI_FUNCTION_SCSI_TASK_MGMT;
4814 pScsiTm->TaskType = type;
4815 pScsiTm->MsgFlags = 0;
4816 pScsiTm->TargetID = id;
4817 pScsiTm->Bus = channel;
4818 pScsiTm->ChainOffset = 0;
4819 pScsiTm->Reserved = 0;
4820 pScsiTm->Reserved1 = 0;
4821 pScsiTm->TaskMsgContext = task_context;
4822 int_to_scsilun(lun, (struct scsi_lun *)pScsiTm->LUN);
4823
4824 INITIALIZE_MGMT_STATUS(ioc->taskmgmt_cmds.status)
4825 CLEAR_MGMT_STATUS(ioc->internal_cmds.status)
4826 retval = 0;
4827 mpt_put_msg_frame_hi_pri(mptsasDeviceResetCtx, ioc, mf);
4828
4829 /* Now wait for the command to complete */
4830 timeleft = wait_for_completion_timeout(&ioc->taskmgmt_cmds.done,
4831 timeout*HZ);
4832 if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_COMMAND_GOOD)) {
4833 retval = -1; /* return failure */
4834 dtmprintk(ioc, printk(MYIOC_s_ERR_FMT
4835 "TaskMgmt request: TIMED OUT!(mr=%p)\n", ioc->name, mf));
4836 mpt_free_msg_frame(ioc, mf);
4837 if (ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_DID_IOCRESET)
4838 goto out;
4839 *issue_reset = 1;
4840 goto out;
4841 }
4842
4843 if (!(ioc->taskmgmt_cmds.status & MPT_MGMT_STATUS_RF_VALID)) {
4844 retval = -1; /* return failure */
4845 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4846 "TaskMgmt request: failed with no reply\n", ioc->name));
4847 goto out;
4848 }
4849
4850 out:
4851 CLEAR_MGMT_STATUS(ioc->taskmgmt_cmds.status)
4852 return retval;
4853}
4854
4855/**
4856 * mptsas_broadcast_primitive_work - Handle broadcast primitives
4857 * @fw_event: work queue payload containing info describing the event
4858 *
4859 * This will be handled in workqueue context.
4860 */
4861static void
4862mptsas_broadcast_primitive_work(struct fw_event_work *fw_event)
4863{
4864 MPT_ADAPTER *ioc = fw_event->ioc;
4865 MPT_FRAME_HDR *mf;
4866 VirtDevice *vdevice;
4867 int ii;
4868 struct scsi_cmnd *sc;
4869 SCSITaskMgmtReply_t *pScsiTmReply;
4870 u8 issue_reset;
4871 int task_context;
4872 u8 channel, id;
4873 int lun;
4874 u32 termination_count;
4875 u32 query_count;
4876
4877 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4878 "%s - enter\n", ioc->name, __func__));
4879
4880 mutex_lock(&ioc->taskmgmt_cmds.mutex);
4881 if (mpt_set_taskmgmt_in_progress_flag(ioc) != 0) {
4882 mutex_unlock(&ioc->taskmgmt_cmds.mutex);
4883 mptsas_requeue_fw_event(ioc, fw_event, 1000);
4884 return;
4885 }
4886
4887 issue_reset = 0;
4888 termination_count = 0;
4889 query_count = 0;
4890 mpt_findImVolumes(ioc);
4891 pScsiTmReply = (SCSITaskMgmtReply_t *) ioc->taskmgmt_cmds.reply;
4892
4893 for (ii = 0; ii < ioc->req_depth; ii++) {
4894 if (ioc->fw_events_off)
4895 goto out;
4896 sc = mptscsih_get_scsi_lookup(ioc, ii);
4897 if (!sc)
4898 continue;
4899 mf = MPT_INDEX_2_MFPTR(ioc, ii);
4900 if (!mf)
4901 continue;
4902 task_context = mf->u.frame.hwhdr.msgctxu.MsgContext;
4903 vdevice = sc->device->hostdata;
4904 if (!vdevice || !vdevice->vtarget)
4905 continue;
4906 if (vdevice->vtarget->tflags & MPT_TARGET_FLAGS_RAID_COMPONENT)
4907 continue; /* skip hidden raid components */
4908 if (vdevice->vtarget->raidVolume)
4909 continue; /* skip hidden raid components */
4910 channel = vdevice->vtarget->channel;
4911 id = vdevice->vtarget->id;
4912 lun = vdevice->lun;
4913 if (mptsas_issue_tm(ioc, MPI_SCSITASKMGMT_TASKTYPE_QUERY_TASK,
4914 channel, id, (u64)lun, task_context, 30, &issue_reset))
4915 goto out;
4916 query_count++;
4917 termination_count +=
4918 le32_to_cpu(pScsiTmReply->TerminationCount);
4919 if ((pScsiTmReply->IOCStatus == MPI_IOCSTATUS_SUCCESS) &&
4920 (pScsiTmReply->ResponseCode ==
4921 MPI_SCSITASKMGMT_RSP_TM_SUCCEEDED ||
4922 pScsiTmReply->ResponseCode ==
4923 MPI_SCSITASKMGMT_RSP_IO_QUEUED_ON_IOC))
4924 continue;
4925 if (mptsas_issue_tm(ioc,
4926 MPI_SCSITASKMGMT_TASKTYPE_ABRT_TASK_SET,
4927 channel, id, (u64)lun, 0, 30, &issue_reset))
4928 goto out;
4929 termination_count +=
4930 le32_to_cpu(pScsiTmReply->TerminationCount);
4931 }
4932
4933 out:
4934 dtmprintk(ioc, printk(MYIOC_s_DEBUG_FMT
4935 "%s - exit, query_count = %d termination_count = %d\n",
4936 ioc->name, __func__, query_count, termination_count));
4937
4938 ioc->broadcast_aen_busy = 0;
4939 mpt_clear_taskmgmt_in_progress_flag(ioc);
4940 mutex_unlock(&ioc->taskmgmt_cmds.mutex);
4941
4942 if (issue_reset) {
4943 printk(MYIOC_s_WARN_FMT
4944 "Issuing Reset from %s!! doorbell=0x%08x\n",
4945 ioc->name, __func__, mpt_GetIocState(ioc, 0));
4946 mpt_Soft_Hard_ResetHandler(ioc, CAN_SLEEP);
4947 }
4948 mptsas_free_fw_event(ioc, fw_event);
4949}
4950
4951/*
4952 * mptsas_send_ir2_event - handle exposing hidden disk when
4953 * an inactive raid volume is added
4954 *
4955 * @ioc: Pointer to MPT_ADAPTER structure
4956 * @ir2_data
4957 *
4958 */
4959static void
4960mptsas_send_ir2_event(struct fw_event_work *fw_event)
4961{
4962 MPT_ADAPTER *ioc;
4963 struct mptsas_hotplug_event hot_plug_info;
4964 MPI_EVENT_DATA_IR2 *ir2_data;
4965 u8 reasonCode;
4966 RaidPhysDiskPage0_t phys_disk;
4967
4968 ioc = fw_event->ioc;
4969 ir2_data = (MPI_EVENT_DATA_IR2 *)fw_event->event_data;
4970 reasonCode = ir2_data->ReasonCode;
4971
4972 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT "Entering %s: "
4973 "ReasonCode=%02x\n", ioc->name, __func__, reasonCode));
4974
4975 memset(&hot_plug_info, 0, sizeof(struct mptsas_hotplug_event));
4976 hot_plug_info.id = ir2_data->TargetID;
4977 hot_plug_info.channel = ir2_data->Bus;
4978 switch (reasonCode) {
4979 case MPI_EVENT_IR2_RC_FOREIGN_CFG_DETECTED:
4980 hot_plug_info.event_type = MPTSAS_ADD_INACTIVE_VOLUME;
4981 break;
4982 case MPI_EVENT_IR2_RC_DUAL_PORT_REMOVED:
4983 hot_plug_info.phys_disk_num = ir2_data->PhysDiskNum;
4984 hot_plug_info.event_type = MPTSAS_DEL_PHYSDISK;
4985 break;
4986 case MPI_EVENT_IR2_RC_DUAL_PORT_ADDED:
4987 hot_plug_info.phys_disk_num = ir2_data->PhysDiskNum;
4988 mpt_raid_phys_disk_pg0(ioc,
4989 ir2_data->PhysDiskNum, &phys_disk);
4990 hot_plug_info.id = phys_disk.PhysDiskID;
4991 hot_plug_info.event_type = MPTSAS_ADD_PHYSDISK;
4992 break;
4993 default:
4994 mptsas_free_fw_event(ioc, fw_event);
4995 return;
4996 }
4997 mptsas_hotplug_work(ioc, fw_event, &hot_plug_info);
4998}
4999
5000static int
5001mptsas_event_process(MPT_ADAPTER *ioc, EventNotificationReply_t *reply)
5002{
5003 u32 event = le32_to_cpu(reply->Event);
5004 int event_data_sz;
5005 struct fw_event_work *fw_event;
5006 unsigned long delay;
5007
5008 if (ioc->bus_type != SAS)
5009 return 0;
5010
5011 /* events turned off due to host reset or driver unloading */
5012 if (ioc->fw_events_off)
5013 return 0;
5014
5015 delay = msecs_to_jiffies(1);
5016 switch (event) {
5017 case MPI_EVENT_SAS_BROADCAST_PRIMITIVE:
5018 {
5019 EVENT_DATA_SAS_BROADCAST_PRIMITIVE *broadcast_event_data =
5020 (EVENT_DATA_SAS_BROADCAST_PRIMITIVE *)reply->Data;
5021 if (broadcast_event_data->Primitive !=
5022 MPI_EVENT_PRIMITIVE_ASYNCHRONOUS_EVENT)
5023 return 0;
5024 if (ioc->broadcast_aen_busy)
5025 return 0;
5026 ioc->broadcast_aen_busy = 1;
5027 break;
5028 }
5029 case MPI_EVENT_SAS_DEVICE_STATUS_CHANGE:
5030 {
5031 EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *sas_event_data =
5032 (EVENT_DATA_SAS_DEVICE_STATUS_CHANGE *)reply->Data;
5033 u16 ioc_stat;
5034 ioc_stat = le16_to_cpu(reply->IOCStatus);
5035
5036 if (sas_event_data->ReasonCode ==
5037 MPI_EVENT_SAS_DEV_STAT_RC_NOT_RESPONDING) {
5038 mptsas_target_reset_queue(ioc, sas_event_data);
5039 return 0;
5040 }
5041 if (sas_event_data->ReasonCode ==
5042 MPI_EVENT_SAS_DEV_STAT_RC_INTERNAL_DEVICE_RESET &&
5043 ioc->device_missing_delay &&
5044 (ioc_stat & MPI_IOCSTATUS_FLAG_LOG_INFO_AVAILABLE)) {
5045 VirtTarget *vtarget = NULL;
5046 u8 id, channel;
5047
5048 id = sas_event_data->TargetID;
5049 channel = sas_event_data->Bus;
5050
5051 vtarget = mptsas_find_vtarget(ioc, channel, id);
5052 if (vtarget) {
5053 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5054 "LogInfo (0x%x) available for "
5055 "INTERNAL_DEVICE_RESET"
5056 "fw_id %d fw_channel %d\n", ioc->name,
5057 le32_to_cpu(reply->IOCLogInfo),
5058 id, channel));
5059 if (vtarget->raidVolume) {
5060 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5061 "Skipping Raid Volume for inDMD\n",
5062 ioc->name));
5063 } else {
5064 devtprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5065 "Setting device flag inDMD\n",
5066 ioc->name));
5067 vtarget->inDMD = 1;
5068 }
5069
5070 }
5071
5072 }
5073
5074 break;
5075 }
5076 case MPI_EVENT_SAS_EXPANDER_STATUS_CHANGE:
5077 {
5078 MpiEventDataSasExpanderStatusChange_t *expander_data =
5079 (MpiEventDataSasExpanderStatusChange_t *)reply->Data;
5080
5081 if (ioc->old_sas_discovery_protocal)
5082 return 0;
5083
5084 if (expander_data->ReasonCode ==
5085 MPI_EVENT_SAS_EXP_RC_NOT_RESPONDING &&
5086 ioc->device_missing_delay)
5087 delay = HZ * ioc->device_missing_delay;
5088 break;
5089 }
5090 case MPI_EVENT_SAS_DISCOVERY:
5091 {
5092 u32 discovery_status;
5093 EventDataSasDiscovery_t *discovery_data =
5094 (EventDataSasDiscovery_t *)reply->Data;
5095
5096 discovery_status = le32_to_cpu(discovery_data->DiscoveryStatus);
5097 ioc->sas_discovery_quiesce_io = discovery_status ? 1 : 0;
5098 if (ioc->old_sas_discovery_protocal && !discovery_status)
5099 mptsas_queue_rescan(ioc);
5100 return 0;
5101 }
5102 case MPI_EVENT_INTEGRATED_RAID:
5103 case MPI_EVENT_PERSISTENT_TABLE_FULL:
5104 case MPI_EVENT_IR2:
5105 case MPI_EVENT_SAS_PHY_LINK_STATUS:
5106 case MPI_EVENT_QUEUE_FULL:
5107 break;
5108 default:
5109 return 0;
5110 }
5111
5112 event_data_sz = ((reply->MsgLength * 4) -
5113 offsetof(EventNotificationReply_t, Data));
5114 fw_event = kzalloc(sizeof(*fw_event) + event_data_sz, GFP_ATOMIC);
5115 if (!fw_event) {
5116 printk(MYIOC_s_WARN_FMT "%s: failed at (line=%d)\n", ioc->name,
5117 __func__, __LINE__);
5118 return 0;
5119 }
5120 memcpy(fw_event->event_data, reply->Data, event_data_sz);
5121 fw_event->event = event;
5122 fw_event->ioc = ioc;
5123 mptsas_add_fw_event(ioc, fw_event, delay);
5124 return 0;
5125}
5126
5127/* Delete a volume when no longer listed in ioc pg2
5128 */
5129static void mptsas_volume_delete(MPT_ADAPTER *ioc, u8 id)
5130{
5131 struct scsi_device *sdev;
5132 int i;
5133
5134 sdev = scsi_device_lookup(ioc->sh, MPTSAS_RAID_CHANNEL, id, 0);
5135 if (!sdev)
5136 return;
5137 if (!ioc->raid_data.pIocPg2)
5138 goto out;
5139 if (!ioc->raid_data.pIocPg2->NumActiveVolumes)
5140 goto out;
5141 for (i = 0; i < ioc->raid_data.pIocPg2->NumActiveVolumes; i++)
5142 if (ioc->raid_data.pIocPg2->RaidVolume[i].VolumeID == id)
5143 goto release_sdev;
5144 out:
5145 printk(MYIOC_s_INFO_FMT "removing raid volume, channel %d, "
5146 "id %d\n", ioc->name, MPTSAS_RAID_CHANNEL, id);
5147 scsi_remove_device(sdev);
5148 release_sdev:
5149 scsi_device_put(sdev);
5150}
5151
5152static int
5153mptsas_probe(struct pci_dev *pdev, const struct pci_device_id *id)
5154{
5155 struct Scsi_Host *sh;
5156 MPT_SCSI_HOST *hd;
5157 MPT_ADAPTER *ioc;
5158 unsigned long flags;
5159 int ii;
5160 int numSGE = 0;
5161 int scale;
5162 int ioc_cap;
5163 int error=0;
5164 int r;
5165
5166 r = mpt_attach(pdev,id);
5167 if (r)
5168 return r;
5169
5170 ioc = pci_get_drvdata(pdev);
5171 mptsas_fw_event_off(ioc);
5172 ioc->DoneCtx = mptsasDoneCtx;
5173 ioc->TaskCtx = mptsasTaskCtx;
5174 ioc->InternalCtx = mptsasInternalCtx;
5175 ioc->schedule_target_reset = &mptsas_schedule_target_reset;
5176 ioc->schedule_dead_ioc_flush_running_cmds =
5177 &mptscsih_flush_running_cmds;
5178 /* Added sanity check on readiness of the MPT adapter.
5179 */
5180 if (ioc->last_state != MPI_IOC_STATE_OPERATIONAL) {
5181 printk(MYIOC_s_WARN_FMT
5182 "Skipping because it's not operational!\n",
5183 ioc->name);
5184 error = -ENODEV;
5185 goto out_mptsas_probe;
5186 }
5187
5188 if (!ioc->active) {
5189 printk(MYIOC_s_WARN_FMT "Skipping because it's disabled!\n",
5190 ioc->name);
5191 error = -ENODEV;
5192 goto out_mptsas_probe;
5193 }
5194
5195 /* Sanity check - ensure at least 1 port is INITIATOR capable
5196 */
5197 ioc_cap = 0;
5198 for (ii = 0; ii < ioc->facts.NumberOfPorts; ii++) {
5199 if (ioc->pfacts[ii].ProtocolFlags &
5200 MPI_PORTFACTS_PROTOCOL_INITIATOR)
5201 ioc_cap++;
5202 }
5203
5204 if (!ioc_cap) {
5205 printk(MYIOC_s_WARN_FMT
5206 "Skipping ioc=%p because SCSI Initiator mode "
5207 "is NOT enabled!\n", ioc->name, ioc);
5208 return 0;
5209 }
5210
5211 sh = scsi_host_alloc(&mptsas_driver_template, sizeof(MPT_SCSI_HOST));
5212 if (!sh) {
5213 printk(MYIOC_s_WARN_FMT
5214 "Unable to register controller with SCSI subsystem\n",
5215 ioc->name);
5216 error = -1;
5217 goto out_mptsas_probe;
5218 }
5219
5220 spin_lock_irqsave(&ioc->FreeQlock, flags);
5221
5222 /* Attach the SCSI Host to the IOC structure
5223 */
5224 ioc->sh = sh;
5225
5226 sh->io_port = 0;
5227 sh->n_io_port = 0;
5228 sh->irq = 0;
5229
5230 /* set 16 byte cdb's */
5231 sh->max_cmd_len = 16;
5232 sh->can_queue = min_t(int, ioc->req_depth - 10, sh->can_queue);
5233 sh->max_id = -1;
5234 sh->max_lun = max_lun;
5235 sh->transportt = mptsas_transport_template;
5236
5237 /* Required entry.
5238 */
5239 sh->unique_id = ioc->id;
5240
5241 INIT_LIST_HEAD(&ioc->sas_topology);
5242 mutex_init(&ioc->sas_topology_mutex);
5243 mutex_init(&ioc->sas_discovery_mutex);
5244 mutex_init(&ioc->sas_mgmt.mutex);
5245 init_completion(&ioc->sas_mgmt.done);
5246
5247 /* Verify that we won't exceed the maximum
5248 * number of chain buffers
5249 * We can optimize: ZZ = req_sz/sizeof(SGE)
5250 * For 32bit SGE's:
5251 * numSGE = 1 + (ZZ-1)*(maxChain -1) + ZZ
5252 * + (req_sz - 64)/sizeof(SGE)
5253 * A slightly different algorithm is required for
5254 * 64bit SGEs.
5255 */
5256 scale = ioc->req_sz/ioc->SGE_size;
5257 if (ioc->sg_addr_size == sizeof(u64)) {
5258 numSGE = (scale - 1) *
5259 (ioc->facts.MaxChainDepth-1) + scale +
5260 (ioc->req_sz - 60) / ioc->SGE_size;
5261 } else {
5262 numSGE = 1 + (scale - 1) *
5263 (ioc->facts.MaxChainDepth-1) + scale +
5264 (ioc->req_sz - 64) / ioc->SGE_size;
5265 }
5266
5267 if (numSGE < sh->sg_tablesize) {
5268 /* Reset this value */
5269 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5270 "Resetting sg_tablesize to %d from %d\n",
5271 ioc->name, numSGE, sh->sg_tablesize));
5272 sh->sg_tablesize = numSGE;
5273 }
5274
5275 if (mpt_loadtime_max_sectors) {
5276 if (mpt_loadtime_max_sectors < 64 ||
5277 mpt_loadtime_max_sectors > 8192) {
5278 printk(MYIOC_s_INFO_FMT "Invalid value passed for"
5279 "mpt_loadtime_max_sectors %d."
5280 "Range from 64 to 8192\n", ioc->name,
5281 mpt_loadtime_max_sectors);
5282 }
5283 mpt_loadtime_max_sectors &= 0xFFFFFFFE;
5284 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT
5285 "Resetting max sector to %d from %d\n",
5286 ioc->name, mpt_loadtime_max_sectors, sh->max_sectors));
5287 sh->max_sectors = mpt_loadtime_max_sectors;
5288 }
5289
5290 hd = shost_priv(sh);
5291 hd->ioc = ioc;
5292
5293 /* SCSI needs scsi_cmnd lookup table!
5294 * (with size equal to req_depth*PtrSz!)
5295 */
5296 ioc->ScsiLookup = kcalloc(ioc->req_depth, sizeof(void *), GFP_ATOMIC);
5297 if (!ioc->ScsiLookup) {
5298 error = -ENOMEM;
5299 spin_unlock_irqrestore(&ioc->FreeQlock, flags);
5300 goto out_mptsas_probe;
5301 }
5302 spin_lock_init(&ioc->scsi_lookup_lock);
5303
5304 dprintk(ioc, printk(MYIOC_s_DEBUG_FMT "ScsiLookup @ %p\n",
5305 ioc->name, ioc->ScsiLookup));
5306
5307 ioc->sas_data.ptClear = mpt_pt_clear;
5308
5309 hd->last_queue_full = 0;
5310 INIT_LIST_HEAD(&hd->target_reset_list);
5311 INIT_LIST_HEAD(&ioc->sas_device_info_list);
5312 mutex_init(&ioc->sas_device_info_mutex);
5313
5314 spin_unlock_irqrestore(&ioc->FreeQlock, flags);
5315
5316 if (ioc->sas_data.ptClear==1) {
5317 mptbase_sas_persist_operation(
5318 ioc, MPI_SAS_OP_CLEAR_ALL_PERSISTENT);
5319 }
5320
5321 error = scsi_add_host(sh, &ioc->pcidev->dev);
5322 if (error) {
5323 dprintk(ioc, printk(MYIOC_s_ERR_FMT
5324 "scsi_add_host failed\n", ioc->name));
5325 goto out_mptsas_probe;
5326 }
5327
5328 /* older firmware doesn't support expander events */
5329 if ((ioc->facts.HeaderVersion >> 8) < 0xE)
5330 ioc->old_sas_discovery_protocal = 1;
5331 mptsas_scan_sas_topology(ioc);
5332 mptsas_fw_event_on(ioc);
5333 return 0;
5334
5335 out_mptsas_probe:
5336
5337 mptscsih_remove(pdev);
5338 return error;
5339}
5340
5341static void
5342mptsas_shutdown(struct pci_dev *pdev)
5343{
5344 MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
5345
5346 mptsas_fw_event_off(ioc);
5347 mptsas_cleanup_fw_event_q(ioc);
5348}
5349
5350static void mptsas_remove(struct pci_dev *pdev)
5351{
5352 MPT_ADAPTER *ioc = pci_get_drvdata(pdev);
5353 struct mptsas_portinfo *p, *n;
5354 int i;
5355
5356 if (!ioc->sh) {
5357 printk(MYIOC_s_INFO_FMT "IOC is in Target mode\n", ioc->name);
5358 mpt_detach(pdev);
5359 return;
5360 }
5361
5362 mptsas_shutdown(pdev);
5363
5364 mptsas_del_device_components(ioc);
5365
5366 ioc->sas_discovery_ignore_events = 1;
5367 sas_remove_host(ioc->sh);
5368
5369 mutex_lock(&ioc->sas_topology_mutex);
5370 list_for_each_entry_safe(p, n, &ioc->sas_topology, list) {
5371 list_del(&p->list);
5372 for (i = 0 ; i < p->num_phys ; i++)
5373 mptsas_port_delete(ioc, p->phy_info[i].port_details);
5374
5375 kfree(p->phy_info);
5376 kfree(p);
5377 }
5378 mutex_unlock(&ioc->sas_topology_mutex);
5379 ioc->hba_port_info = NULL;
5380 mptscsih_remove(pdev);
5381}
5382
5383static struct pci_device_id mptsas_pci_table[] = {
5384 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064,
5385 PCI_ANY_ID, PCI_ANY_ID },
5386 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068,
5387 PCI_ANY_ID, PCI_ANY_ID },
5388 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1064E,
5389 PCI_ANY_ID, PCI_ANY_ID },
5390 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068E,
5391 PCI_ANY_ID, PCI_ANY_ID },
5392 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1078,
5393 PCI_ANY_ID, PCI_ANY_ID },
5394 { PCI_VENDOR_ID_LSI_LOGIC, MPI_MANUFACTPAGE_DEVID_SAS1068_820XELP,
5395 PCI_ANY_ID, PCI_ANY_ID },
5396 {0} /* Terminating entry */
5397};
5398MODULE_DEVICE_TABLE(pci, mptsas_pci_table);
5399
5400
5401static struct pci_driver mptsas_driver = {
5402 .name = "mptsas",
5403 .id_table = mptsas_pci_table,
5404 .probe = mptsas_probe,
5405 .remove = mptsas_remove,
5406 .shutdown = mptsas_shutdown,
5407#ifdef CONFIG_PM
5408 .suspend = mptscsih_suspend,
5409 .resume = mptscsih_resume,
5410#endif
5411};
5412
5413static int __init
5414mptsas_init(void)
5415{
5416 int error;
5417
5418 show_mptmod_ver(my_NAME, my_VERSION);
5419
5420 mptsas_transport_template =
5421 sas_attach_transport(&mptsas_transport_functions);
5422 if (!mptsas_transport_template)
5423 return -ENODEV;
5424
5425 mptsasDoneCtx = mpt_register(mptscsih_io_done, MPTSAS_DRIVER,
5426 "mptscsih_io_done");
5427 mptsasTaskCtx = mpt_register(mptscsih_taskmgmt_complete, MPTSAS_DRIVER,
5428 "mptscsih_taskmgmt_complete");
5429 mptsasInternalCtx =
5430 mpt_register(mptscsih_scandv_complete, MPTSAS_DRIVER,
5431 "mptscsih_scandv_complete");
5432 mptsasMgmtCtx = mpt_register(mptsas_mgmt_done, MPTSAS_DRIVER,
5433 "mptsas_mgmt_done");
5434 mptsasDeviceResetCtx =
5435 mpt_register(mptsas_taskmgmt_complete, MPTSAS_DRIVER,
5436 "mptsas_taskmgmt_complete");
5437
5438 mpt_event_register(mptsasDoneCtx, mptsas_event_process);
5439 mpt_reset_register(mptsasDoneCtx, mptsas_ioc_reset);
5440
5441 error = pci_register_driver(&mptsas_driver);
5442 if (error)
5443 sas_release_transport(mptsas_transport_template);
5444
5445 return error;
5446}
5447
5448static void __exit
5449mptsas_exit(void)
5450{
5451 pci_unregister_driver(&mptsas_driver);
5452 sas_release_transport(mptsas_transport_template);
5453
5454 mpt_reset_deregister(mptsasDoneCtx);
5455 mpt_event_deregister(mptsasDoneCtx);
5456
5457 mpt_deregister(mptsasMgmtCtx);
5458 mpt_deregister(mptsasInternalCtx);
5459 mpt_deregister(mptsasTaskCtx);
5460 mpt_deregister(mptsasDoneCtx);
5461 mpt_deregister(mptsasDeviceResetCtx);
5462}
5463
5464module_init(mptsas_init);
5465module_exit(mptsas_exit);