Lines Matching full:ch
64 static void ahci_ch_intr_main(struct ahci_channel *ch, uint32_t istatus);
65 static void ahci_begin_transaction(struct ahci_channel *ch, union ccb *ccb);
70 static int ahci_setup_fis(struct ahci_channel *ch, struct ahci_cmd_tab *ctp, union ccb *ccb, int ta…
76 static void ahci_reset(struct ahci_channel *ch);
77 static void ahci_start(struct ahci_channel *ch, int fbs);
78 static void ahci_stop(struct ahci_channel *ch);
79 static void ahci_clo(struct ahci_channel *ch);
80 static void ahci_start_fr(struct ahci_channel *ch);
81 static void ahci_stop_fr(struct ahci_channel *ch);
82 static int ahci_phy_check_events(struct ahci_channel *ch, u_int32_t serr);
83 static uint32_t ahci_ch_detval(struct ahci_channel *ch, uint32_t val);
85 static int ahci_sata_connect(struct ahci_channel *ch);
86 static int ahci_sata_phy_reset(struct ahci_channel *ch);
87 static int ahci_wait_ready(struct ahci_channel *ch, int t, int t0);
89 static void ahci_issue_recovery(struct ahci_channel *ch);
90 static void ahci_process_read_log(struct ahci_channel *ch, union ccb *ccb);
91 static void ahci_process_request_sense(struct ahci_channel *ch, union ccb *ccb);
105 ahci_ch_detval(struct ahci_channel *ch, uint32_t val) in ahci_ch_detval() argument
108 return ch->disablephy ? ATA_SC_DET_DISABLE : val; in ahci_ch_detval()
488 "ch%d" : "%d", i); in ahci_setup_interrupt()
723 ahci_attached(device_t dev, struct ahci_channel *ch) in ahci_attached() argument
728 ctlr->ch[ch->unit] = ch; in ahci_attached()
733 ahci_detached(device_t dev, struct ahci_channel *ch) in ahci_detached() argument
738 mtx_lock(&ch->mtx); in ahci_detached()
739 ctlr->ch[ch->unit] = NULL; in ahci_detached()
740 mtx_unlock(&ch->mtx); in ahci_detached()
748 struct ahci_channel *ch; in ahci_getch() local
752 ch = ctlr->ch[n]; in ahci_getch()
753 if (ch != NULL) in ahci_getch()
754 mtx_lock(&ch->mtx); in ahci_getch()
756 return (ch); in ahci_getch()
760 ahci_putch(struct ahci_channel *ch) in ahci_putch() argument
763 mtx_unlock(&ch->mtx); in ahci_putch()
777 struct ahci_channel *ch; in ahci_ch_disablephy_proc() local
780 ch = arg1; in ahci_ch_disablephy_proc()
781 value = ch->disablephy; in ahci_ch_disablephy_proc()
786 mtx_lock(&ch->mtx); in ahci_ch_disablephy_proc()
787 ch->disablephy = value; in ahci_ch_disablephy_proc()
789 ahci_ch_deinit(ch->dev); in ahci_ch_disablephy_proc()
791 ahci_ch_init(ch->dev); in ahci_ch_disablephy_proc()
792 ahci_phy_check_events(ch, ATA_SE_PHY_CHANGED | ATA_SE_EXCHANGED); in ahci_ch_disablephy_proc()
794 mtx_unlock(&ch->mtx); in ahci_ch_disablephy_proc()
803 struct ahci_channel *ch = device_get_softc(dev); in ahci_ch_attach() local
810 ch->dev = dev; in ahci_ch_attach()
811 ch->unit = (intptr_t)device_get_ivars(dev); in ahci_ch_attach()
812 ch->caps = ctlr->caps; in ahci_ch_attach()
813 ch->caps2 = ctlr->caps2; in ahci_ch_attach()
814 ch->start = ctlr->ch_start; in ahci_ch_attach()
815 ch->quirks = ctlr->quirks; in ahci_ch_attach()
816 ch->vendorid = ctlr->vendorid; in ahci_ch_attach()
817 ch->deviceid = ctlr->deviceid; in ahci_ch_attach()
818 ch->subvendorid = ctlr->subvendorid; in ahci_ch_attach()
819 ch->subdeviceid = ctlr->subdeviceid; in ahci_ch_attach()
820 ch->numslots = ((ch->caps & AHCI_CAP_NCS) >> AHCI_CAP_NCS_SHIFT) + 1; in ahci_ch_attach()
821 mtx_init(&ch->mtx, "AHCI channel lock", NULL, MTX_DEF); in ahci_ch_attach()
822 ch->pm_level = 0; in ahci_ch_attach()
824 device_get_unit(dev), "pm_level", &ch->pm_level); in ahci_ch_attach()
825 STAILQ_INIT(&ch->doneq); in ahci_ch_attach()
826 if (ch->pm_level > 3) in ahci_ch_attach()
827 callout_init_mtx(&ch->pm_timer, &ch->mtx, 0); in ahci_ch_attach()
828 callout_init_mtx(&ch->reset_timer, &ch->mtx, 0); in ahci_ch_attach()
830 if ((ctlr->quirks & AHCI_Q_SATA1_UNIT0) && ch->unit == 0) in ahci_ch_attach()
832 if (ch->quirks & AHCI_Q_SATA2) in ahci_ch_attach()
837 ch->user[i].revision = sata_rev; in ahci_ch_attach()
838 ch->user[i].mode = 0; in ahci_ch_attach()
839 ch->user[i].bytecount = 8192; in ahci_ch_attach()
840 ch->user[i].tags = ch->numslots; in ahci_ch_attach()
841 ch->user[i].caps = 0; in ahci_ch_attach()
842 ch->curr[i] = ch->user[i]; in ahci_ch_attach()
843 if (ch->pm_level) { in ahci_ch_attach()
844 ch->user[i].caps = CTS_SATA_CAPS_H_PMREQ | in ahci_ch_attach()
848 ch->user[i].caps |= CTS_SATA_CAPS_H_DMAAA | in ahci_ch_attach()
852 if (!(ch->r_mem = bus_alloc_resource_any(dev, SYS_RES_MEMORY, in ahci_ch_attach()
855 ch->chcaps = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_ch_attach()
858 ch->chcaps |= AHCI_P_CMD_FBSCP; in ahci_ch_attach()
859 if (ch->caps2 & AHCI_CAP2_SDS) in ahci_ch_attach()
860 ch->chscaps = ATA_INL(ch->r_mem, AHCI_P_DEVSLP); in ahci_ch_attach()
863 (ch->chcaps & AHCI_P_CMD_HPCP) ? " HPCP":"", in ahci_ch_attach()
864 (ch->chcaps & AHCI_P_CMD_MPSP) ? " MPSP":"", in ahci_ch_attach()
865 (ch->chcaps & AHCI_P_CMD_CPD) ? " CPD":"", in ahci_ch_attach()
866 (ch->chcaps & AHCI_P_CMD_ESP) ? " ESP":"", in ahci_ch_attach()
867 (ch->chcaps & AHCI_P_CMD_FBSCP) ? " FBSCP":"", in ahci_ch_attach()
868 (ch->chscaps & AHCI_P_DEVSLP_DSP) ? " DSP":""); in ahci_ch_attach()
872 mtx_lock(&ch->mtx); in ahci_ch_attach()
875 if (!(ch->r_irq = bus_alloc_resource_any(dev, SYS_RES_IRQ, in ahci_ch_attach()
881 if ((bus_setup_intr(dev, ch->r_irq, ATA_INTR_FLAGS, NULL, in ahci_ch_attach()
883 ch, &ch->ih))) { in ahci_ch_attach()
889 devq = cam_simq_alloc(ch->numslots); in ahci_ch_attach()
896 ch->sim = cam_sim_alloc(ahciaction, ahcipoll, "ahcich", ch, in ahci_ch_attach()
897 device_get_unit(dev), (struct mtx *)&ch->mtx, in ahci_ch_attach()
898 (ch->quirks & AHCI_Q_NOCCS) ? 1 : min(2, ch->numslots), in ahci_ch_attach()
899 (ch->caps & AHCI_CAP_SNCQ) ? ch->numslots : 0, in ahci_ch_attach()
901 if (ch->sim == NULL) { in ahci_ch_attach()
907 if (xpt_bus_register(ch->sim, dev, 0) != CAM_SUCCESS) { in ahci_ch_attach()
912 if (xpt_create_path(&ch->path, /*periph*/NULL, cam_sim_path(ch->sim), in ahci_ch_attach()
918 if (ch->pm_level > 3) { in ahci_ch_attach()
919 callout_reset(&ch->pm_timer, in ahci_ch_attach()
920 (ch->pm_level == 4) ? hz / 1000 : hz / 8, in ahci_ch_attach()
921 ahci_ch_pm, ch); in ahci_ch_attach()
923 mtx_unlock(&ch->mtx); in ahci_ch_attach()
924 ahci_attached(device_get_parent(dev), ch); in ahci_ch_attach()
928 CTLFLAG_RW | CTLTYPE_UINT | CTLFLAG_MPSAFE, ch, in ahci_ch_attach()
933 xpt_bus_deregister(cam_sim_path(ch->sim)); in ahci_ch_attach()
935 cam_sim_free(ch->sim, /*free_devq*/TRUE); in ahci_ch_attach()
937 bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq); in ahci_ch_attach()
939 bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem); in ahci_ch_attach()
940 mtx_unlock(&ch->mtx); in ahci_ch_attach()
941 mtx_destroy(&ch->mtx); in ahci_ch_attach()
948 struct ahci_channel *ch = device_get_softc(dev); in ahci_ch_detach() local
950 ahci_detached(device_get_parent(dev), ch); in ahci_ch_detach()
951 mtx_lock(&ch->mtx); in ahci_ch_detach()
952 xpt_async(AC_LOST_DEVICE, ch->path, NULL); in ahci_ch_detach()
954 if (ch->resetting) { in ahci_ch_detach()
955 ch->resetting = 0; in ahci_ch_detach()
956 xpt_release_simq(ch->sim, TRUE); in ahci_ch_detach()
958 xpt_free_path(ch->path); in ahci_ch_detach()
959 xpt_bus_deregister(cam_sim_path(ch->sim)); in ahci_ch_detach()
960 cam_sim_free(ch->sim, /*free_devq*/TRUE); in ahci_ch_detach()
961 mtx_unlock(&ch->mtx); in ahci_ch_detach()
963 if (ch->pm_level > 3) in ahci_ch_detach()
964 callout_drain(&ch->pm_timer); in ahci_ch_detach()
965 callout_drain(&ch->reset_timer); in ahci_ch_detach()
966 bus_teardown_intr(dev, ch->r_irq, ch->ih); in ahci_ch_detach()
967 bus_release_resource(dev, SYS_RES_IRQ, ATA_IRQ_RID, ch->r_irq); in ahci_ch_detach()
973 bus_release_resource(dev, SYS_RES_MEMORY, ch->unit, ch->r_mem); in ahci_ch_detach()
974 mtx_destroy(&ch->mtx); in ahci_ch_detach()
981 struct ahci_channel *ch = device_get_softc(dev); in ahci_ch_init() local
985 ATA_OUTL(ch->r_mem, AHCI_P_IE, 0); in ahci_ch_init()
987 work = ch->dma.work_bus + AHCI_CL_OFFSET; in ahci_ch_init()
988 ATA_OUTL(ch->r_mem, AHCI_P_CLB, work & 0xffffffff); in ahci_ch_init()
989 ATA_OUTL(ch->r_mem, AHCI_P_CLBU, work >> 32); in ahci_ch_init()
990 work = ch->dma.rfis_bus; in ahci_ch_init()
991 ATA_OUTL(ch->r_mem, AHCI_P_FB, work & 0xffffffff); in ahci_ch_init()
992 ATA_OUTL(ch->r_mem, AHCI_P_FBU, work >> 32); in ahci_ch_init()
994 ATA_OUTL(ch->r_mem, AHCI_P_CMD, in ahci_ch_init()
996 ((ch->pm_level == 2 || ch->pm_level == 3) ? AHCI_P_CMD_ALPE : 0) | in ahci_ch_init()
997 ((ch->pm_level > 2) ? AHCI_P_CMD_ASP : 0 ))); in ahci_ch_init()
998 ahci_start_fr(ch); in ahci_ch_init()
999 ahci_start(ch, 1); in ahci_ch_init()
1006 struct ahci_channel *ch = device_get_softc(dev); in ahci_ch_deinit() local
1009 ATA_OUTL(ch->r_mem, AHCI_P_IE, 0); in ahci_ch_deinit()
1011 ahci_stop(ch); in ahci_ch_deinit()
1012 ahci_stop_fr(ch); in ahci_ch_deinit()
1013 ATA_OUTL(ch->r_mem, AHCI_P_CMD, 0); in ahci_ch_deinit()
1015 ATA_OUTL(ch->r_mem, AHCI_P_SCTL, 0); in ahci_ch_deinit()
1017 ATA_OUTL(ch->r_mem, AHCI_P_CMD, AHCI_P_CMD_SLUMBER); in ahci_ch_deinit()
1020 ATA_OUTL(ch->r_mem, AHCI_P_SCTL, ATA_SC_DET_DISABLE); in ahci_ch_deinit()
1027 struct ahci_channel *ch = device_get_softc(dev); in ahci_ch_suspend() local
1029 mtx_lock(&ch->mtx); in ahci_ch_suspend()
1030 xpt_freeze_simq(ch->sim, 1); in ahci_ch_suspend()
1032 if (ch->resetting) { in ahci_ch_suspend()
1033 ch->resetting = 0; in ahci_ch_suspend()
1034 callout_stop(&ch->reset_timer); in ahci_ch_suspend()
1035 xpt_release_simq(ch->sim, TRUE); in ahci_ch_suspend()
1037 while (ch->oslots) in ahci_ch_suspend()
1038 msleep(ch, &ch->mtx, PRIBIO, "ahcisusp", hz/100); in ahci_ch_suspend()
1040 mtx_unlock(&ch->mtx); in ahci_ch_suspend()
1047 struct ahci_channel *ch = device_get_softc(dev); in ahci_ch_resume() local
1049 mtx_lock(&ch->mtx); in ahci_ch_resume()
1051 ahci_reset(ch); in ahci_ch_resume()
1052 xpt_release_simq(ch->sim, TRUE); in ahci_ch_resume()
1053 mtx_unlock(&ch->mtx); in ahci_ch_resume()
1080 struct ahci_channel *ch = device_get_softc(dev); in ahci_dmainit() local
1089 0, NULL, NULL, &ch->dma.work_tag); in ahci_dmainit()
1092 error = bus_dmamem_alloc(ch->dma.work_tag, (void **)&ch->dma.work, in ahci_dmainit()
1093 BUS_DMA_ZERO, &ch->dma.work_map); in ahci_dmainit()
1096 error = bus_dmamap_load(ch->dma.work_tag, ch->dma.work_map, ch->dma.work, in ahci_dmainit()
1099 bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map); in ahci_dmainit()
1102 ch->dma.work_bus = dcba.maddr; in ahci_dmainit()
1104 if (ch->chcaps & AHCI_P_CMD_FBSCP) in ahci_dmainit()
1111 0, NULL, NULL, &ch->dma.rfis_tag); in ahci_dmainit()
1114 error = bus_dmamem_alloc(ch->dma.rfis_tag, (void **)&ch->dma.rfis, 0, in ahci_dmainit()
1115 &ch->dma.rfis_map); in ahci_dmainit()
1118 error = bus_dmamap_load(ch->dma.rfis_tag, ch->dma.rfis_map, ch->dma.rfis, in ahci_dmainit()
1121 bus_dmamem_free(ch->dma.rfis_tag, ch->dma.rfis, ch->dma.rfis_map); in ahci_dmainit()
1124 ch->dma.rfis_bus = dcba.maddr; in ahci_dmainit()
1130 0, busdma_lock_mutex, &ch->mtx, &ch->dma.data_tag); in ahci_dmainit()
1153 struct ahci_channel *ch = device_get_softc(dev); in ahci_dmafini() local
1155 if (ch->dma.data_tag) { in ahci_dmafini()
1156 bus_dma_tag_destroy(ch->dma.data_tag); in ahci_dmafini()
1157 ch->dma.data_tag = NULL; in ahci_dmafini()
1159 if (ch->dma.rfis_bus) { in ahci_dmafini()
1160 bus_dmamap_unload(ch->dma.rfis_tag, ch->dma.rfis_map); in ahci_dmafini()
1161 bus_dmamem_free(ch->dma.rfis_tag, ch->dma.rfis, ch->dma.rfis_map); in ahci_dmafini()
1162 ch->dma.rfis_bus = 0; in ahci_dmafini()
1163 ch->dma.rfis = NULL; in ahci_dmafini()
1165 if (ch->dma.work_bus) { in ahci_dmafini()
1166 bus_dmamap_unload(ch->dma.work_tag, ch->dma.work_map); in ahci_dmafini()
1167 bus_dmamem_free(ch->dma.work_tag, ch->dma.work, ch->dma.work_map); in ahci_dmafini()
1168 ch->dma.work_bus = 0; in ahci_dmafini()
1169 ch->dma.work = NULL; in ahci_dmafini()
1171 if (ch->dma.work_tag) { in ahci_dmafini()
1172 bus_dma_tag_destroy(ch->dma.work_tag); in ahci_dmafini()
1173 ch->dma.work_tag = NULL; in ahci_dmafini()
1180 struct ahci_channel *ch = device_get_softc(dev); in ahci_slotsalloc() local
1184 bzero(ch->slot, sizeof(ch->slot)); in ahci_slotsalloc()
1185 for (i = 0; i < ch->numslots; i++) { in ahci_slotsalloc()
1186 struct ahci_slot *slot = &ch->slot[i]; in ahci_slotsalloc()
1188 slot->ch = ch; in ahci_slotsalloc()
1193 callout_init_mtx(&slot->timeout, &ch->mtx, 0); in ahci_slotsalloc()
1195 if (bus_dmamap_create(ch->dma.data_tag, 0, &slot->dma.data_map)) in ahci_slotsalloc()
1196 device_printf(ch->dev, "FAILURE - create data_map\n"); in ahci_slotsalloc()
1203 struct ahci_channel *ch = device_get_softc(dev); in ahci_slotsfree() local
1207 for (i = 0; i < ch->numslots; i++) { in ahci_slotsfree()
1208 struct ahci_slot *slot = &ch->slot[i]; in ahci_slotsfree()
1212 bus_dmamap_destroy(ch->dma.data_tag, slot->dma.data_map); in ahci_slotsfree()
1219 ahci_phy_check_events(struct ahci_channel *ch, u_int32_t serr) in ahci_phy_check_events() argument
1222 if (((ch->pm_level == 0) && (serr & ATA_SE_PHY_CHANGED)) || in ahci_phy_check_events()
1223 ((ch->pm_level != 0 || ch->listening) && (serr & ATA_SE_EXCHANGED))) { in ahci_phy_check_events()
1224 u_int32_t status = ATA_INL(ch->r_mem, AHCI_P_SSTS); in ahci_phy_check_events()
1229 device_printf(ch->dev, "CONNECT requested\n"); in ahci_phy_check_events()
1231 device_printf(ch->dev, "DISCONNECT requested\n"); in ahci_phy_check_events()
1233 ahci_reset(ch); in ahci_phy_check_events()
1237 cam_sim_path(ch->sim), in ahci_phy_check_events()
1249 ahci_cpd_check_events(struct ahci_channel *ch) in ahci_cpd_check_events() argument
1255 if (ch->pm_level == 0) in ahci_cpd_check_events()
1258 status = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_cpd_check_events()
1263 dev = ch->dev; in ahci_cpd_check_events()
1269 ahci_reset(ch); in ahci_cpd_check_events()
1272 if (xpt_create_path(&ccb->ccb_h.path, NULL, cam_sim_path(ch->sim), in ahci_cpd_check_events()
1281 ahci_notify_events(struct ahci_channel *ch, u_int32_t status) in ahci_notify_events() argument
1286 if (ch->caps & AHCI_CAP_SSNTF) in ahci_notify_events()
1287 ATA_OUTL(ch->r_mem, AHCI_P_SNTF, status); in ahci_notify_events()
1289 device_printf(ch->dev, "SNTF 0x%04x\n", status); in ahci_notify_events()
1294 xpt_path_path_id(ch->path), i, 0) == CAM_REQ_CMP) { in ahci_notify_events()
1302 ahci_done(struct ahci_channel *ch, union ccb *ccb) in ahci_done() argument
1305 mtx_assert(&ch->mtx, MA_OWNED); in ahci_done()
1307 ch->batch == 0) { in ahci_done()
1312 STAILQ_INSERT_TAIL(&ch->doneq, &ccb->ccb_h, sim_links.stqe); in ahci_done()
1318 struct ahci_channel *ch = (struct ahci_channel *)arg; in ahci_ch_intr() local
1322 istatus = ATA_INL(ch->r_mem, AHCI_P_IS); in ahci_ch_intr()
1324 mtx_lock(&ch->mtx); in ahci_ch_intr()
1325 ahci_ch_intr_main(ch, istatus); in ahci_ch_intr()
1326 mtx_unlock(&ch->mtx); in ahci_ch_intr()
1332 struct ahci_channel *ch = (struct ahci_channel *)arg; in ahci_ch_intr_direct() local
1338 istatus = ATA_INL(ch->r_mem, AHCI_P_IS); in ahci_ch_intr_direct()
1340 mtx_lock(&ch->mtx); in ahci_ch_intr_direct()
1341 ch->batch = 1; in ahci_ch_intr_direct()
1342 ahci_ch_intr_main(ch, istatus); in ahci_ch_intr_direct()
1343 ch->batch = 0; in ahci_ch_intr_direct()
1348 STAILQ_CONCAT(&tmp_doneq, &ch->doneq); in ahci_ch_intr_direct()
1349 mtx_unlock(&ch->mtx); in ahci_ch_intr_direct()
1359 struct ahci_channel *ch = (struct ahci_channel *)arg; in ahci_ch_pm() local
1362 if (ch->numrslots != 0) in ahci_ch_pm()
1364 work = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_ch_pm()
1365 if (ch->pm_level == 4) in ahci_ch_pm()
1369 ATA_OUTL(ch->r_mem, AHCI_P_CMD, work); in ahci_ch_pm()
1373 ahci_ch_intr_main(struct ahci_channel *ch, uint32_t istatus) in ahci_ch_intr_main() argument
1380 ATA_OUTL(ch->r_mem, AHCI_P_IS, istatus); in ahci_ch_intr_main()
1382 if (ch->numtslots != 0) in ahci_ch_intr_main()
1383 cstatus = ATA_INL(ch->r_mem, AHCI_P_SACT); in ahci_ch_intr_main()
1386 if (ch->numrslots != ch->numtslots) in ahci_ch_intr_main()
1387 cstatus |= ATA_INL(ch->r_mem, AHCI_P_CI); in ahci_ch_intr_main()
1390 (ch->pm_present || ch->curr[0].atapi != 0)) { in ahci_ch_intr_main()
1391 if (ch->caps & AHCI_CAP_SSNTF) in ahci_ch_intr_main()
1392 sntf = ATA_INL(ch->r_mem, AHCI_P_SNTF); in ahci_ch_intr_main()
1393 else if (ch->fbs_enabled) { in ahci_ch_intr_main()
1394 u_int8_t *fis = ch->dma.rfis + 0x58; in ahci_ch_intr_main()
1404 u_int8_t *fis = ch->dma.rfis + 0x58; in ahci_ch_intr_main()
1413 serr = ATA_INL(ch->r_mem, AHCI_P_SERR); in ahci_ch_intr_main()
1415 ATA_OUTL(ch->r_mem, AHCI_P_SERR, serr); in ahci_ch_intr_main()
1416 reset = ahci_phy_check_events(ch, serr); in ahci_ch_intr_main()
1421 ahci_cpd_check_events(ch); in ahci_ch_intr_main()
1425 if (ch->quirks & AHCI_Q_NOCCS) { in ahci_ch_intr_main()
1430 cstatus |= ch->rslots; in ahci_ch_intr_main()
1435 ccs = (ATA_INL(ch->r_mem, AHCI_P_CMD) & in ahci_ch_intr_main()
1439 // __func__, istatus, cstatus, sstatus, ch->rslots, ATA_INL(ch->r_mem, AHCI_P_TFD), in ahci_ch_intr_main()
1440 // serr, ATA_INL(ch->r_mem, AHCI_P_FBS), ccs); in ahci_ch_intr_main()
1442 if (ch->fbs_enabled) { in ahci_ch_intr_main()
1443 uint32_t fbs = ATA_INL(ch->r_mem, AHCI_P_FBS); in ahci_ch_intr_main()
1449 if (ch->numrslotspd[i] == 0) in ahci_ch_intr_main()
1460 err = ch->rslots & cstatus; in ahci_ch_intr_main()
1467 ok = ch->rslots & ~cstatus; in ahci_ch_intr_main()
1468 for (i = 0; i < ch->numslots; i++) { in ahci_ch_intr_main()
1470 ahci_end_transaction(&ch->slot[i], AHCI_ERR_NONE); in ahci_ch_intr_main()
1474 if (ch->frozen) { in ahci_ch_intr_main()
1475 union ccb *fccb = ch->frozen; in ahci_ch_intr_main()
1476 ch->frozen = NULL; in ahci_ch_intr_main()
1482 ahci_done(ch, fccb); in ahci_ch_intr_main()
1484 for (i = 0; i < ch->numslots; i++) { in ahci_ch_intr_main()
1489 ch->slot[i].ccb->ccb_h.target_id != port) in ahci_ch_intr_main()
1494 if (ch->numtslotspd[ in ahci_ch_intr_main()
1495 ch->slot[i].ccb->ccb_h.target_id] == 0) { in ahci_ch_intr_main()
1507 ch->fatalerr = 1; in ahci_ch_intr_main()
1510 if (ch->numtslots == 0 && i != ccs && port != -2) in ahci_ch_intr_main()
1516 ahci_end_transaction(&ch->slot[i], et); in ahci_ch_intr_main()
1522 if (ch->rslots != 0 && !ch->recoverycmd) in ahci_ch_intr_main()
1523 ATA_OUTL(ch->r_mem, AHCI_P_FBS, AHCI_P_FBS_EN | AHCI_P_FBS_DEC); in ahci_ch_intr_main()
1527 ahci_notify_events(ch, sntf); in ahci_ch_intr_main()
1532 ahci_check_collision(struct ahci_channel *ch, union ccb *ccb) in ahci_check_collision() argument
1539 if (((~ch->oslots) & (0xffffffff >> (32 - in ahci_check_collision()
1540 ch->curr[t].tags))) == 0) in ahci_check_collision()
1543 if (ch->fbs_enabled) { in ahci_check_collision()
1545 if (ch->numrslotspd[t] != 0 && ch->numtslotspd[t] == 0) in ahci_check_collision()
1549 if (ch->numrslots != 0 && ch->numtslots == 0) in ahci_check_collision()
1552 if (ch->numtslots != 0 && in ahci_check_collision()
1553 ch->taggedtarget != ccb->ccb_h.target_id) in ahci_check_collision()
1558 if (ch->fbs_enabled) { in ahci_check_collision()
1560 if (ch->numrslotspd[t] != 0 && ch->numtslotspd[t] != 0) in ahci_check_collision()
1564 if (ch->numrslots != 0 && ch->numtslots != 0) in ahci_check_collision()
1571 if (ch->numrslots != 0) in ahci_check_collision()
1575 if (ch->aslots != 0) in ahci_check_collision()
1582 ahci_begin_transaction(struct ahci_channel *ch, union ccb *ccb) in ahci_begin_transaction() argument
1588 tags = ch->numslots; in ahci_begin_transaction()
1591 tags = ch->curr[ccb->ccb_h.target_id].tags; in ahci_begin_transaction()
1592 if (ch->lastslot + 1 < tags) in ahci_begin_transaction()
1593 tag = ffs(~(ch->oslots >> (ch->lastslot + 1))); in ahci_begin_transaction()
1596 if (tag == 0 || tag + ch->lastslot >= tags) in ahci_begin_transaction()
1597 tag = ffs(~ch->oslots) - 1; in ahci_begin_transaction()
1599 tag += ch->lastslot; in ahci_begin_transaction()
1600 ch->lastslot = tag; in ahci_begin_transaction()
1602 slot = &ch->slot[tag]; in ahci_begin_transaction()
1605 if (ch->numrslots == 0 && ch->pm_level > 3) in ahci_begin_transaction()
1606 callout_stop(&ch->pm_timer); in ahci_begin_transaction()
1608 ch->oslots |= (1 << tag); in ahci_begin_transaction()
1609 ch->numrslots++; in ahci_begin_transaction()
1610 ch->numrslotspd[ccb->ccb_h.target_id]++; in ahci_begin_transaction()
1613 ch->numtslots++; in ahci_begin_transaction()
1614 ch->numtslotspd[ccb->ccb_h.target_id]++; in ahci_begin_transaction()
1615 ch->taggedtarget = ccb->ccb_h.target_id; in ahci_begin_transaction()
1619 ch->aslots |= (1 << tag); in ahci_begin_transaction()
1622 bus_dmamap_load_ccb(ch->dma.data_tag, slot->dma.data_map, ccb, in ahci_begin_transaction()
1635 struct ahci_channel *ch = slot->ch; in ahci_dmasetprd() local
1641 device_printf(ch->dev, "DMA load error\n"); in ahci_dmasetprd()
1647 ctp = (struct ahci_cmd_tab *)(ch->dma.work + slot->ct_offset); in ahci_dmasetprd()
1655 bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map, in ahci_dmasetprd()
1665 struct ahci_channel *ch = slot->ch; in ahci_execute_transaction() local
1671 uint8_t *fis = ch->dma.rfis + 0x40; in ahci_execute_transaction()
1676 ctp = (struct ahci_cmd_tab *)(ch->dma.work + slot->ct_offset); in ahci_execute_transaction()
1678 if (!(fis_size = ahci_setup_fis(ch, ctp, ccb, slot->slot))) { in ahci_execute_transaction()
1679 device_printf(ch->dev, "Setting up SATA FIS failed\n"); in ahci_execute_transaction()
1685 (ch->dma.work + AHCI_CL_OFFSET + (AHCI_CL_SIZE * slot->slot)); in ahci_execute_transaction()
1699 ahci_stop(ch); in ahci_execute_transaction()
1700 ahci_clo(ch); in ahci_execute_transaction()
1701 ahci_start(ch, 0); in ahci_execute_transaction()
1713 clp->cmd_table_phys = htole64(ch->dma.work_bus + slot->ct_offset); in ahci_execute_transaction()
1714 bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map, in ahci_execute_transaction()
1716 bus_dmamap_sync(ch->dma.rfis_tag, ch->dma.rfis_map, in ahci_execute_transaction()
1721 ATA_OUTL(ch->r_mem, AHCI_P_SACT, 1 << slot->slot); in ahci_execute_transaction()
1724 if (ch->fbs_enabled) { in ahci_execute_transaction()
1725 ATA_OUTL(ch->r_mem, AHCI_P_FBS, AHCI_P_FBS_EN | in ahci_execute_transaction()
1730 ch->rslots |= (1 << slot->slot); in ahci_execute_transaction()
1731 ATA_OUTL(ch->r_mem, AHCI_P_CI, (1 << slot->slot)); in ahci_execute_transaction()
1740 if (!(ATA_INL(ch->r_mem, AHCI_P_CI) & (1 << slot->slot))) in ahci_execute_transaction()
1742 if ((ATA_INL(ch->r_mem, AHCI_P_TFD) & ATA_S_ERROR) && in ahci_execute_transaction()
1745 device_printf(ch->dev, in ahci_execute_transaction()
1747 slot->slot, ATA_INL(ch->r_mem, AHCI_P_TFD)); in ahci_execute_transaction()
1754 (ch->quirks & AHCI_Q_ATI_PMP_BUG) && in ahci_execute_transaction()
1755 (ATA_INL(ch->r_mem, AHCI_P_IS) & AHCI_P_IX_IPM)) { in ahci_execute_transaction()
1766 if (ch->quirks & AHCI_Q_MRVL_SR_DEL) in ahci_execute_transaction()
1776 if ((ch->quirks & AHCI_Q_NOBSYRES) == 0 && in ahci_execute_transaction()
1777 (ch->quirks & AHCI_Q_ATI_PMP_BUG) == 0 && in ahci_execute_transaction()
1780 bus_dmamap_sync(ch->dma.rfis_tag, in ahci_execute_transaction()
1781 ch->dma.rfis_map, BUS_DMASYNC_POSTREAD); in ahci_execute_transaction()
1783 bus_dmamap_sync(ch->dma.rfis_tag, in ahci_execute_transaction()
1784 ch->dma.rfis_map, BUS_DMASYNC_PREREAD); in ahci_execute_transaction()
1792 device_printf(ch->dev, "Poll timeout on slot %d port %d\n", in ahci_execute_transaction()
1794 device_printf(ch->dev, "is %08x cs %08x ss %08x " in ahci_execute_transaction()
1796 ATA_INL(ch->r_mem, AHCI_P_IS), in ahci_execute_transaction()
1797 ATA_INL(ch->r_mem, AHCI_P_CI), in ahci_execute_transaction()
1798 ATA_INL(ch->r_mem, AHCI_P_SACT), ch->rslots, in ahci_execute_transaction()
1799 ATA_INL(ch->r_mem, AHCI_P_TFD), in ahci_execute_transaction()
1800 ATA_INL(ch->r_mem, AHCI_P_SERR), in ahci_execute_transaction()
1801 ATA_INL(ch->r_mem, AHCI_P_CMD)); in ahci_execute_transaction()
1807 ch->eslots |= (1 << slot->slot); in ahci_execute_transaction()
1819 ahci_process_timeout(struct ahci_channel *ch) in ahci_process_timeout() argument
1823 mtx_assert(&ch->mtx, MA_OWNED); in ahci_process_timeout()
1825 for (i = 0; i < ch->numslots; i++) { in ahci_process_timeout()
1827 if (ch->slot[i].state < AHCI_SLOT_RUNNING) in ahci_process_timeout()
1829 ahci_end_transaction(&ch->slot[i], AHCI_ERR_TIMEOUT); in ahci_process_timeout()
1835 ahci_rearm_timeout(struct ahci_channel *ch) in ahci_rearm_timeout() argument
1839 mtx_assert(&ch->mtx, MA_OWNED); in ahci_rearm_timeout()
1840 for (i = 0; i < ch->numslots; i++) { in ahci_rearm_timeout()
1841 struct ahci_slot *slot = &ch->slot[i]; in ahci_rearm_timeout()
1846 if ((ch->toslots & (1 << i)) == 0) in ahci_rearm_timeout()
1859 struct ahci_channel *ch = slot->ch; in ahci_timeout() local
1860 device_t dev = ch->dev; in ahci_timeout()
1872 sstatus = ATA_INL(ch->r_mem, AHCI_P_SACT); in ahci_timeout()
1873 ccs = (ATA_INL(ch->r_mem, AHCI_P_CMD) & AHCI_P_CMD_CCS_MASK) in ahci_timeout()
1876 ch->fbs_enabled || ch->wrongccs) in ahci_timeout()
1878 else if ((ch->rslots & (1 << ccs)) == 0) { in ahci_timeout()
1879 ch->wrongccs = 1; in ahci_timeout()
1893 ATA_INL(ch->r_mem, AHCI_P_IS), ATA_INL(ch->r_mem, AHCI_P_CI), in ahci_timeout()
1894 ATA_INL(ch->r_mem, AHCI_P_SACT), ch->rslots, in ahci_timeout()
1895 ATA_INL(ch->r_mem, AHCI_P_TFD), ATA_INL(ch->r_mem, AHCI_P_SERR), in ahci_timeout()
1896 ATA_INL(ch->r_mem, AHCI_P_CMD)); in ahci_timeout()
1899 if (ch->frozen) { in ahci_timeout()
1900 union ccb *fccb = ch->frozen; in ahci_timeout()
1901 ch->frozen = NULL; in ahci_timeout()
1907 ahci_done(ch, fccb); in ahci_timeout()
1909 if (!ch->fbs_enabled && !ch->wrongccs) { in ahci_timeout()
1911 ch->fatalerr = 1; in ahci_timeout()
1913 ahci_end_transaction(&ch->slot[slot->slot], AHCI_ERR_TIMEOUT); in ahci_timeout()
1915 for (i = 0; i < ch->numslots; i++) { in ahci_timeout()
1917 if (ch->slot[i].state < AHCI_SLOT_RUNNING) in ahci_timeout()
1919 ahci_end_transaction(&ch->slot[i], AHCI_ERR_INNOCENT); in ahci_timeout()
1923 if (ch->toslots == 0) in ahci_timeout()
1924 xpt_freeze_simq(ch->sim, 1); in ahci_timeout()
1925 ch->toslots |= (1 << slot->slot); in ahci_timeout()
1926 if ((ch->rslots & ~ch->toslots) == 0) in ahci_timeout()
1927 ahci_process_timeout(ch); in ahci_timeout()
1930 ch->rslots & ~ch->toslots); in ahci_timeout()
1938 struct ahci_channel *ch = slot->ch; in ahci_end_transaction() local
1944 bus_dmamap_sync(ch->dma.work_tag, ch->dma.work_map, in ahci_end_transaction()
1947 (ch->dma.work + AHCI_CL_OFFSET + (AHCI_CL_SIZE * slot->slot)); in ahci_end_transaction()
1957 u_int8_t *fis = ch->dma.rfis + 0x40; in ahci_end_transaction()
1959 bus_dmamap_sync(ch->dma.rfis_tag, ch->dma.rfis_map, in ahci_end_transaction()
1961 if (ch->fbs_enabled) { in ahci_end_transaction()
1966 uint16_t tfd = ATA_INL(ch->r_mem, AHCI_P_TFD); in ahci_end_transaction()
1985 if ((ch->quirks & AHCI_Q_ALTSIG) && in ahci_end_transaction()
1988 sig = ATA_INL(ch->r_mem, AHCI_P_SIG); in ahci_end_transaction()
1998 (ch->quirks & AHCI_Q_NOCOUNT) == 0) { in ahci_end_transaction()
2004 (ch->quirks & AHCI_Q_NOCOUNT) == 0) { in ahci_end_transaction()
2010 bus_dmamap_sync(ch->dma.data_tag, slot->dma.data_map, in ahci_end_transaction()
2013 bus_dmamap_unload(ch->dma.data_tag, slot->dma.data_map); in ahci_end_transaction()
2016 ch->eslots |= (1 << slot->slot); in ahci_end_transaction()
2018 if ((et != AHCI_ERR_NONE) && (!ch->recoverycmd) && in ahci_end_transaction()
2032 ch->fatalerr = 1; in ahci_end_transaction()
2048 ch->fatalerr = 1; in ahci_end_transaction()
2049 if (!ch->recoverycmd) { in ahci_end_transaction()
2050 xpt_freeze_simq(ch->sim, 1); in ahci_end_transaction()
2057 if (!ch->recoverycmd) { in ahci_end_transaction()
2058 xpt_freeze_simq(ch->sim, 1); in ahci_end_transaction()
2065 ch->fatalerr = 1; in ahci_end_transaction()
2069 ch->oslots &= ~(1 << slot->slot); in ahci_end_transaction()
2070 ch->rslots &= ~(1 << slot->slot); in ahci_end_transaction()
2071 ch->aslots &= ~(1 << slot->slot); in ahci_end_transaction()
2075 ch->numrslots--; in ahci_end_transaction()
2076 ch->numrslotspd[ccb->ccb_h.target_id]--; in ahci_end_transaction()
2079 ch->numtslots--; in ahci_end_transaction()
2080 ch->numtslotspd[ccb->ccb_h.target_id]--; in ahci_end_transaction()
2084 lastto = (ch->toslots == (1 << slot->slot)); in ahci_end_transaction()
2085 ch->toslots &= ~(1 << slot->slot); in ahci_end_transaction()
2087 xpt_release_simq(ch->sim, TRUE); in ahci_end_transaction()
2096 ahci_begin_transaction(ch, ccb); in ahci_end_transaction()
2101 ahci_process_read_log(ch, ccb); in ahci_end_transaction()
2104 ahci_process_request_sense(ch, ccb); in ahci_end_transaction()
2109 ch->hold[slot->slot] = ccb; in ahci_end_transaction()
2110 ch->numhslots++; in ahci_end_transaction()
2112 ahci_done(ch, ccb); in ahci_end_transaction()
2114 if (ch->rslots == 0) { in ahci_end_transaction()
2116 if (ch->toslots != 0 || ch->fatalerr) { in ahci_end_transaction()
2117 ahci_reset(ch); in ahci_end_transaction()
2120 if (ch->eslots != 0) { in ahci_end_transaction()
2121 ahci_stop(ch); in ahci_end_transaction()
2122 ahci_clo(ch); in ahci_end_transaction()
2123 ahci_start(ch, 1); in ahci_end_transaction()
2126 if (!ch->recoverycmd && ch->numhslots) in ahci_end_transaction()
2127 ahci_issue_recovery(ch); in ahci_end_transaction()
2130 } else if ((ch->rslots & ~ch->toslots) == 0 && in ahci_end_transaction()
2132 ahci_rearm_timeout(ch); in ahci_end_transaction()
2134 if (ch->frozen && !ahci_check_collision(ch, ch->frozen)) { in ahci_end_transaction()
2135 union ccb *fccb = ch->frozen; in ahci_end_transaction()
2136 ch->frozen = NULL; in ahci_end_transaction()
2137 ahci_begin_transaction(ch, fccb); in ahci_end_transaction()
2138 xpt_release_simq(ch->sim, TRUE); in ahci_end_transaction()
2141 if (ch->numrslots == 0 && ch->pm_level > 3 && in ahci_end_transaction()
2142 (ch->curr[ch->pm_present ? 15 : 0].caps & CTS_SATA_CAPS_D_PMREQ)) { in ahci_end_transaction()
2143 callout_schedule(&ch->pm_timer, in ahci_end_transaction()
2144 (ch->pm_level == 4) ? hz / 1000 : hz / 8); in ahci_end_transaction()
2149 ahci_issue_recovery(struct ahci_channel *ch) in ahci_issue_recovery() argument
2157 for (i = 0; i < ch->numslots; i++) { in ahci_issue_recovery()
2158 if (ch->hold[i]) in ahci_issue_recovery()
2163 device_printf(ch->dev, "Unable to allocate recovery command\n"); in ahci_issue_recovery()
2166 for (i = 0; i < ch->numslots; i++) { in ahci_issue_recovery()
2167 if (ch->hold[i] == NULL) in ahci_issue_recovery()
2169 ch->hold[i]->ccb_h.status &= ~CAM_STATUS_MASK; in ahci_issue_recovery()
2170 ch->hold[i]->ccb_h.status |= CAM_RESRC_UNAVAIL; in ahci_issue_recovery()
2171 ahci_done(ch, ch->hold[i]); in ahci_issue_recovery()
2172 ch->hold[i] = NULL; in ahci_issue_recovery()
2173 ch->numhslots--; in ahci_issue_recovery()
2175 ahci_reset(ch); in ahci_issue_recovery()
2178 xpt_setup_ccb(&ccb->ccb_h, ch->hold[i]->ccb_h.path, in ahci_issue_recovery()
2179 ch->hold[i]->ccb_h.pinfo.priority); in ahci_issue_recovery()
2180 if (ch->hold[i]->ccb_h.func_code == XPT_ATA_IO) { in ahci_issue_recovery()
2190 device_printf(ch->dev, in ahci_issue_recovery()
2212 csio->data_ptr = (void *)&ch->hold[i]->csio.sense_data; in ahci_issue_recovery()
2213 csio->dxfer_len = ch->hold[i]->csio.sense_len; in ahci_issue_recovery()
2220 ch->recoverycmd = 1; in ahci_issue_recovery()
2221 xpt_freeze_simq(ch->sim, 1); in ahci_issue_recovery()
2222 ahci_begin_transaction(ch, ccb); in ahci_issue_recovery()
2226 ahci_process_read_log(struct ahci_channel *ch, union ccb *ccb) in ahci_process_read_log() argument
2232 ch->recoverycmd = 0; in ahci_process_read_log()
2237 for (i = 0; i < ch->numslots; i++) { in ahci_process_read_log()
2238 if (!ch->hold[i]) in ahci_process_read_log()
2240 if (ch->hold[i]->ccb_h.func_code != XPT_ATA_IO) in ahci_process_read_log()
2243 res = &ch->hold[i]->ataio.res; in ahci_process_read_log()
2256 ch->hold[i]->ccb_h.status &= ~CAM_STATUS_MASK; in ahci_process_read_log()
2257 ch->hold[i]->ccb_h.status |= CAM_REQUEUE_REQ; in ahci_process_read_log()
2259 ahci_done(ch, ch->hold[i]); in ahci_process_read_log()
2260 ch->hold[i] = NULL; in ahci_process_read_log()
2261 ch->numhslots--; in ahci_process_read_log()
2265 device_printf(ch->dev, "Error while READ LOG EXT\n"); in ahci_process_read_log()
2267 device_printf(ch->dev, "Non-queued command error in READ LOG EXT\n"); in ahci_process_read_log()
2269 for (i = 0; i < ch->numslots; i++) { in ahci_process_read_log()
2270 if (!ch->hold[i]) in ahci_process_read_log()
2272 if (ch->hold[i]->ccb_h.func_code != XPT_ATA_IO) in ahci_process_read_log()
2274 ahci_done(ch, ch->hold[i]); in ahci_process_read_log()
2275 ch->hold[i] = NULL; in ahci_process_read_log()
2276 ch->numhslots--; in ahci_process_read_log()
2281 xpt_release_simq(ch->sim, TRUE); in ahci_process_read_log()
2285 ahci_process_request_sense(struct ahci_channel *ch, union ccb *ccb) in ahci_process_request_sense() argument
2289 ch->recoverycmd = 0; in ahci_process_request_sense()
2293 ch->hold[i]->ccb_h.status |= CAM_AUTOSNS_VALID; in ahci_process_request_sense()
2295 ch->hold[i]->ccb_h.status &= ~CAM_STATUS_MASK; in ahci_process_request_sense()
2296 ch->hold[i]->ccb_h.status |= CAM_AUTOSENSE_FAIL; in ahci_process_request_sense()
2298 ahci_done(ch, ch->hold[i]); in ahci_process_request_sense()
2299 ch->hold[i] = NULL; in ahci_process_request_sense()
2300 ch->numhslots--; in ahci_process_request_sense()
2302 xpt_release_simq(ch->sim, TRUE); in ahci_process_request_sense()
2306 ahci_start(struct ahci_channel *ch, int fbs) in ahci_start() argument
2311 if (ch->start) in ahci_start()
2312 ch->start(ch); in ahci_start()
2315 ATA_OUTL(ch->r_mem, AHCI_P_SERR, 0xFFFFFFFF); in ahci_start()
2317 ATA_OUTL(ch->r_mem, AHCI_P_IS, 0xFFFFFFFF); in ahci_start()
2319 if (ch->chcaps & AHCI_P_CMD_FBSCP) { in ahci_start()
2320 ch->fbs_enabled = (fbs && ch->pm_present) ? 1 : 0; in ahci_start()
2321 ATA_OUTL(ch->r_mem, AHCI_P_FBS, in ahci_start()
2322 ch->fbs_enabled ? AHCI_P_FBS_EN : 0); in ahci_start()
2325 cmd = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_start()
2327 ATA_OUTL(ch->r_mem, AHCI_P_CMD, cmd | AHCI_P_CMD_ST | in ahci_start()
2328 (ch->pm_present ? AHCI_P_CMD_PMA : 0)); in ahci_start()
2332 ahci_stop(struct ahci_channel *ch) in ahci_stop() argument
2338 cmd = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_stop()
2339 ATA_OUTL(ch->r_mem, AHCI_P_CMD, cmd & ~AHCI_P_CMD_ST); in ahci_stop()
2345 device_printf(ch->dev, "stopping AHCI engine failed\n"); in ahci_stop()
2348 } while (ATA_INL(ch->r_mem, AHCI_P_CMD) & AHCI_P_CMD_CR); in ahci_stop()
2349 ch->eslots = 0; in ahci_stop()
2353 ahci_clo(struct ahci_channel *ch) in ahci_clo() argument
2359 if (ch->caps & AHCI_CAP_SCLO) { in ahci_clo()
2360 cmd = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_clo()
2362 ATA_OUTL(ch->r_mem, AHCI_P_CMD, cmd); in ahci_clo()
2367 device_printf(ch->dev, "executing CLO failed\n"); in ahci_clo()
2370 } while (ATA_INL(ch->r_mem, AHCI_P_CMD) & AHCI_P_CMD_CLO); in ahci_clo()
2375 ahci_stop_fr(struct ahci_channel *ch) in ahci_stop_fr() argument
2381 cmd = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_stop_fr()
2382 ATA_OUTL(ch->r_mem, AHCI_P_CMD, cmd & ~AHCI_P_CMD_FRE); in ahci_stop_fr()
2388 device_printf(ch->dev, "stopping AHCI FR engine failed\n"); in ahci_stop_fr()
2391 } while (ATA_INL(ch->r_mem, AHCI_P_CMD) & AHCI_P_CMD_FR); in ahci_stop_fr()
2395 ahci_start_fr(struct ahci_channel *ch) in ahci_start_fr() argument
2400 cmd = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_start_fr()
2401 ATA_OUTL(ch->r_mem, AHCI_P_CMD, cmd | AHCI_P_CMD_FRE); in ahci_start_fr()
2405 ahci_wait_ready(struct ahci_channel *ch, int t, int t0) in ahci_wait_ready() argument
2410 while ((val = ATA_INL(ch->r_mem, AHCI_P_TFD)) & in ahci_wait_ready()
2414 device_printf(ch->dev, in ahci_wait_ready()
2425 device_printf(ch->dev, "AHCI reset: device ready after %dms\n", in ahci_wait_ready()
2433 struct ahci_channel *ch = arg; in ahci_reset_to() local
2435 if (ch->resetting == 0) in ahci_reset_to()
2437 ch->resetting--; in ahci_reset_to()
2438 if (ahci_wait_ready(ch, ch->resetting == 0 ? -1 : 0, in ahci_reset_to()
2439 (310 - ch->resetting) * 100) == 0) { in ahci_reset_to()
2440 ch->resetting = 0; in ahci_reset_to()
2441 ahci_start(ch, 1); in ahci_reset_to()
2442 xpt_release_simq(ch->sim, TRUE); in ahci_reset_to()
2445 if (ch->resetting == 0) { in ahci_reset_to()
2446 ahci_clo(ch); in ahci_reset_to()
2447 ahci_start(ch, 1); in ahci_reset_to()
2448 xpt_release_simq(ch->sim, TRUE); in ahci_reset_to()
2451 callout_schedule(&ch->reset_timer, hz / 10); in ahci_reset_to()
2455 ahci_reset(struct ahci_channel *ch) in ahci_reset() argument
2457 struct ahci_controller *ctlr = device_get_softc(device_get_parent(ch->dev)); in ahci_reset()
2460 xpt_freeze_simq(ch->sim, 1); in ahci_reset()
2462 device_printf(ch->dev, "AHCI reset...\n"); in ahci_reset()
2464 if (ch->resetting) { in ahci_reset()
2465 ch->resetting = 0; in ahci_reset()
2466 callout_stop(&ch->reset_timer); in ahci_reset()
2467 xpt_release_simq(ch->sim, TRUE); in ahci_reset()
2470 if (ch->frozen) { in ahci_reset()
2471 union ccb *fccb = ch->frozen; in ahci_reset()
2472 ch->frozen = NULL; in ahci_reset()
2478 ahci_done(ch, fccb); in ahci_reset()
2481 ahci_stop(ch); in ahci_reset()
2482 for (i = 0; i < ch->numslots; i++) { in ahci_reset()
2484 if (ch->slot[i].state < AHCI_SLOT_RUNNING) in ahci_reset()
2487 ahci_end_transaction(&ch->slot[i], AHCI_ERR_INNOCENT); in ahci_reset()
2489 for (i = 0; i < ch->numslots; i++) { in ahci_reset()
2490 if (!ch->hold[i]) in ahci_reset()
2492 ahci_done(ch, ch->hold[i]); in ahci_reset()
2493 ch->hold[i] = NULL; in ahci_reset()
2494 ch->numhslots--; in ahci_reset()
2496 if (ch->toslots != 0) in ahci_reset()
2497 xpt_release_simq(ch->sim, TRUE); in ahci_reset()
2498 ch->eslots = 0; in ahci_reset()
2499 ch->toslots = 0; in ahci_reset()
2500 ch->wrongccs = 0; in ahci_reset()
2501 ch->fatalerr = 0; in ahci_reset()
2503 xpt_async(AC_BUS_RESET, ch->path, NULL); in ahci_reset()
2505 ATA_OUTL(ch->r_mem, AHCI_P_IE, 0); in ahci_reset()
2507 if (!ahci_sata_phy_reset(ch)) { in ahci_reset()
2509 device_printf(ch->dev, in ahci_reset()
2511 ch->devices = 0; in ahci_reset()
2513 ATA_OUTL(ch->r_mem, AHCI_P_IE, in ahci_reset()
2514 (((ch->pm_level != 0) ? AHCI_P_IX_CPD | AHCI_P_IX_MP : 0) | in ahci_reset()
2516 xpt_release_simq(ch->sim, TRUE); in ahci_reset()
2520 device_printf(ch->dev, "AHCI reset: device found\n"); in ahci_reset()
2522 if (ahci_wait_ready(ch, dumping ? 31000 : 0, 0)) { in ahci_reset()
2524 ahci_clo(ch); in ahci_reset()
2526 ch->resetting = 310; in ahci_reset()
2528 ch->devices = 1; in ahci_reset()
2530 ATA_OUTL(ch->r_mem, AHCI_P_IE, in ahci_reset()
2531 (((ch->pm_level != 0) ? AHCI_P_IX_CPD | AHCI_P_IX_MP : 0) | in ahci_reset()
2534 ((ch->pm_level == 0) ? AHCI_P_IX_PRC : 0) | AHCI_P_IX_PC | in ahci_reset()
2537 if (ch->resetting) in ahci_reset()
2538 callout_reset(&ch->reset_timer, hz / 10, ahci_reset_to, ch); in ahci_reset()
2540 ahci_start(ch, 1); in ahci_reset()
2541 xpt_release_simq(ch->sim, TRUE); in ahci_reset()
2546 ahci_setup_fis(struct ahci_channel *ch, struct ahci_cmd_tab *ctp, union ccb *ccb, int tag) in ahci_setup_fis() argument
2557 ch->curr[ccb->ccb_h.target_id].mode >= ATA_DMA) in ahci_setup_fis()
2603 ahci_sata_connect(struct ahci_channel *ch) in ahci_sata_connect() argument
2612 timeoutslot = ((ch->quirks & AHCI_Q_SLOWDEV) ? 5000 : 1000); in ahci_sata_connect()
2614 status = ATA_INL(ch->r_mem, AHCI_P_SSTS); in ahci_sata_connect()
2623 device_printf(ch->dev, "SATA offline status=%08x\n", in ahci_sata_connect()
2634 device_printf(ch->dev, in ahci_sata_connect()
2641 device_printf(ch->dev, "SATA connect time=%dus status=%08x\n", in ahci_sata_connect()
2645 ATA_OUTL(ch->r_mem, AHCI_P_SERR, 0xffffffff); in ahci_sata_connect()
2650 ahci_sata_phy_reset(struct ahci_channel *ch) in ahci_sata_phy_reset() argument
2655 if (ch->listening) { in ahci_sata_phy_reset()
2656 val = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_sata_phy_reset()
2658 ATA_OUTL(ch->r_mem, AHCI_P_CMD, val); in ahci_sata_phy_reset()
2659 ch->listening = 0; in ahci_sata_phy_reset()
2661 sata_rev = ch->user[ch->pm_present ? 15 : 0].revision; in ahci_sata_phy_reset()
2670 detval = ahci_ch_detval(ch, ATA_SC_DET_RESET); in ahci_sata_phy_reset()
2671 ATA_OUTL(ch->r_mem, AHCI_P_SCTL, in ahci_sata_phy_reset()
2675 detval = ahci_ch_detval(ch, ATA_SC_DET_IDLE); in ahci_sata_phy_reset()
2676 ATA_OUTL(ch->r_mem, AHCI_P_SCTL, in ahci_sata_phy_reset()
2677 detval | val | ((ch->pm_level > 0) ? 0 : in ahci_sata_phy_reset()
2679 if (!ahci_sata_connect(ch)) { in ahci_sata_phy_reset()
2680 if (ch->caps & AHCI_CAP_SSS) { in ahci_sata_phy_reset()
2681 val = ATA_INL(ch->r_mem, AHCI_P_CMD); in ahci_sata_phy_reset()
2683 ATA_OUTL(ch->r_mem, AHCI_P_CMD, val); in ahci_sata_phy_reset()
2684 ch->listening = 1; in ahci_sata_phy_reset()
2685 } else if (ch->pm_level > 0) in ahci_sata_phy_reset()
2686 ATA_OUTL(ch->r_mem, AHCI_P_SCTL, ATA_SC_DET_DISABLE); in ahci_sata_phy_reset()
2693 ahci_check_ids(struct ahci_channel *ch, union ccb *ccb) in ahci_check_ids() argument
2696 if (ccb->ccb_h.target_id > ((ch->caps & AHCI_CAP_SPM) ? 15 : 0)) { in ahci_check_ids()
2698 ahci_done(ch, ccb); in ahci_check_ids()
2703 ahci_done(ch, ccb); in ahci_check_ids()
2712 struct ahci_channel *ch; in ahciaction() local
2717 ch = (struct ahci_channel *)cam_sim_softc(sim); in ahciaction()
2722 if (ahci_check_ids(ch, ccb)) in ahciaction()
2724 if (ch->devices == 0 || in ahciaction()
2725 (ch->pm_present == 0 && in ahciaction()
2732 if (ahci_check_collision(ch, ccb)) { in ahciaction()
2734 ch->frozen = ccb; in ahciaction()
2736 xpt_freeze_simq(ch->sim, 1); in ahciaction()
2739 ahci_begin_transaction(ch, ccb); in ahciaction()
2750 if (ahci_check_ids(ch, ccb)) in ahciaction()
2753 d = &ch->curr[ccb->ccb_h.target_id]; in ahciaction()
2755 d = &ch->user[ccb->ccb_h.target_id]; in ahciaction()
2763 d->tags = min(ch->numslots, cts->xport_specific.sata.tags); in ahciaction()
2765 ch->pm_present = cts->xport_specific.sata.pm_present; in ahciaction()
2780 if (ahci_check_ids(ch, ccb)) in ahciaction()
2783 d = &ch->curr[ccb->ccb_h.target_id]; in ahciaction()
2785 d = &ch->user[ccb->ccb_h.target_id]; in ahciaction()
2794 (ccb->ccb_h.target_id == 0 && !ch->pm_present))) { in ahciaction()
2795 status = ATA_INL(ch->r_mem, AHCI_P_SSTS) & ATA_SS_SPD_MASK; in ahciaction()
2803 if (ch->pm_level) { in ahciaction()
2804 if (ch->caps & (AHCI_CAP_PSC | AHCI_CAP_SSC)) in ahciaction()
2806 if (ch->caps2 & AHCI_CAP2_APST) in ahciaction()
2809 if ((ch->caps & AHCI_CAP_SNCQ) && in ahciaction()
2810 (ch->quirks & AHCI_Q_NOAA) == 0) in ahciaction()
2814 ch->user[ccb->ccb_h.target_id].caps; in ahciaction()
2826 cts->xport_specific.sata.pm_present = ch->pm_present; in ahciaction()
2837 ahci_reset(ch); in ahciaction()
2850 if (ch->caps & AHCI_CAP_SNCQ) in ahciaction()
2852 if (ch->caps & AHCI_CAP_SPM) in ahciaction()
2856 if ((ch->quirks & AHCI_Q_NOAUX) == 0) in ahciaction()
2859 if (ch->caps & AHCI_CAP_SPM) in ahciaction()
2877 if (ch->quirks & AHCI_Q_MAXIO_64K) in ahciaction()
2879 cpi->hba_vendor = ch->vendorid; in ahciaction()
2880 cpi->hba_device = ch->deviceid; in ahciaction()
2881 cpi->hba_subvendor = ch->subvendorid; in ahciaction()
2882 cpi->hba_subdevice = ch->subdeviceid; in ahciaction()
2890 ahci_done(ch, ccb); in ahciaction()
2896 struct ahci_channel *ch = (struct ahci_channel *)cam_sim_softc(sim); in ahcipoll() local
2900 istatus = ATA_INL(ch->r_mem, AHCI_P_IS); in ahcipoll()
2902 ahci_ch_intr_main(ch, istatus); in ahcipoll()
2903 if (ch->resetting != 0 && in ahcipoll()
2904 (--ch->resetpolldiv <= 0 || !callout_pending(&ch->reset_timer))) { in ahcipoll()
2905 ch->resetpolldiv = 1000; in ahcipoll()
2906 ahci_reset_to(ch); in ahcipoll()