Lines Matching +full:phy +full:- +full:device
1 // SPDX-License-Identifier: GPL-2.0-or-later
11 ((!dev) || (dev->dev_type == SAS_PHY_UNUSED))
13 static int hisi_sas_softreset_ata_disk(struct domain_device *device);
17 struct domain_device *device);
18 static void hisi_sas_dev_gone(struct domain_device *device);
26 switch (fis->command) { in hisi_sas_get_ata_protocol()
79 switch (fis->features) { in hisi_sas_get_ata_protocol()
105 struct task_status_struct *ts = &task->task_status; in hisi_sas_sata_done()
106 struct ata_task_resp *resp = (struct ata_task_resp *)ts->buf; in hisi_sas_sata_done()
109 u8 *iu = &status_buf->iu[0]; in hisi_sas_sata_done()
112 resp->frame_len = sizeof(struct dev_to_host_fis); in hisi_sas_sata_done()
113 memcpy(&resp->ending_fis[0], d2h, sizeof(struct dev_to_host_fis)); in hisi_sas_sata_done()
115 ts->buf_valid_size = sizeof(*resp); in hisi_sas_sata_done()
128 max -= SAS_LINK_RATE_1_5_GBPS; in hisi_sas_get_prog_phy_linkrate_mask()
135 static struct hisi_hba *dev_to_hisi_hba(struct domain_device *device) in dev_to_hisi_hba() argument
137 return device->port->ha->lldd_ha; in dev_to_hisi_hba()
150 for (phy_no = 0; phy_no < hisi_hba->n_phy; phy_no++) in hisi_sas_stop_phys()
157 void *bitmap = hisi_hba->slot_index_tags; in hisi_sas_slot_index_clear()
164 if (hisi_hba->hw->slot_index_alloc || in hisi_sas_slot_index_free()
166 spin_lock(&hisi_hba->lock); in hisi_sas_slot_index_free()
168 spin_unlock(&hisi_hba->lock); in hisi_sas_slot_index_free()
174 void *bitmap = hisi_hba->slot_index_tags; in hisi_sas_slot_index_set()
183 void *bitmap = hisi_hba->slot_index_tags; in hisi_sas_slot_index_alloc()
186 return rq->tag + HISI_SAS_RESERVED_IPTT; in hisi_sas_slot_index_alloc()
188 spin_lock(&hisi_hba->lock); in hisi_sas_slot_index_alloc()
190 hisi_hba->last_slot_index + 1); in hisi_sas_slot_index_alloc()
196 spin_unlock(&hisi_hba->lock); in hisi_sas_slot_index_alloc()
197 return -SAS_QUEUE_FULL; in hisi_sas_slot_index_alloc()
201 hisi_hba->last_slot_index = index; in hisi_sas_slot_index_alloc()
202 spin_unlock(&hisi_hba->lock); in hisi_sas_slot_index_alloc()
210 int device_id = slot->device_id; in hisi_sas_slot_task_free()
211 struct hisi_sas_device *sas_dev = &hisi_hba->devices[device_id]; in hisi_sas_slot_task_free()
214 struct device *dev = hisi_hba->dev; in hisi_sas_slot_task_free()
216 if (!task->lldd_task) in hisi_sas_slot_task_free()
219 task->lldd_task = NULL; in hisi_sas_slot_task_free()
221 if (!sas_protocol_ata(task->task_proto)) { in hisi_sas_slot_task_free()
222 if (slot->n_elem) { in hisi_sas_slot_task_free()
223 if (task->task_proto & SAS_PROTOCOL_SSP) in hisi_sas_slot_task_free()
224 dma_unmap_sg(dev, task->scatter, in hisi_sas_slot_task_free()
225 task->num_scatter, in hisi_sas_slot_task_free()
226 task->data_dir); in hisi_sas_slot_task_free()
228 dma_unmap_sg(dev, &task->smp_task.smp_req, in hisi_sas_slot_task_free()
231 if (slot->n_elem_dif) { in hisi_sas_slot_task_free()
232 struct sas_ssp_task *ssp_task = &task->ssp_task; in hisi_sas_slot_task_free()
233 struct scsi_cmnd *scsi_cmnd = ssp_task->cmd; in hisi_sas_slot_task_free()
237 task->data_dir); in hisi_sas_slot_task_free()
243 spin_lock(&sas_dev->lock); in hisi_sas_slot_task_free()
244 list_del_init(&slot->entry); in hisi_sas_slot_task_free()
245 spin_unlock(&sas_dev->lock); in hisi_sas_slot_task_free()
247 list_del_init(&slot->entry); in hisi_sas_slot_task_free()
252 hisi_sas_slot_index_free(hisi_hba, slot->idx); in hisi_sas_slot_task_free()
259 hisi_hba->hw->prep_smp(hisi_hba, slot); in hisi_sas_task_prep_smp()
265 hisi_hba->hw->prep_ssp(hisi_hba, slot); in hisi_sas_task_prep_ssp()
271 hisi_hba->hw->prep_stp(hisi_hba, slot); in hisi_sas_task_prep_ata()
277 hisi_hba->hw->prep_abort(hisi_hba, slot); in hisi_sas_task_prep_abort()
283 struct device *dev = hisi_hba->dev; in hisi_sas_dma_unmap()
285 if (!sas_protocol_ata(task->task_proto) && n_elem) { in hisi_sas_dma_unmap()
286 if (task->num_scatter) { in hisi_sas_dma_unmap()
287 dma_unmap_sg(dev, task->scatter, task->num_scatter, in hisi_sas_dma_unmap()
288 task->data_dir); in hisi_sas_dma_unmap()
289 } else if (task->task_proto & SAS_PROTOCOL_SMP) { in hisi_sas_dma_unmap()
290 dma_unmap_sg(dev, &task->smp_task.smp_req, in hisi_sas_dma_unmap()
299 struct device *dev = hisi_hba->dev; in hisi_sas_dma_map()
302 if (sas_protocol_ata(task->task_proto)) { in hisi_sas_dma_map()
303 *n_elem = task->num_scatter; in hisi_sas_dma_map()
307 if (task->num_scatter) { in hisi_sas_dma_map()
308 *n_elem = dma_map_sg(dev, task->scatter, in hisi_sas_dma_map()
309 task->num_scatter, task->data_dir); in hisi_sas_dma_map()
311 rc = -ENOMEM; in hisi_sas_dma_map()
314 } else if (task->task_proto & SAS_PROTOCOL_SMP) { in hisi_sas_dma_map()
315 *n_elem = dma_map_sg(dev, &task->smp_task.smp_req, in hisi_sas_dma_map()
318 rc = -ENOMEM; in hisi_sas_dma_map()
321 req_len = sg_dma_len(&task->smp_task.smp_req); in hisi_sas_dma_map()
323 rc = -EINVAL; in hisi_sas_dma_map()
332 rc = -EINVAL; in hisi_sas_dma_map()
347 struct device *dev = hisi_hba->dev; in hisi_sas_dif_dma_unmap()
350 struct sas_ssp_task *ssp_task = &task->ssp_task; in hisi_sas_dif_dma_unmap()
351 struct scsi_cmnd *scsi_cmnd = ssp_task->cmd; in hisi_sas_dif_dma_unmap()
355 task->data_dir); in hisi_sas_dif_dma_unmap()
362 struct device *dev = hisi_hba->dev; in hisi_sas_dif_dma_map()
367 if (task->num_scatter) { in hisi_sas_dif_dma_map()
368 ssp_task = &task->ssp_task; in hisi_sas_dif_dma_map()
369 scsi_cmnd = ssp_task->cmd; in hisi_sas_dif_dma_map()
375 task->data_dir); in hisi_sas_dif_dma_map()
378 return -ENOMEM; in hisi_sas_dif_dma_map()
383 rc = -EINVAL; in hisi_sas_dif_dma_map()
393 scsi_prot_sg_count(scsi_cmnd), task->data_dir); in hisi_sas_dif_dma_map()
405 struct sas_task *task = slot->task; in hisi_sas_task_deliver()
408 spin_lock(&dq->lock); in hisi_sas_task_deliver()
409 wr_q_index = dq->wr_point; in hisi_sas_task_deliver()
410 dq->wr_point = (dq->wr_point + 1) % HISI_SAS_QUEUE_SLOTS; in hisi_sas_task_deliver()
411 list_add_tail(&slot->delivery, &dq->list); in hisi_sas_task_deliver()
412 spin_unlock(&dq->lock); in hisi_sas_task_deliver()
413 spin_lock(&sas_dev->lock); in hisi_sas_task_deliver()
414 list_add_tail(&slot->entry, &sas_dev->list); in hisi_sas_task_deliver()
415 spin_unlock(&sas_dev->lock); in hisi_sas_task_deliver()
417 dlvry_queue = dq->id; in hisi_sas_task_deliver()
420 slot->device_id = sas_dev->device_id; in hisi_sas_task_deliver()
421 slot->dlvry_queue = dlvry_queue; in hisi_sas_task_deliver()
422 slot->dlvry_queue_slot = dlvry_queue_slot; in hisi_sas_task_deliver()
423 cmd_hdr_base = hisi_hba->cmd_hdr[dlvry_queue]; in hisi_sas_task_deliver()
424 slot->cmd_hdr = &cmd_hdr_base[dlvry_queue_slot]; in hisi_sas_task_deliver()
426 task->lldd_task = slot; in hisi_sas_task_deliver()
428 memset(slot->cmd_hdr, 0, sizeof(struct hisi_sas_cmd_hdr)); in hisi_sas_task_deliver()
433 switch (task->task_proto) { in hisi_sas_task_deliver()
454 WRITE_ONCE(slot->ready, 1); in hisi_sas_task_deliver()
456 spin_lock(&dq->lock); in hisi_sas_task_deliver()
457 hisi_hba->hw->start_delivery(dq); in hisi_sas_task_deliver()
458 spin_unlock(&dq->lock); in hisi_sas_task_deliver()
464 struct domain_device *device = task->dev; in hisi_sas_queue_command() local
465 struct asd_sas_port *sas_port = device->port; in hisi_sas_queue_command()
466 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_queue_command()
473 struct device *dev; in hisi_sas_queue_command()
477 struct task_status_struct *ts = &task->task_status; in hisi_sas_queue_command()
479 ts->resp = SAS_TASK_UNDELIVERED; in hisi_sas_queue_command()
480 ts->stat = SAS_PHY_DOWN; in hisi_sas_queue_command()
482 * libsas will use dev->port, should in hisi_sas_queue_command()
485 if (device->dev_type != SAS_SATA_DEV && !internal_abort) in hisi_sas_queue_command()
486 task->task_done(task); in hisi_sas_queue_command()
487 return -ECOMM; in hisi_sas_queue_command()
490 hisi_hba = dev_to_hisi_hba(device); in hisi_sas_queue_command()
491 dev = hisi_hba->dev; in hisi_sas_queue_command()
493 switch (task->task_proto) { in hisi_sas_queue_command()
499 if (unlikely(test_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags))) { in hisi_sas_queue_command()
501 return -EINVAL; in hisi_sas_queue_command()
503 down(&hisi_hba->sem); in hisi_sas_queue_command()
504 up(&hisi_hba->sem); in hisi_sas_queue_command()
509 dev_info(dev, "task prep: device %d not ready\n", in hisi_sas_queue_command()
510 sas_dev->device_id); in hisi_sas_queue_command()
512 dev_info(dev, "task prep: device %016llx not ready\n", in hisi_sas_queue_command()
513 SAS_ADDR(device->sas_addr)); in hisi_sas_queue_command()
515 return -ECOMM; in hisi_sas_queue_command()
519 if (!port->port_attached) { in hisi_sas_queue_command()
520 dev_info(dev, "task prep: %s port%d not attach device\n", in hisi_sas_queue_command()
521 dev_is_sata(device) ? "SATA/STP" : "SAS", in hisi_sas_queue_command()
522 device->port->id); in hisi_sas_queue_command()
524 return -ECOMM; in hisi_sas_queue_command()
534 dq = &hisi_hba->dq[dq_index]; in hisi_sas_queue_command()
538 if (hisi_hba->iopoll_q_cnt) { in hisi_sas_queue_command()
546 struct Scsi_Host *shost = hisi_hba->shost; in hisi_sas_queue_command()
547 struct blk_mq_queue_map *qmap = &shost->tag_set.map[HCTX_TYPE_DEFAULT]; in hisi_sas_queue_command()
549 queue = qmap->mq_map[raw_smp_processor_id()]; in hisi_sas_queue_command()
551 dq = &hisi_hba->dq[queue]; in hisi_sas_queue_command()
555 if (!hisi_hba->hw->prep_abort) in hisi_sas_queue_command()
558 if (test_bit(HISI_SAS_HW_FAULT_BIT, &hisi_hba->flags)) in hisi_sas_queue_command()
559 return -EIO; in hisi_sas_queue_command()
561 hisi_hba = dev_to_hisi_hba(device); in hisi_sas_queue_command()
563 if (unlikely(test_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags))) in hisi_sas_queue_command()
564 return -EINVAL; in hisi_sas_queue_command()
567 dq = &hisi_hba->dq[task->abort_task.qid]; in hisi_sas_queue_command()
570 dev_err(hisi_hba->dev, "task prep: unknown/unsupported proto (0x%x)\n", in hisi_sas_queue_command()
571 task->task_proto); in hisi_sas_queue_command()
572 return -EINVAL; in hisi_sas_queue_command()
579 if (!sas_protocol_ata(task->task_proto)) { in hisi_sas_queue_command()
585 if (!internal_abort && hisi_hba->hw->slot_index_alloc) in hisi_sas_queue_command()
586 rc = hisi_hba->hw->slot_index_alloc(hisi_hba, device); in hisi_sas_queue_command()
593 slot = &hisi_hba->slot_info[rc]; in hisi_sas_queue_command()
594 slot->n_elem = n_elem; in hisi_sas_queue_command()
595 slot->n_elem_dif = n_elem_dif; in hisi_sas_queue_command()
596 slot->task = task; in hisi_sas_queue_command()
597 slot->port = port; in hisi_sas_queue_command()
599 slot->tmf = task->tmf; in hisi_sas_queue_command()
600 slot->is_internal = !!task->tmf || internal_abort; in hisi_sas_queue_command()
608 if (!sas_protocol_ata(task->task_proto)) in hisi_sas_queue_command()
620 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_bytes_dmaed() local
621 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_bytes_dmaed()
623 if (!phy->phy_attached) in hisi_sas_bytes_dmaed()
628 if (sas_phy->phy) { in hisi_sas_bytes_dmaed()
629 struct sas_phy *sphy = sas_phy->phy; in hisi_sas_bytes_dmaed()
631 sphy->negotiated_linkrate = sas_phy->linkrate; in hisi_sas_bytes_dmaed()
632 sphy->minimum_linkrate_hw = SAS_LINK_RATE_1_5_GBPS; in hisi_sas_bytes_dmaed()
633 sphy->maximum_linkrate_hw = in hisi_sas_bytes_dmaed()
634 hisi_hba->hw->phy_get_max_linkrate(); in hisi_sas_bytes_dmaed()
635 if (sphy->minimum_linkrate == SAS_LINK_RATE_UNKNOWN) in hisi_sas_bytes_dmaed()
636 sphy->minimum_linkrate = phy->minimum_linkrate; in hisi_sas_bytes_dmaed()
638 if (sphy->maximum_linkrate == SAS_LINK_RATE_UNKNOWN) in hisi_sas_bytes_dmaed()
639 sphy->maximum_linkrate = phy->maximum_linkrate; in hisi_sas_bytes_dmaed()
642 if (phy->phy_type & PORT_TYPE_SAS) { in hisi_sas_bytes_dmaed()
645 id = (struct sas_identify_frame *)phy->frame_rcvd; in hisi_sas_bytes_dmaed()
646 id->dev_type = phy->identify.device_type; in hisi_sas_bytes_dmaed()
647 id->initiator_bits = SAS_PROTOCOL_ALL; in hisi_sas_bytes_dmaed()
648 id->target_bits = phy->identify.target_port_protocols; in hisi_sas_bytes_dmaed()
649 } else if (phy->phy_type & PORT_TYPE_SATA) { in hisi_sas_bytes_dmaed()
653 sas_phy->frame_rcvd_size = phy->frame_rcvd_size; in hisi_sas_bytes_dmaed()
657 static struct hisi_sas_device *hisi_sas_alloc_dev(struct domain_device *device) in hisi_sas_alloc_dev() argument
659 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_alloc_dev()
661 int last = hisi_hba->last_dev_id; in hisi_sas_alloc_dev()
662 int first = (hisi_hba->last_dev_id + 1) % HISI_SAS_MAX_DEVICES; in hisi_sas_alloc_dev()
665 spin_lock(&hisi_hba->lock); in hisi_sas_alloc_dev()
667 if (hisi_hba->devices[i].dev_type == SAS_PHY_UNUSED) { in hisi_sas_alloc_dev()
668 int queue = i % hisi_hba->queue_count; in hisi_sas_alloc_dev()
669 struct hisi_sas_dq *dq = &hisi_hba->dq[queue]; in hisi_sas_alloc_dev()
671 hisi_hba->devices[i].device_id = i; in hisi_sas_alloc_dev()
672 sas_dev = &hisi_hba->devices[i]; in hisi_sas_alloc_dev()
673 sas_dev->dev_status = HISI_SAS_DEV_INIT; in hisi_sas_alloc_dev()
674 sas_dev->dev_type = device->dev_type; in hisi_sas_alloc_dev()
675 sas_dev->hisi_hba = hisi_hba; in hisi_sas_alloc_dev()
676 sas_dev->sas_device = device; in hisi_sas_alloc_dev()
677 sas_dev->dq = dq; in hisi_sas_alloc_dev()
678 spin_lock_init(&sas_dev->lock); in hisi_sas_alloc_dev()
679 INIT_LIST_HEAD(&hisi_hba->devices[i].list); in hisi_sas_alloc_dev()
684 hisi_hba->last_dev_id = i; in hisi_sas_alloc_dev()
685 spin_unlock(&hisi_hba->lock); in hisi_sas_alloc_dev()
693 spin_lock(&cq->poll_lock); in hisi_sas_sync_poll_cq()
694 spin_unlock(&cq->poll_lock); in hisi_sas_sync_poll_cq()
699 struct hisi_hba *hisi_hba = cq->hisi_hba; in hisi_sas_queue_is_poll()
701 if (cq->id < hisi_hba->queue_count - hisi_hba->iopoll_q_cnt) in hisi_sas_queue_is_poll()
711 synchronize_irq(cq->irq_no); in hisi_sas_sync_cq()
718 for (i = 0; i < hisi_hba->queue_count; i++) { in hisi_sas_sync_poll_cqs()
719 struct hisi_sas_cq *cq = &hisi_hba->cq[i]; in hisi_sas_sync_poll_cqs()
731 for (i = 0; i < hisi_hba->queue_count; i++) { in hisi_sas_sync_cqs()
732 struct hisi_sas_cq *cq = &hisi_hba->cq[i]; in hisi_sas_sync_cqs()
741 struct hisi_sas_slot *slot = task->lldd_task; in hisi_sas_tmf_aborted()
742 struct domain_device *device = task->dev; in hisi_sas_tmf_aborted() local
743 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_tmf_aborted()
744 struct hisi_hba *hisi_hba = sas_dev->hisi_hba; in hisi_sas_tmf_aborted()
748 &hisi_hba->cq[slot->dlvry_queue]; in hisi_sas_tmf_aborted()
754 slot->task = NULL; in hisi_sas_tmf_aborted()
759 static int hisi_sas_init_device(struct domain_device *device) in hisi_sas_init_device() argument
764 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_init_device()
766 switch (device->dev_type) { in hisi_sas_init_device()
770 while (retry-- > 0) { in hisi_sas_init_device()
771 rc = sas_abort_task_set(device, lun.scsi_lun); in hisi_sas_init_device()
773 hisi_sas_release_task(hisi_hba, device); in hisi_sas_init_device()
789 * a. When probing the device, libsas/libata already issues a in hisi_sas_init_device()
790 * hard reset in sas_probe_sata() -> ata_port_probe(). in hisi_sas_init_device()
795 while (retry-- > 0) { in hisi_sas_init_device()
796 rc = hisi_sas_softreset_ata_disk(device); in hisi_sas_init_device()
811 struct hisi_sas_device *sas_dev = ddev->lldd_dev; in hisi_sas_slave_alloc()
821 sas_dev->dev_status = HISI_SAS_DEV_NORMAL; in hisi_sas_slave_alloc()
826 static int hisi_sas_dev_found(struct domain_device *device) in hisi_sas_dev_found() argument
828 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_dev_found()
829 struct domain_device *parent_dev = device->parent; in hisi_sas_dev_found()
831 struct device *dev = hisi_hba->dev; in hisi_sas_dev_found()
834 if (hisi_hba->hw->alloc_dev) in hisi_sas_dev_found()
835 sas_dev = hisi_hba->hw->alloc_dev(device); in hisi_sas_dev_found()
837 sas_dev = hisi_sas_alloc_dev(device); in hisi_sas_dev_found()
841 return -EINVAL; in hisi_sas_dev_found()
844 device->lldd_dev = sas_dev; in hisi_sas_dev_found()
845 hisi_hba->hw->setup_itct(hisi_hba, sas_dev); in hisi_sas_dev_found()
847 if (parent_dev && dev_is_expander(parent_dev->dev_type)) { in hisi_sas_dev_found()
850 phy_no = sas_find_attached_phy_id(&parent_dev->ex_dev, device); in hisi_sas_dev_found()
854 SAS_ADDR(device->sas_addr), in hisi_sas_dev_found()
855 SAS_ADDR(parent_dev->sas_addr)); in hisi_sas_dev_found()
862 sas_dev->device_id, sas_dev->dev_type); in hisi_sas_dev_found()
867 hisi_sas_dev_gone(device); in hisi_sas_dev_found()
889 hisi_hba->hw->phys_init(hisi_hba); in hisi_sas_scan_start()
896 struct sas_ha_struct *sha = &hisi_hba->sha; in hisi_sas_scan_finished()
898 /* Wait for PHY up interrupt to occur */ in hisi_sas_scan_finished()
910 struct hisi_sas_phy *phy = in hisi_sas_phyup_work_common() local
911 container_of(work, typeof(*phy), works[event]); in hisi_sas_phyup_work_common()
912 struct hisi_hba *hisi_hba = phy->hisi_hba; in hisi_sas_phyup_work_common()
913 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_phyup_work_common()
914 int phy_no = sas_phy->id; in hisi_sas_phyup_work_common()
916 phy->wait_phyup_cnt = 0; in hisi_sas_phyup_work_common()
917 if (phy->identify.target_port_protocols == SAS_PROTOCOL_SSP) in hisi_sas_phyup_work_common()
918 hisi_hba->hw->sl_notify_ssp(hisi_hba, phy_no); in hisi_sas_phyup_work_common()
929 struct hisi_sas_phy *phy = in hisi_sas_linkreset_work() local
930 container_of(work, typeof(*phy), works[HISI_PHYE_LINK_RESET]); in hisi_sas_linkreset_work()
931 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_linkreset_work()
938 struct hisi_sas_phy *phy = in hisi_sas_phyup_pm_work() local
939 container_of(work, typeof(*phy), works[HISI_PHYE_PHY_UP_PM]); in hisi_sas_phyup_pm_work()
940 struct hisi_hba *hisi_hba = phy->hisi_hba; in hisi_sas_phyup_pm_work()
941 struct device *dev = hisi_hba->dev; in hisi_sas_phyup_pm_work()
953 bool hisi_sas_notify_phy_event(struct hisi_sas_phy *phy, in hisi_sas_notify_phy_event() argument
956 struct hisi_hba *hisi_hba = phy->hisi_hba; in hisi_sas_notify_phy_event()
961 return queue_work(hisi_hba->wq, &phy->works[event]); in hisi_sas_notify_phy_event()
967 struct hisi_sas_phy *phy = from_timer(phy, t, timer); in hisi_sas_wait_phyup_timedout() local
968 struct hisi_hba *hisi_hba = phy->hisi_hba; in hisi_sas_wait_phyup_timedout()
969 struct device *dev = hisi_hba->dev; in hisi_sas_wait_phyup_timedout()
970 int phy_no = phy->sas_phy.id; in hisi_sas_wait_phyup_timedout()
972 dev_warn(dev, "phy%d wait phyup timeout, issuing link reset\n", phy_no); in hisi_sas_wait_phyup_timedout()
973 hisi_sas_notify_phy_event(phy, HISI_PHYE_LINK_RESET); in hisi_sas_wait_phyup_timedout()
980 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_phy_oob_ready() local
981 struct device *dev = hisi_hba->dev; in hisi_sas_phy_oob_ready()
984 dev_dbg(dev, "phy%d OOB ready\n", phy_no); in hisi_sas_phy_oob_ready()
985 spin_lock_irqsave(&phy->lock, flags); in hisi_sas_phy_oob_ready()
986 if (phy->phy_attached) { in hisi_sas_phy_oob_ready()
987 spin_unlock_irqrestore(&phy->lock, flags); in hisi_sas_phy_oob_ready()
991 if (!timer_pending(&phy->timer)) { in hisi_sas_phy_oob_ready()
992 if (phy->wait_phyup_cnt < HISI_SAS_WAIT_PHYUP_RETRIES) { in hisi_sas_phy_oob_ready()
993 phy->wait_phyup_cnt++; in hisi_sas_phy_oob_ready()
994 phy->timer.expires = jiffies + in hisi_sas_phy_oob_ready()
996 add_timer(&phy->timer); in hisi_sas_phy_oob_ready()
997 spin_unlock_irqrestore(&phy->lock, flags); in hisi_sas_phy_oob_ready()
1001 dev_warn(dev, "phy%d failed to come up %d times, giving up\n", in hisi_sas_phy_oob_ready()
1002 phy_no, phy->wait_phyup_cnt); in hisi_sas_phy_oob_ready()
1003 phy->wait_phyup_cnt = 0; in hisi_sas_phy_oob_ready()
1005 spin_unlock_irqrestore(&phy->lock, flags); in hisi_sas_phy_oob_ready()
1012 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_phy_init() local
1013 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_phy_init()
1016 phy->hisi_hba = hisi_hba; in hisi_sas_phy_init()
1017 phy->port = NULL; in hisi_sas_phy_init()
1018 phy->minimum_linkrate = SAS_LINK_RATE_1_5_GBPS; in hisi_sas_phy_init()
1019 phy->maximum_linkrate = hisi_hba->hw->phy_get_max_linkrate(); in hisi_sas_phy_init()
1020 sas_phy->enabled = (phy_no < hisi_hba->n_phy) ? 1 : 0; in hisi_sas_phy_init()
1021 sas_phy->iproto = SAS_PROTOCOL_ALL; in hisi_sas_phy_init()
1022 sas_phy->tproto = 0; in hisi_sas_phy_init()
1023 sas_phy->role = PHY_ROLE_INITIATOR; in hisi_sas_phy_init()
1024 sas_phy->oob_mode = OOB_NOT_CONNECTED; in hisi_sas_phy_init()
1025 sas_phy->linkrate = SAS_LINK_RATE_UNKNOWN; in hisi_sas_phy_init()
1026 sas_phy->id = phy_no; in hisi_sas_phy_init()
1027 sas_phy->sas_addr = &hisi_hba->sas_addr[0]; in hisi_sas_phy_init()
1028 sas_phy->frame_rcvd = &phy->frame_rcvd[0]; in hisi_sas_phy_init()
1029 sas_phy->ha = (struct sas_ha_struct *)hisi_hba->shost->hostdata; in hisi_sas_phy_init()
1030 sas_phy->lldd_phy = phy; in hisi_sas_phy_init()
1033 INIT_WORK(&phy->works[i], hisi_sas_phye_fns[i]); in hisi_sas_phy_init()
1035 spin_lock_init(&phy->lock); in hisi_sas_phy_init()
1037 timer_setup(&phy->timer, hisi_sas_wait_phyup_timedout, 0); in hisi_sas_phy_init()
1043 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_phy_enable() local
1044 struct asd_sas_phy *aphy = &phy->sas_phy; in hisi_sas_phy_enable()
1045 struct sas_phy *sphy = aphy->phy; in hisi_sas_phy_enable()
1048 spin_lock_irqsave(&phy->lock, flags); in hisi_sas_phy_enable()
1052 if (!phy->enable) in hisi_sas_phy_enable()
1053 sphy->negotiated_linkrate = SAS_LINK_RATE_UNKNOWN; in hisi_sas_phy_enable()
1054 hisi_hba->hw->phy_start(hisi_hba, phy_no); in hisi_sas_phy_enable()
1056 sphy->negotiated_linkrate = SAS_PHY_DISABLED; in hisi_sas_phy_enable()
1057 hisi_hba->hw->phy_disable(hisi_hba, phy_no); in hisi_sas_phy_enable()
1059 phy->enable = enable; in hisi_sas_phy_enable()
1060 spin_unlock_irqrestore(&phy->lock, flags); in hisi_sas_phy_enable()
1066 struct hisi_sas_phy *phy = sas_phy->lldd_phy; in hisi_sas_port_notify_formed() local
1067 struct asd_sas_port *sas_port = sas_phy->port; in hisi_sas_port_notify_formed()
1074 port->port_attached = 1; in hisi_sas_port_notify_formed()
1075 port->id = phy->port_id; in hisi_sas_port_notify_formed()
1076 phy->port = port; in hisi_sas_port_notify_formed()
1077 sas_port->lldd_port = port; in hisi_sas_port_notify_formed()
1087 ts = &task->task_status; in hisi_sas_do_release_task()
1089 ts->resp = SAS_TASK_COMPLETE; in hisi_sas_do_release_task()
1090 ts->stat = SAS_ABORTED_TASK; in hisi_sas_do_release_task()
1091 spin_lock_irqsave(&task->task_state_lock, flags); in hisi_sas_do_release_task()
1092 task->task_state_flags &= ~SAS_TASK_STATE_PENDING; in hisi_sas_do_release_task()
1093 if (!slot->is_internal && task->task_proto != SAS_PROTOCOL_SMP) in hisi_sas_do_release_task()
1094 task->task_state_flags |= SAS_TASK_STATE_DONE; in hisi_sas_do_release_task()
1095 spin_unlock_irqrestore(&task->task_state_lock, flags); in hisi_sas_do_release_task()
1102 struct domain_device *device) in hisi_sas_release_task() argument
1105 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_release_task()
1107 spin_lock(&sas_dev->lock); in hisi_sas_release_task()
1108 list_for_each_entry_safe(slot, slot2, &sas_dev->list, entry) in hisi_sas_release_task()
1109 hisi_sas_do_release_task(hisi_hba, slot->task, slot, false); in hisi_sas_release_task()
1111 spin_unlock(&sas_dev->lock); in hisi_sas_release_task()
1117 struct domain_device *device; in hisi_sas_release_tasks() local
1121 sas_dev = &hisi_hba->devices[i]; in hisi_sas_release_tasks()
1122 device = sas_dev->sas_device; in hisi_sas_release_tasks()
1124 if ((sas_dev->dev_type == SAS_PHY_UNUSED) || in hisi_sas_release_tasks()
1125 !device) in hisi_sas_release_tasks()
1128 hisi_sas_release_task(hisi_hba, device); in hisi_sas_release_tasks()
1134 struct domain_device *device) in hisi_sas_dereg_device() argument
1136 if (hisi_hba->hw->dereg_device) in hisi_sas_dereg_device()
1137 hisi_hba->hw->dereg_device(hisi_hba, device); in hisi_sas_dereg_device()
1145 struct domain_device *device = sas_dev->sas_device; in hisi_sas_internal_task_abort_dev() local
1146 struct hisi_hba *hisi_hba = sas_dev->hisi_hba; in hisi_sas_internal_task_abort_dev()
1149 for (i = 0; i < hisi_hba->cq_nvecs; i++) { in hisi_sas_internal_task_abort_dev()
1150 struct hisi_sas_cq *cq = &hisi_hba->cq[i]; in hisi_sas_internal_task_abort_dev()
1151 const struct cpumask *mask = cq->irq_mask; in hisi_sas_internal_task_abort_dev()
1155 rc = sas_execute_internal_abort_dev(device, i, &data); in hisi_sas_internal_task_abort_dev()
1163 static void hisi_sas_dev_gone(struct domain_device *device) in hisi_sas_dev_gone() argument
1165 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_dev_gone()
1166 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_dev_gone()
1167 struct device *dev = hisi_hba->dev; in hisi_sas_dev_gone()
1171 sas_dev->device_id, sas_dev->dev_type); in hisi_sas_dev_gone()
1173 down(&hisi_hba->sem); in hisi_sas_dev_gone()
1174 if (!test_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags)) { in hisi_sas_dev_gone()
1177 hisi_sas_dereg_device(hisi_hba, device); in hisi_sas_dev_gone()
1179 ret = hisi_hba->hw->clear_itct(hisi_hba, sas_dev); in hisi_sas_dev_gone()
1180 device->lldd_dev = NULL; in hisi_sas_dev_gone()
1183 if (hisi_hba->hw->free_device) in hisi_sas_dev_gone()
1184 hisi_hba->hw->free_device(sas_dev); in hisi_sas_dev_gone()
1188 sas_dev->dev_type = SAS_PHY_UNUSED; in hisi_sas_dev_gone()
1189 sas_dev->sas_device = NULL; in hisi_sas_dev_gone()
1190 up(&hisi_hba->sem); in hisi_sas_dev_gone()
1198 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_phy_set_linkrate() local
1199 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_phy_set_linkrate()
1202 if (r->minimum_linkrate > SAS_LINK_RATE_1_5_GBPS) in hisi_sas_phy_set_linkrate()
1203 return -EINVAL; in hisi_sas_phy_set_linkrate()
1205 if (r->maximum_linkrate == SAS_LINK_RATE_UNKNOWN) { in hisi_sas_phy_set_linkrate()
1206 max = sas_phy->phy->maximum_linkrate; in hisi_sas_phy_set_linkrate()
1207 min = r->minimum_linkrate; in hisi_sas_phy_set_linkrate()
1208 } else if (r->minimum_linkrate == SAS_LINK_RATE_UNKNOWN) { in hisi_sas_phy_set_linkrate()
1209 max = r->maximum_linkrate; in hisi_sas_phy_set_linkrate()
1210 min = sas_phy->phy->minimum_linkrate; in hisi_sas_phy_set_linkrate()
1212 return -EINVAL; in hisi_sas_phy_set_linkrate()
1217 sas_phy->phy->maximum_linkrate = max; in hisi_sas_phy_set_linkrate()
1218 sas_phy->phy->minimum_linkrate = min; in hisi_sas_phy_set_linkrate()
1222 hisi_hba->hw->phy_set_linkrate(hisi_hba, phy_no, &_r); in hisi_sas_phy_set_linkrate()
1231 struct hisi_sas_phy *phy = container_of(sas_phy, in hisi_sas_control_phy() local
1233 struct sas_ha_struct *sas_ha = sas_phy->ha; in hisi_sas_control_phy()
1234 struct hisi_hba *hisi_hba = sas_ha->lldd_ha; in hisi_sas_control_phy()
1235 struct device *dev = hisi_hba->dev; in hisi_sas_control_phy()
1237 int phy_no = sas_phy->id; in hisi_sas_control_phy()
1238 u8 sts = phy->phy_attached; in hisi_sas_control_phy()
1241 down(&hisi_hba->sem); in hisi_sas_control_phy()
1242 phy->reset_completion = &completion; in hisi_sas_control_phy()
1246 hisi_hba->hw->phy_hard_reset(hisi_hba, phy_no); in hisi_sas_control_phy()
1264 if (hisi_hba->hw->get_events) { in hisi_sas_control_phy()
1265 hisi_hba->hw->get_events(hisi_hba, phy_no); in hisi_sas_control_phy()
1271 ret = -EOPNOTSUPP; in hisi_sas_control_phy()
1277 dev_warn(dev, "phy%d wait phyup timed out for func %d\n", in hisi_sas_control_phy()
1279 if (phy->in_reset) in hisi_sas_control_phy()
1280 ret = -ETIMEDOUT; in hisi_sas_control_phy()
1284 phy->reset_completion = NULL; in hisi_sas_control_phy()
1286 up(&hisi_hba->sem); in hisi_sas_control_phy()
1304 static int hisi_sas_softreset_ata_disk(struct domain_device *device) in hisi_sas_softreset_ata_disk() argument
1307 struct ata_port *ap = device->sata_dev.ap; in hisi_sas_softreset_ata_disk()
1310 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_softreset_ata_disk()
1311 struct device *dev = hisi_hba->dev; in hisi_sas_softreset_ata_disk()
1316 hisi_sas_fill_ata_reset_cmd(link->device, 1, pmp, fis); in hisi_sas_softreset_ata_disk()
1317 rc = sas_execute_ata_cmd(device, fis, -1); in hisi_sas_softreset_ata_disk()
1326 hisi_sas_fill_ata_reset_cmd(link->device, 0, pmp, fis); in hisi_sas_softreset_ata_disk()
1327 rc = sas_execute_ata_cmd(device, fis, -1); in hisi_sas_softreset_ata_disk()
1329 dev_err(dev, "ata disk %016llx de-reset failed\n", in hisi_sas_softreset_ata_disk()
1330 SAS_ADDR(device->sas_addr)); in hisi_sas_softreset_ata_disk()
1334 SAS_ADDR(device->sas_addr)); in hisi_sas_softreset_ata_disk()
1338 hisi_sas_release_task(hisi_hba, device); in hisi_sas_softreset_ata_disk()
1345 u32 state = hisi_hba->hw->get_phys_state(hisi_hba); in hisi_sas_refresh_port_id()
1349 struct hisi_sas_device *sas_dev = &hisi_hba->devices[i]; in hisi_sas_refresh_port_id()
1350 struct domain_device *device = sas_dev->sas_device; in hisi_sas_refresh_port_id() local
1353 struct hisi_sas_phy *phy = NULL; in hisi_sas_refresh_port_id() local
1356 if ((sas_dev->dev_type == SAS_PHY_UNUSED) in hisi_sas_refresh_port_id()
1357 || !device || !device->port) in hisi_sas_refresh_port_id()
1360 sas_port = device->port; in hisi_sas_refresh_port_id()
1363 spin_lock(&sas_port->phy_list_lock); in hisi_sas_refresh_port_id()
1364 list_for_each_entry(sas_phy, &sas_port->phy_list, port_phy_el) in hisi_sas_refresh_port_id()
1365 if (state & BIT(sas_phy->id)) { in hisi_sas_refresh_port_id()
1366 phy = sas_phy->lldd_phy; in hisi_sas_refresh_port_id()
1369 spin_unlock(&sas_port->phy_list_lock); in hisi_sas_refresh_port_id()
1371 if (phy) { in hisi_sas_refresh_port_id()
1372 port->id = phy->port_id; in hisi_sas_refresh_port_id()
1374 /* Update linkrate of directly attached device. */ in hisi_sas_refresh_port_id()
1375 if (!device->parent) in hisi_sas_refresh_port_id()
1376 device->linkrate = phy->sas_phy.linkrate; in hisi_sas_refresh_port_id()
1378 hisi_hba->hw->setup_itct(hisi_hba, sas_dev); in hisi_sas_refresh_port_id()
1379 } else if (!port->port_attached) in hisi_sas_refresh_port_id()
1380 port->id = 0xff; in hisi_sas_refresh_port_id()
1389 for (phy_no = 0; phy_no < hisi_hba->n_phy; phy_no++) { in hisi_sas_rescan_topology()
1390 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_rescan_topology() local
1391 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_rescan_topology()
1392 struct asd_sas_port *sas_port = sas_phy->port; in hisi_sas_rescan_topology()
1395 if (!sas_phy->phy->enabled) in hisi_sas_rescan_topology()
1398 /* Report PHY state change to libsas */ in hisi_sas_rescan_topology()
1400 if (do_port_check && sas_port && sas_port->port_dev) { in hisi_sas_rescan_topology()
1401 struct domain_device *dev = sas_port->port_dev; in hisi_sas_rescan_topology()
1405 if (dev_is_expander(dev->dev_type)) in hisi_sas_rescan_topology()
1419 struct domain_device *device; in hisi_sas_reset_init_all_devices() local
1423 sas_dev = &hisi_hba->devices[i]; in hisi_sas_reset_init_all_devices()
1424 device = sas_dev->sas_device; in hisi_sas_reset_init_all_devices()
1426 if ((sas_dev->dev_type == SAS_PHY_UNUSED) || !device) in hisi_sas_reset_init_all_devices()
1429 hisi_sas_init_device(device); in hisi_sas_reset_init_all_devices()
1435 struct domain_device *device) in hisi_sas_send_ata_reset_each_phy() argument
1437 struct ata_port *ap = device->sata_dev.ap; in hisi_sas_send_ata_reset_each_phy()
1438 struct device *dev = hisi_hba->dev; in hisi_sas_send_ata_reset_each_phy()
1444 for (i = 0; i < hisi_hba->n_phy; i++) { in hisi_sas_send_ata_reset_each_phy()
1445 if (!(sas_port->phy_mask & BIT(i))) in hisi_sas_send_ata_reset_each_phy()
1451 hisi_sas_fill_ata_reset_cmd(link->device, 1, pmp, fis); in hisi_sas_send_ata_reset_each_phy()
1452 rc = sas_execute_ata_cmd(device, fis, i); in hisi_sas_send_ata_reset_each_phy()
1454 dev_err(dev, "phy%d ata reset failed rc=%d\n", in hisi_sas_send_ata_reset_each_phy()
1464 struct device *dev = hisi_hba->dev; in hisi_sas_terminate_stp_reject()
1468 struct hisi_sas_device *sas_dev = &hisi_hba->devices[i]; in hisi_sas_terminate_stp_reject()
1469 struct domain_device *device = sas_dev->sas_device; in hisi_sas_terminate_stp_reject() local
1471 if ((sas_dev->dev_type == SAS_PHY_UNUSED) || !device) in hisi_sas_terminate_stp_reject()
1479 for (port_no = 0; port_no < hisi_hba->n_phy; port_no++) { in hisi_sas_terminate_stp_reject()
1480 struct hisi_sas_port *port = &hisi_hba->port[port_no]; in hisi_sas_terminate_stp_reject()
1481 struct asd_sas_port *sas_port = &port->sas_port; in hisi_sas_terminate_stp_reject()
1482 struct domain_device *port_dev = sas_port->port_dev; in hisi_sas_terminate_stp_reject()
1483 struct domain_device *device; in hisi_sas_terminate_stp_reject() local
1485 if (!port_dev || !dev_is_expander(port_dev->dev_type)) in hisi_sas_terminate_stp_reject()
1488 /* Try to find a SATA device */ in hisi_sas_terminate_stp_reject()
1489 list_for_each_entry(device, &sas_port->dev_list, in hisi_sas_terminate_stp_reject()
1491 if (dev_is_sata(device)) { in hisi_sas_terminate_stp_reject()
1494 device); in hisi_sas_terminate_stp_reject()
1503 struct Scsi_Host *shost = hisi_hba->shost; in hisi_sas_controller_reset_prepare()
1505 hisi_hba->phy_state = hisi_hba->hw->get_phys_state(hisi_hba); in hisi_sas_controller_reset_prepare()
1508 hisi_hba->hw->wait_cmds_complete_timeout(hisi_hba, 100, 5000); in hisi_sas_controller_reset_prepare()
1510 del_timer_sync(&hisi_hba->timer); in hisi_sas_controller_reset_prepare()
1512 set_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); in hisi_sas_controller_reset_prepare()
1518 struct hisi_sas_phy *phy = data; in hisi_sas_async_init_wait_phyup() local
1519 struct hisi_hba *hisi_hba = phy->hisi_hba; in hisi_sas_async_init_wait_phyup()
1520 struct device *dev = hisi_hba->dev; in hisi_sas_async_init_wait_phyup()
1522 int phy_no = phy->sas_phy.id; in hisi_sas_async_init_wait_phyup()
1524 phy->reset_completion = &completion; in hisi_sas_async_init_wait_phyup()
1528 dev_warn(dev, "phy%d wait phyup timed out\n", phy_no); in hisi_sas_async_init_wait_phyup()
1530 phy->reset_completion = NULL; in hisi_sas_async_init_wait_phyup()
1535 struct Scsi_Host *shost = hisi_hba->shost; in hisi_sas_controller_reset_done()
1540 for (phy_no = 0; phy_no < hisi_hba->n_phy; phy_no++) { in hisi_sas_controller_reset_done()
1541 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_controller_reset_done() local
1542 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_controller_reset_done()
1544 if (!sas_phy->phy->enabled) in hisi_sas_controller_reset_done()
1547 if (!(hisi_hba->phy_state & BIT(phy_no))) { in hisi_sas_controller_reset_done()
1553 phy, &async); in hisi_sas_controller_reset_done()
1558 clear_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); in hisi_sas_controller_reset_done()
1560 if (hisi_hba->reject_stp_links_msk) in hisi_sas_controller_reset_done()
1564 clear_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags); in hisi_sas_controller_reset_done()
1565 up(&hisi_hba->sem); in hisi_sas_controller_reset_done()
1567 hisi_sas_rescan_topology(hisi_hba, hisi_hba->phy_state); in hisi_sas_controller_reset_done()
1573 if (!hisi_hba->hw->soft_reset) in hisi_sas_controller_prereset()
1574 return -ENOENT; in hisi_sas_controller_prereset()
1576 down(&hisi_hba->sem); in hisi_sas_controller_prereset()
1577 if (test_and_set_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags)) { in hisi_sas_controller_prereset()
1578 up(&hisi_hba->sem); in hisi_sas_controller_prereset()
1579 return -EPERM; in hisi_sas_controller_prereset()
1583 hisi_hba->hw->debugfs_snapshot_regs(hisi_hba); in hisi_sas_controller_prereset()
1590 struct device *dev = hisi_hba->dev; in hisi_sas_controller_reset()
1591 struct Scsi_Host *shost = hisi_hba->shost; in hisi_sas_controller_reset()
1597 rc = hisi_hba->hw->soft_reset(hisi_hba); in hisi_sas_controller_reset()
1600 clear_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); in hisi_sas_controller_reset()
1601 up(&hisi_hba->sem); in hisi_sas_controller_reset()
1603 clear_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags); in hisi_sas_controller_reset()
1606 clear_bit(HISI_SAS_HW_FAULT_BIT, &hisi_hba->flags); in hisi_sas_controller_reset()
1617 struct domain_device *device = task->dev; in hisi_sas_abort_task() local
1618 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_abort_task()
1619 struct hisi_sas_slot *slot = task->lldd_task; in hisi_sas_abort_task()
1621 struct device *dev; in hisi_sas_abort_task()
1628 hisi_hba = dev_to_hisi_hba(task->dev); in hisi_sas_abort_task()
1629 dev = hisi_hba->dev; in hisi_sas_abort_task()
1631 spin_lock_irqsave(&task->task_state_lock, flags); in hisi_sas_abort_task()
1632 if (task->task_state_flags & SAS_TASK_STATE_DONE) { in hisi_sas_abort_task()
1640 cq = &hisi_hba->cq[slot->dlvry_queue]; in hisi_sas_abort_task()
1643 spin_unlock_irqrestore(&task->task_state_lock, flags); in hisi_sas_abort_task()
1647 task->task_state_flags |= SAS_TASK_STATE_ABORTED; in hisi_sas_abort_task()
1648 spin_unlock_irqrestore(&task->task_state_lock, flags); in hisi_sas_abort_task()
1653 if (task->task_proto & SAS_PROTOCOL_SSP) { in hisi_sas_abort_task()
1654 u16 tag = slot->idx; in hisi_sas_abort_task()
1658 rc2 = sas_execute_internal_abort_single(device, tag, in hisi_sas_abort_task()
1659 slot->dlvry_queue, &internal_abort_data); in hisi_sas_abort_task()
1666 * If the TMF finds that the IO is not in the device and also in hisi_sas_abort_task()
1673 if (task->lldd_task) in hisi_sas_abort_task()
1676 } else if (task->task_proto & SAS_PROTOCOL_SATA || in hisi_sas_abort_task()
1677 task->task_proto & SAS_PROTOCOL_STP) { in hisi_sas_abort_task()
1678 if (task->dev->dev_type == SAS_SATA_DEV) { in hisi_sas_abort_task()
1679 struct ata_queued_cmd *qc = task->uldd_task; in hisi_sas_abort_task()
1686 hisi_sas_dereg_device(hisi_hba, device); in hisi_sas_abort_task()
1692 if ((sas_dev->dev_status == HISI_SAS_DEV_NCQ_ERR) && in hisi_sas_abort_task()
1693 qc && qc->scsicmd) { in hisi_sas_abort_task()
1697 rc = hisi_sas_softreset_ata_disk(device); in hisi_sas_abort_task()
1700 } else if (task->task_proto & SAS_PROTOCOL_SMP) { in hisi_sas_abort_task()
1702 u32 tag = slot->idx; in hisi_sas_abort_task()
1703 struct hisi_sas_cq *cq = &hisi_hba->cq[slot->dlvry_queue]; in hisi_sas_abort_task()
1705 rc = sas_execute_internal_abort_single(device, in hisi_sas_abort_task()
1706 tag, slot->dlvry_queue, in hisi_sas_abort_task()
1709 task->lldd_task) { in hisi_sas_abort_task()
1715 slot->task = NULL; in hisi_sas_abort_task()
1725 static int hisi_sas_abort_task_set(struct domain_device *device, u8 *lun) in hisi_sas_abort_task_set() argument
1727 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_abort_task_set()
1728 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_abort_task_set()
1729 struct device *dev = hisi_hba->dev; in hisi_sas_abort_task_set()
1737 hisi_sas_dereg_device(hisi_hba, device); in hisi_sas_abort_task_set()
1739 rc = sas_abort_task_set(device, lun); in hisi_sas_abort_task_set()
1741 hisi_sas_release_task(hisi_hba, device); in hisi_sas_abort_task_set()
1746 static int hisi_sas_debug_I_T_nexus_reset(struct domain_device *device) in hisi_sas_debug_I_T_nexus_reset() argument
1748 struct sas_phy *local_phy = sas_get_local_phy(device); in hisi_sas_debug_I_T_nexus_reset()
1749 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_debug_I_T_nexus_reset()
1750 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_debug_I_T_nexus_reset()
1751 struct sas_ha_struct *sas_ha = &hisi_hba->sha; in hisi_sas_debug_I_T_nexus_reset()
1754 if (!local_phy->enabled) { in hisi_sas_debug_I_T_nexus_reset()
1756 return -ENODEV; in hisi_sas_debug_I_T_nexus_reset()
1761 sas_ha->sas_phy[local_phy->number]; in hisi_sas_debug_I_T_nexus_reset()
1762 struct hisi_sas_phy *phy = in hisi_sas_debug_I_T_nexus_reset() local
1766 spin_lock_irqsave(&phy->lock, flags); in hisi_sas_debug_I_T_nexus_reset()
1767 phy->in_reset = 1; in hisi_sas_debug_I_T_nexus_reset()
1768 spin_unlock_irqrestore(&phy->lock, flags); in hisi_sas_debug_I_T_nexus_reset()
1771 reset_type = (sas_dev->dev_status == HISI_SAS_DEV_INIT || in hisi_sas_debug_I_T_nexus_reset()
1772 !dev_is_sata(device)) ? true : false; in hisi_sas_debug_I_T_nexus_reset()
1779 sas_ha->sas_phy[local_phy->number]; in hisi_sas_debug_I_T_nexus_reset()
1780 struct hisi_sas_phy *phy = in hisi_sas_debug_I_T_nexus_reset() local
1784 spin_lock_irqsave(&phy->lock, flags); in hisi_sas_debug_I_T_nexus_reset()
1785 phy->in_reset = 0; in hisi_sas_debug_I_T_nexus_reset()
1786 spin_unlock_irqrestore(&phy->lock, flags); in hisi_sas_debug_I_T_nexus_reset()
1788 /* report PHY down if timed out */ in hisi_sas_debug_I_T_nexus_reset()
1789 if (rc == -ETIMEDOUT) in hisi_sas_debug_I_T_nexus_reset()
1790 hisi_sas_phy_down(hisi_hba, sas_phy->id, 0, GFP_KERNEL); in hisi_sas_debug_I_T_nexus_reset()
1794 /* Remote phy */ in hisi_sas_debug_I_T_nexus_reset()
1798 if (dev_is_sata(device)) { in hisi_sas_debug_I_T_nexus_reset()
1799 struct ata_link *link = &device->sata_dev.ap->link; in hisi_sas_debug_I_T_nexus_reset()
1810 static int hisi_sas_I_T_nexus_reset(struct domain_device *device) in hisi_sas_I_T_nexus_reset() argument
1812 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_I_T_nexus_reset()
1813 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_I_T_nexus_reset()
1814 struct device *dev = hisi_hba->dev; in hisi_sas_I_T_nexus_reset()
1817 if (sas_dev->dev_status == HISI_SAS_DEV_NCQ_ERR) in hisi_sas_I_T_nexus_reset()
1818 sas_dev->dev_status = HISI_SAS_DEV_NORMAL; in hisi_sas_I_T_nexus_reset()
1825 hisi_sas_dereg_device(hisi_hba, device); in hisi_sas_I_T_nexus_reset()
1827 rc = hisi_sas_debug_I_T_nexus_reset(device); in hisi_sas_I_T_nexus_reset()
1828 if (rc == TMF_RESP_FUNC_COMPLETE && dev_is_sata(device)) { in hisi_sas_I_T_nexus_reset()
1831 rc = hisi_sas_softreset_ata_disk(device); in hisi_sas_I_T_nexus_reset()
1833 case -ECOMM: in hisi_sas_I_T_nexus_reset()
1834 rc = -ENODEV; in hisi_sas_I_T_nexus_reset()
1837 case -EMSGSIZE: in hisi_sas_I_T_nexus_reset()
1838 case -EIO: in hisi_sas_I_T_nexus_reset()
1839 local_phy = sas_get_local_phy(device); in hisi_sas_I_T_nexus_reset()
1842 local_phy->enabled = 0; in hisi_sas_I_T_nexus_reset()
1843 dev_err(dev, "Disabled local phy of ATA disk %016llx due to softreset fail (%d)\n", in hisi_sas_I_T_nexus_reset()
1844 SAS_ADDR(device->sas_addr), rc); in hisi_sas_I_T_nexus_reset()
1845 rc = -ENODEV; in hisi_sas_I_T_nexus_reset()
1854 if ((rc == TMF_RESP_FUNC_COMPLETE) || (rc == -ENODEV)) in hisi_sas_I_T_nexus_reset()
1855 hisi_sas_release_task(hisi_hba, device); in hisi_sas_I_T_nexus_reset()
1860 static int hisi_sas_lu_reset(struct domain_device *device, u8 *lun) in hisi_sas_lu_reset() argument
1862 struct hisi_sas_device *sas_dev = device->lldd_dev; in hisi_sas_lu_reset()
1863 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_lu_reset()
1864 struct device *dev = hisi_hba->dev; in hisi_sas_lu_reset()
1873 hisi_sas_dereg_device(hisi_hba, device); in hisi_sas_lu_reset()
1875 if (dev_is_sata(device)) { in hisi_sas_lu_reset()
1876 struct sas_phy *phy; in hisi_sas_lu_reset() local
1878 phy = sas_get_local_phy(device); in hisi_sas_lu_reset()
1880 rc = sas_phy_reset(phy, true); in hisi_sas_lu_reset()
1883 hisi_sas_release_task(hisi_hba, device); in hisi_sas_lu_reset()
1884 sas_put_local_phy(phy); in hisi_sas_lu_reset()
1886 rc = sas_lu_reset(device, lun); in hisi_sas_lu_reset()
1888 hisi_sas_release_task(hisi_hba, device); in hisi_sas_lu_reset()
1892 dev_err(dev, "lu_reset: for device[%d]:rc= %d\n", in hisi_sas_lu_reset()
1893 sas_dev->device_id, rc); in hisi_sas_lu_reset()
1899 struct domain_device *device = data; in hisi_sas_async_I_T_nexus_reset() local
1900 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_async_I_T_nexus_reset()
1903 rc = hisi_sas_debug_I_T_nexus_reset(device); in hisi_sas_async_I_T_nexus_reset()
1905 dev_info(hisi_hba->dev, "I_T_nexus reset fail for dev:%016llx rc=%d\n", in hisi_sas_async_I_T_nexus_reset()
1906 SAS_ADDR(device->sas_addr), rc); in hisi_sas_async_I_T_nexus_reset()
1911 struct hisi_hba *hisi_hba = sas_ha->lldd_ha; in hisi_sas_clear_nexus_ha()
1916 queue_work(hisi_hba->wq, &r.work); in hisi_sas_clear_nexus_ha()
1922 struct hisi_sas_device *sas_dev = &hisi_hba->devices[i]; in hisi_sas_clear_nexus_ha()
1923 struct domain_device *device = sas_dev->sas_device; in hisi_sas_clear_nexus_ha() local
1925 if ((sas_dev->dev_type == SAS_PHY_UNUSED) || !device || in hisi_sas_clear_nexus_ha()
1926 dev_is_expander(device->dev_type)) in hisi_sas_clear_nexus_ha()
1930 device, &async); in hisi_sas_clear_nexus_ha()
1943 if (task->lldd_task && task->task_proto & SAS_PROTOCOL_SSP) { in hisi_sas_query_task()
1944 struct hisi_sas_slot *slot = task->lldd_task; in hisi_sas_query_task()
1945 u32 tag = slot->idx; in hisi_sas_query_task()
1951 /* The task is not in Lun or failed, reset the phy */ in hisi_sas_query_task()
1966 struct domain_device *device = task->dev; in hisi_sas_internal_abort_timeout() local
1967 struct hisi_hba *hisi_hba = dev_to_hisi_hba(device); in hisi_sas_internal_abort_timeout()
1972 * If timeout occurs in device gone scenario, to avoid in hisi_sas_internal_abort_timeout()
1974 * hisi_sas_dev_gone() -> down() -> ... -> in hisi_sas_internal_abort_timeout()
1975 * hisi_sas_internal_abort_timeout() -> down(). in hisi_sas_internal_abort_timeout()
1977 if (!timeout->rst_ha_timeout) in hisi_sas_internal_abort_timeout()
1978 down(&hisi_hba->sem); in hisi_sas_internal_abort_timeout()
1979 hisi_hba->hw->debugfs_snapshot_regs(hisi_hba); in hisi_sas_internal_abort_timeout()
1980 if (!timeout->rst_ha_timeout) in hisi_sas_internal_abort_timeout()
1981 up(&hisi_hba->sem); in hisi_sas_internal_abort_timeout()
1984 if (task->task_state_flags & SAS_TASK_STATE_DONE) { in hisi_sas_internal_abort_timeout()
1986 SAS_ADDR(device->sas_addr)); in hisi_sas_internal_abort_timeout()
1988 struct hisi_sas_slot *slot = task->lldd_task; in hisi_sas_internal_abort_timeout()
1990 set_bit(HISI_SAS_HW_FAULT_BIT, &hisi_hba->flags); in hisi_sas_internal_abort_timeout()
1994 &hisi_hba->cq[slot->dlvry_queue]; in hisi_sas_internal_abort_timeout()
2000 slot->task = NULL; in hisi_sas_internal_abort_timeout()
2003 if (timeout->rst_ha_timeout) { in hisi_sas_internal_abort_timeout()
2005 SAS_ADDR(device->sas_addr)); in hisi_sas_internal_abort_timeout()
2006 queue_work(hisi_hba->wq, &hisi_hba->rst_work); in hisi_sas_internal_abort_timeout()
2009 SAS_ADDR(device->sas_addr)); in hisi_sas_internal_abort_timeout()
2026 struct hisi_hba *hisi_hba = sha->lldd_ha; in hisi_sas_write_gpio()
2028 if (!hisi_hba->hw->write_gpio) in hisi_sas_write_gpio()
2029 return -EOPNOTSUPP; in hisi_sas_write_gpio()
2031 return hisi_hba->hw->write_gpio(hisi_hba, reg_type, in hisi_sas_write_gpio()
2035 static void hisi_sas_phy_disconnected(struct hisi_sas_phy *phy) in hisi_sas_phy_disconnected() argument
2037 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_phy_disconnected()
2038 struct sas_phy *sphy = sas_phy->phy; in hisi_sas_phy_disconnected()
2041 phy->phy_attached = 0; in hisi_sas_phy_disconnected()
2042 phy->phy_type = 0; in hisi_sas_phy_disconnected()
2043 phy->port = NULL; in hisi_sas_phy_disconnected()
2045 spin_lock_irqsave(&phy->lock, flags); in hisi_sas_phy_disconnected()
2046 if (phy->enable) in hisi_sas_phy_disconnected()
2047 sphy->negotiated_linkrate = SAS_LINK_RATE_UNKNOWN; in hisi_sas_phy_disconnected()
2049 sphy->negotiated_linkrate = SAS_PHY_DISABLED; in hisi_sas_phy_disconnected()
2050 spin_unlock_irqrestore(&phy->lock, flags); in hisi_sas_phy_disconnected()
2056 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; in hisi_sas_phy_down() local
2057 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_phy_down()
2058 struct device *dev = hisi_hba->dev; in hisi_sas_phy_down()
2061 /* Phy down but ready */ in hisi_sas_phy_down()
2065 struct hisi_sas_port *port = phy->port; in hisi_sas_phy_down()
2067 if (test_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags) || in hisi_sas_phy_down()
2068 phy->in_reset) { in hisi_sas_phy_down()
2069 dev_info(dev, "ignore flutter phy%d down\n", phy_no); in hisi_sas_phy_down()
2072 /* Phy down and not ready */ in hisi_sas_phy_down()
2077 if (phy->phy_type & PORT_TYPE_SAS) { in hisi_sas_phy_down()
2078 int port_id = port->id; in hisi_sas_phy_down()
2080 if (!hisi_hba->hw->get_wideport_bitmap(hisi_hba, in hisi_sas_phy_down()
2082 port->port_attached = 0; in hisi_sas_phy_down()
2083 } else if (phy->phy_type & PORT_TYPE_SATA) in hisi_sas_phy_down()
2084 port->port_attached = 0; in hisi_sas_phy_down()
2086 hisi_sas_phy_disconnected(phy); in hisi_sas_phy_down()
2091 void hisi_sas_phy_bcast(struct hisi_sas_phy *phy) in hisi_sas_phy_bcast() argument
2093 struct asd_sas_phy *sas_phy = &phy->sas_phy; in hisi_sas_phy_bcast()
2094 struct hisi_hba *hisi_hba = phy->hisi_hba; in hisi_sas_phy_bcast()
2096 if (test_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags)) in hisi_sas_phy_bcast()
2108 return -EOPNOTSUPP; in hisi_sas_host_reset()
2110 queue_work(hisi_hba->wq, &hisi_hba->rst_work); in hisi_sas_host_reset()
2139 struct hisi_sas_breakpoint *sata_breakpoint = hisi_hba->sata_breakpoint; in hisi_sas_init_mem()
2141 for (i = 0; i < hisi_hba->queue_count; i++) { in hisi_sas_init_mem()
2142 struct hisi_sas_cq *cq = &hisi_hba->cq[i]; in hisi_sas_init_mem()
2143 struct hisi_sas_dq *dq = &hisi_hba->dq[i]; in hisi_sas_init_mem()
2144 struct hisi_sas_cmd_hdr *cmd_hdr = hisi_hba->cmd_hdr[i]; in hisi_sas_init_mem()
2150 dq->wr_point = 0; in hisi_sas_init_mem()
2152 s = hisi_hba->hw->complete_hdr_size * HISI_SAS_QUEUE_SLOTS; in hisi_sas_init_mem()
2153 memset(hisi_hba->complete_hdr[i], 0, s); in hisi_sas_init_mem()
2154 cq->rd_point = 0; in hisi_sas_init_mem()
2157 s = sizeof(struct hisi_sas_initial_fis) * hisi_hba->n_phy; in hisi_sas_init_mem()
2158 memset(hisi_hba->initial_fis, 0, s); in hisi_sas_init_mem()
2161 memset(hisi_hba->iost, 0, s); in hisi_sas_init_mem()
2164 memset(hisi_hba->breakpoint, 0, s); in hisi_sas_init_mem()
2174 struct device *dev = hisi_hba->dev; in hisi_sas_alloc()
2179 sema_init(&hisi_hba->sem, 1); in hisi_sas_alloc()
2180 spin_lock_init(&hisi_hba->lock); in hisi_sas_alloc()
2181 for (i = 0; i < hisi_hba->n_phy; i++) { in hisi_sas_alloc()
2183 hisi_hba->port[i].port_attached = 0; in hisi_sas_alloc()
2184 hisi_hba->port[i].id = -1; in hisi_sas_alloc()
2188 hisi_hba->devices[i].dev_type = SAS_PHY_UNUSED; in hisi_sas_alloc()
2189 hisi_hba->devices[i].device_id = i; in hisi_sas_alloc()
2190 hisi_hba->devices[i].dev_status = HISI_SAS_DEV_INIT; in hisi_sas_alloc()
2193 for (i = 0; i < hisi_hba->queue_count; i++) { in hisi_sas_alloc()
2194 struct hisi_sas_cq *cq = &hisi_hba->cq[i]; in hisi_sas_alloc()
2195 struct hisi_sas_dq *dq = &hisi_hba->dq[i]; in hisi_sas_alloc()
2198 cq->id = i; in hisi_sas_alloc()
2199 cq->hisi_hba = hisi_hba; in hisi_sas_alloc()
2200 spin_lock_init(&cq->poll_lock); in hisi_sas_alloc()
2203 spin_lock_init(&dq->lock); in hisi_sas_alloc()
2204 INIT_LIST_HEAD(&dq->list); in hisi_sas_alloc()
2205 dq->id = i; in hisi_sas_alloc()
2206 dq->hisi_hba = hisi_hba; in hisi_sas_alloc()
2210 hisi_hba->cmd_hdr[i] = dmam_alloc_coherent(dev, s, in hisi_sas_alloc()
2211 &hisi_hba->cmd_hdr_dma[i], in hisi_sas_alloc()
2213 if (!hisi_hba->cmd_hdr[i]) in hisi_sas_alloc()
2217 s = hisi_hba->hw->complete_hdr_size * HISI_SAS_QUEUE_SLOTS; in hisi_sas_alloc()
2218 hisi_hba->complete_hdr[i] = dmam_alloc_coherent(dev, s, in hisi_sas_alloc()
2219 &hisi_hba->complete_hdr_dma[i], in hisi_sas_alloc()
2221 if (!hisi_hba->complete_hdr[i]) in hisi_sas_alloc()
2226 hisi_hba->itct = dmam_alloc_coherent(dev, s, &hisi_hba->itct_dma, in hisi_sas_alloc()
2228 if (!hisi_hba->itct) in hisi_sas_alloc()
2231 hisi_hba->slot_info = devm_kcalloc(dev, max_command_entries, in hisi_sas_alloc()
2234 if (!hisi_hba->slot_info) in hisi_sas_alloc()
2239 if (hisi_hba->prot_mask & HISI_SAS_DIX_PROT_MASK) in hisi_sas_alloc()
2261 slot = &hisi_hba->slot_info[slot_index]; in hisi_sas_alloc()
2262 slot->buf = buf; in hisi_sas_alloc()
2263 slot->buf_dma = buf_dma; in hisi_sas_alloc()
2264 slot->idx = slot_index; in hisi_sas_alloc()
2272 hisi_hba->iost = dmam_alloc_coherent(dev, s, &hisi_hba->iost_dma, in hisi_sas_alloc()
2274 if (!hisi_hba->iost) in hisi_sas_alloc()
2278 hisi_hba->breakpoint = dmam_alloc_coherent(dev, s, in hisi_sas_alloc()
2279 &hisi_hba->breakpoint_dma, in hisi_sas_alloc()
2281 if (!hisi_hba->breakpoint) in hisi_sas_alloc()
2284 s = hisi_hba->slot_index_count = max_command_entries; in hisi_sas_alloc()
2285 hisi_hba->slot_index_tags = devm_bitmap_zalloc(dev, s, GFP_KERNEL); in hisi_sas_alloc()
2286 if (!hisi_hba->slot_index_tags) in hisi_sas_alloc()
2290 hisi_hba->initial_fis = dmam_alloc_coherent(dev, s, in hisi_sas_alloc()
2291 &hisi_hba->initial_fis_dma, in hisi_sas_alloc()
2293 if (!hisi_hba->initial_fis) in hisi_sas_alloc()
2297 hisi_hba->sata_breakpoint = dmam_alloc_coherent(dev, s, in hisi_sas_alloc()
2298 &hisi_hba->sata_breakpoint_dma, in hisi_sas_alloc()
2300 if (!hisi_hba->sata_breakpoint) in hisi_sas_alloc()
2303 hisi_hba->last_slot_index = 0; in hisi_sas_alloc()
2305 hisi_hba->wq = create_singlethread_workqueue(dev_name(dev)); in hisi_sas_alloc()
2306 if (!hisi_hba->wq) { in hisi_sas_alloc()
2313 return -ENOMEM; in hisi_sas_alloc()
2321 for (i = 0; i < hisi_hba->n_phy; i++) { in hisi_sas_free()
2322 struct hisi_sas_phy *phy = &hisi_hba->phy[i]; in hisi_sas_free() local
2324 del_timer_sync(&phy->timer); in hisi_sas_free()
2327 if (hisi_hba->wq) in hisi_sas_free()
2328 destroy_workqueue(hisi_hba->wq); in hisi_sas_free()
2349 if (hisi_sas_controller_prereset(rst->hisi_hba)) in hisi_sas_sync_rst_work_handler()
2352 if (!hisi_sas_controller_reset(rst->hisi_hba)) in hisi_sas_sync_rst_work_handler()
2353 rst->done = true; in hisi_sas_sync_rst_work_handler()
2355 complete(rst->completion); in hisi_sas_sync_rst_work_handler()
2361 struct device *dev = hisi_hba->dev; in hisi_sas_get_fw_info()
2362 struct platform_device *pdev = hisi_hba->platform_dev; in hisi_sas_get_fw_info()
2363 struct device_node *np = pdev ? pdev->dev.of_node : NULL; in hisi_sas_get_fw_info()
2366 if (device_property_read_u8_array(dev, "sas-addr", hisi_hba->sas_addr, in hisi_sas_get_fw_info()
2368 dev_err(dev, "could not get property sas-addr\n"); in hisi_sas_get_fw_info()
2369 return -ENOENT; in hisi_sas_get_fw_info()
2374 * These properties are only required for platform device-based in hisi_sas_get_fw_info()
2377 hisi_hba->ctrl = syscon_regmap_lookup_by_phandle(np, in hisi_sas_get_fw_info()
2378 "hisilicon,sas-syscon"); in hisi_sas_get_fw_info()
2379 if (IS_ERR(hisi_hba->ctrl)) { in hisi_sas_get_fw_info()
2381 return -ENOENT; in hisi_sas_get_fw_info()
2384 if (device_property_read_u32(dev, "ctrl-reset-reg", in hisi_sas_get_fw_info()
2385 &hisi_hba->ctrl_reset_reg)) { in hisi_sas_get_fw_info()
2386 dev_err(dev, "could not get property ctrl-reset-reg\n"); in hisi_sas_get_fw_info()
2387 return -ENOENT; in hisi_sas_get_fw_info()
2390 if (device_property_read_u32(dev, "ctrl-reset-sts-reg", in hisi_sas_get_fw_info()
2391 &hisi_hba->ctrl_reset_sts_reg)) { in hisi_sas_get_fw_info()
2392 dev_err(dev, "could not get property ctrl-reset-sts-reg\n"); in hisi_sas_get_fw_info()
2393 return -ENOENT; in hisi_sas_get_fw_info()
2396 if (device_property_read_u32(dev, "ctrl-clock-ena-reg", in hisi_sas_get_fw_info()
2397 &hisi_hba->ctrl_clock_ena_reg)) { in hisi_sas_get_fw_info()
2398 dev_err(dev, "could not get property ctrl-clock-ena-reg\n"); in hisi_sas_get_fw_info()
2399 return -ENOENT; in hisi_sas_get_fw_info()
2407 hisi_hba->refclk_frequency_mhz = clk_get_rate(refclk) / 1000000; in hisi_sas_get_fw_info()
2409 if (device_property_read_u32(dev, "phy-count", &hisi_hba->n_phy)) { in hisi_sas_get_fw_info()
2410 dev_err(dev, "could not get property phy-count\n"); in hisi_sas_get_fw_info()
2411 return -ENOENT; in hisi_sas_get_fw_info()
2414 if (device_property_read_u32(dev, "queue-count", in hisi_sas_get_fw_info()
2415 &hisi_hba->queue_count)) { in hisi_sas_get_fw_info()
2416 dev_err(dev, "could not get property queue-count\n"); in hisi_sas_get_fw_info()
2417 return -ENOENT; in hisi_sas_get_fw_info()
2430 struct device *dev = &pdev->dev; in hisi_sas_shost_alloc()
2433 shost = scsi_host_alloc(hw->sht, sizeof(*hisi_hba)); in hisi_sas_shost_alloc()
2440 INIT_WORK(&hisi_hba->rst_work, hisi_sas_rst_work_handler); in hisi_sas_shost_alloc()
2441 hisi_hba->hw = hw; in hisi_sas_shost_alloc()
2442 hisi_hba->dev = dev; in hisi_sas_shost_alloc()
2443 hisi_hba->platform_dev = pdev; in hisi_sas_shost_alloc()
2444 hisi_hba->shost = shost; in hisi_sas_shost_alloc()
2445 SHOST_TO_SAS_HA(shost) = &hisi_hba->sha; in hisi_sas_shost_alloc()
2447 timer_setup(&hisi_hba->timer, NULL, 0); in hisi_sas_shost_alloc()
2458 hisi_hba->regs = devm_platform_ioremap_resource(pdev, 0); in hisi_sas_shost_alloc()
2459 if (IS_ERR(hisi_hba->regs)) in hisi_sas_shost_alloc()
2464 hisi_hba->sgpio_regs = devm_ioremap_resource(dev, res); in hisi_sas_shost_alloc()
2465 if (IS_ERR(hisi_hba->sgpio_regs)) in hisi_sas_shost_alloc()
2483 if (hisi_hba->hw->interrupt_preinit) in hisi_sas_interrupt_preinit()
2484 return hisi_hba->hw->interrupt_preinit(hisi_hba); in hisi_sas_interrupt_preinit()
2493 struct device *dev = &pdev->dev; in hisi_sas_probe()
2501 return -ENOMEM; in hisi_sas_probe()
2507 phy_nr = port_nr = hisi_hba->n_phy; in hisi_sas_probe()
2512 rc = -ENOMEM; in hisi_sas_probe()
2516 sha->sas_phy = arr_phy; in hisi_sas_probe()
2517 sha->sas_port = arr_port; in hisi_sas_probe()
2518 sha->lldd_ha = hisi_hba; in hisi_sas_probe()
2520 shost->transportt = hisi_sas_stt; in hisi_sas_probe()
2521 shost->max_id = HISI_SAS_MAX_DEVICES; in hisi_sas_probe()
2522 shost->max_lun = ~0; in hisi_sas_probe()
2523 shost->max_channel = 1; in hisi_sas_probe()
2524 shost->max_cmd_len = 16; in hisi_sas_probe()
2525 if (hisi_hba->hw->slot_index_alloc) { in hisi_sas_probe()
2526 shost->can_queue = HISI_SAS_MAX_COMMANDS; in hisi_sas_probe()
2527 shost->cmd_per_lun = HISI_SAS_MAX_COMMANDS; in hisi_sas_probe()
2529 shost->can_queue = HISI_SAS_UNRESERVED_IPTT; in hisi_sas_probe()
2530 shost->cmd_per_lun = HISI_SAS_UNRESERVED_IPTT; in hisi_sas_probe()
2533 sha->sas_ha_name = DRV_NAME; in hisi_sas_probe()
2534 sha->dev = hisi_hba->dev; in hisi_sas_probe()
2535 sha->sas_addr = &hisi_hba->sas_addr[0]; in hisi_sas_probe()
2536 sha->num_phys = hisi_hba->n_phy; in hisi_sas_probe()
2537 sha->shost = hisi_hba->shost; in hisi_sas_probe()
2539 for (i = 0; i < hisi_hba->n_phy; i++) { in hisi_sas_probe()
2540 sha->sas_phy[i] = &hisi_hba->phy[i].sas_phy; in hisi_sas_probe()
2541 sha->sas_port[i] = &hisi_hba->port[i].sas_port; in hisi_sas_probe()
2548 rc = scsi_add_host(shost, &pdev->dev); in hisi_sas_probe()
2556 rc = hisi_hba->hw->hw_init(hisi_hba); in hisi_sas_probe()
2578 struct hisi_hba *hisi_hba = sha->lldd_ha; in hisi_sas_remove()
2579 struct Scsi_Host *shost = sha->shost; in hisi_sas_remove()
2581 del_timer_sync(&hisi_hba->timer); in hisi_sas_remove()
2617 return -ENOMEM; in hisi_sas_init()