1 // SPDX-License-Identifier: GPL-2.0-or-later 2 /* 3 * Copyright (c) 2017 Hisilicon Limited. 4 */ 5 6 #include "hisi_sas.h" 7 #define DRV_NAME "hisi_sas_v3_hw" 8 9 /* global registers need init */ 10 #define DLVRY_QUEUE_ENABLE 0x0 11 #define IOST_BASE_ADDR_LO 0x8 12 #define IOST_BASE_ADDR_HI 0xc 13 #define ITCT_BASE_ADDR_LO 0x10 14 #define ITCT_BASE_ADDR_HI 0x14 15 #define IO_BROKEN_MSG_ADDR_LO 0x18 16 #define IO_BROKEN_MSG_ADDR_HI 0x1c 17 #define PHY_CONTEXT 0x20 18 #define PHY_STATE 0x24 19 #define PHY_PORT_NUM_MA 0x28 20 #define PHY_CONN_RATE 0x30 21 #define ITCT_CLR 0x44 22 #define ITCT_CLR_EN_OFF 16 23 #define ITCT_CLR_EN_MSK (0x1 << ITCT_CLR_EN_OFF) 24 #define ITCT_DEV_OFF 0 25 #define ITCT_DEV_MSK (0x7ff << ITCT_DEV_OFF) 26 #define SAS_AXI_USER3 0x50 27 #define IO_SATA_BROKEN_MSG_ADDR_LO 0x58 28 #define IO_SATA_BROKEN_MSG_ADDR_HI 0x5c 29 #define SATA_INITI_D2H_STORE_ADDR_LO 0x60 30 #define SATA_INITI_D2H_STORE_ADDR_HI 0x64 31 #define CFG_MAX_TAG 0x68 32 #define HGC_SAS_TX_OPEN_FAIL_RETRY_CTRL 0x84 33 #define HGC_SAS_TXFAIL_RETRY_CTRL 0x88 34 #define HGC_GET_ITV_TIME 0x90 35 #define DEVICE_MSG_WORK_MODE 0x94 36 #define OPENA_WT_CONTI_TIME 0x9c 37 #define I_T_NEXUS_LOSS_TIME 0xa0 38 #define MAX_CON_TIME_LIMIT_TIME 0xa4 39 #define BUS_INACTIVE_LIMIT_TIME 0xa8 40 #define REJECT_TO_OPEN_LIMIT_TIME 0xac 41 #define CQ_INT_CONVERGE_EN 0xb0 42 #define CFG_AGING_TIME 0xbc 43 #define HGC_DFX_CFG2 0xc0 44 #define CFG_ABT_SET_QUERY_IPTT 0xd4 45 #define CFG_SET_ABORTED_IPTT_OFF 0 46 #define CFG_SET_ABORTED_IPTT_MSK (0xfff << CFG_SET_ABORTED_IPTT_OFF) 47 #define CFG_SET_ABORTED_EN_OFF 12 48 #define CFG_ABT_SET_IPTT_DONE 0xd8 49 #define CFG_ABT_SET_IPTT_DONE_OFF 0 50 #define HGC_IOMB_PROC1_STATUS 0x104 51 #define HGC_LM_DFX_STATUS2 0x128 52 #define HGC_LM_DFX_STATUS2_IOSTLIST_OFF 0 53 #define HGC_LM_DFX_STATUS2_IOSTLIST_MSK (0xfff << \ 54 HGC_LM_DFX_STATUS2_IOSTLIST_OFF) 55 #define HGC_LM_DFX_STATUS2_ITCTLIST_OFF 12 56 #define HGC_LM_DFX_STATUS2_ITCTLIST_MSK (0x7ff << \ 57 HGC_LM_DFX_STATUS2_ITCTLIST_OFF) 58 #define HGC_CQE_ECC_ADDR 0x13c 59 #define HGC_CQE_ECC_1B_ADDR_OFF 0 60 #define HGC_CQE_ECC_1B_ADDR_MSK (0x3f << HGC_CQE_ECC_1B_ADDR_OFF) 61 #define HGC_CQE_ECC_MB_ADDR_OFF 8 62 #define HGC_CQE_ECC_MB_ADDR_MSK (0x3f << HGC_CQE_ECC_MB_ADDR_OFF) 63 #define HGC_IOST_ECC_ADDR 0x140 64 #define HGC_IOST_ECC_1B_ADDR_OFF 0 65 #define HGC_IOST_ECC_1B_ADDR_MSK (0x3ff << HGC_IOST_ECC_1B_ADDR_OFF) 66 #define HGC_IOST_ECC_MB_ADDR_OFF 16 67 #define HGC_IOST_ECC_MB_ADDR_MSK (0x3ff << HGC_IOST_ECC_MB_ADDR_OFF) 68 #define HGC_DQE_ECC_ADDR 0x144 69 #define HGC_DQE_ECC_1B_ADDR_OFF 0 70 #define HGC_DQE_ECC_1B_ADDR_MSK (0xfff << HGC_DQE_ECC_1B_ADDR_OFF) 71 #define HGC_DQE_ECC_MB_ADDR_OFF 16 72 #define HGC_DQE_ECC_MB_ADDR_MSK (0xfff << HGC_DQE_ECC_MB_ADDR_OFF) 73 #define CHNL_INT_STATUS 0x148 74 #define TAB_DFX 0x14c 75 #define HGC_ITCT_ECC_ADDR 0x150 76 #define HGC_ITCT_ECC_1B_ADDR_OFF 0 77 #define HGC_ITCT_ECC_1B_ADDR_MSK (0x3ff << \ 78 HGC_ITCT_ECC_1B_ADDR_OFF) 79 #define HGC_ITCT_ECC_MB_ADDR_OFF 16 80 #define HGC_ITCT_ECC_MB_ADDR_MSK (0x3ff << \ 81 HGC_ITCT_ECC_MB_ADDR_OFF) 82 #define HGC_AXI_FIFO_ERR_INFO 0x154 83 #define AXI_ERR_INFO_OFF 0 84 #define AXI_ERR_INFO_MSK (0xff << AXI_ERR_INFO_OFF) 85 #define FIFO_ERR_INFO_OFF 8 86 #define FIFO_ERR_INFO_MSK (0xff << FIFO_ERR_INFO_OFF) 87 #define TAB_RD_TYPE 0x15c 88 #define INT_COAL_EN 0x19c 89 #define OQ_INT_COAL_TIME 0x1a0 90 #define OQ_INT_COAL_CNT 0x1a4 91 #define ENT_INT_COAL_TIME 0x1a8 92 #define ENT_INT_COAL_CNT 0x1ac 93 #define OQ_INT_SRC 0x1b0 94 #define OQ_INT_SRC_MSK 0x1b4 95 #define ENT_INT_SRC1 0x1b8 96 #define ENT_INT_SRC1_D2H_FIS_CH0_OFF 0 97 #define ENT_INT_SRC1_D2H_FIS_CH0_MSK (0x1 << ENT_INT_SRC1_D2H_FIS_CH0_OFF) 98 #define ENT_INT_SRC1_D2H_FIS_CH1_OFF 8 99 #define ENT_INT_SRC1_D2H_FIS_CH1_MSK (0x1 << ENT_INT_SRC1_D2H_FIS_CH1_OFF) 100 #define ENT_INT_SRC2 0x1bc 101 #define ENT_INT_SRC3 0x1c0 102 #define ENT_INT_SRC3_WP_DEPTH_OFF 8 103 #define ENT_INT_SRC3_IPTT_SLOT_NOMATCH_OFF 9 104 #define ENT_INT_SRC3_RP_DEPTH_OFF 10 105 #define ENT_INT_SRC3_AXI_OFF 11 106 #define ENT_INT_SRC3_FIFO_OFF 12 107 #define ENT_INT_SRC3_LM_OFF 14 108 #define ENT_INT_SRC3_ITC_INT_OFF 15 109 #define ENT_INT_SRC3_ITC_INT_MSK (0x1 << ENT_INT_SRC3_ITC_INT_OFF) 110 #define ENT_INT_SRC3_ABT_OFF 16 111 #define ENT_INT_SRC3_DQE_POISON_OFF 18 112 #define ENT_INT_SRC3_IOST_POISON_OFF 19 113 #define ENT_INT_SRC3_ITCT_POISON_OFF 20 114 #define ENT_INT_SRC3_ITCT_NCQ_POISON_OFF 21 115 #define ENT_INT_SRC_MSK1 0x1c4 116 #define ENT_INT_SRC_MSK2 0x1c8 117 #define ENT_INT_SRC_MSK3 0x1cc 118 #define ENT_INT_SRC_MSK3_ENT95_MSK_OFF 31 119 #define CHNL_PHYUPDOWN_INT_MSK 0x1d0 120 #define CHNL_ENT_INT_MSK 0x1d4 121 #define HGC_COM_INT_MSK 0x1d8 122 #define ENT_INT_SRC_MSK3_ENT95_MSK_MSK (0x1 << ENT_INT_SRC_MSK3_ENT95_MSK_OFF) 123 #define SAS_ECC_INTR 0x1e8 124 #define SAS_ECC_INTR_DQE_ECC_1B_OFF 0 125 #define SAS_ECC_INTR_DQE_ECC_MB_OFF 1 126 #define SAS_ECC_INTR_IOST_ECC_1B_OFF 2 127 #define SAS_ECC_INTR_IOST_ECC_MB_OFF 3 128 #define SAS_ECC_INTR_ITCT_ECC_1B_OFF 4 129 #define SAS_ECC_INTR_ITCT_ECC_MB_OFF 5 130 #define SAS_ECC_INTR_ITCTLIST_ECC_1B_OFF 6 131 #define SAS_ECC_INTR_ITCTLIST_ECC_MB_OFF 7 132 #define SAS_ECC_INTR_IOSTLIST_ECC_1B_OFF 8 133 #define SAS_ECC_INTR_IOSTLIST_ECC_MB_OFF 9 134 #define SAS_ECC_INTR_CQE_ECC_1B_OFF 10 135 #define SAS_ECC_INTR_CQE_ECC_MB_OFF 11 136 #define SAS_ECC_INTR_NCQ_MEM0_ECC_1B_OFF 12 137 #define SAS_ECC_INTR_NCQ_MEM0_ECC_MB_OFF 13 138 #define SAS_ECC_INTR_NCQ_MEM1_ECC_1B_OFF 14 139 #define SAS_ECC_INTR_NCQ_MEM1_ECC_MB_OFF 15 140 #define SAS_ECC_INTR_NCQ_MEM2_ECC_1B_OFF 16 141 #define SAS_ECC_INTR_NCQ_MEM2_ECC_MB_OFF 17 142 #define SAS_ECC_INTR_NCQ_MEM3_ECC_1B_OFF 18 143 #define SAS_ECC_INTR_NCQ_MEM3_ECC_MB_OFF 19 144 #define SAS_ECC_INTR_OOO_RAM_ECC_1B_OFF 20 145 #define SAS_ECC_INTR_OOO_RAM_ECC_MB_OFF 21 146 #define SAS_ECC_INTR_MSK 0x1ec 147 #define HGC_ERR_STAT_EN 0x238 148 #define CQE_SEND_CNT 0x248 149 #define DLVRY_Q_0_BASE_ADDR_LO 0x260 150 #define DLVRY_Q_0_BASE_ADDR_HI 0x264 151 #define DLVRY_Q_0_DEPTH 0x268 152 #define DLVRY_Q_0_WR_PTR 0x26c 153 #define DLVRY_Q_0_RD_PTR 0x270 154 #define HYPER_STREAM_ID_EN_CFG 0xc80 155 #define OQ0_INT_SRC_MSK 0xc90 156 #define COMPL_Q_0_BASE_ADDR_LO 0x4e0 157 #define COMPL_Q_0_BASE_ADDR_HI 0x4e4 158 #define COMPL_Q_0_DEPTH 0x4e8 159 #define COMPL_Q_0_WR_PTR 0x4ec 160 #define COMPL_Q_0_RD_PTR 0x4f0 161 #define HGC_RXM_DFX_STATUS14 0xae8 162 #define HGC_RXM_DFX_STATUS14_MEM0_OFF 0 163 #define HGC_RXM_DFX_STATUS14_MEM0_MSK (0x1ff << \ 164 HGC_RXM_DFX_STATUS14_MEM0_OFF) 165 #define HGC_RXM_DFX_STATUS14_MEM1_OFF 9 166 #define HGC_RXM_DFX_STATUS14_MEM1_MSK (0x1ff << \ 167 HGC_RXM_DFX_STATUS14_MEM1_OFF) 168 #define HGC_RXM_DFX_STATUS14_MEM2_OFF 18 169 #define HGC_RXM_DFX_STATUS14_MEM2_MSK (0x1ff << \ 170 HGC_RXM_DFX_STATUS14_MEM2_OFF) 171 #define HGC_RXM_DFX_STATUS15 0xaec 172 #define HGC_RXM_DFX_STATUS15_MEM3_OFF 0 173 #define HGC_RXM_DFX_STATUS15_MEM3_MSK (0x1ff << \ 174 HGC_RXM_DFX_STATUS15_MEM3_OFF) 175 #define AWQOS_AWCACHE_CFG 0xc84 176 #define ARQOS_ARCACHE_CFG 0xc88 177 #define HILINK_ERR_DFX 0xe04 178 #define SAS_GPIO_CFG_0 0x1000 179 #define SAS_GPIO_CFG_1 0x1004 180 #define SAS_GPIO_TX_0_1 0x1040 181 #define SAS_CFG_DRIVE_VLD 0x1070 182 183 /* phy registers requiring init */ 184 #define PORT_BASE (0x2000) 185 #define PHY_CFG (PORT_BASE + 0x0) 186 #define HARD_PHY_LINKRATE (PORT_BASE + 0x4) 187 #define PHY_CFG_ENA_OFF 0 188 #define PHY_CFG_ENA_MSK (0x1 << PHY_CFG_ENA_OFF) 189 #define PHY_CFG_DC_OPT_OFF 2 190 #define PHY_CFG_DC_OPT_MSK (0x1 << PHY_CFG_DC_OPT_OFF) 191 #define PHY_CFG_PHY_RST_OFF 3 192 #define PHY_CFG_PHY_RST_MSK (0x1 << PHY_CFG_PHY_RST_OFF) 193 #define PROG_PHY_LINK_RATE (PORT_BASE + 0x8) 194 #define CFG_PROG_PHY_LINK_RATE_OFF 0 195 #define CFG_PROG_PHY_LINK_RATE_MSK (0xff << CFG_PROG_PHY_LINK_RATE_OFF) 196 #define CFG_PROG_OOB_PHY_LINK_RATE_OFF 8 197 #define CFG_PROG_OOB_PHY_LINK_RATE_MSK (0xf << CFG_PROG_OOB_PHY_LINK_RATE_OFF) 198 #define PHY_CTRL (PORT_BASE + 0x14) 199 #define PHY_CTRL_RESET_OFF 0 200 #define PHY_CTRL_RESET_MSK (0x1 << PHY_CTRL_RESET_OFF) 201 #define CMD_HDR_PIR_OFF 8 202 #define CMD_HDR_PIR_MSK (0x1 << CMD_HDR_PIR_OFF) 203 #define SERDES_CFG (PORT_BASE + 0x1c) 204 #define CFG_ALOS_CHK_DISABLE_OFF 9 205 #define CFG_ALOS_CHK_DISABLE_MSK (0x1 << CFG_ALOS_CHK_DISABLE_OFF) 206 #define SAS_PHY_BIST_CTRL (PORT_BASE + 0x2c) 207 #define CFG_BIST_MODE_SEL_OFF 0 208 #define CFG_BIST_MODE_SEL_MSK (0xf << CFG_BIST_MODE_SEL_OFF) 209 #define CFG_LOOP_TEST_MODE_OFF 14 210 #define CFG_LOOP_TEST_MODE_MSK (0x3 << CFG_LOOP_TEST_MODE_OFF) 211 #define CFG_RX_BIST_EN_OFF 16 212 #define CFG_RX_BIST_EN_MSK (0x1 << CFG_RX_BIST_EN_OFF) 213 #define CFG_TX_BIST_EN_OFF 17 214 #define CFG_TX_BIST_EN_MSK (0x1 << CFG_TX_BIST_EN_OFF) 215 #define CFG_BIST_TEST_OFF 18 216 #define CFG_BIST_TEST_MSK (0x1 << CFG_BIST_TEST_OFF) 217 #define SAS_PHY_BIST_CODE (PORT_BASE + 0x30) 218 #define SAS_PHY_BIST_CODE1 (PORT_BASE + 0x34) 219 #define SAS_BIST_ERR_CNT (PORT_BASE + 0x38) 220 #define SL_CFG (PORT_BASE + 0x84) 221 #define AIP_LIMIT (PORT_BASE + 0x90) 222 #define SL_CONTROL (PORT_BASE + 0x94) 223 #define SL_CONTROL_NOTIFY_EN_OFF 0 224 #define SL_CONTROL_NOTIFY_EN_MSK (0x1 << SL_CONTROL_NOTIFY_EN_OFF) 225 #define SL_CTA_OFF 17 226 #define SL_CTA_MSK (0x1 << SL_CTA_OFF) 227 #define RX_PRIMS_STATUS (PORT_BASE + 0x98) 228 #define RX_BCAST_CHG_OFF 1 229 #define RX_BCAST_CHG_MSK (0x1 << RX_BCAST_CHG_OFF) 230 #define TX_ID_DWORD0 (PORT_BASE + 0x9c) 231 #define TX_ID_DWORD1 (PORT_BASE + 0xa0) 232 #define TX_ID_DWORD2 (PORT_BASE + 0xa4) 233 #define TX_ID_DWORD3 (PORT_BASE + 0xa8) 234 #define TX_ID_DWORD4 (PORT_BASE + 0xaC) 235 #define TX_ID_DWORD5 (PORT_BASE + 0xb0) 236 #define TX_ID_DWORD6 (PORT_BASE + 0xb4) 237 #define TXID_AUTO (PORT_BASE + 0xb8) 238 #define CT3_OFF 1 239 #define CT3_MSK (0x1 << CT3_OFF) 240 #define TX_HARDRST_OFF 2 241 #define TX_HARDRST_MSK (0x1 << TX_HARDRST_OFF) 242 #define RX_IDAF_DWORD0 (PORT_BASE + 0xc4) 243 #define RXOP_CHECK_CFG_H (PORT_BASE + 0xfc) 244 #define STP_LINK_TIMER (PORT_BASE + 0x120) 245 #define STP_LINK_TIMEOUT_STATE (PORT_BASE + 0x124) 246 #define CON_CFG_DRIVER (PORT_BASE + 0x130) 247 #define SAS_SSP_CON_TIMER_CFG (PORT_BASE + 0x134) 248 #define SAS_SMP_CON_TIMER_CFG (PORT_BASE + 0x138) 249 #define SAS_STP_CON_TIMER_CFG (PORT_BASE + 0x13c) 250 #define CHL_INT0 (PORT_BASE + 0x1b4) 251 #define CHL_INT0_HOTPLUG_TOUT_OFF 0 252 #define CHL_INT0_HOTPLUG_TOUT_MSK (0x1 << CHL_INT0_HOTPLUG_TOUT_OFF) 253 #define CHL_INT0_SL_RX_BCST_ACK_OFF 1 254 #define CHL_INT0_SL_RX_BCST_ACK_MSK (0x1 << CHL_INT0_SL_RX_BCST_ACK_OFF) 255 #define CHL_INT0_SL_PHY_ENABLE_OFF 2 256 #define CHL_INT0_SL_PHY_ENABLE_MSK (0x1 << CHL_INT0_SL_PHY_ENABLE_OFF) 257 #define CHL_INT0_NOT_RDY_OFF 4 258 #define CHL_INT0_NOT_RDY_MSK (0x1 << CHL_INT0_NOT_RDY_OFF) 259 #define CHL_INT0_PHY_RDY_OFF 5 260 #define CHL_INT0_PHY_RDY_MSK (0x1 << CHL_INT0_PHY_RDY_OFF) 261 #define CHL_INT1 (PORT_BASE + 0x1b8) 262 #define CHL_INT1_DMAC_TX_ECC_MB_ERR_OFF 15 263 #define CHL_INT1_DMAC_TX_ECC_1B_ERR_OFF 16 264 #define CHL_INT1_DMAC_RX_ECC_MB_ERR_OFF 17 265 #define CHL_INT1_DMAC_RX_ECC_1B_ERR_OFF 18 266 #define CHL_INT1_DMAC_TX_AXI_WR_ERR_OFF 19 267 #define CHL_INT1_DMAC_TX_AXI_RD_ERR_OFF 20 268 #define CHL_INT1_DMAC_RX_AXI_WR_ERR_OFF 21 269 #define CHL_INT1_DMAC_RX_AXI_RD_ERR_OFF 22 270 #define CHL_INT1_DMAC_TX_FIFO_ERR_OFF 23 271 #define CHL_INT1_DMAC_RX_FIFO_ERR_OFF 24 272 #define CHL_INT1_DMAC_TX_AXI_RUSER_ERR_OFF 26 273 #define CHL_INT1_DMAC_RX_AXI_RUSER_ERR_OFF 27 274 #define CHL_INT2 (PORT_BASE + 0x1bc) 275 #define CHL_INT2_SL_IDAF_TOUT_CONF_OFF 0 276 #define CHL_INT2_RX_DISP_ERR_OFF 28 277 #define CHL_INT2_RX_CODE_ERR_OFF 29 278 #define CHL_INT2_RX_INVLD_DW_OFF 30 279 #define CHL_INT2_STP_LINK_TIMEOUT_OFF 31 280 #define CHL_INT0_MSK (PORT_BASE + 0x1c0) 281 #define CHL_INT1_MSK (PORT_BASE + 0x1c4) 282 #define CHL_INT2_MSK (PORT_BASE + 0x1c8) 283 #define SAS_EC_INT_COAL_TIME (PORT_BASE + 0x1cc) 284 #define CHL_INT_COAL_EN (PORT_BASE + 0x1d0) 285 #define SAS_RX_TRAIN_TIMER (PORT_BASE + 0x2a4) 286 #define PHY_CTRL_RDY_MSK (PORT_BASE + 0x2b0) 287 #define PHYCTRL_NOT_RDY_MSK (PORT_BASE + 0x2b4) 288 #define PHYCTRL_DWS_RESET_MSK (PORT_BASE + 0x2b8) 289 #define PHYCTRL_PHY_ENA_MSK (PORT_BASE + 0x2bc) 290 #define SL_RX_BCAST_CHK_MSK (PORT_BASE + 0x2c0) 291 #define PHYCTRL_OOB_RESTART_MSK (PORT_BASE + 0x2c4) 292 #define DMA_TX_STATUS (PORT_BASE + 0x2d0) 293 #define DMA_TX_STATUS_BUSY_OFF 0 294 #define DMA_TX_STATUS_BUSY_MSK (0x1 << DMA_TX_STATUS_BUSY_OFF) 295 #define DMA_RX_STATUS (PORT_BASE + 0x2e8) 296 #define DMA_RX_STATUS_BUSY_OFF 0 297 #define DMA_RX_STATUS_BUSY_MSK (0x1 << DMA_RX_STATUS_BUSY_OFF) 298 299 #define COARSETUNE_TIME (PORT_BASE + 0x304) 300 #define TXDEEMPH_G1 (PORT_BASE + 0x350) 301 #define ERR_CNT_DWS_LOST (PORT_BASE + 0x380) 302 #define ERR_CNT_RESET_PROB (PORT_BASE + 0x384) 303 #define ERR_CNT_INVLD_DW (PORT_BASE + 0x390) 304 #define ERR_CNT_CODE_ERR (PORT_BASE + 0x394) 305 #define ERR_CNT_DISP_ERR (PORT_BASE + 0x398) 306 #define DFX_FIFO_CTRL (PORT_BASE + 0x3a0) 307 #define DFX_FIFO_CTRL_TRIGGER_MODE_OFF 0 308 #define DFX_FIFO_CTRL_TRIGGER_MODE_MSK (0x7 << DFX_FIFO_CTRL_TRIGGER_MODE_OFF) 309 #define DFX_FIFO_CTRL_DUMP_MODE_OFF 3 310 #define DFX_FIFO_CTRL_DUMP_MODE_MSK (0x7 << DFX_FIFO_CTRL_DUMP_MODE_OFF) 311 #define DFX_FIFO_CTRL_SIGNAL_SEL_OFF 6 312 #define DFX_FIFO_CTRL_SIGNAL_SEL_MSK (0xF << DFX_FIFO_CTRL_SIGNAL_SEL_OFF) 313 #define DFX_FIFO_CTRL_DUMP_DISABLE_OFF 10 314 #define DFX_FIFO_CTRL_DUMP_DISABLE_MSK (0x1 << DFX_FIFO_CTRL_DUMP_DISABLE_OFF) 315 #define DFX_FIFO_TRIGGER (PORT_BASE + 0x3a4) 316 #define DFX_FIFO_TRIGGER_MSK (PORT_BASE + 0x3a8) 317 #define DFX_FIFO_DUMP_MSK (PORT_BASE + 0x3aC) 318 #define DFX_FIFO_RD_DATA (PORT_BASE + 0x3b0) 319 320 #define DEFAULT_ITCT_HW 2048 /* reset value, not reprogrammed */ 321 #if (HISI_SAS_MAX_DEVICES > DEFAULT_ITCT_HW) 322 #error Max ITCT exceeded 323 #endif 324 325 #define AXI_MASTER_CFG_BASE (0x5000) 326 #define AM_CTRL_GLOBAL (0x0) 327 #define AM_CTRL_SHUTDOWN_REQ_OFF 0 328 #define AM_CTRL_SHUTDOWN_REQ_MSK (0x1 << AM_CTRL_SHUTDOWN_REQ_OFF) 329 #define AM_CURR_TRANS_RETURN (0x150) 330 331 #define AM_CFG_MAX_TRANS (0x5010) 332 #define AM_CFG_SINGLE_PORT_MAX_TRANS (0x5014) 333 #define AXI_CFG (0x5100) 334 #define AM_ROB_ECC_ERR_ADDR (0x510c) 335 #define AM_ROB_ECC_ERR_ADDR_OFF 0 336 #define AM_ROB_ECC_ERR_ADDR_MSK 0xffffffff 337 338 /* RAS registers need init */ 339 #define RAS_BASE (0x6000) 340 #define SAS_RAS_INTR0 (RAS_BASE) 341 #define SAS_RAS_INTR1 (RAS_BASE + 0x04) 342 #define SAS_RAS_INTR0_MASK (RAS_BASE + 0x08) 343 #define SAS_RAS_INTR1_MASK (RAS_BASE + 0x0c) 344 #define CFG_SAS_RAS_INTR_MASK (RAS_BASE + 0x1c) 345 #define SAS_RAS_INTR2 (RAS_BASE + 0x20) 346 #define SAS_RAS_INTR2_MASK (RAS_BASE + 0x24) 347 348 /* HW dma structures */ 349 /* Delivery queue header */ 350 /* dw0 */ 351 #define CMD_HDR_ABORT_FLAG_OFF 0 352 #define CMD_HDR_ABORT_FLAG_MSK (0x3 << CMD_HDR_ABORT_FLAG_OFF) 353 #define CMD_HDR_ABORT_DEVICE_TYPE_OFF 2 354 #define CMD_HDR_ABORT_DEVICE_TYPE_MSK (0x1 << CMD_HDR_ABORT_DEVICE_TYPE_OFF) 355 #define CMD_HDR_RESP_REPORT_OFF 5 356 #define CMD_HDR_RESP_REPORT_MSK (0x1 << CMD_HDR_RESP_REPORT_OFF) 357 #define CMD_HDR_TLR_CTRL_OFF 6 358 #define CMD_HDR_TLR_CTRL_MSK (0x3 << CMD_HDR_TLR_CTRL_OFF) 359 #define CMD_HDR_PORT_OFF 18 360 #define CMD_HDR_PORT_MSK (0xf << CMD_HDR_PORT_OFF) 361 #define CMD_HDR_PRIORITY_OFF 27 362 #define CMD_HDR_PRIORITY_MSK (0x1 << CMD_HDR_PRIORITY_OFF) 363 #define CMD_HDR_CMD_OFF 29 364 #define CMD_HDR_CMD_MSK (0x7 << CMD_HDR_CMD_OFF) 365 /* dw1 */ 366 #define CMD_HDR_UNCON_CMD_OFF 3 367 #define CMD_HDR_DIR_OFF 5 368 #define CMD_HDR_DIR_MSK (0x3 << CMD_HDR_DIR_OFF) 369 #define CMD_HDR_RESET_OFF 7 370 #define CMD_HDR_RESET_MSK (0x1 << CMD_HDR_RESET_OFF) 371 #define CMD_HDR_VDTL_OFF 10 372 #define CMD_HDR_VDTL_MSK (0x1 << CMD_HDR_VDTL_OFF) 373 #define CMD_HDR_FRAME_TYPE_OFF 11 374 #define CMD_HDR_FRAME_TYPE_MSK (0x1f << CMD_HDR_FRAME_TYPE_OFF) 375 #define CMD_HDR_DEV_ID_OFF 16 376 #define CMD_HDR_DEV_ID_MSK (0xffff << CMD_HDR_DEV_ID_OFF) 377 /* dw2 */ 378 #define CMD_HDR_CFL_OFF 0 379 #define CMD_HDR_CFL_MSK (0x1ff << CMD_HDR_CFL_OFF) 380 #define CMD_HDR_NCQ_TAG_OFF 10 381 #define CMD_HDR_NCQ_TAG_MSK (0x1f << CMD_HDR_NCQ_TAG_OFF) 382 #define CMD_HDR_MRFL_OFF 15 383 #define CMD_HDR_MRFL_MSK (0x1ff << CMD_HDR_MRFL_OFF) 384 #define CMD_HDR_SG_MOD_OFF 24 385 #define CMD_HDR_SG_MOD_MSK (0x3 << CMD_HDR_SG_MOD_OFF) 386 /* dw3 */ 387 #define CMD_HDR_IPTT_OFF 0 388 #define CMD_HDR_IPTT_MSK (0xffff << CMD_HDR_IPTT_OFF) 389 /* dw6 */ 390 #define CMD_HDR_DIF_SGL_LEN_OFF 0 391 #define CMD_HDR_DIF_SGL_LEN_MSK (0xffff << CMD_HDR_DIF_SGL_LEN_OFF) 392 #define CMD_HDR_DATA_SGL_LEN_OFF 16 393 #define CMD_HDR_DATA_SGL_LEN_MSK (0xffff << CMD_HDR_DATA_SGL_LEN_OFF) 394 /* dw7 */ 395 #define CMD_HDR_ADDR_MODE_SEL_OFF 15 396 #define CMD_HDR_ADDR_MODE_SEL_MSK (1 << CMD_HDR_ADDR_MODE_SEL_OFF) 397 #define CMD_HDR_ABORT_IPTT_OFF 16 398 #define CMD_HDR_ABORT_IPTT_MSK (0xffff << CMD_HDR_ABORT_IPTT_OFF) 399 400 /* Completion header */ 401 /* dw0 */ 402 #define CMPLT_HDR_CMPLT_OFF 0 403 #define CMPLT_HDR_CMPLT_MSK (0x3 << CMPLT_HDR_CMPLT_OFF) 404 #define CMPLT_HDR_ERROR_PHASE_OFF 2 405 #define CMPLT_HDR_ERROR_PHASE_MSK (0xff << CMPLT_HDR_ERROR_PHASE_OFF) 406 #define CMPLT_HDR_RSPNS_XFRD_OFF 10 407 #define CMPLT_HDR_RSPNS_XFRD_MSK (0x1 << CMPLT_HDR_RSPNS_XFRD_OFF) 408 #define CMPLT_HDR_ERX_OFF 12 409 #define CMPLT_HDR_ERX_MSK (0x1 << CMPLT_HDR_ERX_OFF) 410 #define CMPLT_HDR_ABORT_STAT_OFF 13 411 #define CMPLT_HDR_ABORT_STAT_MSK (0x7 << CMPLT_HDR_ABORT_STAT_OFF) 412 /* abort_stat */ 413 #define STAT_IO_NOT_VALID 0x1 414 #define STAT_IO_NO_DEVICE 0x2 415 #define STAT_IO_COMPLETE 0x3 416 #define STAT_IO_ABORTED 0x4 417 /* dw1 */ 418 #define CMPLT_HDR_IPTT_OFF 0 419 #define CMPLT_HDR_IPTT_MSK (0xffff << CMPLT_HDR_IPTT_OFF) 420 #define CMPLT_HDR_DEV_ID_OFF 16 421 #define CMPLT_HDR_DEV_ID_MSK (0xffff << CMPLT_HDR_DEV_ID_OFF) 422 /* dw3 */ 423 #define CMPLT_HDR_IO_IN_TARGET_OFF 17 424 #define CMPLT_HDR_IO_IN_TARGET_MSK (0x1 << CMPLT_HDR_IO_IN_TARGET_OFF) 425 426 /* ITCT header */ 427 /* qw0 */ 428 #define ITCT_HDR_DEV_TYPE_OFF 0 429 #define ITCT_HDR_DEV_TYPE_MSK (0x3 << ITCT_HDR_DEV_TYPE_OFF) 430 #define ITCT_HDR_VALID_OFF 2 431 #define ITCT_HDR_VALID_MSK (0x1 << ITCT_HDR_VALID_OFF) 432 #define ITCT_HDR_MCR_OFF 5 433 #define ITCT_HDR_MCR_MSK (0xf << ITCT_HDR_MCR_OFF) 434 #define ITCT_HDR_VLN_OFF 9 435 #define ITCT_HDR_VLN_MSK (0xf << ITCT_HDR_VLN_OFF) 436 #define ITCT_HDR_SMP_TIMEOUT_OFF 16 437 #define ITCT_HDR_AWT_CONTINUE_OFF 25 438 #define ITCT_HDR_PORT_ID_OFF 28 439 #define ITCT_HDR_PORT_ID_MSK (0xf << ITCT_HDR_PORT_ID_OFF) 440 /* qw2 */ 441 #define ITCT_HDR_INLT_OFF 0 442 #define ITCT_HDR_INLT_MSK (0xffffULL << ITCT_HDR_INLT_OFF) 443 #define ITCT_HDR_RTOLT_OFF 48 444 #define ITCT_HDR_RTOLT_MSK (0xffffULL << ITCT_HDR_RTOLT_OFF) 445 446 struct hisi_sas_protect_iu_v3_hw { 447 u32 dw0; 448 u32 lbrtcv; 449 u32 lbrtgv; 450 u32 dw3; 451 u32 dw4; 452 u32 dw5; 453 u32 rsv; 454 }; 455 456 struct hisi_sas_complete_v3_hdr { 457 __le32 dw0; 458 __le32 dw1; 459 __le32 act; 460 __le32 dw3; 461 }; 462 463 struct hisi_sas_err_record_v3 { 464 /* dw0 */ 465 __le32 trans_tx_fail_type; 466 467 /* dw1 */ 468 __le32 trans_rx_fail_type; 469 470 /* dw2 */ 471 __le16 dma_tx_err_type; 472 __le16 sipc_rx_err_type; 473 474 /* dw3 */ 475 __le32 dma_rx_err_type; 476 }; 477 478 #define RX_DATA_LEN_UNDERFLOW_OFF 6 479 #define RX_DATA_LEN_UNDERFLOW_MSK (1 << RX_DATA_LEN_UNDERFLOW_OFF) 480 481 #define HISI_SAS_COMMAND_ENTRIES_V3_HW 4096 482 #define HISI_SAS_MSI_COUNT_V3_HW 32 483 484 #define DIR_NO_DATA 0 485 #define DIR_TO_INI 1 486 #define DIR_TO_DEVICE 2 487 #define DIR_RESERVED 3 488 489 #define FIS_CMD_IS_UNCONSTRAINED(fis) \ 490 ((fis.command == ATA_CMD_READ_LOG_EXT) || \ 491 (fis.command == ATA_CMD_READ_LOG_DMA_EXT) || \ 492 ((fis.command == ATA_CMD_DEV_RESET) && \ 493 ((fis.control & ATA_SRST) != 0))) 494 495 #define T10_INSRT_EN_OFF 0 496 #define T10_INSRT_EN_MSK (1 << T10_INSRT_EN_OFF) 497 #define T10_RMV_EN_OFF 1 498 #define T10_RMV_EN_MSK (1 << T10_RMV_EN_OFF) 499 #define T10_RPLC_EN_OFF 2 500 #define T10_RPLC_EN_MSK (1 << T10_RPLC_EN_OFF) 501 #define T10_CHK_EN_OFF 3 502 #define T10_CHK_EN_MSK (1 << T10_CHK_EN_OFF) 503 #define INCR_LBRT_OFF 5 504 #define INCR_LBRT_MSK (1 << INCR_LBRT_OFF) 505 #define USR_DATA_BLOCK_SZ_OFF 20 506 #define USR_DATA_BLOCK_SZ_MSK (0x3 << USR_DATA_BLOCK_SZ_OFF) 507 #define T10_CHK_MSK_OFF 16 508 #define T10_CHK_REF_TAG_MSK (0xf0 << T10_CHK_MSK_OFF) 509 #define T10_CHK_APP_TAG_MSK (0xc << T10_CHK_MSK_OFF) 510 511 #define BASE_VECTORS_V3_HW 16 512 #define MIN_AFFINE_VECTORS_V3_HW (BASE_VECTORS_V3_HW + 1) 513 514 #define CHNL_INT_STS_MSK 0xeeeeeeee 515 #define CHNL_INT_STS_PHY_MSK 0xe 516 #define CHNL_INT_STS_INT0_MSK BIT(1) 517 #define CHNL_INT_STS_INT1_MSK BIT(2) 518 #define CHNL_INT_STS_INT2_MSK BIT(3) 519 #define CHNL_WIDTH 4 520 521 #define BAR_NO_V3_HW 5 522 523 enum { 524 DSM_FUNC_ERR_HANDLE_MSI = 0, 525 }; 526 527 static bool hisi_sas_intr_conv; 528 MODULE_PARM_DESC(intr_conv, "interrupt converge enable (0-1)"); 529 530 /* permit overriding the host protection capabilities mask (EEDP/T10 PI) */ 531 static int prot_mask; 532 module_param(prot_mask, int, 0); 533 MODULE_PARM_DESC(prot_mask, " host protection capabilities mask, def=0x0 "); 534 535 static void debugfs_work_handler_v3_hw(struct work_struct *work); 536 static void debugfs_snapshot_regs_v3_hw(struct hisi_hba *hisi_hba); 537 538 static u32 hisi_sas_read32(struct hisi_hba *hisi_hba, u32 off) 539 { 540 void __iomem *regs = hisi_hba->regs + off; 541 542 return readl(regs); 543 } 544 545 static void hisi_sas_write32(struct hisi_hba *hisi_hba, u32 off, u32 val) 546 { 547 void __iomem *regs = hisi_hba->regs + off; 548 549 writel(val, regs); 550 } 551 552 static void hisi_sas_phy_write32(struct hisi_hba *hisi_hba, int phy_no, 553 u32 off, u32 val) 554 { 555 void __iomem *regs = hisi_hba->regs + (0x400 * phy_no) + off; 556 557 writel(val, regs); 558 } 559 560 static u32 hisi_sas_phy_read32(struct hisi_hba *hisi_hba, 561 int phy_no, u32 off) 562 { 563 void __iomem *regs = hisi_hba->regs + (0x400 * phy_no) + off; 564 565 return readl(regs); 566 } 567 568 #define hisi_sas_read32_poll_timeout(off, val, cond, delay_us, \ 569 timeout_us) \ 570 ({ \ 571 void __iomem *regs = hisi_hba->regs + off; \ 572 readl_poll_timeout(regs, val, cond, delay_us, timeout_us); \ 573 }) 574 575 #define hisi_sas_read32_poll_timeout_atomic(off, val, cond, delay_us, \ 576 timeout_us) \ 577 ({ \ 578 void __iomem *regs = hisi_hba->regs + off; \ 579 readl_poll_timeout_atomic(regs, val, cond, delay_us, timeout_us);\ 580 }) 581 582 static void init_reg_v3_hw(struct hisi_hba *hisi_hba) 583 { 584 int i, j; 585 586 /* Global registers init */ 587 hisi_sas_write32(hisi_hba, DLVRY_QUEUE_ENABLE, 588 (u32)((1ULL << hisi_hba->queue_count) - 1)); 589 hisi_sas_write32(hisi_hba, SAS_AXI_USER3, 0); 590 hisi_sas_write32(hisi_hba, CFG_MAX_TAG, 0xfff0400); 591 hisi_sas_write32(hisi_hba, HGC_SAS_TXFAIL_RETRY_CTRL, 0x108); 592 hisi_sas_write32(hisi_hba, CFG_AGING_TIME, 0x1); 593 hisi_sas_write32(hisi_hba, INT_COAL_EN, 0x1); 594 hisi_sas_write32(hisi_hba, OQ_INT_COAL_TIME, 0x1); 595 hisi_sas_write32(hisi_hba, OQ_INT_COAL_CNT, 0x1); 596 hisi_sas_write32(hisi_hba, CQ_INT_CONVERGE_EN, 597 hisi_sas_intr_conv); 598 hisi_sas_write32(hisi_hba, OQ_INT_SRC, 0xffff); 599 hisi_sas_write32(hisi_hba, ENT_INT_SRC1, 0xffffffff); 600 hisi_sas_write32(hisi_hba, ENT_INT_SRC2, 0xffffffff); 601 hisi_sas_write32(hisi_hba, ENT_INT_SRC3, 0xffffffff); 602 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK1, 0xfefefefe); 603 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK2, 0xfefefefe); 604 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK3, 0xffc220ff); 605 hisi_sas_write32(hisi_hba, CHNL_PHYUPDOWN_INT_MSK, 0x0); 606 hisi_sas_write32(hisi_hba, CHNL_ENT_INT_MSK, 0x0); 607 hisi_sas_write32(hisi_hba, HGC_COM_INT_MSK, 0x0); 608 hisi_sas_write32(hisi_hba, SAS_ECC_INTR_MSK, 0x155555); 609 hisi_sas_write32(hisi_hba, AWQOS_AWCACHE_CFG, 0xf0f0); 610 hisi_sas_write32(hisi_hba, ARQOS_ARCACHE_CFG, 0xf0f0); 611 for (i = 0; i < hisi_hba->queue_count; i++) 612 hisi_sas_write32(hisi_hba, OQ0_INT_SRC_MSK + 0x4 * i, 0); 613 614 hisi_sas_write32(hisi_hba, HYPER_STREAM_ID_EN_CFG, 1); 615 616 for (i = 0; i < hisi_hba->n_phy; i++) { 617 enum sas_linkrate max; 618 struct hisi_sas_phy *phy = &hisi_hba->phy[i]; 619 struct asd_sas_phy *sas_phy = &phy->sas_phy; 620 u32 prog_phy_link_rate = hisi_sas_phy_read32(hisi_hba, i, 621 PROG_PHY_LINK_RATE); 622 623 prog_phy_link_rate &= ~CFG_PROG_PHY_LINK_RATE_MSK; 624 if (!sas_phy->phy || (sas_phy->phy->maximum_linkrate < 625 SAS_LINK_RATE_1_5_GBPS)) 626 max = SAS_LINK_RATE_12_0_GBPS; 627 else 628 max = sas_phy->phy->maximum_linkrate; 629 prog_phy_link_rate |= hisi_sas_get_prog_phy_linkrate_mask(max); 630 hisi_sas_phy_write32(hisi_hba, i, PROG_PHY_LINK_RATE, 631 prog_phy_link_rate); 632 hisi_sas_phy_write32(hisi_hba, i, SERDES_CFG, 0xffc00); 633 hisi_sas_phy_write32(hisi_hba, i, SAS_RX_TRAIN_TIMER, 0x13e80); 634 hisi_sas_phy_write32(hisi_hba, i, CHL_INT0, 0xffffffff); 635 hisi_sas_phy_write32(hisi_hba, i, CHL_INT1, 0xffffffff); 636 hisi_sas_phy_write32(hisi_hba, i, CHL_INT2, 0xffffffff); 637 hisi_sas_phy_write32(hisi_hba, i, RXOP_CHECK_CFG_H, 0x1000); 638 hisi_sas_phy_write32(hisi_hba, i, CHL_INT1_MSK, 0xf2057fff); 639 hisi_sas_phy_write32(hisi_hba, i, CHL_INT2_MSK, 0xffffbfe); 640 hisi_sas_phy_write32(hisi_hba, i, PHY_CTRL_RDY_MSK, 0x0); 641 hisi_sas_phy_write32(hisi_hba, i, PHYCTRL_NOT_RDY_MSK, 0x0); 642 hisi_sas_phy_write32(hisi_hba, i, PHYCTRL_DWS_RESET_MSK, 0x0); 643 hisi_sas_phy_write32(hisi_hba, i, PHYCTRL_PHY_ENA_MSK, 0x0); 644 hisi_sas_phy_write32(hisi_hba, i, SL_RX_BCAST_CHK_MSK, 0x0); 645 hisi_sas_phy_write32(hisi_hba, i, PHYCTRL_OOB_RESTART_MSK, 0x1); 646 hisi_sas_phy_write32(hisi_hba, i, STP_LINK_TIMER, 0x7f7a120); 647 hisi_sas_phy_write32(hisi_hba, i, CON_CFG_DRIVER, 0x2a0a01); 648 hisi_sas_phy_write32(hisi_hba, i, SAS_SSP_CON_TIMER_CFG, 0x32); 649 hisi_sas_phy_write32(hisi_hba, i, SAS_EC_INT_COAL_TIME, 650 0x30f4240); 651 /* used for 12G negotiate */ 652 hisi_sas_phy_write32(hisi_hba, i, COARSETUNE_TIME, 0x1e); 653 hisi_sas_phy_write32(hisi_hba, i, AIP_LIMIT, 0x2ffff); 654 655 /* get default FFE configuration for BIST */ 656 for (j = 0; j < FFE_CFG_MAX; j++) { 657 u32 val = hisi_sas_phy_read32(hisi_hba, i, 658 TXDEEMPH_G1 + (j * 0x4)); 659 hisi_hba->debugfs_bist_ffe[i][j] = val; 660 } 661 } 662 663 for (i = 0; i < hisi_hba->queue_count; i++) { 664 /* Delivery queue */ 665 hisi_sas_write32(hisi_hba, 666 DLVRY_Q_0_BASE_ADDR_HI + (i * 0x14), 667 upper_32_bits(hisi_hba->cmd_hdr_dma[i])); 668 669 hisi_sas_write32(hisi_hba, DLVRY_Q_0_BASE_ADDR_LO + (i * 0x14), 670 lower_32_bits(hisi_hba->cmd_hdr_dma[i])); 671 672 hisi_sas_write32(hisi_hba, DLVRY_Q_0_DEPTH + (i * 0x14), 673 HISI_SAS_QUEUE_SLOTS); 674 675 /* Completion queue */ 676 hisi_sas_write32(hisi_hba, COMPL_Q_0_BASE_ADDR_HI + (i * 0x14), 677 upper_32_bits(hisi_hba->complete_hdr_dma[i])); 678 679 hisi_sas_write32(hisi_hba, COMPL_Q_0_BASE_ADDR_LO + (i * 0x14), 680 lower_32_bits(hisi_hba->complete_hdr_dma[i])); 681 682 hisi_sas_write32(hisi_hba, COMPL_Q_0_DEPTH + (i * 0x14), 683 HISI_SAS_QUEUE_SLOTS); 684 } 685 686 /* itct */ 687 hisi_sas_write32(hisi_hba, ITCT_BASE_ADDR_LO, 688 lower_32_bits(hisi_hba->itct_dma)); 689 690 hisi_sas_write32(hisi_hba, ITCT_BASE_ADDR_HI, 691 upper_32_bits(hisi_hba->itct_dma)); 692 693 /* iost */ 694 hisi_sas_write32(hisi_hba, IOST_BASE_ADDR_LO, 695 lower_32_bits(hisi_hba->iost_dma)); 696 697 hisi_sas_write32(hisi_hba, IOST_BASE_ADDR_HI, 698 upper_32_bits(hisi_hba->iost_dma)); 699 700 /* breakpoint */ 701 hisi_sas_write32(hisi_hba, IO_BROKEN_MSG_ADDR_LO, 702 lower_32_bits(hisi_hba->breakpoint_dma)); 703 704 hisi_sas_write32(hisi_hba, IO_BROKEN_MSG_ADDR_HI, 705 upper_32_bits(hisi_hba->breakpoint_dma)); 706 707 /* SATA broken msg */ 708 hisi_sas_write32(hisi_hba, IO_SATA_BROKEN_MSG_ADDR_LO, 709 lower_32_bits(hisi_hba->sata_breakpoint_dma)); 710 711 hisi_sas_write32(hisi_hba, IO_SATA_BROKEN_MSG_ADDR_HI, 712 upper_32_bits(hisi_hba->sata_breakpoint_dma)); 713 714 /* SATA initial fis */ 715 hisi_sas_write32(hisi_hba, SATA_INITI_D2H_STORE_ADDR_LO, 716 lower_32_bits(hisi_hba->initial_fis_dma)); 717 718 hisi_sas_write32(hisi_hba, SATA_INITI_D2H_STORE_ADDR_HI, 719 upper_32_bits(hisi_hba->initial_fis_dma)); 720 721 /* RAS registers init */ 722 hisi_sas_write32(hisi_hba, SAS_RAS_INTR0_MASK, 0x0); 723 hisi_sas_write32(hisi_hba, SAS_RAS_INTR1_MASK, 0x0); 724 hisi_sas_write32(hisi_hba, SAS_RAS_INTR2_MASK, 0x0); 725 hisi_sas_write32(hisi_hba, CFG_SAS_RAS_INTR_MASK, 0x0); 726 727 /* LED registers init */ 728 hisi_sas_write32(hisi_hba, SAS_CFG_DRIVE_VLD, 0x80000ff); 729 hisi_sas_write32(hisi_hba, SAS_GPIO_TX_0_1, 0x80808080); 730 hisi_sas_write32(hisi_hba, SAS_GPIO_TX_0_1 + 0x4, 0x80808080); 731 /* Configure blink generator rate A to 1Hz and B to 4Hz */ 732 hisi_sas_write32(hisi_hba, SAS_GPIO_CFG_1, 0x121700); 733 hisi_sas_write32(hisi_hba, SAS_GPIO_CFG_0, 0x800000); 734 } 735 736 static void config_phy_opt_mode_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 737 { 738 u32 cfg = hisi_sas_phy_read32(hisi_hba, phy_no, PHY_CFG); 739 740 cfg &= ~PHY_CFG_DC_OPT_MSK; 741 cfg |= 1 << PHY_CFG_DC_OPT_OFF; 742 hisi_sas_phy_write32(hisi_hba, phy_no, PHY_CFG, cfg); 743 } 744 745 static void config_id_frame_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 746 { 747 struct sas_identify_frame identify_frame; 748 u32 *identify_buffer; 749 750 memset(&identify_frame, 0, sizeof(identify_frame)); 751 identify_frame.dev_type = SAS_END_DEVICE; 752 identify_frame.frame_type = 0; 753 identify_frame._un1 = 1; 754 identify_frame.initiator_bits = SAS_PROTOCOL_ALL; 755 identify_frame.target_bits = SAS_PROTOCOL_NONE; 756 memcpy(&identify_frame._un4_11[0], hisi_hba->sas_addr, SAS_ADDR_SIZE); 757 memcpy(&identify_frame.sas_addr[0], hisi_hba->sas_addr, SAS_ADDR_SIZE); 758 identify_frame.phy_id = phy_no; 759 identify_buffer = (u32 *)(&identify_frame); 760 761 hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD0, 762 __swab32(identify_buffer[0])); 763 hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD1, 764 __swab32(identify_buffer[1])); 765 hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD2, 766 __swab32(identify_buffer[2])); 767 hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD3, 768 __swab32(identify_buffer[3])); 769 hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD4, 770 __swab32(identify_buffer[4])); 771 hisi_sas_phy_write32(hisi_hba, phy_no, TX_ID_DWORD5, 772 __swab32(identify_buffer[5])); 773 } 774 775 static void setup_itct_v3_hw(struct hisi_hba *hisi_hba, 776 struct hisi_sas_device *sas_dev) 777 { 778 struct domain_device *device = sas_dev->sas_device; 779 struct device *dev = hisi_hba->dev; 780 u64 qw0, device_id = sas_dev->device_id; 781 struct hisi_sas_itct *itct = &hisi_hba->itct[device_id]; 782 struct domain_device *parent_dev = device->parent; 783 struct asd_sas_port *sas_port = device->port; 784 struct hisi_sas_port *port = to_hisi_sas_port(sas_port); 785 u64 sas_addr; 786 787 memset(itct, 0, sizeof(*itct)); 788 789 /* qw0 */ 790 qw0 = 0; 791 switch (sas_dev->dev_type) { 792 case SAS_END_DEVICE: 793 case SAS_EDGE_EXPANDER_DEVICE: 794 case SAS_FANOUT_EXPANDER_DEVICE: 795 qw0 = HISI_SAS_DEV_TYPE_SSP << ITCT_HDR_DEV_TYPE_OFF; 796 break; 797 case SAS_SATA_DEV: 798 case SAS_SATA_PENDING: 799 if (parent_dev && dev_is_expander(parent_dev->dev_type)) 800 qw0 = HISI_SAS_DEV_TYPE_STP << ITCT_HDR_DEV_TYPE_OFF; 801 else 802 qw0 = HISI_SAS_DEV_TYPE_SATA << ITCT_HDR_DEV_TYPE_OFF; 803 break; 804 default: 805 dev_warn(dev, "setup itct: unsupported dev type (%d)\n", 806 sas_dev->dev_type); 807 } 808 809 qw0 |= ((1 << ITCT_HDR_VALID_OFF) | 810 (device->linkrate << ITCT_HDR_MCR_OFF) | 811 (1 << ITCT_HDR_VLN_OFF) | 812 (0xfa << ITCT_HDR_SMP_TIMEOUT_OFF) | 813 (1 << ITCT_HDR_AWT_CONTINUE_OFF) | 814 (port->id << ITCT_HDR_PORT_ID_OFF)); 815 itct->qw0 = cpu_to_le64(qw0); 816 817 /* qw1 */ 818 memcpy(&sas_addr, device->sas_addr, SAS_ADDR_SIZE); 819 itct->sas_addr = cpu_to_le64(__swab64(sas_addr)); 820 821 /* qw2 */ 822 if (!dev_is_sata(device)) 823 itct->qw2 = cpu_to_le64((5000ULL << ITCT_HDR_INLT_OFF) | 824 (0x1ULL << ITCT_HDR_RTOLT_OFF)); 825 } 826 827 static int clear_itct_v3_hw(struct hisi_hba *hisi_hba, 828 struct hisi_sas_device *sas_dev) 829 { 830 DECLARE_COMPLETION_ONSTACK(completion); 831 u64 dev_id = sas_dev->device_id; 832 struct hisi_sas_itct *itct = &hisi_hba->itct[dev_id]; 833 u32 reg_val = hisi_sas_read32(hisi_hba, ENT_INT_SRC3); 834 struct device *dev = hisi_hba->dev; 835 836 sas_dev->completion = &completion; 837 838 /* clear the itct interrupt state */ 839 if (ENT_INT_SRC3_ITC_INT_MSK & reg_val) 840 hisi_sas_write32(hisi_hba, ENT_INT_SRC3, 841 ENT_INT_SRC3_ITC_INT_MSK); 842 843 /* clear the itct table */ 844 reg_val = ITCT_CLR_EN_MSK | (dev_id & ITCT_DEV_MSK); 845 hisi_sas_write32(hisi_hba, ITCT_CLR, reg_val); 846 847 if (!wait_for_completion_timeout(sas_dev->completion, 848 HISI_SAS_CLEAR_ITCT_TIMEOUT)) { 849 dev_warn(dev, "failed to clear ITCT\n"); 850 return -ETIMEDOUT; 851 } 852 853 memset(itct, 0, sizeof(struct hisi_sas_itct)); 854 return 0; 855 } 856 857 static void dereg_device_v3_hw(struct hisi_hba *hisi_hba, 858 struct domain_device *device) 859 { 860 struct hisi_sas_slot *slot, *slot2; 861 struct hisi_sas_device *sas_dev = device->lldd_dev; 862 u32 cfg_abt_set_query_iptt; 863 864 cfg_abt_set_query_iptt = hisi_sas_read32(hisi_hba, 865 CFG_ABT_SET_QUERY_IPTT); 866 list_for_each_entry_safe(slot, slot2, &sas_dev->list, entry) { 867 cfg_abt_set_query_iptt &= ~CFG_SET_ABORTED_IPTT_MSK; 868 cfg_abt_set_query_iptt |= (1 << CFG_SET_ABORTED_EN_OFF) | 869 (slot->idx << CFG_SET_ABORTED_IPTT_OFF); 870 hisi_sas_write32(hisi_hba, CFG_ABT_SET_QUERY_IPTT, 871 cfg_abt_set_query_iptt); 872 } 873 cfg_abt_set_query_iptt &= ~(1 << CFG_SET_ABORTED_EN_OFF); 874 hisi_sas_write32(hisi_hba, CFG_ABT_SET_QUERY_IPTT, 875 cfg_abt_set_query_iptt); 876 hisi_sas_write32(hisi_hba, CFG_ABT_SET_IPTT_DONE, 877 1 << CFG_ABT_SET_IPTT_DONE_OFF); 878 } 879 880 static int reset_hw_v3_hw(struct hisi_hba *hisi_hba) 881 { 882 struct device *dev = hisi_hba->dev; 883 int ret; 884 u32 val; 885 886 hisi_sas_write32(hisi_hba, DLVRY_QUEUE_ENABLE, 0); 887 888 /* Disable all of the PHYs */ 889 hisi_sas_stop_phys(hisi_hba); 890 udelay(50); 891 892 /* Ensure axi bus idle */ 893 ret = hisi_sas_read32_poll_timeout(AXI_CFG, val, !val, 894 20000, 1000000); 895 if (ret) { 896 dev_err(dev, "axi bus is not idle, ret = %d!\n", ret); 897 return -EIO; 898 } 899 900 if (ACPI_HANDLE(dev)) { 901 acpi_status s; 902 903 s = acpi_evaluate_object(ACPI_HANDLE(dev), "_RST", NULL, NULL); 904 if (ACPI_FAILURE(s)) { 905 dev_err(dev, "Reset failed\n"); 906 return -EIO; 907 } 908 } else { 909 dev_err(dev, "no reset method!\n"); 910 return -EINVAL; 911 } 912 913 return 0; 914 } 915 916 static int hw_init_v3_hw(struct hisi_hba *hisi_hba) 917 { 918 struct device *dev = hisi_hba->dev; 919 struct acpi_device *acpi_dev; 920 union acpi_object *obj; 921 guid_t guid; 922 int rc; 923 924 rc = reset_hw_v3_hw(hisi_hba); 925 if (rc) { 926 dev_err(dev, "hisi_sas_reset_hw failed, rc=%d\n", rc); 927 return rc; 928 } 929 930 msleep(100); 931 init_reg_v3_hw(hisi_hba); 932 933 if (guid_parse("D5918B4B-37AE-4E10-A99F-E5E8A6EF4C1F", &guid)) { 934 dev_err(dev, "Parse GUID failed\n"); 935 return -EINVAL; 936 } 937 938 /* 939 * This DSM handles some hardware-related configurations: 940 * 1. Switch over to MSI error handling in kernel 941 * 2. BIOS *may* reset some register values through this method 942 */ 943 obj = acpi_evaluate_dsm(ACPI_HANDLE(dev), &guid, 0, 944 DSM_FUNC_ERR_HANDLE_MSI, NULL); 945 if (!obj) 946 dev_warn(dev, "can not find DSM method, ignore\n"); 947 else 948 ACPI_FREE(obj); 949 950 acpi_dev = ACPI_COMPANION(dev); 951 if (!acpi_device_power_manageable(acpi_dev)) 952 dev_notice(dev, "neither _PS0 nor _PR0 is defined\n"); 953 return 0; 954 } 955 956 static void enable_phy_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 957 { 958 u32 cfg = hisi_sas_phy_read32(hisi_hba, phy_no, PHY_CFG); 959 960 cfg |= PHY_CFG_ENA_MSK; 961 cfg &= ~PHY_CFG_PHY_RST_MSK; 962 hisi_sas_phy_write32(hisi_hba, phy_no, PHY_CFG, cfg); 963 } 964 965 static void disable_phy_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 966 { 967 u32 cfg = hisi_sas_phy_read32(hisi_hba, phy_no, PHY_CFG); 968 u32 irq_msk = hisi_sas_phy_read32(hisi_hba, phy_no, CHL_INT2_MSK); 969 static const u32 msk = BIT(CHL_INT2_RX_DISP_ERR_OFF) | 970 BIT(CHL_INT2_RX_CODE_ERR_OFF) | 971 BIT(CHL_INT2_RX_INVLD_DW_OFF); 972 u32 state; 973 974 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT2_MSK, msk | irq_msk); 975 976 cfg &= ~PHY_CFG_ENA_MSK; 977 hisi_sas_phy_write32(hisi_hba, phy_no, PHY_CFG, cfg); 978 979 mdelay(50); 980 981 state = hisi_sas_read32(hisi_hba, PHY_STATE); 982 if (state & BIT(phy_no)) { 983 cfg |= PHY_CFG_PHY_RST_MSK; 984 hisi_sas_phy_write32(hisi_hba, phy_no, PHY_CFG, cfg); 985 } 986 987 udelay(1); 988 989 hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_INVLD_DW); 990 hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_DISP_ERR); 991 hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_CODE_ERR); 992 993 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT2, msk); 994 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT2_MSK, irq_msk); 995 } 996 997 static void start_phy_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 998 { 999 config_id_frame_v3_hw(hisi_hba, phy_no); 1000 config_phy_opt_mode_v3_hw(hisi_hba, phy_no); 1001 enable_phy_v3_hw(hisi_hba, phy_no); 1002 } 1003 1004 static void phy_hard_reset_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 1005 { 1006 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; 1007 u32 txid_auto; 1008 1009 hisi_sas_phy_enable(hisi_hba, phy_no, 0); 1010 if (phy->identify.device_type == SAS_END_DEVICE) { 1011 txid_auto = hisi_sas_phy_read32(hisi_hba, phy_no, TXID_AUTO); 1012 hisi_sas_phy_write32(hisi_hba, phy_no, TXID_AUTO, 1013 txid_auto | TX_HARDRST_MSK); 1014 } 1015 msleep(100); 1016 hisi_sas_phy_enable(hisi_hba, phy_no, 1); 1017 } 1018 1019 static enum sas_linkrate phy_get_max_linkrate_v3_hw(void) 1020 { 1021 return SAS_LINK_RATE_12_0_GBPS; 1022 } 1023 1024 static void phys_init_v3_hw(struct hisi_hba *hisi_hba) 1025 { 1026 int i; 1027 1028 for (i = 0; i < hisi_hba->n_phy; i++) { 1029 struct hisi_sas_phy *phy = &hisi_hba->phy[i]; 1030 struct asd_sas_phy *sas_phy = &phy->sas_phy; 1031 1032 if (!sas_phy->phy->enabled) 1033 continue; 1034 1035 hisi_sas_phy_enable(hisi_hba, i, 1); 1036 } 1037 } 1038 1039 static void sl_notify_ssp_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 1040 { 1041 u32 sl_control; 1042 1043 sl_control = hisi_sas_phy_read32(hisi_hba, phy_no, SL_CONTROL); 1044 sl_control |= SL_CONTROL_NOTIFY_EN_MSK; 1045 hisi_sas_phy_write32(hisi_hba, phy_no, SL_CONTROL, sl_control); 1046 msleep(1); 1047 sl_control = hisi_sas_phy_read32(hisi_hba, phy_no, SL_CONTROL); 1048 sl_control &= ~SL_CONTROL_NOTIFY_EN_MSK; 1049 hisi_sas_phy_write32(hisi_hba, phy_no, SL_CONTROL, sl_control); 1050 } 1051 1052 static int get_wideport_bitmap_v3_hw(struct hisi_hba *hisi_hba, int port_id) 1053 { 1054 int i, bitmap = 0; 1055 u32 phy_port_num_ma = hisi_sas_read32(hisi_hba, PHY_PORT_NUM_MA); 1056 u32 phy_state = hisi_sas_read32(hisi_hba, PHY_STATE); 1057 1058 for (i = 0; i < hisi_hba->n_phy; i++) 1059 if (phy_state & BIT(i)) 1060 if (((phy_port_num_ma >> (i * 4)) & 0xf) == port_id) 1061 bitmap |= BIT(i); 1062 1063 return bitmap; 1064 } 1065 1066 static void start_delivery_v3_hw(struct hisi_sas_dq *dq) 1067 { 1068 struct hisi_hba *hisi_hba = dq->hisi_hba; 1069 struct hisi_sas_slot *s, *s1, *s2 = NULL; 1070 int dlvry_queue = dq->id; 1071 int wp; 1072 1073 list_for_each_entry_safe(s, s1, &dq->list, delivery) { 1074 if (!s->ready) 1075 break; 1076 s2 = s; 1077 list_del(&s->delivery); 1078 } 1079 1080 if (!s2) 1081 return; 1082 1083 /* 1084 * Ensure that memories for slots built on other CPUs is observed. 1085 */ 1086 smp_rmb(); 1087 wp = (s2->dlvry_queue_slot + 1) % HISI_SAS_QUEUE_SLOTS; 1088 1089 hisi_sas_write32(hisi_hba, DLVRY_Q_0_WR_PTR + (dlvry_queue * 0x14), wp); 1090 } 1091 1092 static void prep_prd_sge_v3_hw(struct hisi_hba *hisi_hba, 1093 struct hisi_sas_slot *slot, 1094 struct hisi_sas_cmd_hdr *hdr, 1095 struct scatterlist *scatter, 1096 int n_elem) 1097 { 1098 struct hisi_sas_sge_page *sge_page = hisi_sas_sge_addr_mem(slot); 1099 struct scatterlist *sg; 1100 int i; 1101 1102 for_each_sg(scatter, sg, n_elem, i) { 1103 struct hisi_sas_sge *entry = &sge_page->sge[i]; 1104 1105 entry->addr = cpu_to_le64(sg_dma_address(sg)); 1106 entry->page_ctrl_0 = entry->page_ctrl_1 = 0; 1107 entry->data_len = cpu_to_le32(sg_dma_len(sg)); 1108 entry->data_off = 0; 1109 } 1110 1111 hdr->prd_table_addr = cpu_to_le64(hisi_sas_sge_addr_dma(slot)); 1112 1113 hdr->sg_len |= cpu_to_le32(n_elem << CMD_HDR_DATA_SGL_LEN_OFF); 1114 } 1115 1116 static void prep_prd_sge_dif_v3_hw(struct hisi_hba *hisi_hba, 1117 struct hisi_sas_slot *slot, 1118 struct hisi_sas_cmd_hdr *hdr, 1119 struct scatterlist *scatter, 1120 int n_elem) 1121 { 1122 struct hisi_sas_sge_dif_page *sge_dif_page; 1123 struct scatterlist *sg; 1124 int i; 1125 1126 sge_dif_page = hisi_sas_sge_dif_addr_mem(slot); 1127 1128 for_each_sg(scatter, sg, n_elem, i) { 1129 struct hisi_sas_sge *entry = &sge_dif_page->sge[i]; 1130 1131 entry->addr = cpu_to_le64(sg_dma_address(sg)); 1132 entry->page_ctrl_0 = 0; 1133 entry->page_ctrl_1 = 0; 1134 entry->data_len = cpu_to_le32(sg_dma_len(sg)); 1135 entry->data_off = 0; 1136 } 1137 1138 hdr->dif_prd_table_addr = 1139 cpu_to_le64(hisi_sas_sge_dif_addr_dma(slot)); 1140 1141 hdr->sg_len |= cpu_to_le32(n_elem << CMD_HDR_DIF_SGL_LEN_OFF); 1142 } 1143 1144 static u32 get_prot_chk_msk_v3_hw(struct scsi_cmnd *scsi_cmnd) 1145 { 1146 unsigned char prot_flags = scsi_cmnd->prot_flags; 1147 1148 if (prot_flags & SCSI_PROT_REF_CHECK) 1149 return T10_CHK_APP_TAG_MSK; 1150 return T10_CHK_REF_TAG_MSK | T10_CHK_APP_TAG_MSK; 1151 } 1152 1153 static void fill_prot_v3_hw(struct scsi_cmnd *scsi_cmnd, 1154 struct hisi_sas_protect_iu_v3_hw *prot) 1155 { 1156 unsigned char prot_op = scsi_get_prot_op(scsi_cmnd); 1157 unsigned int interval = scsi_prot_interval(scsi_cmnd); 1158 u32 lbrt_chk_val = t10_pi_ref_tag(scsi_cmd_to_rq(scsi_cmnd)); 1159 1160 switch (prot_op) { 1161 case SCSI_PROT_READ_INSERT: 1162 prot->dw0 |= T10_INSRT_EN_MSK; 1163 prot->lbrtgv = lbrt_chk_val; 1164 break; 1165 case SCSI_PROT_READ_STRIP: 1166 prot->dw0 |= (T10_RMV_EN_MSK | T10_CHK_EN_MSK); 1167 prot->lbrtcv = lbrt_chk_val; 1168 prot->dw4 |= get_prot_chk_msk_v3_hw(scsi_cmnd); 1169 break; 1170 case SCSI_PROT_READ_PASS: 1171 prot->dw0 |= T10_CHK_EN_MSK; 1172 prot->lbrtcv = lbrt_chk_val; 1173 prot->dw4 |= get_prot_chk_msk_v3_hw(scsi_cmnd); 1174 break; 1175 case SCSI_PROT_WRITE_INSERT: 1176 prot->dw0 |= T10_INSRT_EN_MSK; 1177 prot->lbrtgv = lbrt_chk_val; 1178 break; 1179 case SCSI_PROT_WRITE_STRIP: 1180 prot->dw0 |= (T10_RMV_EN_MSK | T10_CHK_EN_MSK); 1181 prot->lbrtcv = lbrt_chk_val; 1182 break; 1183 case SCSI_PROT_WRITE_PASS: 1184 prot->dw0 |= T10_CHK_EN_MSK; 1185 prot->lbrtcv = lbrt_chk_val; 1186 prot->dw4 |= get_prot_chk_msk_v3_hw(scsi_cmnd); 1187 break; 1188 default: 1189 WARN(1, "prot_op(0x%x) is not valid\n", prot_op); 1190 break; 1191 } 1192 1193 switch (interval) { 1194 case 512: 1195 break; 1196 case 4096: 1197 prot->dw0 |= (0x1 << USR_DATA_BLOCK_SZ_OFF); 1198 break; 1199 case 520: 1200 prot->dw0 |= (0x2 << USR_DATA_BLOCK_SZ_OFF); 1201 break; 1202 default: 1203 WARN(1, "protection interval (0x%x) invalid\n", 1204 interval); 1205 break; 1206 } 1207 1208 prot->dw0 |= INCR_LBRT_MSK; 1209 } 1210 1211 static void prep_ssp_v3_hw(struct hisi_hba *hisi_hba, 1212 struct hisi_sas_slot *slot) 1213 { 1214 struct sas_task *task = slot->task; 1215 struct hisi_sas_cmd_hdr *hdr = slot->cmd_hdr; 1216 struct domain_device *device = task->dev; 1217 struct hisi_sas_device *sas_dev = device->lldd_dev; 1218 struct hisi_sas_port *port = slot->port; 1219 struct sas_ssp_task *ssp_task = &task->ssp_task; 1220 struct scsi_cmnd *scsi_cmnd = ssp_task->cmd; 1221 struct hisi_sas_tmf_task *tmf = slot->tmf; 1222 int has_data = 0, priority = !!tmf; 1223 unsigned char prot_op; 1224 u8 *buf_cmd; 1225 u32 dw1 = 0, dw2 = 0, len = 0; 1226 1227 hdr->dw0 = cpu_to_le32((1 << CMD_HDR_RESP_REPORT_OFF) | 1228 (2 << CMD_HDR_TLR_CTRL_OFF) | 1229 (port->id << CMD_HDR_PORT_OFF) | 1230 (priority << CMD_HDR_PRIORITY_OFF) | 1231 (1 << CMD_HDR_CMD_OFF)); /* ssp */ 1232 1233 dw1 = 1 << CMD_HDR_VDTL_OFF; 1234 if (tmf) { 1235 dw1 |= 2 << CMD_HDR_FRAME_TYPE_OFF; 1236 dw1 |= DIR_NO_DATA << CMD_HDR_DIR_OFF; 1237 } else { 1238 prot_op = scsi_get_prot_op(scsi_cmnd); 1239 dw1 |= 1 << CMD_HDR_FRAME_TYPE_OFF; 1240 switch (scsi_cmnd->sc_data_direction) { 1241 case DMA_TO_DEVICE: 1242 has_data = 1; 1243 dw1 |= DIR_TO_DEVICE << CMD_HDR_DIR_OFF; 1244 break; 1245 case DMA_FROM_DEVICE: 1246 has_data = 1; 1247 dw1 |= DIR_TO_INI << CMD_HDR_DIR_OFF; 1248 break; 1249 default: 1250 dw1 &= ~CMD_HDR_DIR_MSK; 1251 } 1252 } 1253 1254 /* map itct entry */ 1255 dw1 |= sas_dev->device_id << CMD_HDR_DEV_ID_OFF; 1256 1257 dw2 = (((sizeof(struct ssp_command_iu) + sizeof(struct ssp_frame_hdr) 1258 + 3) / 4) << CMD_HDR_CFL_OFF) | 1259 ((HISI_SAS_MAX_SSP_RESP_SZ / 4) << CMD_HDR_MRFL_OFF) | 1260 (2 << CMD_HDR_SG_MOD_OFF); 1261 hdr->dw2 = cpu_to_le32(dw2); 1262 hdr->transfer_tags = cpu_to_le32(slot->idx); 1263 1264 if (has_data) { 1265 prep_prd_sge_v3_hw(hisi_hba, slot, hdr, task->scatter, 1266 slot->n_elem); 1267 1268 if (scsi_prot_sg_count(scsi_cmnd)) 1269 prep_prd_sge_dif_v3_hw(hisi_hba, slot, hdr, 1270 scsi_prot_sglist(scsi_cmnd), 1271 slot->n_elem_dif); 1272 } 1273 1274 hdr->cmd_table_addr = cpu_to_le64(hisi_sas_cmd_hdr_addr_dma(slot)); 1275 hdr->sts_buffer_addr = cpu_to_le64(hisi_sas_status_buf_addr_dma(slot)); 1276 1277 buf_cmd = hisi_sas_cmd_hdr_addr_mem(slot) + 1278 sizeof(struct ssp_frame_hdr); 1279 1280 memcpy(buf_cmd, &task->ssp_task.LUN, 8); 1281 if (!tmf) { 1282 buf_cmd[9] = ssp_task->task_attr | (ssp_task->task_prio << 3); 1283 memcpy(buf_cmd + 12, scsi_cmnd->cmnd, scsi_cmnd->cmd_len); 1284 } else { 1285 buf_cmd[10] = tmf->tmf; 1286 switch (tmf->tmf) { 1287 case TMF_ABORT_TASK: 1288 case TMF_QUERY_TASK: 1289 buf_cmd[12] = 1290 (tmf->tag_of_task_to_be_managed >> 8) & 0xff; 1291 buf_cmd[13] = 1292 tmf->tag_of_task_to_be_managed & 0xff; 1293 break; 1294 default: 1295 break; 1296 } 1297 } 1298 1299 if (has_data && (prot_op != SCSI_PROT_NORMAL)) { 1300 struct hisi_sas_protect_iu_v3_hw prot; 1301 u8 *buf_cmd_prot; 1302 1303 hdr->dw7 |= cpu_to_le32(1 << CMD_HDR_ADDR_MODE_SEL_OFF); 1304 dw1 |= CMD_HDR_PIR_MSK; 1305 buf_cmd_prot = hisi_sas_cmd_hdr_addr_mem(slot) + 1306 sizeof(struct ssp_frame_hdr) + 1307 sizeof(struct ssp_command_iu); 1308 1309 memset(&prot, 0, sizeof(struct hisi_sas_protect_iu_v3_hw)); 1310 fill_prot_v3_hw(scsi_cmnd, &prot); 1311 memcpy(buf_cmd_prot, &prot, 1312 sizeof(struct hisi_sas_protect_iu_v3_hw)); 1313 /* 1314 * For READ, we need length of info read to memory, while for 1315 * WRITE we need length of data written to the disk. 1316 */ 1317 if (prot_op == SCSI_PROT_WRITE_INSERT || 1318 prot_op == SCSI_PROT_READ_INSERT || 1319 prot_op == SCSI_PROT_WRITE_PASS || 1320 prot_op == SCSI_PROT_READ_PASS) { 1321 unsigned int interval = scsi_prot_interval(scsi_cmnd); 1322 unsigned int ilog2_interval = ilog2(interval); 1323 1324 len = (task->total_xfer_len >> ilog2_interval) * 8; 1325 } 1326 } 1327 1328 hdr->dw1 = cpu_to_le32(dw1); 1329 1330 hdr->data_transfer_len = cpu_to_le32(task->total_xfer_len + len); 1331 } 1332 1333 static void prep_smp_v3_hw(struct hisi_hba *hisi_hba, 1334 struct hisi_sas_slot *slot) 1335 { 1336 struct sas_task *task = slot->task; 1337 struct hisi_sas_cmd_hdr *hdr = slot->cmd_hdr; 1338 struct domain_device *device = task->dev; 1339 struct hisi_sas_port *port = slot->port; 1340 struct scatterlist *sg_req; 1341 struct hisi_sas_device *sas_dev = device->lldd_dev; 1342 dma_addr_t req_dma_addr; 1343 unsigned int req_len; 1344 1345 /* req */ 1346 sg_req = &task->smp_task.smp_req; 1347 req_len = sg_dma_len(sg_req); 1348 req_dma_addr = sg_dma_address(sg_req); 1349 1350 /* create header */ 1351 /* dw0 */ 1352 hdr->dw0 = cpu_to_le32((port->id << CMD_HDR_PORT_OFF) | 1353 (1 << CMD_HDR_PRIORITY_OFF) | /* high pri */ 1354 (2 << CMD_HDR_CMD_OFF)); /* smp */ 1355 1356 /* map itct entry */ 1357 hdr->dw1 = cpu_to_le32((sas_dev->device_id << CMD_HDR_DEV_ID_OFF) | 1358 (1 << CMD_HDR_FRAME_TYPE_OFF) | 1359 (DIR_NO_DATA << CMD_HDR_DIR_OFF)); 1360 1361 /* dw2 */ 1362 hdr->dw2 = cpu_to_le32((((req_len - 4) / 4) << CMD_HDR_CFL_OFF) | 1363 (HISI_SAS_MAX_SMP_RESP_SZ / 4 << 1364 CMD_HDR_MRFL_OFF)); 1365 1366 hdr->transfer_tags = cpu_to_le32(slot->idx << CMD_HDR_IPTT_OFF); 1367 1368 hdr->cmd_table_addr = cpu_to_le64(req_dma_addr); 1369 hdr->sts_buffer_addr = cpu_to_le64(hisi_sas_status_buf_addr_dma(slot)); 1370 } 1371 1372 static void prep_ata_v3_hw(struct hisi_hba *hisi_hba, 1373 struct hisi_sas_slot *slot) 1374 { 1375 struct sas_task *task = slot->task; 1376 struct domain_device *device = task->dev; 1377 struct domain_device *parent_dev = device->parent; 1378 struct hisi_sas_device *sas_dev = device->lldd_dev; 1379 struct hisi_sas_cmd_hdr *hdr = slot->cmd_hdr; 1380 struct asd_sas_port *sas_port = device->port; 1381 struct hisi_sas_port *port = to_hisi_sas_port(sas_port); 1382 u8 *buf_cmd; 1383 int has_data = 0, hdr_tag = 0; 1384 u32 dw1 = 0, dw2 = 0; 1385 1386 hdr->dw0 = cpu_to_le32(port->id << CMD_HDR_PORT_OFF); 1387 if (parent_dev && dev_is_expander(parent_dev->dev_type)) 1388 hdr->dw0 |= cpu_to_le32(3 << CMD_HDR_CMD_OFF); 1389 else 1390 hdr->dw0 |= cpu_to_le32(4U << CMD_HDR_CMD_OFF); 1391 1392 switch (task->data_dir) { 1393 case DMA_TO_DEVICE: 1394 has_data = 1; 1395 dw1 |= DIR_TO_DEVICE << CMD_HDR_DIR_OFF; 1396 break; 1397 case DMA_FROM_DEVICE: 1398 has_data = 1; 1399 dw1 |= DIR_TO_INI << CMD_HDR_DIR_OFF; 1400 break; 1401 default: 1402 dw1 &= ~CMD_HDR_DIR_MSK; 1403 } 1404 1405 if ((task->ata_task.fis.command == ATA_CMD_DEV_RESET) && 1406 (task->ata_task.fis.control & ATA_SRST)) 1407 dw1 |= 1 << CMD_HDR_RESET_OFF; 1408 1409 dw1 |= (hisi_sas_get_ata_protocol( 1410 &task->ata_task.fis, task->data_dir)) 1411 << CMD_HDR_FRAME_TYPE_OFF; 1412 dw1 |= sas_dev->device_id << CMD_HDR_DEV_ID_OFF; 1413 1414 if (FIS_CMD_IS_UNCONSTRAINED(task->ata_task.fis)) 1415 dw1 |= 1 << CMD_HDR_UNCON_CMD_OFF; 1416 1417 hdr->dw1 = cpu_to_le32(dw1); 1418 1419 /* dw2 */ 1420 if (task->ata_task.use_ncq) { 1421 struct ata_queued_cmd *qc = task->uldd_task; 1422 1423 hdr_tag = qc->tag; 1424 task->ata_task.fis.sector_count |= (u8) (hdr_tag << 3); 1425 dw2 |= hdr_tag << CMD_HDR_NCQ_TAG_OFF; 1426 } 1427 1428 dw2 |= (HISI_SAS_MAX_STP_RESP_SZ / 4) << CMD_HDR_CFL_OFF | 1429 2 << CMD_HDR_SG_MOD_OFF; 1430 hdr->dw2 = cpu_to_le32(dw2); 1431 1432 /* dw3 */ 1433 hdr->transfer_tags = cpu_to_le32(slot->idx); 1434 1435 if (has_data) 1436 prep_prd_sge_v3_hw(hisi_hba, slot, hdr, task->scatter, 1437 slot->n_elem); 1438 1439 hdr->data_transfer_len = cpu_to_le32(task->total_xfer_len); 1440 hdr->cmd_table_addr = cpu_to_le64(hisi_sas_cmd_hdr_addr_dma(slot)); 1441 hdr->sts_buffer_addr = cpu_to_le64(hisi_sas_status_buf_addr_dma(slot)); 1442 1443 buf_cmd = hisi_sas_cmd_hdr_addr_mem(slot); 1444 1445 if (likely(!task->ata_task.device_control_reg_update)) 1446 task->ata_task.fis.flags |= 0x80; /* C=1: update ATA cmd reg */ 1447 /* fill in command FIS */ 1448 memcpy(buf_cmd, &task->ata_task.fis, sizeof(struct host_to_dev_fis)); 1449 } 1450 1451 static void prep_abort_v3_hw(struct hisi_hba *hisi_hba, 1452 struct hisi_sas_slot *slot, 1453 int device_id, int abort_flag, int tag_to_abort) 1454 { 1455 struct sas_task *task = slot->task; 1456 struct domain_device *dev = task->dev; 1457 struct hisi_sas_cmd_hdr *hdr = slot->cmd_hdr; 1458 struct hisi_sas_port *port = slot->port; 1459 1460 /* dw0 */ 1461 hdr->dw0 = cpu_to_le32((5U << CMD_HDR_CMD_OFF) | /*abort*/ 1462 (port->id << CMD_HDR_PORT_OFF) | 1463 (dev_is_sata(dev) 1464 << CMD_HDR_ABORT_DEVICE_TYPE_OFF) | 1465 (abort_flag 1466 << CMD_HDR_ABORT_FLAG_OFF)); 1467 1468 /* dw1 */ 1469 hdr->dw1 = cpu_to_le32(device_id 1470 << CMD_HDR_DEV_ID_OFF); 1471 1472 /* dw7 */ 1473 hdr->dw7 = cpu_to_le32(tag_to_abort << CMD_HDR_ABORT_IPTT_OFF); 1474 hdr->transfer_tags = cpu_to_le32(slot->idx); 1475 } 1476 1477 static irqreturn_t phy_up_v3_hw(int phy_no, struct hisi_hba *hisi_hba) 1478 { 1479 int i; 1480 irqreturn_t res; 1481 u32 context, port_id, link_rate; 1482 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; 1483 struct asd_sas_phy *sas_phy = &phy->sas_phy; 1484 struct device *dev = hisi_hba->dev; 1485 1486 del_timer(&phy->timer); 1487 hisi_sas_phy_write32(hisi_hba, phy_no, PHYCTRL_PHY_ENA_MSK, 1); 1488 1489 port_id = hisi_sas_read32(hisi_hba, PHY_PORT_NUM_MA); 1490 port_id = (port_id >> (4 * phy_no)) & 0xf; 1491 link_rate = hisi_sas_read32(hisi_hba, PHY_CONN_RATE); 1492 link_rate = (link_rate >> (phy_no * 4)) & 0xf; 1493 1494 if (port_id == 0xf) { 1495 dev_err(dev, "phyup: phy%d invalid portid\n", phy_no); 1496 res = IRQ_NONE; 1497 goto end; 1498 } 1499 sas_phy->linkrate = link_rate; 1500 phy->phy_type &= ~(PORT_TYPE_SAS | PORT_TYPE_SATA); 1501 1502 /* Check for SATA dev */ 1503 context = hisi_sas_read32(hisi_hba, PHY_CONTEXT); 1504 if (context & (1 << phy_no)) { 1505 struct hisi_sas_initial_fis *initial_fis; 1506 struct dev_to_host_fis *fis; 1507 u8 attached_sas_addr[SAS_ADDR_SIZE] = {0}; 1508 struct Scsi_Host *shost = hisi_hba->shost; 1509 1510 dev_info(dev, "phyup: phy%d link_rate=%d(sata)\n", phy_no, link_rate); 1511 initial_fis = &hisi_hba->initial_fis[phy_no]; 1512 fis = &initial_fis->fis; 1513 1514 /* check ERR bit of Status Register */ 1515 if (fis->status & ATA_ERR) { 1516 dev_warn(dev, "sata int: phy%d FIS status: 0x%x\n", 1517 phy_no, fis->status); 1518 hisi_sas_notify_phy_event(phy, HISI_PHYE_LINK_RESET); 1519 res = IRQ_NONE; 1520 goto end; 1521 } 1522 1523 sas_phy->oob_mode = SATA_OOB_MODE; 1524 attached_sas_addr[0] = 0x50; 1525 attached_sas_addr[6] = shost->host_no; 1526 attached_sas_addr[7] = phy_no; 1527 memcpy(sas_phy->attached_sas_addr, 1528 attached_sas_addr, 1529 SAS_ADDR_SIZE); 1530 memcpy(sas_phy->frame_rcvd, fis, 1531 sizeof(struct dev_to_host_fis)); 1532 phy->phy_type |= PORT_TYPE_SATA; 1533 phy->identify.device_type = SAS_SATA_DEV; 1534 phy->frame_rcvd_size = sizeof(struct dev_to_host_fis); 1535 phy->identify.target_port_protocols = SAS_PROTOCOL_SATA; 1536 } else { 1537 u32 *frame_rcvd = (u32 *)sas_phy->frame_rcvd; 1538 struct sas_identify_frame *id = 1539 (struct sas_identify_frame *)frame_rcvd; 1540 1541 dev_info(dev, "phyup: phy%d link_rate=%d\n", phy_no, link_rate); 1542 for (i = 0; i < 6; i++) { 1543 u32 idaf = hisi_sas_phy_read32(hisi_hba, phy_no, 1544 RX_IDAF_DWORD0 + (i * 4)); 1545 frame_rcvd[i] = __swab32(idaf); 1546 } 1547 sas_phy->oob_mode = SAS_OOB_MODE; 1548 memcpy(sas_phy->attached_sas_addr, 1549 &id->sas_addr, 1550 SAS_ADDR_SIZE); 1551 phy->phy_type |= PORT_TYPE_SAS; 1552 phy->identify.device_type = id->dev_type; 1553 phy->frame_rcvd_size = sizeof(struct sas_identify_frame); 1554 if (phy->identify.device_type == SAS_END_DEVICE) 1555 phy->identify.target_port_protocols = 1556 SAS_PROTOCOL_SSP; 1557 else if (phy->identify.device_type != SAS_PHY_UNUSED) 1558 phy->identify.target_port_protocols = 1559 SAS_PROTOCOL_SMP; 1560 } 1561 1562 phy->port_id = port_id; 1563 phy->phy_attached = 1; 1564 hisi_sas_notify_phy_event(phy, HISI_PHYE_PHY_UP); 1565 res = IRQ_HANDLED; 1566 end: 1567 if (phy->reset_completion) 1568 complete(phy->reset_completion); 1569 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT0, 1570 CHL_INT0_SL_PHY_ENABLE_MSK); 1571 hisi_sas_phy_write32(hisi_hba, phy_no, PHYCTRL_PHY_ENA_MSK, 0); 1572 1573 return res; 1574 } 1575 1576 static irqreturn_t phy_down_v3_hw(int phy_no, struct hisi_hba *hisi_hba) 1577 { 1578 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; 1579 u32 phy_state, sl_ctrl, txid_auto; 1580 struct device *dev = hisi_hba->dev; 1581 1582 atomic_inc(&phy->down_cnt); 1583 1584 del_timer(&phy->timer); 1585 hisi_sas_phy_write32(hisi_hba, phy_no, PHYCTRL_NOT_RDY_MSK, 1); 1586 1587 phy_state = hisi_sas_read32(hisi_hba, PHY_STATE); 1588 dev_info(dev, "phydown: phy%d phy_state=0x%x\n", phy_no, phy_state); 1589 hisi_sas_phy_down(hisi_hba, phy_no, (phy_state & 1 << phy_no) ? 1 : 0, 1590 GFP_ATOMIC); 1591 1592 sl_ctrl = hisi_sas_phy_read32(hisi_hba, phy_no, SL_CONTROL); 1593 hisi_sas_phy_write32(hisi_hba, phy_no, SL_CONTROL, 1594 sl_ctrl&(~SL_CTA_MSK)); 1595 1596 txid_auto = hisi_sas_phy_read32(hisi_hba, phy_no, TXID_AUTO); 1597 hisi_sas_phy_write32(hisi_hba, phy_no, TXID_AUTO, 1598 txid_auto | CT3_MSK); 1599 1600 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT0, CHL_INT0_NOT_RDY_MSK); 1601 hisi_sas_phy_write32(hisi_hba, phy_no, PHYCTRL_NOT_RDY_MSK, 0); 1602 1603 return IRQ_HANDLED; 1604 } 1605 1606 static irqreturn_t phy_bcast_v3_hw(int phy_no, struct hisi_hba *hisi_hba) 1607 { 1608 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; 1609 struct asd_sas_phy *sas_phy = &phy->sas_phy; 1610 u32 bcast_status; 1611 1612 hisi_sas_phy_write32(hisi_hba, phy_no, SL_RX_BCAST_CHK_MSK, 1); 1613 bcast_status = hisi_sas_phy_read32(hisi_hba, phy_no, RX_PRIMS_STATUS); 1614 if ((bcast_status & RX_BCAST_CHG_MSK) && 1615 !test_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags)) 1616 sas_notify_port_event(sas_phy, PORTE_BROADCAST_RCVD, 1617 GFP_ATOMIC); 1618 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT0, 1619 CHL_INT0_SL_RX_BCST_ACK_MSK); 1620 hisi_sas_phy_write32(hisi_hba, phy_no, SL_RX_BCAST_CHK_MSK, 0); 1621 1622 return IRQ_HANDLED; 1623 } 1624 1625 static irqreturn_t int_phy_up_down_bcast_v3_hw(int irq_no, void *p) 1626 { 1627 struct hisi_hba *hisi_hba = p; 1628 u32 irq_msk; 1629 int phy_no = 0; 1630 irqreturn_t res = IRQ_NONE; 1631 1632 irq_msk = hisi_sas_read32(hisi_hba, CHNL_INT_STATUS) 1633 & 0x11111111; 1634 while (irq_msk) { 1635 if (irq_msk & 1) { 1636 u32 irq_value = hisi_sas_phy_read32(hisi_hba, phy_no, 1637 CHL_INT0); 1638 u32 phy_state = hisi_sas_read32(hisi_hba, PHY_STATE); 1639 int rdy = phy_state & (1 << phy_no); 1640 1641 if (rdy) { 1642 if (irq_value & CHL_INT0_SL_PHY_ENABLE_MSK) 1643 /* phy up */ 1644 if (phy_up_v3_hw(phy_no, hisi_hba) 1645 == IRQ_HANDLED) 1646 res = IRQ_HANDLED; 1647 if (irq_value & CHL_INT0_SL_RX_BCST_ACK_MSK) 1648 /* phy bcast */ 1649 if (phy_bcast_v3_hw(phy_no, hisi_hba) 1650 == IRQ_HANDLED) 1651 res = IRQ_HANDLED; 1652 } else { 1653 if (irq_value & CHL_INT0_NOT_RDY_MSK) 1654 /* phy down */ 1655 if (phy_down_v3_hw(phy_no, hisi_hba) 1656 == IRQ_HANDLED) 1657 res = IRQ_HANDLED; 1658 } 1659 } 1660 irq_msk >>= 4; 1661 phy_no++; 1662 } 1663 1664 return res; 1665 } 1666 1667 static const struct hisi_sas_hw_error port_axi_error[] = { 1668 { 1669 .irq_msk = BIT(CHL_INT1_DMAC_TX_ECC_MB_ERR_OFF), 1670 .msg = "dmac_tx_ecc_bad_err", 1671 }, 1672 { 1673 .irq_msk = BIT(CHL_INT1_DMAC_RX_ECC_MB_ERR_OFF), 1674 .msg = "dmac_rx_ecc_bad_err", 1675 }, 1676 { 1677 .irq_msk = BIT(CHL_INT1_DMAC_TX_AXI_WR_ERR_OFF), 1678 .msg = "dma_tx_axi_wr_err", 1679 }, 1680 { 1681 .irq_msk = BIT(CHL_INT1_DMAC_TX_AXI_RD_ERR_OFF), 1682 .msg = "dma_tx_axi_rd_err", 1683 }, 1684 { 1685 .irq_msk = BIT(CHL_INT1_DMAC_RX_AXI_WR_ERR_OFF), 1686 .msg = "dma_rx_axi_wr_err", 1687 }, 1688 { 1689 .irq_msk = BIT(CHL_INT1_DMAC_RX_AXI_RD_ERR_OFF), 1690 .msg = "dma_rx_axi_rd_err", 1691 }, 1692 { 1693 .irq_msk = BIT(CHL_INT1_DMAC_TX_FIFO_ERR_OFF), 1694 .msg = "dma_tx_fifo_err", 1695 }, 1696 { 1697 .irq_msk = BIT(CHL_INT1_DMAC_RX_FIFO_ERR_OFF), 1698 .msg = "dma_rx_fifo_err", 1699 }, 1700 { 1701 .irq_msk = BIT(CHL_INT1_DMAC_TX_AXI_RUSER_ERR_OFF), 1702 .msg = "dma_tx_axi_ruser_err", 1703 }, 1704 { 1705 .irq_msk = BIT(CHL_INT1_DMAC_RX_AXI_RUSER_ERR_OFF), 1706 .msg = "dma_rx_axi_ruser_err", 1707 }, 1708 }; 1709 1710 static void handle_chl_int1_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 1711 { 1712 u32 irq_value = hisi_sas_phy_read32(hisi_hba, phy_no, CHL_INT1); 1713 u32 irq_msk = hisi_sas_phy_read32(hisi_hba, phy_no, CHL_INT1_MSK); 1714 struct device *dev = hisi_hba->dev; 1715 int i; 1716 1717 irq_value &= ~irq_msk; 1718 if (!irq_value) { 1719 dev_warn(dev, "phy%d channel int 1 received with status bits cleared\n", 1720 phy_no); 1721 return; 1722 } 1723 1724 for (i = 0; i < ARRAY_SIZE(port_axi_error); i++) { 1725 const struct hisi_sas_hw_error *error = &port_axi_error[i]; 1726 1727 if (!(irq_value & error->irq_msk)) 1728 continue; 1729 1730 dev_err(dev, "%s error (phy%d 0x%x) found!\n", 1731 error->msg, phy_no, irq_value); 1732 queue_work(hisi_hba->wq, &hisi_hba->rst_work); 1733 } 1734 1735 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT1, irq_value); 1736 } 1737 1738 static void phy_get_events_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 1739 { 1740 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; 1741 struct asd_sas_phy *sas_phy = &phy->sas_phy; 1742 struct sas_phy *sphy = sas_phy->phy; 1743 unsigned long flags; 1744 u32 reg_value; 1745 1746 spin_lock_irqsave(&phy->lock, flags); 1747 1748 /* loss dword sync */ 1749 reg_value = hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_DWS_LOST); 1750 sphy->loss_of_dword_sync_count += reg_value; 1751 1752 /* phy reset problem */ 1753 reg_value = hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_RESET_PROB); 1754 sphy->phy_reset_problem_count += reg_value; 1755 1756 /* invalid dword */ 1757 reg_value = hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_INVLD_DW); 1758 sphy->invalid_dword_count += reg_value; 1759 1760 /* disparity err */ 1761 reg_value = hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_DISP_ERR); 1762 sphy->running_disparity_error_count += reg_value; 1763 1764 /* code violation error */ 1765 reg_value = hisi_sas_phy_read32(hisi_hba, phy_no, ERR_CNT_CODE_ERR); 1766 phy->code_violation_err_count += reg_value; 1767 1768 spin_unlock_irqrestore(&phy->lock, flags); 1769 } 1770 1771 static void handle_chl_int2_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 1772 { 1773 u32 irq_msk = hisi_sas_phy_read32(hisi_hba, phy_no, CHL_INT2_MSK); 1774 u32 irq_value = hisi_sas_phy_read32(hisi_hba, phy_no, CHL_INT2); 1775 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; 1776 struct pci_dev *pci_dev = hisi_hba->pci_dev; 1777 struct device *dev = hisi_hba->dev; 1778 static const u32 msk = BIT(CHL_INT2_RX_DISP_ERR_OFF) | 1779 BIT(CHL_INT2_RX_CODE_ERR_OFF) | 1780 BIT(CHL_INT2_RX_INVLD_DW_OFF); 1781 1782 irq_value &= ~irq_msk; 1783 if (!irq_value) { 1784 dev_warn(dev, "phy%d channel int 2 received with status bits cleared\n", 1785 phy_no); 1786 return; 1787 } 1788 1789 if (irq_value & BIT(CHL_INT2_SL_IDAF_TOUT_CONF_OFF)) { 1790 dev_warn(dev, "phy%d identify timeout\n", phy_no); 1791 hisi_sas_notify_phy_event(phy, HISI_PHYE_LINK_RESET); 1792 } 1793 1794 if (irq_value & BIT(CHL_INT2_STP_LINK_TIMEOUT_OFF)) { 1795 u32 reg_value = hisi_sas_phy_read32(hisi_hba, phy_no, 1796 STP_LINK_TIMEOUT_STATE); 1797 1798 dev_warn(dev, "phy%d stp link timeout (0x%x)\n", 1799 phy_no, reg_value); 1800 if (reg_value & BIT(4)) 1801 hisi_sas_notify_phy_event(phy, HISI_PHYE_LINK_RESET); 1802 } 1803 1804 if (pci_dev->revision > 0x20 && (irq_value & msk)) { 1805 struct asd_sas_phy *sas_phy = &phy->sas_phy; 1806 struct sas_phy *sphy = sas_phy->phy; 1807 1808 phy_get_events_v3_hw(hisi_hba, phy_no); 1809 1810 if (irq_value & BIT(CHL_INT2_RX_INVLD_DW_OFF)) 1811 dev_info(dev, "phy%d invalid dword cnt: %u\n", phy_no, 1812 sphy->invalid_dword_count); 1813 1814 if (irq_value & BIT(CHL_INT2_RX_CODE_ERR_OFF)) 1815 dev_info(dev, "phy%d code violation cnt: %u\n", phy_no, 1816 phy->code_violation_err_count); 1817 1818 if (irq_value & BIT(CHL_INT2_RX_DISP_ERR_OFF)) 1819 dev_info(dev, "phy%d disparity error cnt: %u\n", phy_no, 1820 sphy->running_disparity_error_count); 1821 } 1822 1823 if ((irq_value & BIT(CHL_INT2_RX_INVLD_DW_OFF)) && 1824 (pci_dev->revision == 0x20)) { 1825 u32 reg_value; 1826 int rc; 1827 1828 rc = hisi_sas_read32_poll_timeout_atomic( 1829 HILINK_ERR_DFX, reg_value, 1830 !((reg_value >> 8) & BIT(phy_no)), 1831 1000, 10000); 1832 if (rc) 1833 hisi_sas_notify_phy_event(phy, HISI_PHYE_LINK_RESET); 1834 } 1835 1836 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT2, irq_value); 1837 } 1838 1839 static void handle_chl_int0_v3_hw(struct hisi_hba *hisi_hba, int phy_no) 1840 { 1841 u32 irq_value0 = hisi_sas_phy_read32(hisi_hba, phy_no, CHL_INT0); 1842 1843 if (irq_value0 & CHL_INT0_PHY_RDY_MSK) 1844 hisi_sas_phy_oob_ready(hisi_hba, phy_no); 1845 1846 hisi_sas_phy_write32(hisi_hba, phy_no, CHL_INT0, 1847 irq_value0 & (~CHL_INT0_SL_RX_BCST_ACK_MSK) 1848 & (~CHL_INT0_SL_PHY_ENABLE_MSK) 1849 & (~CHL_INT0_NOT_RDY_MSK)); 1850 } 1851 1852 static irqreturn_t int_chnl_int_v3_hw(int irq_no, void *p) 1853 { 1854 struct hisi_hba *hisi_hba = p; 1855 u32 irq_msk; 1856 int phy_no = 0; 1857 1858 irq_msk = hisi_sas_read32(hisi_hba, CHNL_INT_STATUS) 1859 & CHNL_INT_STS_MSK; 1860 1861 while (irq_msk) { 1862 if (irq_msk & (CHNL_INT_STS_INT0_MSK << (phy_no * CHNL_WIDTH))) 1863 handle_chl_int0_v3_hw(hisi_hba, phy_no); 1864 1865 if (irq_msk & (CHNL_INT_STS_INT1_MSK << (phy_no * CHNL_WIDTH))) 1866 handle_chl_int1_v3_hw(hisi_hba, phy_no); 1867 1868 if (irq_msk & (CHNL_INT_STS_INT2_MSK << (phy_no * CHNL_WIDTH))) 1869 handle_chl_int2_v3_hw(hisi_hba, phy_no); 1870 1871 irq_msk &= ~(CHNL_INT_STS_PHY_MSK << (phy_no * CHNL_WIDTH)); 1872 phy_no++; 1873 } 1874 1875 return IRQ_HANDLED; 1876 } 1877 1878 static const struct hisi_sas_hw_error multi_bit_ecc_errors[] = { 1879 { 1880 .irq_msk = BIT(SAS_ECC_INTR_DQE_ECC_MB_OFF), 1881 .msk = HGC_DQE_ECC_MB_ADDR_MSK, 1882 .shift = HGC_DQE_ECC_MB_ADDR_OFF, 1883 .msg = "hgc_dqe_eccbad_intr", 1884 .reg = HGC_DQE_ECC_ADDR, 1885 }, 1886 { 1887 .irq_msk = BIT(SAS_ECC_INTR_IOST_ECC_MB_OFF), 1888 .msk = HGC_IOST_ECC_MB_ADDR_MSK, 1889 .shift = HGC_IOST_ECC_MB_ADDR_OFF, 1890 .msg = "hgc_iost_eccbad_intr", 1891 .reg = HGC_IOST_ECC_ADDR, 1892 }, 1893 { 1894 .irq_msk = BIT(SAS_ECC_INTR_ITCT_ECC_MB_OFF), 1895 .msk = HGC_ITCT_ECC_MB_ADDR_MSK, 1896 .shift = HGC_ITCT_ECC_MB_ADDR_OFF, 1897 .msg = "hgc_itct_eccbad_intr", 1898 .reg = HGC_ITCT_ECC_ADDR, 1899 }, 1900 { 1901 .irq_msk = BIT(SAS_ECC_INTR_IOSTLIST_ECC_MB_OFF), 1902 .msk = HGC_LM_DFX_STATUS2_IOSTLIST_MSK, 1903 .shift = HGC_LM_DFX_STATUS2_IOSTLIST_OFF, 1904 .msg = "hgc_iostl_eccbad_intr", 1905 .reg = HGC_LM_DFX_STATUS2, 1906 }, 1907 { 1908 .irq_msk = BIT(SAS_ECC_INTR_ITCTLIST_ECC_MB_OFF), 1909 .msk = HGC_LM_DFX_STATUS2_ITCTLIST_MSK, 1910 .shift = HGC_LM_DFX_STATUS2_ITCTLIST_OFF, 1911 .msg = "hgc_itctl_eccbad_intr", 1912 .reg = HGC_LM_DFX_STATUS2, 1913 }, 1914 { 1915 .irq_msk = BIT(SAS_ECC_INTR_CQE_ECC_MB_OFF), 1916 .msk = HGC_CQE_ECC_MB_ADDR_MSK, 1917 .shift = HGC_CQE_ECC_MB_ADDR_OFF, 1918 .msg = "hgc_cqe_eccbad_intr", 1919 .reg = HGC_CQE_ECC_ADDR, 1920 }, 1921 { 1922 .irq_msk = BIT(SAS_ECC_INTR_NCQ_MEM0_ECC_MB_OFF), 1923 .msk = HGC_RXM_DFX_STATUS14_MEM0_MSK, 1924 .shift = HGC_RXM_DFX_STATUS14_MEM0_OFF, 1925 .msg = "rxm_mem0_eccbad_intr", 1926 .reg = HGC_RXM_DFX_STATUS14, 1927 }, 1928 { 1929 .irq_msk = BIT(SAS_ECC_INTR_NCQ_MEM1_ECC_MB_OFF), 1930 .msk = HGC_RXM_DFX_STATUS14_MEM1_MSK, 1931 .shift = HGC_RXM_DFX_STATUS14_MEM1_OFF, 1932 .msg = "rxm_mem1_eccbad_intr", 1933 .reg = HGC_RXM_DFX_STATUS14, 1934 }, 1935 { 1936 .irq_msk = BIT(SAS_ECC_INTR_NCQ_MEM2_ECC_MB_OFF), 1937 .msk = HGC_RXM_DFX_STATUS14_MEM2_MSK, 1938 .shift = HGC_RXM_DFX_STATUS14_MEM2_OFF, 1939 .msg = "rxm_mem2_eccbad_intr", 1940 .reg = HGC_RXM_DFX_STATUS14, 1941 }, 1942 { 1943 .irq_msk = BIT(SAS_ECC_INTR_NCQ_MEM3_ECC_MB_OFF), 1944 .msk = HGC_RXM_DFX_STATUS15_MEM3_MSK, 1945 .shift = HGC_RXM_DFX_STATUS15_MEM3_OFF, 1946 .msg = "rxm_mem3_eccbad_intr", 1947 .reg = HGC_RXM_DFX_STATUS15, 1948 }, 1949 { 1950 .irq_msk = BIT(SAS_ECC_INTR_OOO_RAM_ECC_MB_OFF), 1951 .msk = AM_ROB_ECC_ERR_ADDR_MSK, 1952 .shift = AM_ROB_ECC_ERR_ADDR_OFF, 1953 .msg = "ooo_ram_eccbad_intr", 1954 .reg = AM_ROB_ECC_ERR_ADDR, 1955 }, 1956 }; 1957 1958 static void multi_bit_ecc_error_process_v3_hw(struct hisi_hba *hisi_hba, 1959 u32 irq_value) 1960 { 1961 struct device *dev = hisi_hba->dev; 1962 const struct hisi_sas_hw_error *ecc_error; 1963 u32 val; 1964 int i; 1965 1966 for (i = 0; i < ARRAY_SIZE(multi_bit_ecc_errors); i++) { 1967 ecc_error = &multi_bit_ecc_errors[i]; 1968 if (irq_value & ecc_error->irq_msk) { 1969 val = hisi_sas_read32(hisi_hba, ecc_error->reg); 1970 val &= ecc_error->msk; 1971 val >>= ecc_error->shift; 1972 dev_err(dev, "%s (0x%x) found: mem addr is 0x%08X\n", 1973 ecc_error->msg, irq_value, val); 1974 queue_work(hisi_hba->wq, &hisi_hba->rst_work); 1975 } 1976 } 1977 } 1978 1979 static void fatal_ecc_int_v3_hw(struct hisi_hba *hisi_hba) 1980 { 1981 u32 irq_value, irq_msk; 1982 1983 irq_msk = hisi_sas_read32(hisi_hba, SAS_ECC_INTR_MSK); 1984 hisi_sas_write32(hisi_hba, SAS_ECC_INTR_MSK, 0xffffffff); 1985 1986 irq_value = hisi_sas_read32(hisi_hba, SAS_ECC_INTR); 1987 if (irq_value) 1988 multi_bit_ecc_error_process_v3_hw(hisi_hba, irq_value); 1989 1990 hisi_sas_write32(hisi_hba, SAS_ECC_INTR, irq_value); 1991 hisi_sas_write32(hisi_hba, SAS_ECC_INTR_MSK, irq_msk); 1992 } 1993 1994 static const struct hisi_sas_hw_error axi_error[] = { 1995 { .msk = BIT(0), .msg = "IOST_AXI_W_ERR" }, 1996 { .msk = BIT(1), .msg = "IOST_AXI_R_ERR" }, 1997 { .msk = BIT(2), .msg = "ITCT_AXI_W_ERR" }, 1998 { .msk = BIT(3), .msg = "ITCT_AXI_R_ERR" }, 1999 { .msk = BIT(4), .msg = "SATA_AXI_W_ERR" }, 2000 { .msk = BIT(5), .msg = "SATA_AXI_R_ERR" }, 2001 { .msk = BIT(6), .msg = "DQE_AXI_R_ERR" }, 2002 { .msk = BIT(7), .msg = "CQE_AXI_W_ERR" }, 2003 {} 2004 }; 2005 2006 static const struct hisi_sas_hw_error fifo_error[] = { 2007 { .msk = BIT(8), .msg = "CQE_WINFO_FIFO" }, 2008 { .msk = BIT(9), .msg = "CQE_MSG_FIFIO" }, 2009 { .msk = BIT(10), .msg = "GETDQE_FIFO" }, 2010 { .msk = BIT(11), .msg = "CMDP_FIFO" }, 2011 { .msk = BIT(12), .msg = "AWTCTRL_FIFO" }, 2012 {} 2013 }; 2014 2015 static const struct hisi_sas_hw_error fatal_axi_error[] = { 2016 { 2017 .irq_msk = BIT(ENT_INT_SRC3_WP_DEPTH_OFF), 2018 .msg = "write pointer and depth", 2019 }, 2020 { 2021 .irq_msk = BIT(ENT_INT_SRC3_IPTT_SLOT_NOMATCH_OFF), 2022 .msg = "iptt no match slot", 2023 }, 2024 { 2025 .irq_msk = BIT(ENT_INT_SRC3_RP_DEPTH_OFF), 2026 .msg = "read pointer and depth", 2027 }, 2028 { 2029 .irq_msk = BIT(ENT_INT_SRC3_AXI_OFF), 2030 .reg = HGC_AXI_FIFO_ERR_INFO, 2031 .sub = axi_error, 2032 }, 2033 { 2034 .irq_msk = BIT(ENT_INT_SRC3_FIFO_OFF), 2035 .reg = HGC_AXI_FIFO_ERR_INFO, 2036 .sub = fifo_error, 2037 }, 2038 { 2039 .irq_msk = BIT(ENT_INT_SRC3_LM_OFF), 2040 .msg = "LM add/fetch list", 2041 }, 2042 { 2043 .irq_msk = BIT(ENT_INT_SRC3_ABT_OFF), 2044 .msg = "SAS_HGC_ABT fetch LM list", 2045 }, 2046 { 2047 .irq_msk = BIT(ENT_INT_SRC3_DQE_POISON_OFF), 2048 .msg = "read dqe poison", 2049 }, 2050 { 2051 .irq_msk = BIT(ENT_INT_SRC3_IOST_POISON_OFF), 2052 .msg = "read iost poison", 2053 }, 2054 { 2055 .irq_msk = BIT(ENT_INT_SRC3_ITCT_POISON_OFF), 2056 .msg = "read itct poison", 2057 }, 2058 { 2059 .irq_msk = BIT(ENT_INT_SRC3_ITCT_NCQ_POISON_OFF), 2060 .msg = "read itct ncq poison", 2061 }, 2062 2063 }; 2064 2065 static irqreturn_t fatal_axi_int_v3_hw(int irq_no, void *p) 2066 { 2067 u32 irq_value, irq_msk; 2068 struct hisi_hba *hisi_hba = p; 2069 struct device *dev = hisi_hba->dev; 2070 struct pci_dev *pdev = hisi_hba->pci_dev; 2071 int i; 2072 2073 irq_msk = hisi_sas_read32(hisi_hba, ENT_INT_SRC_MSK3); 2074 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK3, irq_msk | 0x1df00); 2075 2076 irq_value = hisi_sas_read32(hisi_hba, ENT_INT_SRC3); 2077 irq_value &= ~irq_msk; 2078 2079 for (i = 0; i < ARRAY_SIZE(fatal_axi_error); i++) { 2080 const struct hisi_sas_hw_error *error = &fatal_axi_error[i]; 2081 2082 if (!(irq_value & error->irq_msk)) 2083 continue; 2084 2085 if (error->sub) { 2086 const struct hisi_sas_hw_error *sub = error->sub; 2087 u32 err_value = hisi_sas_read32(hisi_hba, error->reg); 2088 2089 for (; sub->msk || sub->msg; sub++) { 2090 if (!(err_value & sub->msk)) 2091 continue; 2092 2093 dev_err(dev, "%s error (0x%x) found!\n", 2094 sub->msg, irq_value); 2095 queue_work(hisi_hba->wq, &hisi_hba->rst_work); 2096 } 2097 } else { 2098 dev_err(dev, "%s error (0x%x) found!\n", 2099 error->msg, irq_value); 2100 queue_work(hisi_hba->wq, &hisi_hba->rst_work); 2101 } 2102 2103 if (pdev->revision < 0x21) { 2104 u32 reg_val; 2105 2106 reg_val = hisi_sas_read32(hisi_hba, 2107 AXI_MASTER_CFG_BASE + 2108 AM_CTRL_GLOBAL); 2109 reg_val |= AM_CTRL_SHUTDOWN_REQ_MSK; 2110 hisi_sas_write32(hisi_hba, AXI_MASTER_CFG_BASE + 2111 AM_CTRL_GLOBAL, reg_val); 2112 } 2113 } 2114 2115 fatal_ecc_int_v3_hw(hisi_hba); 2116 2117 if (irq_value & BIT(ENT_INT_SRC3_ITC_INT_OFF)) { 2118 u32 reg_val = hisi_sas_read32(hisi_hba, ITCT_CLR); 2119 u32 dev_id = reg_val & ITCT_DEV_MSK; 2120 struct hisi_sas_device *sas_dev = 2121 &hisi_hba->devices[dev_id]; 2122 2123 hisi_sas_write32(hisi_hba, ITCT_CLR, 0); 2124 dev_dbg(dev, "clear ITCT ok\n"); 2125 complete(sas_dev->completion); 2126 } 2127 2128 hisi_sas_write32(hisi_hba, ENT_INT_SRC3, irq_value & 0x1df00); 2129 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK3, irq_msk); 2130 2131 return IRQ_HANDLED; 2132 } 2133 2134 static void 2135 slot_err_v3_hw(struct hisi_hba *hisi_hba, struct sas_task *task, 2136 struct hisi_sas_slot *slot) 2137 { 2138 struct task_status_struct *ts = &task->task_status; 2139 struct hisi_sas_complete_v3_hdr *complete_queue = 2140 hisi_hba->complete_hdr[slot->cmplt_queue]; 2141 struct hisi_sas_complete_v3_hdr *complete_hdr = 2142 &complete_queue[slot->cmplt_queue_slot]; 2143 struct hisi_sas_err_record_v3 *record = 2144 hisi_sas_status_buf_addr_mem(slot); 2145 u32 dma_rx_err_type = le32_to_cpu(record->dma_rx_err_type); 2146 u32 trans_tx_fail_type = le32_to_cpu(record->trans_tx_fail_type); 2147 u32 dw3 = le32_to_cpu(complete_hdr->dw3); 2148 2149 switch (task->task_proto) { 2150 case SAS_PROTOCOL_SSP: 2151 if (dma_rx_err_type & RX_DATA_LEN_UNDERFLOW_MSK) { 2152 ts->residual = trans_tx_fail_type; 2153 ts->stat = SAS_DATA_UNDERRUN; 2154 } else if (dw3 & CMPLT_HDR_IO_IN_TARGET_MSK) { 2155 ts->stat = SAS_QUEUE_FULL; 2156 slot->abort = 1; 2157 } else { 2158 ts->stat = SAS_OPEN_REJECT; 2159 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY; 2160 } 2161 break; 2162 case SAS_PROTOCOL_SATA: 2163 case SAS_PROTOCOL_STP: 2164 case SAS_PROTOCOL_SATA | SAS_PROTOCOL_STP: 2165 if (dma_rx_err_type & RX_DATA_LEN_UNDERFLOW_MSK) { 2166 ts->residual = trans_tx_fail_type; 2167 ts->stat = SAS_DATA_UNDERRUN; 2168 } else if (dw3 & CMPLT_HDR_IO_IN_TARGET_MSK) { 2169 ts->stat = SAS_PHY_DOWN; 2170 slot->abort = 1; 2171 } else { 2172 ts->stat = SAS_OPEN_REJECT; 2173 ts->open_rej_reason = SAS_OREJ_RSVD_RETRY; 2174 } 2175 hisi_sas_sata_done(task, slot); 2176 break; 2177 case SAS_PROTOCOL_SMP: 2178 ts->stat = SAS_SAM_STAT_CHECK_CONDITION; 2179 break; 2180 default: 2181 break; 2182 } 2183 } 2184 2185 static void slot_complete_v3_hw(struct hisi_hba *hisi_hba, 2186 struct hisi_sas_slot *slot) 2187 { 2188 struct sas_task *task = slot->task; 2189 struct hisi_sas_device *sas_dev; 2190 struct device *dev = hisi_hba->dev; 2191 struct task_status_struct *ts; 2192 struct domain_device *device; 2193 struct sas_ha_struct *ha; 2194 struct hisi_sas_complete_v3_hdr *complete_queue = 2195 hisi_hba->complete_hdr[slot->cmplt_queue]; 2196 struct hisi_sas_complete_v3_hdr *complete_hdr = 2197 &complete_queue[slot->cmplt_queue_slot]; 2198 unsigned long flags; 2199 bool is_internal = slot->is_internal; 2200 u32 dw0, dw1, dw3; 2201 2202 if (unlikely(!task || !task->lldd_task || !task->dev)) 2203 return; 2204 2205 ts = &task->task_status; 2206 device = task->dev; 2207 ha = device->port->ha; 2208 sas_dev = device->lldd_dev; 2209 2210 spin_lock_irqsave(&task->task_state_lock, flags); 2211 task->task_state_flags &= 2212 ~(SAS_TASK_STATE_PENDING | SAS_TASK_AT_INITIATOR); 2213 spin_unlock_irqrestore(&task->task_state_lock, flags); 2214 2215 memset(ts, 0, sizeof(*ts)); 2216 ts->resp = SAS_TASK_COMPLETE; 2217 2218 if (unlikely(!sas_dev)) { 2219 dev_dbg(dev, "slot complete: port has not device\n"); 2220 ts->stat = SAS_PHY_DOWN; 2221 goto out; 2222 } 2223 2224 dw0 = le32_to_cpu(complete_hdr->dw0); 2225 dw1 = le32_to_cpu(complete_hdr->dw1); 2226 dw3 = le32_to_cpu(complete_hdr->dw3); 2227 2228 /* 2229 * Use SAS+TMF status codes 2230 */ 2231 switch ((dw0 & CMPLT_HDR_ABORT_STAT_MSK) >> CMPLT_HDR_ABORT_STAT_OFF) { 2232 case STAT_IO_ABORTED: 2233 /* this IO has been aborted by abort command */ 2234 ts->stat = SAS_ABORTED_TASK; 2235 goto out; 2236 case STAT_IO_COMPLETE: 2237 /* internal abort command complete */ 2238 ts->stat = TMF_RESP_FUNC_SUCC; 2239 goto out; 2240 case STAT_IO_NO_DEVICE: 2241 ts->stat = TMF_RESP_FUNC_COMPLETE; 2242 goto out; 2243 case STAT_IO_NOT_VALID: 2244 /* 2245 * abort single IO, the controller can't find the IO 2246 */ 2247 ts->stat = TMF_RESP_FUNC_FAILED; 2248 goto out; 2249 default: 2250 break; 2251 } 2252 2253 /* check for erroneous completion */ 2254 if ((dw0 & CMPLT_HDR_CMPLT_MSK) == 0x3) { 2255 u32 *error_info = hisi_sas_status_buf_addr_mem(slot); 2256 2257 slot_err_v3_hw(hisi_hba, task, slot); 2258 if (ts->stat != SAS_DATA_UNDERRUN) 2259 dev_info(dev, "erroneous completion iptt=%d task=%pK dev id=%d addr=%016llx CQ hdr: 0x%x 0x%x 0x%x 0x%x Error info: 0x%x 0x%x 0x%x 0x%x\n", 2260 slot->idx, task, sas_dev->device_id, 2261 SAS_ADDR(device->sas_addr), 2262 dw0, dw1, complete_hdr->act, dw3, 2263 error_info[0], error_info[1], 2264 error_info[2], error_info[3]); 2265 if (unlikely(slot->abort)) { 2266 sas_task_abort(task); 2267 return; 2268 } 2269 goto out; 2270 } 2271 2272 switch (task->task_proto) { 2273 case SAS_PROTOCOL_SSP: { 2274 struct ssp_response_iu *iu = 2275 hisi_sas_status_buf_addr_mem(slot) + 2276 sizeof(struct hisi_sas_err_record); 2277 2278 sas_ssp_task_response(dev, task, iu); 2279 break; 2280 } 2281 case SAS_PROTOCOL_SMP: { 2282 struct scatterlist *sg_resp = &task->smp_task.smp_resp; 2283 void *to = page_address(sg_page(sg_resp)); 2284 2285 ts->stat = SAS_SAM_STAT_GOOD; 2286 2287 dma_unmap_sg(dev, &task->smp_task.smp_req, 1, 2288 DMA_TO_DEVICE); 2289 memcpy(to + sg_resp->offset, 2290 hisi_sas_status_buf_addr_mem(slot) + 2291 sizeof(struct hisi_sas_err_record), 2292 sg_resp->length); 2293 break; 2294 } 2295 case SAS_PROTOCOL_SATA: 2296 case SAS_PROTOCOL_STP: 2297 case SAS_PROTOCOL_SATA | SAS_PROTOCOL_STP: 2298 ts->stat = SAS_SAM_STAT_GOOD; 2299 hisi_sas_sata_done(task, slot); 2300 break; 2301 default: 2302 ts->stat = SAS_SAM_STAT_CHECK_CONDITION; 2303 break; 2304 } 2305 2306 if (!slot->port->port_attached) { 2307 dev_warn(dev, "slot complete: port %d has removed\n", 2308 slot->port->sas_port.id); 2309 ts->stat = SAS_PHY_DOWN; 2310 } 2311 2312 out: 2313 spin_lock_irqsave(&task->task_state_lock, flags); 2314 if (task->task_state_flags & SAS_TASK_STATE_ABORTED) { 2315 spin_unlock_irqrestore(&task->task_state_lock, flags); 2316 dev_info(dev, "slot complete: task(%pK) aborted\n", task); 2317 return; 2318 } 2319 task->task_state_flags |= SAS_TASK_STATE_DONE; 2320 spin_unlock_irqrestore(&task->task_state_lock, flags); 2321 hisi_sas_slot_task_free(hisi_hba, task, slot); 2322 2323 if (!is_internal && (task->task_proto != SAS_PROTOCOL_SMP)) { 2324 spin_lock_irqsave(&device->done_lock, flags); 2325 if (test_bit(SAS_HA_FROZEN, &ha->state)) { 2326 spin_unlock_irqrestore(&device->done_lock, flags); 2327 dev_info(dev, "slot complete: task(%pK) ignored\n ", 2328 task); 2329 return; 2330 } 2331 spin_unlock_irqrestore(&device->done_lock, flags); 2332 } 2333 2334 if (task->task_done) 2335 task->task_done(task); 2336 } 2337 2338 static irqreturn_t cq_thread_v3_hw(int irq_no, void *p) 2339 { 2340 struct hisi_sas_cq *cq = p; 2341 struct hisi_hba *hisi_hba = cq->hisi_hba; 2342 struct hisi_sas_slot *slot; 2343 struct hisi_sas_complete_v3_hdr *complete_queue; 2344 u32 rd_point = cq->rd_point, wr_point; 2345 int queue = cq->id; 2346 2347 complete_queue = hisi_hba->complete_hdr[queue]; 2348 2349 wr_point = hisi_sas_read32(hisi_hba, COMPL_Q_0_WR_PTR + 2350 (0x14 * queue)); 2351 2352 while (rd_point != wr_point) { 2353 struct hisi_sas_complete_v3_hdr *complete_hdr; 2354 struct device *dev = hisi_hba->dev; 2355 u32 dw1; 2356 int iptt; 2357 2358 complete_hdr = &complete_queue[rd_point]; 2359 dw1 = le32_to_cpu(complete_hdr->dw1); 2360 2361 iptt = dw1 & CMPLT_HDR_IPTT_MSK; 2362 if (likely(iptt < HISI_SAS_COMMAND_ENTRIES_V3_HW)) { 2363 slot = &hisi_hba->slot_info[iptt]; 2364 slot->cmplt_queue_slot = rd_point; 2365 slot->cmplt_queue = queue; 2366 slot_complete_v3_hw(hisi_hba, slot); 2367 } else 2368 dev_err(dev, "IPTT %d is invalid, discard it.\n", iptt); 2369 2370 if (++rd_point >= HISI_SAS_QUEUE_SLOTS) 2371 rd_point = 0; 2372 } 2373 2374 /* update rd_point */ 2375 cq->rd_point = rd_point; 2376 hisi_sas_write32(hisi_hba, COMPL_Q_0_RD_PTR + (0x14 * queue), rd_point); 2377 2378 return IRQ_HANDLED; 2379 } 2380 2381 static irqreturn_t cq_interrupt_v3_hw(int irq_no, void *p) 2382 { 2383 struct hisi_sas_cq *cq = p; 2384 struct hisi_hba *hisi_hba = cq->hisi_hba; 2385 int queue = cq->id; 2386 2387 hisi_sas_write32(hisi_hba, OQ_INT_SRC, 1 << queue); 2388 2389 return IRQ_WAKE_THREAD; 2390 } 2391 2392 static int interrupt_preinit_v3_hw(struct hisi_hba *hisi_hba) 2393 { 2394 int vectors; 2395 int max_msi = HISI_SAS_MSI_COUNT_V3_HW, min_msi; 2396 struct Scsi_Host *shost = hisi_hba->shost; 2397 struct irq_affinity desc = { 2398 .pre_vectors = BASE_VECTORS_V3_HW, 2399 }; 2400 2401 min_msi = MIN_AFFINE_VECTORS_V3_HW; 2402 vectors = pci_alloc_irq_vectors_affinity(hisi_hba->pci_dev, 2403 min_msi, max_msi, 2404 PCI_IRQ_MSI | 2405 PCI_IRQ_AFFINITY, 2406 &desc); 2407 if (vectors < 0) 2408 return -ENOENT; 2409 2410 2411 hisi_hba->cq_nvecs = vectors - BASE_VECTORS_V3_HW; 2412 shost->nr_hw_queues = hisi_hba->cq_nvecs; 2413 2414 return 0; 2415 } 2416 2417 static int interrupt_init_v3_hw(struct hisi_hba *hisi_hba) 2418 { 2419 struct device *dev = hisi_hba->dev; 2420 struct pci_dev *pdev = hisi_hba->pci_dev; 2421 int rc, i; 2422 2423 rc = devm_request_irq(dev, pci_irq_vector(pdev, 1), 2424 int_phy_up_down_bcast_v3_hw, 0, 2425 DRV_NAME " phy", hisi_hba); 2426 if (rc) { 2427 dev_err(dev, "could not request phy interrupt, rc=%d\n", rc); 2428 return -ENOENT; 2429 } 2430 2431 rc = devm_request_irq(dev, pci_irq_vector(pdev, 2), 2432 int_chnl_int_v3_hw, 0, 2433 DRV_NAME " channel", hisi_hba); 2434 if (rc) { 2435 dev_err(dev, "could not request chnl interrupt, rc=%d\n", rc); 2436 return -ENOENT; 2437 } 2438 2439 rc = devm_request_irq(dev, pci_irq_vector(pdev, 11), 2440 fatal_axi_int_v3_hw, 0, 2441 DRV_NAME " fatal", hisi_hba); 2442 if (rc) { 2443 dev_err(dev, "could not request fatal interrupt, rc=%d\n", rc); 2444 return -ENOENT; 2445 } 2446 2447 if (hisi_sas_intr_conv) 2448 dev_info(dev, "Enable interrupt converge\n"); 2449 2450 for (i = 0; i < hisi_hba->cq_nvecs; i++) { 2451 struct hisi_sas_cq *cq = &hisi_hba->cq[i]; 2452 int nr = hisi_sas_intr_conv ? 16 : 16 + i; 2453 unsigned long irqflags = hisi_sas_intr_conv ? IRQF_SHARED : 2454 IRQF_ONESHOT; 2455 2456 cq->irq_no = pci_irq_vector(pdev, nr); 2457 rc = devm_request_threaded_irq(dev, cq->irq_no, 2458 cq_interrupt_v3_hw, 2459 cq_thread_v3_hw, 2460 irqflags, 2461 DRV_NAME " cq", cq); 2462 if (rc) { 2463 dev_err(dev, "could not request cq%d interrupt, rc=%d\n", 2464 i, rc); 2465 return -ENOENT; 2466 } 2467 cq->irq_mask = pci_irq_get_affinity(pdev, i + BASE_VECTORS_V3_HW); 2468 if (!cq->irq_mask) { 2469 dev_err(dev, "could not get cq%d irq affinity!\n", i); 2470 return -ENOENT; 2471 } 2472 } 2473 2474 return 0; 2475 } 2476 2477 static int hisi_sas_v3_init(struct hisi_hba *hisi_hba) 2478 { 2479 int rc; 2480 2481 rc = hw_init_v3_hw(hisi_hba); 2482 if (rc) 2483 return rc; 2484 2485 rc = interrupt_init_v3_hw(hisi_hba); 2486 if (rc) 2487 return rc; 2488 2489 return 0; 2490 } 2491 2492 static void phy_set_linkrate_v3_hw(struct hisi_hba *hisi_hba, int phy_no, 2493 struct sas_phy_linkrates *r) 2494 { 2495 enum sas_linkrate max = r->maximum_linkrate; 2496 u32 prog_phy_link_rate = hisi_sas_phy_read32(hisi_hba, phy_no, 2497 PROG_PHY_LINK_RATE); 2498 2499 prog_phy_link_rate &= ~CFG_PROG_PHY_LINK_RATE_MSK; 2500 prog_phy_link_rate |= hisi_sas_get_prog_phy_linkrate_mask(max); 2501 hisi_sas_phy_write32(hisi_hba, phy_no, PROG_PHY_LINK_RATE, 2502 prog_phy_link_rate); 2503 } 2504 2505 static void interrupt_disable_v3_hw(struct hisi_hba *hisi_hba) 2506 { 2507 struct pci_dev *pdev = hisi_hba->pci_dev; 2508 int i; 2509 2510 synchronize_irq(pci_irq_vector(pdev, 1)); 2511 synchronize_irq(pci_irq_vector(pdev, 2)); 2512 synchronize_irq(pci_irq_vector(pdev, 11)); 2513 for (i = 0; i < hisi_hba->queue_count; i++) 2514 hisi_sas_write32(hisi_hba, OQ0_INT_SRC_MSK + 0x4 * i, 0x1); 2515 2516 for (i = 0; i < hisi_hba->cq_nvecs; i++) 2517 synchronize_irq(pci_irq_vector(pdev, i + 16)); 2518 2519 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK1, 0xffffffff); 2520 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK2, 0xffffffff); 2521 hisi_sas_write32(hisi_hba, ENT_INT_SRC_MSK3, 0xffffffff); 2522 hisi_sas_write32(hisi_hba, SAS_ECC_INTR_MSK, 0xffffffff); 2523 2524 for (i = 0; i < hisi_hba->n_phy; i++) { 2525 hisi_sas_phy_write32(hisi_hba, i, CHL_INT1_MSK, 0xffffffff); 2526 hisi_sas_phy_write32(hisi_hba, i, CHL_INT2_MSK, 0xffffffff); 2527 hisi_sas_phy_write32(hisi_hba, i, PHYCTRL_NOT_RDY_MSK, 0x1); 2528 hisi_sas_phy_write32(hisi_hba, i, PHYCTRL_PHY_ENA_MSK, 0x1); 2529 hisi_sas_phy_write32(hisi_hba, i, SL_RX_BCAST_CHK_MSK, 0x1); 2530 } 2531 } 2532 2533 static u32 get_phys_state_v3_hw(struct hisi_hba *hisi_hba) 2534 { 2535 return hisi_sas_read32(hisi_hba, PHY_STATE); 2536 } 2537 2538 static int disable_host_v3_hw(struct hisi_hba *hisi_hba) 2539 { 2540 struct device *dev = hisi_hba->dev; 2541 u32 status, reg_val; 2542 int rc; 2543 2544 interrupt_disable_v3_hw(hisi_hba); 2545 hisi_sas_write32(hisi_hba, DLVRY_QUEUE_ENABLE, 0x0); 2546 2547 hisi_sas_stop_phys(hisi_hba); 2548 2549 mdelay(10); 2550 2551 reg_val = hisi_sas_read32(hisi_hba, AXI_MASTER_CFG_BASE + 2552 AM_CTRL_GLOBAL); 2553 reg_val |= AM_CTRL_SHUTDOWN_REQ_MSK; 2554 hisi_sas_write32(hisi_hba, AXI_MASTER_CFG_BASE + 2555 AM_CTRL_GLOBAL, reg_val); 2556 2557 /* wait until bus idle */ 2558 rc = hisi_sas_read32_poll_timeout(AXI_MASTER_CFG_BASE + 2559 AM_CURR_TRANS_RETURN, status, 2560 status == 0x3, 10, 100); 2561 if (rc) { 2562 dev_err(dev, "axi bus is not idle, rc=%d\n", rc); 2563 return rc; 2564 } 2565 2566 return 0; 2567 } 2568 2569 static int soft_reset_v3_hw(struct hisi_hba *hisi_hba) 2570 { 2571 struct device *dev = hisi_hba->dev; 2572 int rc; 2573 2574 rc = disable_host_v3_hw(hisi_hba); 2575 if (rc) { 2576 dev_err(dev, "soft reset: disable host failed rc=%d\n", rc); 2577 return rc; 2578 } 2579 2580 hisi_sas_init_mem(hisi_hba); 2581 2582 return hw_init_v3_hw(hisi_hba); 2583 } 2584 2585 static int write_gpio_v3_hw(struct hisi_hba *hisi_hba, u8 reg_type, 2586 u8 reg_index, u8 reg_count, u8 *write_data) 2587 { 2588 struct device *dev = hisi_hba->dev; 2589 u32 *data = (u32 *)write_data; 2590 int i; 2591 2592 switch (reg_type) { 2593 case SAS_GPIO_REG_TX: 2594 if ((reg_index + reg_count) > ((hisi_hba->n_phy + 3) / 4)) { 2595 dev_err(dev, "write gpio: invalid reg range[%d, %d]\n", 2596 reg_index, reg_index + reg_count - 1); 2597 return -EINVAL; 2598 } 2599 2600 for (i = 0; i < reg_count; i++) 2601 hisi_sas_write32(hisi_hba, 2602 SAS_GPIO_TX_0_1 + (reg_index + i) * 4, 2603 data[i]); 2604 break; 2605 default: 2606 dev_err(dev, "write gpio: unsupported or bad reg type %d\n", 2607 reg_type); 2608 return -EINVAL; 2609 } 2610 2611 return 0; 2612 } 2613 2614 static void wait_cmds_complete_timeout_v3_hw(struct hisi_hba *hisi_hba, 2615 int delay_ms, int timeout_ms) 2616 { 2617 struct device *dev = hisi_hba->dev; 2618 int entries, entries_old = 0, time; 2619 2620 for (time = 0; time < timeout_ms; time += delay_ms) { 2621 entries = hisi_sas_read32(hisi_hba, CQE_SEND_CNT); 2622 if (entries == entries_old) 2623 break; 2624 2625 entries_old = entries; 2626 msleep(delay_ms); 2627 } 2628 2629 if (time >= timeout_ms) { 2630 dev_dbg(dev, "Wait commands complete timeout!\n"); 2631 return; 2632 } 2633 2634 dev_dbg(dev, "wait commands complete %dms\n", time); 2635 } 2636 2637 static ssize_t intr_conv_v3_hw_show(struct device *dev, 2638 struct device_attribute *attr, char *buf) 2639 { 2640 return scnprintf(buf, PAGE_SIZE, "%u\n", hisi_sas_intr_conv); 2641 } 2642 static DEVICE_ATTR_RO(intr_conv_v3_hw); 2643 2644 static void config_intr_coal_v3_hw(struct hisi_hba *hisi_hba) 2645 { 2646 /* config those registers between enable and disable PHYs */ 2647 hisi_sas_stop_phys(hisi_hba); 2648 2649 if (hisi_hba->intr_coal_ticks == 0 || 2650 hisi_hba->intr_coal_count == 0) { 2651 hisi_sas_write32(hisi_hba, INT_COAL_EN, 0x1); 2652 hisi_sas_write32(hisi_hba, OQ_INT_COAL_TIME, 0x1); 2653 hisi_sas_write32(hisi_hba, OQ_INT_COAL_CNT, 0x1); 2654 } else { 2655 hisi_sas_write32(hisi_hba, INT_COAL_EN, 0x3); 2656 hisi_sas_write32(hisi_hba, OQ_INT_COAL_TIME, 2657 hisi_hba->intr_coal_ticks); 2658 hisi_sas_write32(hisi_hba, OQ_INT_COAL_CNT, 2659 hisi_hba->intr_coal_count); 2660 } 2661 phys_init_v3_hw(hisi_hba); 2662 } 2663 2664 static ssize_t intr_coal_ticks_v3_hw_show(struct device *dev, 2665 struct device_attribute *attr, 2666 char *buf) 2667 { 2668 struct Scsi_Host *shost = class_to_shost(dev); 2669 struct hisi_hba *hisi_hba = shost_priv(shost); 2670 2671 return scnprintf(buf, PAGE_SIZE, "%u\n", 2672 hisi_hba->intr_coal_ticks); 2673 } 2674 2675 static ssize_t intr_coal_ticks_v3_hw_store(struct device *dev, 2676 struct device_attribute *attr, 2677 const char *buf, size_t count) 2678 { 2679 struct Scsi_Host *shost = class_to_shost(dev); 2680 struct hisi_hba *hisi_hba = shost_priv(shost); 2681 u32 intr_coal_ticks; 2682 int ret; 2683 2684 ret = kstrtou32(buf, 10, &intr_coal_ticks); 2685 if (ret) { 2686 dev_err(dev, "Input data of interrupt coalesce unmatch\n"); 2687 return -EINVAL; 2688 } 2689 2690 if (intr_coal_ticks >= BIT(24)) { 2691 dev_err(dev, "intr_coal_ticks must be less than 2^24!\n"); 2692 return -EINVAL; 2693 } 2694 2695 hisi_hba->intr_coal_ticks = intr_coal_ticks; 2696 2697 config_intr_coal_v3_hw(hisi_hba); 2698 2699 return count; 2700 } 2701 static DEVICE_ATTR_RW(intr_coal_ticks_v3_hw); 2702 2703 static ssize_t intr_coal_count_v3_hw_show(struct device *dev, 2704 struct device_attribute 2705 *attr, char *buf) 2706 { 2707 struct Scsi_Host *shost = class_to_shost(dev); 2708 struct hisi_hba *hisi_hba = shost_priv(shost); 2709 2710 return scnprintf(buf, PAGE_SIZE, "%u\n", 2711 hisi_hba->intr_coal_count); 2712 } 2713 2714 static ssize_t intr_coal_count_v3_hw_store(struct device *dev, 2715 struct device_attribute 2716 *attr, const char *buf, size_t count) 2717 { 2718 struct Scsi_Host *shost = class_to_shost(dev); 2719 struct hisi_hba *hisi_hba = shost_priv(shost); 2720 u32 intr_coal_count; 2721 int ret; 2722 2723 ret = kstrtou32(buf, 10, &intr_coal_count); 2724 if (ret) { 2725 dev_err(dev, "Input data of interrupt coalesce unmatch\n"); 2726 return -EINVAL; 2727 } 2728 2729 if (intr_coal_count >= BIT(8)) { 2730 dev_err(dev, "intr_coal_count must be less than 2^8!\n"); 2731 return -EINVAL; 2732 } 2733 2734 hisi_hba->intr_coal_count = intr_coal_count; 2735 2736 config_intr_coal_v3_hw(hisi_hba); 2737 2738 return count; 2739 } 2740 static DEVICE_ATTR_RW(intr_coal_count_v3_hw); 2741 2742 static int slave_configure_v3_hw(struct scsi_device *sdev) 2743 { 2744 struct Scsi_Host *shost = dev_to_shost(&sdev->sdev_gendev); 2745 struct domain_device *ddev = sdev_to_domain_dev(sdev); 2746 struct hisi_hba *hisi_hba = shost_priv(shost); 2747 struct device *dev = hisi_hba->dev; 2748 int ret = sas_slave_configure(sdev); 2749 2750 if (ret) 2751 return ret; 2752 if (!dev_is_sata(ddev)) 2753 sas_change_queue_depth(sdev, 64); 2754 2755 if (sdev->type == TYPE_ENCLOSURE) 2756 return 0; 2757 2758 if (!device_link_add(&sdev->sdev_gendev, dev, 2759 DL_FLAG_PM_RUNTIME | DL_FLAG_RPM_ACTIVE)) { 2760 if (pm_runtime_enabled(dev)) { 2761 dev_info(dev, "add device link failed, disable runtime PM for the host\n"); 2762 pm_runtime_disable(dev); 2763 } 2764 } 2765 2766 return 0; 2767 } 2768 2769 static struct attribute *host_v3_hw_attrs[] = { 2770 &dev_attr_phy_event_threshold.attr, 2771 &dev_attr_intr_conv_v3_hw.attr, 2772 &dev_attr_intr_coal_ticks_v3_hw.attr, 2773 &dev_attr_intr_coal_count_v3_hw.attr, 2774 NULL 2775 }; 2776 2777 ATTRIBUTE_GROUPS(host_v3_hw); 2778 2779 #define HISI_SAS_DEBUGFS_REG(x) {#x, x} 2780 2781 struct hisi_sas_debugfs_reg_lu { 2782 char *name; 2783 int off; 2784 }; 2785 2786 struct hisi_sas_debugfs_reg { 2787 const struct hisi_sas_debugfs_reg_lu *lu; 2788 int count; 2789 int base_off; 2790 }; 2791 2792 static const struct hisi_sas_debugfs_reg_lu debugfs_port_reg_lu[] = { 2793 HISI_SAS_DEBUGFS_REG(PHY_CFG), 2794 HISI_SAS_DEBUGFS_REG(HARD_PHY_LINKRATE), 2795 HISI_SAS_DEBUGFS_REG(PROG_PHY_LINK_RATE), 2796 HISI_SAS_DEBUGFS_REG(PHY_CTRL), 2797 HISI_SAS_DEBUGFS_REG(SL_CFG), 2798 HISI_SAS_DEBUGFS_REG(AIP_LIMIT), 2799 HISI_SAS_DEBUGFS_REG(SL_CONTROL), 2800 HISI_SAS_DEBUGFS_REG(RX_PRIMS_STATUS), 2801 HISI_SAS_DEBUGFS_REG(TX_ID_DWORD0), 2802 HISI_SAS_DEBUGFS_REG(TX_ID_DWORD1), 2803 HISI_SAS_DEBUGFS_REG(TX_ID_DWORD2), 2804 HISI_SAS_DEBUGFS_REG(TX_ID_DWORD3), 2805 HISI_SAS_DEBUGFS_REG(TX_ID_DWORD4), 2806 HISI_SAS_DEBUGFS_REG(TX_ID_DWORD5), 2807 HISI_SAS_DEBUGFS_REG(TX_ID_DWORD6), 2808 HISI_SAS_DEBUGFS_REG(TXID_AUTO), 2809 HISI_SAS_DEBUGFS_REG(RX_IDAF_DWORD0), 2810 HISI_SAS_DEBUGFS_REG(RXOP_CHECK_CFG_H), 2811 HISI_SAS_DEBUGFS_REG(STP_LINK_TIMER), 2812 HISI_SAS_DEBUGFS_REG(STP_LINK_TIMEOUT_STATE), 2813 HISI_SAS_DEBUGFS_REG(CON_CFG_DRIVER), 2814 HISI_SAS_DEBUGFS_REG(SAS_SSP_CON_TIMER_CFG), 2815 HISI_SAS_DEBUGFS_REG(SAS_SMP_CON_TIMER_CFG), 2816 HISI_SAS_DEBUGFS_REG(SAS_STP_CON_TIMER_CFG), 2817 HISI_SAS_DEBUGFS_REG(CHL_INT0), 2818 HISI_SAS_DEBUGFS_REG(CHL_INT1), 2819 HISI_SAS_DEBUGFS_REG(CHL_INT2), 2820 HISI_SAS_DEBUGFS_REG(CHL_INT0_MSK), 2821 HISI_SAS_DEBUGFS_REG(CHL_INT1_MSK), 2822 HISI_SAS_DEBUGFS_REG(CHL_INT2_MSK), 2823 HISI_SAS_DEBUGFS_REG(SAS_EC_INT_COAL_TIME), 2824 HISI_SAS_DEBUGFS_REG(CHL_INT_COAL_EN), 2825 HISI_SAS_DEBUGFS_REG(SAS_RX_TRAIN_TIMER), 2826 HISI_SAS_DEBUGFS_REG(PHY_CTRL_RDY_MSK), 2827 HISI_SAS_DEBUGFS_REG(PHYCTRL_NOT_RDY_MSK), 2828 HISI_SAS_DEBUGFS_REG(PHYCTRL_DWS_RESET_MSK), 2829 HISI_SAS_DEBUGFS_REG(PHYCTRL_PHY_ENA_MSK), 2830 HISI_SAS_DEBUGFS_REG(SL_RX_BCAST_CHK_MSK), 2831 HISI_SAS_DEBUGFS_REG(PHYCTRL_OOB_RESTART_MSK), 2832 HISI_SAS_DEBUGFS_REG(DMA_TX_STATUS), 2833 HISI_SAS_DEBUGFS_REG(DMA_RX_STATUS), 2834 HISI_SAS_DEBUGFS_REG(COARSETUNE_TIME), 2835 HISI_SAS_DEBUGFS_REG(ERR_CNT_DWS_LOST), 2836 HISI_SAS_DEBUGFS_REG(ERR_CNT_RESET_PROB), 2837 HISI_SAS_DEBUGFS_REG(ERR_CNT_INVLD_DW), 2838 HISI_SAS_DEBUGFS_REG(ERR_CNT_CODE_ERR), 2839 HISI_SAS_DEBUGFS_REG(ERR_CNT_DISP_ERR), 2840 {} 2841 }; 2842 2843 static const struct hisi_sas_debugfs_reg debugfs_port_reg = { 2844 .lu = debugfs_port_reg_lu, 2845 .count = 0x100, 2846 .base_off = PORT_BASE, 2847 }; 2848 2849 static const struct hisi_sas_debugfs_reg_lu debugfs_global_reg_lu[] = { 2850 HISI_SAS_DEBUGFS_REG(DLVRY_QUEUE_ENABLE), 2851 HISI_SAS_DEBUGFS_REG(PHY_CONTEXT), 2852 HISI_SAS_DEBUGFS_REG(PHY_STATE), 2853 HISI_SAS_DEBUGFS_REG(PHY_PORT_NUM_MA), 2854 HISI_SAS_DEBUGFS_REG(PHY_CONN_RATE), 2855 HISI_SAS_DEBUGFS_REG(ITCT_CLR), 2856 HISI_SAS_DEBUGFS_REG(IO_SATA_BROKEN_MSG_ADDR_LO), 2857 HISI_SAS_DEBUGFS_REG(IO_SATA_BROKEN_MSG_ADDR_HI), 2858 HISI_SAS_DEBUGFS_REG(SATA_INITI_D2H_STORE_ADDR_LO), 2859 HISI_SAS_DEBUGFS_REG(SATA_INITI_D2H_STORE_ADDR_HI), 2860 HISI_SAS_DEBUGFS_REG(CFG_MAX_TAG), 2861 HISI_SAS_DEBUGFS_REG(HGC_SAS_TX_OPEN_FAIL_RETRY_CTRL), 2862 HISI_SAS_DEBUGFS_REG(HGC_SAS_TXFAIL_RETRY_CTRL), 2863 HISI_SAS_DEBUGFS_REG(HGC_GET_ITV_TIME), 2864 HISI_SAS_DEBUGFS_REG(DEVICE_MSG_WORK_MODE), 2865 HISI_SAS_DEBUGFS_REG(OPENA_WT_CONTI_TIME), 2866 HISI_SAS_DEBUGFS_REG(I_T_NEXUS_LOSS_TIME), 2867 HISI_SAS_DEBUGFS_REG(MAX_CON_TIME_LIMIT_TIME), 2868 HISI_SAS_DEBUGFS_REG(BUS_INACTIVE_LIMIT_TIME), 2869 HISI_SAS_DEBUGFS_REG(REJECT_TO_OPEN_LIMIT_TIME), 2870 HISI_SAS_DEBUGFS_REG(CQ_INT_CONVERGE_EN), 2871 HISI_SAS_DEBUGFS_REG(CFG_AGING_TIME), 2872 HISI_SAS_DEBUGFS_REG(HGC_DFX_CFG2), 2873 HISI_SAS_DEBUGFS_REG(CFG_ABT_SET_QUERY_IPTT), 2874 HISI_SAS_DEBUGFS_REG(CFG_ABT_SET_IPTT_DONE), 2875 HISI_SAS_DEBUGFS_REG(HGC_IOMB_PROC1_STATUS), 2876 HISI_SAS_DEBUGFS_REG(CHNL_INT_STATUS), 2877 HISI_SAS_DEBUGFS_REG(HGC_AXI_FIFO_ERR_INFO), 2878 HISI_SAS_DEBUGFS_REG(INT_COAL_EN), 2879 HISI_SAS_DEBUGFS_REG(OQ_INT_COAL_TIME), 2880 HISI_SAS_DEBUGFS_REG(OQ_INT_COAL_CNT), 2881 HISI_SAS_DEBUGFS_REG(ENT_INT_COAL_TIME), 2882 HISI_SAS_DEBUGFS_REG(ENT_INT_COAL_CNT), 2883 HISI_SAS_DEBUGFS_REG(OQ_INT_SRC), 2884 HISI_SAS_DEBUGFS_REG(OQ_INT_SRC_MSK), 2885 HISI_SAS_DEBUGFS_REG(ENT_INT_SRC1), 2886 HISI_SAS_DEBUGFS_REG(ENT_INT_SRC2), 2887 HISI_SAS_DEBUGFS_REG(ENT_INT_SRC3), 2888 HISI_SAS_DEBUGFS_REG(ENT_INT_SRC_MSK1), 2889 HISI_SAS_DEBUGFS_REG(ENT_INT_SRC_MSK2), 2890 HISI_SAS_DEBUGFS_REG(ENT_INT_SRC_MSK3), 2891 HISI_SAS_DEBUGFS_REG(CHNL_PHYUPDOWN_INT_MSK), 2892 HISI_SAS_DEBUGFS_REG(CHNL_ENT_INT_MSK), 2893 HISI_SAS_DEBUGFS_REG(HGC_COM_INT_MSK), 2894 HISI_SAS_DEBUGFS_REG(SAS_ECC_INTR), 2895 HISI_SAS_DEBUGFS_REG(SAS_ECC_INTR_MSK), 2896 HISI_SAS_DEBUGFS_REG(HGC_ERR_STAT_EN), 2897 HISI_SAS_DEBUGFS_REG(CQE_SEND_CNT), 2898 HISI_SAS_DEBUGFS_REG(DLVRY_Q_0_DEPTH), 2899 HISI_SAS_DEBUGFS_REG(DLVRY_Q_0_WR_PTR), 2900 HISI_SAS_DEBUGFS_REG(DLVRY_Q_0_RD_PTR), 2901 HISI_SAS_DEBUGFS_REG(HYPER_STREAM_ID_EN_CFG), 2902 HISI_SAS_DEBUGFS_REG(OQ0_INT_SRC_MSK), 2903 HISI_SAS_DEBUGFS_REG(COMPL_Q_0_DEPTH), 2904 HISI_SAS_DEBUGFS_REG(COMPL_Q_0_WR_PTR), 2905 HISI_SAS_DEBUGFS_REG(COMPL_Q_0_RD_PTR), 2906 HISI_SAS_DEBUGFS_REG(AWQOS_AWCACHE_CFG), 2907 HISI_SAS_DEBUGFS_REG(ARQOS_ARCACHE_CFG), 2908 HISI_SAS_DEBUGFS_REG(HILINK_ERR_DFX), 2909 HISI_SAS_DEBUGFS_REG(SAS_GPIO_CFG_0), 2910 HISI_SAS_DEBUGFS_REG(SAS_GPIO_CFG_1), 2911 HISI_SAS_DEBUGFS_REG(SAS_GPIO_TX_0_1), 2912 HISI_SAS_DEBUGFS_REG(SAS_CFG_DRIVE_VLD), 2913 {} 2914 }; 2915 2916 static const struct hisi_sas_debugfs_reg debugfs_global_reg = { 2917 .lu = debugfs_global_reg_lu, 2918 .count = 0x800, 2919 }; 2920 2921 static const struct hisi_sas_debugfs_reg_lu debugfs_axi_reg_lu[] = { 2922 HISI_SAS_DEBUGFS_REG(AM_CFG_MAX_TRANS), 2923 HISI_SAS_DEBUGFS_REG(AM_CFG_SINGLE_PORT_MAX_TRANS), 2924 HISI_SAS_DEBUGFS_REG(AXI_CFG), 2925 HISI_SAS_DEBUGFS_REG(AM_ROB_ECC_ERR_ADDR), 2926 {} 2927 }; 2928 2929 static const struct hisi_sas_debugfs_reg debugfs_axi_reg = { 2930 .lu = debugfs_axi_reg_lu, 2931 .count = 0x61, 2932 .base_off = AXI_MASTER_CFG_BASE, 2933 }; 2934 2935 static const struct hisi_sas_debugfs_reg_lu debugfs_ras_reg_lu[] = { 2936 HISI_SAS_DEBUGFS_REG(SAS_RAS_INTR0), 2937 HISI_SAS_DEBUGFS_REG(SAS_RAS_INTR1), 2938 HISI_SAS_DEBUGFS_REG(SAS_RAS_INTR0_MASK), 2939 HISI_SAS_DEBUGFS_REG(SAS_RAS_INTR1_MASK), 2940 HISI_SAS_DEBUGFS_REG(CFG_SAS_RAS_INTR_MASK), 2941 HISI_SAS_DEBUGFS_REG(SAS_RAS_INTR2), 2942 HISI_SAS_DEBUGFS_REG(SAS_RAS_INTR2_MASK), 2943 {} 2944 }; 2945 2946 static const struct hisi_sas_debugfs_reg debugfs_ras_reg = { 2947 .lu = debugfs_ras_reg_lu, 2948 .count = 0x10, 2949 .base_off = RAS_BASE, 2950 }; 2951 2952 static void debugfs_snapshot_prepare_v3_hw(struct hisi_hba *hisi_hba) 2953 { 2954 set_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); 2955 2956 hisi_sas_write32(hisi_hba, DLVRY_QUEUE_ENABLE, 0); 2957 2958 wait_cmds_complete_timeout_v3_hw(hisi_hba, 100, 5000); 2959 2960 hisi_sas_sync_irqs(hisi_hba); 2961 } 2962 2963 static void debugfs_snapshot_restore_v3_hw(struct hisi_hba *hisi_hba) 2964 { 2965 hisi_sas_write32(hisi_hba, DLVRY_QUEUE_ENABLE, 2966 (u32)((1ULL << hisi_hba->queue_count) - 1)); 2967 2968 clear_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); 2969 } 2970 2971 static void read_iost_itct_cache_v3_hw(struct hisi_hba *hisi_hba, 2972 enum hisi_sas_debugfs_cache_type type, 2973 u32 *cache) 2974 { 2975 u32 cache_dw_size = HISI_SAS_IOST_ITCT_CACHE_DW_SZ * 2976 HISI_SAS_IOST_ITCT_CACHE_NUM; 2977 struct device *dev = hisi_hba->dev; 2978 u32 *buf = cache; 2979 u32 i, val; 2980 2981 hisi_sas_write32(hisi_hba, TAB_RD_TYPE, type); 2982 2983 for (i = 0; i < HISI_SAS_IOST_ITCT_CACHE_DW_SZ; i++) { 2984 val = hisi_sas_read32(hisi_hba, TAB_DFX); 2985 if (val == 0xffffffff) 2986 break; 2987 } 2988 2989 if (val != 0xffffffff) { 2990 dev_err(dev, "Issue occurred in reading IOST/ITCT cache!\n"); 2991 return; 2992 } 2993 2994 memset(buf, 0, cache_dw_size * 4); 2995 buf[0] = val; 2996 2997 for (i = 1; i < cache_dw_size; i++) 2998 buf[i] = hisi_sas_read32(hisi_hba, TAB_DFX); 2999 } 3000 3001 static void hisi_sas_bist_test_prep_v3_hw(struct hisi_hba *hisi_hba) 3002 { 3003 u32 reg_val; 3004 int phy_no = hisi_hba->debugfs_bist_phy_no; 3005 int i; 3006 3007 /* disable PHY */ 3008 hisi_sas_phy_enable(hisi_hba, phy_no, 0); 3009 3010 /* update FFE */ 3011 for (i = 0; i < FFE_CFG_MAX; i++) 3012 hisi_sas_phy_write32(hisi_hba, phy_no, TXDEEMPH_G1 + (i * 0x4), 3013 hisi_hba->debugfs_bist_ffe[phy_no][i]); 3014 3015 /* disable ALOS */ 3016 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, SERDES_CFG); 3017 reg_val |= CFG_ALOS_CHK_DISABLE_MSK; 3018 hisi_sas_phy_write32(hisi_hba, phy_no, SERDES_CFG, reg_val); 3019 } 3020 3021 static void hisi_sas_bist_test_restore_v3_hw(struct hisi_hba *hisi_hba) 3022 { 3023 u32 reg_val; 3024 int phy_no = hisi_hba->debugfs_bist_phy_no; 3025 3026 /* disable loopback */ 3027 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, SAS_PHY_BIST_CTRL); 3028 reg_val &= ~(CFG_RX_BIST_EN_MSK | CFG_TX_BIST_EN_MSK | 3029 CFG_BIST_TEST_MSK); 3030 hisi_sas_phy_write32(hisi_hba, phy_no, SAS_PHY_BIST_CTRL, reg_val); 3031 3032 /* enable ALOS */ 3033 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, SERDES_CFG); 3034 reg_val &= ~CFG_ALOS_CHK_DISABLE_MSK; 3035 hisi_sas_phy_write32(hisi_hba, phy_no, SERDES_CFG, reg_val); 3036 3037 /* restore the linkrate */ 3038 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, PROG_PHY_LINK_RATE); 3039 /* init OOB link rate as 1.5 Gbits */ 3040 reg_val &= ~CFG_PROG_OOB_PHY_LINK_RATE_MSK; 3041 reg_val |= (0x8 << CFG_PROG_OOB_PHY_LINK_RATE_OFF); 3042 hisi_sas_phy_write32(hisi_hba, phy_no, PROG_PHY_LINK_RATE, reg_val); 3043 3044 /* enable PHY */ 3045 hisi_sas_phy_enable(hisi_hba, phy_no, 1); 3046 } 3047 3048 #define SAS_PHY_BIST_CODE_INIT 0x1 3049 #define SAS_PHY_BIST_CODE1_INIT 0X80 3050 static int debugfs_set_bist_v3_hw(struct hisi_hba *hisi_hba, bool enable) 3051 { 3052 u32 reg_val, mode_tmp; 3053 u32 linkrate = hisi_hba->debugfs_bist_linkrate; 3054 u32 phy_no = hisi_hba->debugfs_bist_phy_no; 3055 u32 *ffe = hisi_hba->debugfs_bist_ffe[phy_no]; 3056 u32 code_mode = hisi_hba->debugfs_bist_code_mode; 3057 u32 path_mode = hisi_hba->debugfs_bist_mode; 3058 u32 *fix_code = &hisi_hba->debugfs_bist_fixed_code[0]; 3059 struct device *dev = hisi_hba->dev; 3060 3061 dev_info(dev, "BIST info:phy%d link_rate=%d code_mode=%d path_mode=%d ffe={0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x, 0x%x} fixed_code={0x%x, 0x%x}\n", 3062 phy_no, linkrate, code_mode, path_mode, 3063 ffe[FFE_SAS_1_5_GBPS], ffe[FFE_SAS_3_0_GBPS], 3064 ffe[FFE_SAS_6_0_GBPS], ffe[FFE_SAS_12_0_GBPS], 3065 ffe[FFE_SATA_1_5_GBPS], ffe[FFE_SATA_3_0_GBPS], 3066 ffe[FFE_SATA_6_0_GBPS], fix_code[FIXED_CODE], 3067 fix_code[FIXED_CODE_1]); 3068 mode_tmp = path_mode ? 2 : 1; 3069 if (enable) { 3070 /* some preparations before bist test */ 3071 hisi_sas_bist_test_prep_v3_hw(hisi_hba); 3072 3073 /* set linkrate of bit test*/ 3074 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, 3075 PROG_PHY_LINK_RATE); 3076 reg_val &= ~CFG_PROG_OOB_PHY_LINK_RATE_MSK; 3077 reg_val |= (linkrate << CFG_PROG_OOB_PHY_LINK_RATE_OFF); 3078 hisi_sas_phy_write32(hisi_hba, phy_no, PROG_PHY_LINK_RATE, 3079 reg_val); 3080 3081 /* set code mode of bit test */ 3082 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, 3083 SAS_PHY_BIST_CTRL); 3084 reg_val &= ~(CFG_BIST_MODE_SEL_MSK | CFG_LOOP_TEST_MODE_MSK | 3085 CFG_RX_BIST_EN_MSK | CFG_TX_BIST_EN_MSK | 3086 CFG_BIST_TEST_MSK); 3087 reg_val |= ((code_mode << CFG_BIST_MODE_SEL_OFF) | 3088 (mode_tmp << CFG_LOOP_TEST_MODE_OFF) | 3089 CFG_BIST_TEST_MSK); 3090 hisi_sas_phy_write32(hisi_hba, phy_no, SAS_PHY_BIST_CTRL, 3091 reg_val); 3092 3093 /* set the bist init value */ 3094 if (code_mode == HISI_SAS_BIST_CODE_MODE_FIXED_DATA) { 3095 reg_val = hisi_hba->debugfs_bist_fixed_code[0]; 3096 hisi_sas_phy_write32(hisi_hba, phy_no, 3097 SAS_PHY_BIST_CODE, reg_val); 3098 3099 reg_val = hisi_hba->debugfs_bist_fixed_code[1]; 3100 hisi_sas_phy_write32(hisi_hba, phy_no, 3101 SAS_PHY_BIST_CODE1, reg_val); 3102 } else { 3103 hisi_sas_phy_write32(hisi_hba, phy_no, 3104 SAS_PHY_BIST_CODE, 3105 SAS_PHY_BIST_CODE_INIT); 3106 hisi_sas_phy_write32(hisi_hba, phy_no, 3107 SAS_PHY_BIST_CODE1, 3108 SAS_PHY_BIST_CODE1_INIT); 3109 } 3110 3111 mdelay(100); 3112 reg_val |= (CFG_RX_BIST_EN_MSK | CFG_TX_BIST_EN_MSK); 3113 hisi_sas_phy_write32(hisi_hba, phy_no, SAS_PHY_BIST_CTRL, 3114 reg_val); 3115 3116 /* clear error bit */ 3117 mdelay(100); 3118 hisi_sas_phy_read32(hisi_hba, phy_no, SAS_BIST_ERR_CNT); 3119 } else { 3120 /* disable bist test and recover it */ 3121 hisi_hba->debugfs_bist_cnt += hisi_sas_phy_read32(hisi_hba, 3122 phy_no, SAS_BIST_ERR_CNT); 3123 hisi_sas_bist_test_restore_v3_hw(hisi_hba); 3124 } 3125 3126 return 0; 3127 } 3128 3129 static int hisi_sas_map_queues(struct Scsi_Host *shost) 3130 { 3131 struct hisi_hba *hisi_hba = shost_priv(shost); 3132 struct blk_mq_queue_map *qmap = &shost->tag_set.map[HCTX_TYPE_DEFAULT]; 3133 3134 return blk_mq_pci_map_queues(qmap, hisi_hba->pci_dev, 3135 BASE_VECTORS_V3_HW); 3136 } 3137 3138 static struct scsi_host_template sht_v3_hw = { 3139 .name = DRV_NAME, 3140 .proc_name = DRV_NAME, 3141 .module = THIS_MODULE, 3142 .queuecommand = sas_queuecommand, 3143 .dma_need_drain = ata_scsi_dma_need_drain, 3144 .target_alloc = sas_target_alloc, 3145 .slave_configure = slave_configure_v3_hw, 3146 .scan_finished = hisi_sas_scan_finished, 3147 .scan_start = hisi_sas_scan_start, 3148 .map_queues = hisi_sas_map_queues, 3149 .change_queue_depth = sas_change_queue_depth, 3150 .bios_param = sas_bios_param, 3151 .this_id = -1, 3152 .sg_tablesize = HISI_SAS_SGE_PAGE_CNT, 3153 .sg_prot_tablesize = HISI_SAS_SGE_PAGE_CNT, 3154 .max_sectors = SCSI_DEFAULT_MAX_SECTORS, 3155 .eh_device_reset_handler = sas_eh_device_reset_handler, 3156 .eh_target_reset_handler = sas_eh_target_reset_handler, 3157 .slave_alloc = hisi_sas_slave_alloc, 3158 .target_destroy = sas_target_destroy, 3159 .ioctl = sas_ioctl, 3160 #ifdef CONFIG_COMPAT 3161 .compat_ioctl = sas_ioctl, 3162 #endif 3163 .shost_groups = host_v3_hw_groups, 3164 .tag_alloc_policy = BLK_TAG_ALLOC_RR, 3165 .host_reset = hisi_sas_host_reset, 3166 .host_tagset = 1, 3167 }; 3168 3169 static const struct hisi_sas_hw hisi_sas_v3_hw = { 3170 .setup_itct = setup_itct_v3_hw, 3171 .get_wideport_bitmap = get_wideport_bitmap_v3_hw, 3172 .complete_hdr_size = sizeof(struct hisi_sas_complete_v3_hdr), 3173 .clear_itct = clear_itct_v3_hw, 3174 .sl_notify_ssp = sl_notify_ssp_v3_hw, 3175 .prep_ssp = prep_ssp_v3_hw, 3176 .prep_smp = prep_smp_v3_hw, 3177 .prep_stp = prep_ata_v3_hw, 3178 .prep_abort = prep_abort_v3_hw, 3179 .start_delivery = start_delivery_v3_hw, 3180 .phys_init = phys_init_v3_hw, 3181 .phy_start = start_phy_v3_hw, 3182 .phy_disable = disable_phy_v3_hw, 3183 .phy_hard_reset = phy_hard_reset_v3_hw, 3184 .phy_get_max_linkrate = phy_get_max_linkrate_v3_hw, 3185 .phy_set_linkrate = phy_set_linkrate_v3_hw, 3186 .dereg_device = dereg_device_v3_hw, 3187 .soft_reset = soft_reset_v3_hw, 3188 .get_phys_state = get_phys_state_v3_hw, 3189 .get_events = phy_get_events_v3_hw, 3190 .write_gpio = write_gpio_v3_hw, 3191 .wait_cmds_complete_timeout = wait_cmds_complete_timeout_v3_hw, 3192 .debugfs_snapshot_regs = debugfs_snapshot_regs_v3_hw, 3193 }; 3194 3195 static struct Scsi_Host * 3196 hisi_sas_shost_alloc_pci(struct pci_dev *pdev) 3197 { 3198 struct Scsi_Host *shost; 3199 struct hisi_hba *hisi_hba; 3200 struct device *dev = &pdev->dev; 3201 3202 shost = scsi_host_alloc(&sht_v3_hw, sizeof(*hisi_hba)); 3203 if (!shost) { 3204 dev_err(dev, "shost alloc failed\n"); 3205 return NULL; 3206 } 3207 hisi_hba = shost_priv(shost); 3208 3209 INIT_WORK(&hisi_hba->rst_work, hisi_sas_rst_work_handler); 3210 INIT_WORK(&hisi_hba->debugfs_work, debugfs_work_handler_v3_hw); 3211 hisi_hba->hw = &hisi_sas_v3_hw; 3212 hisi_hba->pci_dev = pdev; 3213 hisi_hba->dev = dev; 3214 hisi_hba->shost = shost; 3215 SHOST_TO_SAS_HA(shost) = &hisi_hba->sha; 3216 3217 if (prot_mask & ~HISI_SAS_PROT_MASK) 3218 dev_err(dev, "unsupported protection mask 0x%x, using default (0x0)\n", 3219 prot_mask); 3220 else 3221 hisi_hba->prot_mask = prot_mask; 3222 3223 if (hisi_sas_get_fw_info(hisi_hba) < 0) 3224 goto err_out; 3225 3226 if (hisi_sas_alloc(hisi_hba)) { 3227 hisi_sas_free(hisi_hba); 3228 goto err_out; 3229 } 3230 3231 return shost; 3232 err_out: 3233 scsi_host_put(shost); 3234 dev_err(dev, "shost alloc failed\n"); 3235 return NULL; 3236 } 3237 3238 static void debugfs_snapshot_cq_reg_v3_hw(struct hisi_hba *hisi_hba) 3239 { 3240 int queue_entry_size = hisi_hba->hw->complete_hdr_size; 3241 int dump_index = hisi_hba->debugfs_dump_index; 3242 int i; 3243 3244 for (i = 0; i < hisi_hba->queue_count; i++) 3245 memcpy(hisi_hba->debugfs_cq[dump_index][i].complete_hdr, 3246 hisi_hba->complete_hdr[i], 3247 HISI_SAS_QUEUE_SLOTS * queue_entry_size); 3248 } 3249 3250 static void debugfs_snapshot_dq_reg_v3_hw(struct hisi_hba *hisi_hba) 3251 { 3252 int queue_entry_size = sizeof(struct hisi_sas_cmd_hdr); 3253 int dump_index = hisi_hba->debugfs_dump_index; 3254 int i; 3255 3256 for (i = 0; i < hisi_hba->queue_count; i++) { 3257 struct hisi_sas_cmd_hdr *debugfs_cmd_hdr, *cmd_hdr; 3258 int j; 3259 3260 debugfs_cmd_hdr = hisi_hba->debugfs_dq[dump_index][i].hdr; 3261 cmd_hdr = hisi_hba->cmd_hdr[i]; 3262 3263 for (j = 0; j < HISI_SAS_QUEUE_SLOTS; j++) 3264 memcpy(&debugfs_cmd_hdr[j], &cmd_hdr[j], 3265 queue_entry_size); 3266 } 3267 } 3268 3269 static void debugfs_snapshot_port_reg_v3_hw(struct hisi_hba *hisi_hba) 3270 { 3271 int dump_index = hisi_hba->debugfs_dump_index; 3272 const struct hisi_sas_debugfs_reg *port = &debugfs_port_reg; 3273 int i, phy_cnt; 3274 u32 offset; 3275 u32 *databuf; 3276 3277 for (phy_cnt = 0; phy_cnt < hisi_hba->n_phy; phy_cnt++) { 3278 databuf = hisi_hba->debugfs_port_reg[dump_index][phy_cnt].data; 3279 for (i = 0; i < port->count; i++, databuf++) { 3280 offset = port->base_off + 4 * i; 3281 *databuf = hisi_sas_phy_read32(hisi_hba, phy_cnt, 3282 offset); 3283 } 3284 } 3285 } 3286 3287 static void debugfs_snapshot_global_reg_v3_hw(struct hisi_hba *hisi_hba) 3288 { 3289 int dump_index = hisi_hba->debugfs_dump_index; 3290 u32 *databuf = hisi_hba->debugfs_regs[dump_index][DEBUGFS_GLOBAL].data; 3291 int i; 3292 3293 for (i = 0; i < debugfs_axi_reg.count; i++, databuf++) 3294 *databuf = hisi_sas_read32(hisi_hba, 4 * i); 3295 } 3296 3297 static void debugfs_snapshot_axi_reg_v3_hw(struct hisi_hba *hisi_hba) 3298 { 3299 int dump_index = hisi_hba->debugfs_dump_index; 3300 u32 *databuf = hisi_hba->debugfs_regs[dump_index][DEBUGFS_AXI].data; 3301 const struct hisi_sas_debugfs_reg *axi = &debugfs_axi_reg; 3302 int i; 3303 3304 for (i = 0; i < axi->count; i++, databuf++) 3305 *databuf = hisi_sas_read32(hisi_hba, 4 * i + axi->base_off); 3306 } 3307 3308 static void debugfs_snapshot_ras_reg_v3_hw(struct hisi_hba *hisi_hba) 3309 { 3310 int dump_index = hisi_hba->debugfs_dump_index; 3311 u32 *databuf = hisi_hba->debugfs_regs[dump_index][DEBUGFS_RAS].data; 3312 const struct hisi_sas_debugfs_reg *ras = &debugfs_ras_reg; 3313 int i; 3314 3315 for (i = 0; i < ras->count; i++, databuf++) 3316 *databuf = hisi_sas_read32(hisi_hba, 4 * i + ras->base_off); 3317 } 3318 3319 static void debugfs_snapshot_itct_reg_v3_hw(struct hisi_hba *hisi_hba) 3320 { 3321 int dump_index = hisi_hba->debugfs_dump_index; 3322 void *cachebuf = hisi_hba->debugfs_itct_cache[dump_index].cache; 3323 void *databuf = hisi_hba->debugfs_itct[dump_index].itct; 3324 struct hisi_sas_itct *itct; 3325 int i; 3326 3327 read_iost_itct_cache_v3_hw(hisi_hba, HISI_SAS_ITCT_CACHE, cachebuf); 3328 3329 itct = hisi_hba->itct; 3330 3331 for (i = 0; i < HISI_SAS_MAX_ITCT_ENTRIES; i++, itct++) { 3332 memcpy(databuf, itct, sizeof(struct hisi_sas_itct)); 3333 databuf += sizeof(struct hisi_sas_itct); 3334 } 3335 } 3336 3337 static void debugfs_snapshot_iost_reg_v3_hw(struct hisi_hba *hisi_hba) 3338 { 3339 int dump_index = hisi_hba->debugfs_dump_index; 3340 int max_command_entries = HISI_SAS_MAX_COMMANDS; 3341 void *cachebuf = hisi_hba->debugfs_iost_cache[dump_index].cache; 3342 void *databuf = hisi_hba->debugfs_iost[dump_index].iost; 3343 struct hisi_sas_iost *iost; 3344 int i; 3345 3346 read_iost_itct_cache_v3_hw(hisi_hba, HISI_SAS_IOST_CACHE, cachebuf); 3347 3348 iost = hisi_hba->iost; 3349 3350 for (i = 0; i < max_command_entries; i++, iost++) { 3351 memcpy(databuf, iost, sizeof(struct hisi_sas_iost)); 3352 databuf += sizeof(struct hisi_sas_iost); 3353 } 3354 } 3355 3356 static const char * 3357 debugfs_to_reg_name_v3_hw(int off, int base_off, 3358 const struct hisi_sas_debugfs_reg_lu *lu) 3359 { 3360 for (; lu->name; lu++) { 3361 if (off == lu->off - base_off) 3362 return lu->name; 3363 } 3364 3365 return NULL; 3366 } 3367 3368 static void debugfs_print_reg_v3_hw(u32 *regs_val, struct seq_file *s, 3369 const struct hisi_sas_debugfs_reg *reg) 3370 { 3371 int i; 3372 3373 for (i = 0; i < reg->count; i++) { 3374 int off = i * 4; 3375 const char *name; 3376 3377 name = debugfs_to_reg_name_v3_hw(off, reg->base_off, 3378 reg->lu); 3379 3380 if (name) 3381 seq_printf(s, "0x%08x 0x%08x %s\n", off, 3382 regs_val[i], name); 3383 else 3384 seq_printf(s, "0x%08x 0x%08x\n", off, 3385 regs_val[i]); 3386 } 3387 } 3388 3389 static int debugfs_global_v3_hw_show(struct seq_file *s, void *p) 3390 { 3391 struct hisi_sas_debugfs_regs *global = s->private; 3392 3393 debugfs_print_reg_v3_hw(global->data, s, 3394 &debugfs_global_reg); 3395 3396 return 0; 3397 } 3398 DEFINE_SHOW_ATTRIBUTE(debugfs_global_v3_hw); 3399 3400 static int debugfs_axi_v3_hw_show(struct seq_file *s, void *p) 3401 { 3402 struct hisi_sas_debugfs_regs *axi = s->private; 3403 3404 debugfs_print_reg_v3_hw(axi->data, s, 3405 &debugfs_axi_reg); 3406 3407 return 0; 3408 } 3409 DEFINE_SHOW_ATTRIBUTE(debugfs_axi_v3_hw); 3410 3411 static int debugfs_ras_v3_hw_show(struct seq_file *s, void *p) 3412 { 3413 struct hisi_sas_debugfs_regs *ras = s->private; 3414 3415 debugfs_print_reg_v3_hw(ras->data, s, 3416 &debugfs_ras_reg); 3417 3418 return 0; 3419 } 3420 DEFINE_SHOW_ATTRIBUTE(debugfs_ras_v3_hw); 3421 3422 static int debugfs_port_v3_hw_show(struct seq_file *s, void *p) 3423 { 3424 struct hisi_sas_debugfs_port *port = s->private; 3425 const struct hisi_sas_debugfs_reg *reg_port = &debugfs_port_reg; 3426 3427 debugfs_print_reg_v3_hw(port->data, s, reg_port); 3428 3429 return 0; 3430 } 3431 DEFINE_SHOW_ATTRIBUTE(debugfs_port_v3_hw); 3432 3433 static void debugfs_show_row_64_v3_hw(struct seq_file *s, int index, 3434 int sz, __le64 *ptr) 3435 { 3436 int i; 3437 3438 /* completion header size not fixed per HW version */ 3439 seq_printf(s, "index %04d:\n\t", index); 3440 for (i = 1; i <= sz / 8; i++, ptr++) { 3441 seq_printf(s, " 0x%016llx", le64_to_cpu(*ptr)); 3442 if (!(i % 2)) 3443 seq_puts(s, "\n\t"); 3444 } 3445 3446 seq_puts(s, "\n"); 3447 } 3448 3449 static void debugfs_show_row_32_v3_hw(struct seq_file *s, int index, 3450 int sz, __le32 *ptr) 3451 { 3452 int i; 3453 3454 /* completion header size not fixed per HW version */ 3455 seq_printf(s, "index %04d:\n\t", index); 3456 for (i = 1; i <= sz / 4; i++, ptr++) { 3457 seq_printf(s, " 0x%08x", le32_to_cpu(*ptr)); 3458 if (!(i % 4)) 3459 seq_puts(s, "\n\t"); 3460 } 3461 seq_puts(s, "\n"); 3462 } 3463 3464 static void debugfs_cq_show_slot_v3_hw(struct seq_file *s, int slot, 3465 struct hisi_sas_debugfs_cq *debugfs_cq) 3466 { 3467 struct hisi_sas_cq *cq = debugfs_cq->cq; 3468 struct hisi_hba *hisi_hba = cq->hisi_hba; 3469 __le32 *complete_hdr = debugfs_cq->complete_hdr + 3470 (hisi_hba->hw->complete_hdr_size * slot); 3471 3472 debugfs_show_row_32_v3_hw(s, slot, 3473 hisi_hba->hw->complete_hdr_size, 3474 complete_hdr); 3475 } 3476 3477 static int debugfs_cq_v3_hw_show(struct seq_file *s, void *p) 3478 { 3479 struct hisi_sas_debugfs_cq *debugfs_cq = s->private; 3480 int slot; 3481 3482 for (slot = 0; slot < HISI_SAS_QUEUE_SLOTS; slot++) 3483 debugfs_cq_show_slot_v3_hw(s, slot, debugfs_cq); 3484 3485 return 0; 3486 } 3487 DEFINE_SHOW_ATTRIBUTE(debugfs_cq_v3_hw); 3488 3489 static void debugfs_dq_show_slot_v3_hw(struct seq_file *s, int slot, 3490 void *dq_ptr) 3491 { 3492 struct hisi_sas_debugfs_dq *debugfs_dq = dq_ptr; 3493 void *cmd_queue = debugfs_dq->hdr; 3494 __le32 *cmd_hdr = cmd_queue + 3495 sizeof(struct hisi_sas_cmd_hdr) * slot; 3496 3497 debugfs_show_row_32_v3_hw(s, slot, sizeof(struct hisi_sas_cmd_hdr), 3498 cmd_hdr); 3499 } 3500 3501 static int debugfs_dq_v3_hw_show(struct seq_file *s, void *p) 3502 { 3503 int slot; 3504 3505 for (slot = 0; slot < HISI_SAS_QUEUE_SLOTS; slot++) 3506 debugfs_dq_show_slot_v3_hw(s, slot, s->private); 3507 3508 return 0; 3509 } 3510 DEFINE_SHOW_ATTRIBUTE(debugfs_dq_v3_hw); 3511 3512 static int debugfs_iost_v3_hw_show(struct seq_file *s, void *p) 3513 { 3514 struct hisi_sas_debugfs_iost *debugfs_iost = s->private; 3515 struct hisi_sas_iost *iost = debugfs_iost->iost; 3516 int i, max_command_entries = HISI_SAS_MAX_COMMANDS; 3517 3518 for (i = 0; i < max_command_entries; i++, iost++) { 3519 __le64 *data = &iost->qw0; 3520 3521 debugfs_show_row_64_v3_hw(s, i, sizeof(*iost), data); 3522 } 3523 3524 return 0; 3525 } 3526 DEFINE_SHOW_ATTRIBUTE(debugfs_iost_v3_hw); 3527 3528 static int debugfs_iost_cache_v3_hw_show(struct seq_file *s, void *p) 3529 { 3530 struct hisi_sas_debugfs_iost_cache *debugfs_iost_cache = s->private; 3531 struct hisi_sas_iost_itct_cache *iost_cache = 3532 debugfs_iost_cache->cache; 3533 u32 cache_size = HISI_SAS_IOST_ITCT_CACHE_DW_SZ * 4; 3534 int i, tab_idx; 3535 __le64 *iost; 3536 3537 for (i = 0; i < HISI_SAS_IOST_ITCT_CACHE_NUM; i++, iost_cache++) { 3538 /* 3539 * Data struct of IOST cache: 3540 * Data[1]: BIT0~15: Table index 3541 * Bit16: Valid mask 3542 * Data[2]~[9]: IOST table 3543 */ 3544 tab_idx = (iost_cache->data[1] & 0xffff); 3545 iost = (__le64 *)iost_cache; 3546 3547 debugfs_show_row_64_v3_hw(s, tab_idx, cache_size, iost); 3548 } 3549 3550 return 0; 3551 } 3552 DEFINE_SHOW_ATTRIBUTE(debugfs_iost_cache_v3_hw); 3553 3554 static int debugfs_itct_v3_hw_show(struct seq_file *s, void *p) 3555 { 3556 int i; 3557 struct hisi_sas_debugfs_itct *debugfs_itct = s->private; 3558 struct hisi_sas_itct *itct = debugfs_itct->itct; 3559 3560 for (i = 0; i < HISI_SAS_MAX_ITCT_ENTRIES; i++, itct++) { 3561 __le64 *data = &itct->qw0; 3562 3563 debugfs_show_row_64_v3_hw(s, i, sizeof(*itct), data); 3564 } 3565 3566 return 0; 3567 } 3568 DEFINE_SHOW_ATTRIBUTE(debugfs_itct_v3_hw); 3569 3570 static int debugfs_itct_cache_v3_hw_show(struct seq_file *s, void *p) 3571 { 3572 struct hisi_sas_debugfs_itct_cache *debugfs_itct_cache = s->private; 3573 struct hisi_sas_iost_itct_cache *itct_cache = 3574 debugfs_itct_cache->cache; 3575 u32 cache_size = HISI_SAS_IOST_ITCT_CACHE_DW_SZ * 4; 3576 int i, tab_idx; 3577 __le64 *itct; 3578 3579 for (i = 0; i < HISI_SAS_IOST_ITCT_CACHE_NUM; i++, itct_cache++) { 3580 /* 3581 * Data struct of ITCT cache: 3582 * Data[1]: BIT0~15: Table index 3583 * Bit16: Valid mask 3584 * Data[2]~[9]: ITCT table 3585 */ 3586 tab_idx = itct_cache->data[1] & 0xffff; 3587 itct = (__le64 *)itct_cache; 3588 3589 debugfs_show_row_64_v3_hw(s, tab_idx, cache_size, itct); 3590 } 3591 3592 return 0; 3593 } 3594 DEFINE_SHOW_ATTRIBUTE(debugfs_itct_cache_v3_hw); 3595 3596 static void debugfs_create_files_v3_hw(struct hisi_hba *hisi_hba) 3597 { 3598 u64 *debugfs_timestamp; 3599 int dump_index = hisi_hba->debugfs_dump_index; 3600 struct dentry *dump_dentry; 3601 struct dentry *dentry; 3602 char name[256]; 3603 int p; 3604 int c; 3605 int d; 3606 3607 snprintf(name, 256, "%d", dump_index); 3608 3609 dump_dentry = debugfs_create_dir(name, hisi_hba->debugfs_dump_dentry); 3610 3611 debugfs_timestamp = &hisi_hba->debugfs_timestamp[dump_index]; 3612 3613 debugfs_create_u64("timestamp", 0400, dump_dentry, 3614 debugfs_timestamp); 3615 3616 debugfs_create_file("global", 0400, dump_dentry, 3617 &hisi_hba->debugfs_regs[dump_index][DEBUGFS_GLOBAL], 3618 &debugfs_global_v3_hw_fops); 3619 3620 /* Create port dir and files */ 3621 dentry = debugfs_create_dir("port", dump_dentry); 3622 for (p = 0; p < hisi_hba->n_phy; p++) { 3623 snprintf(name, 256, "%d", p); 3624 3625 debugfs_create_file(name, 0400, dentry, 3626 &hisi_hba->debugfs_port_reg[dump_index][p], 3627 &debugfs_port_v3_hw_fops); 3628 } 3629 3630 /* Create CQ dir and files */ 3631 dentry = debugfs_create_dir("cq", dump_dentry); 3632 for (c = 0; c < hisi_hba->queue_count; c++) { 3633 snprintf(name, 256, "%d", c); 3634 3635 debugfs_create_file(name, 0400, dentry, 3636 &hisi_hba->debugfs_cq[dump_index][c], 3637 &debugfs_cq_v3_hw_fops); 3638 } 3639 3640 /* Create DQ dir and files */ 3641 dentry = debugfs_create_dir("dq", dump_dentry); 3642 for (d = 0; d < hisi_hba->queue_count; d++) { 3643 snprintf(name, 256, "%d", d); 3644 3645 debugfs_create_file(name, 0400, dentry, 3646 &hisi_hba->debugfs_dq[dump_index][d], 3647 &debugfs_dq_v3_hw_fops); 3648 } 3649 3650 debugfs_create_file("iost", 0400, dump_dentry, 3651 &hisi_hba->debugfs_iost[dump_index], 3652 &debugfs_iost_v3_hw_fops); 3653 3654 debugfs_create_file("iost_cache", 0400, dump_dentry, 3655 &hisi_hba->debugfs_iost_cache[dump_index], 3656 &debugfs_iost_cache_v3_hw_fops); 3657 3658 debugfs_create_file("itct", 0400, dump_dentry, 3659 &hisi_hba->debugfs_itct[dump_index], 3660 &debugfs_itct_v3_hw_fops); 3661 3662 debugfs_create_file("itct_cache", 0400, dump_dentry, 3663 &hisi_hba->debugfs_itct_cache[dump_index], 3664 &debugfs_itct_cache_v3_hw_fops); 3665 3666 debugfs_create_file("axi", 0400, dump_dentry, 3667 &hisi_hba->debugfs_regs[dump_index][DEBUGFS_AXI], 3668 &debugfs_axi_v3_hw_fops); 3669 3670 debugfs_create_file("ras", 0400, dump_dentry, 3671 &hisi_hba->debugfs_regs[dump_index][DEBUGFS_RAS], 3672 &debugfs_ras_v3_hw_fops); 3673 } 3674 3675 static void debugfs_snapshot_regs_v3_hw(struct hisi_hba *hisi_hba) 3676 { 3677 int debugfs_dump_index = hisi_hba->debugfs_dump_index; 3678 struct device *dev = hisi_hba->dev; 3679 u64 timestamp = local_clock(); 3680 3681 if (debugfs_dump_index >= hisi_sas_debugfs_dump_count) { 3682 dev_warn(dev, "dump count exceeded!\n"); 3683 return; 3684 } 3685 3686 do_div(timestamp, NSEC_PER_MSEC); 3687 hisi_hba->debugfs_timestamp[debugfs_dump_index] = timestamp; 3688 3689 debugfs_snapshot_prepare_v3_hw(hisi_hba); 3690 3691 debugfs_snapshot_global_reg_v3_hw(hisi_hba); 3692 debugfs_snapshot_port_reg_v3_hw(hisi_hba); 3693 debugfs_snapshot_axi_reg_v3_hw(hisi_hba); 3694 debugfs_snapshot_ras_reg_v3_hw(hisi_hba); 3695 debugfs_snapshot_cq_reg_v3_hw(hisi_hba); 3696 debugfs_snapshot_dq_reg_v3_hw(hisi_hba); 3697 debugfs_snapshot_itct_reg_v3_hw(hisi_hba); 3698 debugfs_snapshot_iost_reg_v3_hw(hisi_hba); 3699 3700 debugfs_create_files_v3_hw(hisi_hba); 3701 3702 debugfs_snapshot_restore_v3_hw(hisi_hba); 3703 hisi_hba->debugfs_dump_index++; 3704 } 3705 3706 static ssize_t debugfs_trigger_dump_v3_hw_write(struct file *file, 3707 const char __user *user_buf, 3708 size_t count, loff_t *ppos) 3709 { 3710 struct hisi_hba *hisi_hba = file->f_inode->i_private; 3711 char buf[8]; 3712 3713 if (hisi_hba->debugfs_dump_index >= hisi_sas_debugfs_dump_count) 3714 return -EFAULT; 3715 3716 if (count > 8) 3717 return -EFAULT; 3718 3719 if (copy_from_user(buf, user_buf, count)) 3720 return -EFAULT; 3721 3722 if (buf[0] != '1') 3723 return -EFAULT; 3724 3725 queue_work(hisi_hba->wq, &hisi_hba->debugfs_work); 3726 3727 return count; 3728 } 3729 3730 static const struct file_operations debugfs_trigger_dump_v3_hw_fops = { 3731 .write = &debugfs_trigger_dump_v3_hw_write, 3732 .owner = THIS_MODULE, 3733 }; 3734 3735 enum { 3736 HISI_SAS_BIST_LOOPBACK_MODE_DIGITAL = 0, 3737 HISI_SAS_BIST_LOOPBACK_MODE_SERDES, 3738 HISI_SAS_BIST_LOOPBACK_MODE_REMOTE, 3739 }; 3740 3741 static const struct { 3742 int value; 3743 char *name; 3744 } debugfs_loop_linkrate_v3_hw[] = { 3745 { SAS_LINK_RATE_1_5_GBPS, "1.5 Gbit" }, 3746 { SAS_LINK_RATE_3_0_GBPS, "3.0 Gbit" }, 3747 { SAS_LINK_RATE_6_0_GBPS, "6.0 Gbit" }, 3748 { SAS_LINK_RATE_12_0_GBPS, "12.0 Gbit" }, 3749 }; 3750 3751 static int debugfs_bist_linkrate_v3_hw_show(struct seq_file *s, void *p) 3752 { 3753 struct hisi_hba *hisi_hba = s->private; 3754 int i; 3755 3756 for (i = 0; i < ARRAY_SIZE(debugfs_loop_linkrate_v3_hw); i++) { 3757 int match = (hisi_hba->debugfs_bist_linkrate == 3758 debugfs_loop_linkrate_v3_hw[i].value); 3759 3760 seq_printf(s, "%s%s%s ", match ? "[" : "", 3761 debugfs_loop_linkrate_v3_hw[i].name, 3762 match ? "]" : ""); 3763 } 3764 seq_puts(s, "\n"); 3765 3766 return 0; 3767 } 3768 3769 static ssize_t debugfs_bist_linkrate_v3_hw_write(struct file *filp, 3770 const char __user *buf, 3771 size_t count, loff_t *ppos) 3772 { 3773 struct seq_file *m = filp->private_data; 3774 struct hisi_hba *hisi_hba = m->private; 3775 char kbuf[16] = {}, *pkbuf; 3776 bool found = false; 3777 int i; 3778 3779 if (hisi_hba->debugfs_bist_enable) 3780 return -EPERM; 3781 3782 if (count >= sizeof(kbuf)) 3783 return -EOVERFLOW; 3784 3785 if (copy_from_user(kbuf, buf, count)) 3786 return -EINVAL; 3787 3788 pkbuf = strstrip(kbuf); 3789 3790 for (i = 0; i < ARRAY_SIZE(debugfs_loop_linkrate_v3_hw); i++) { 3791 if (!strncmp(debugfs_loop_linkrate_v3_hw[i].name, 3792 pkbuf, 16)) { 3793 hisi_hba->debugfs_bist_linkrate = 3794 debugfs_loop_linkrate_v3_hw[i].value; 3795 found = true; 3796 break; 3797 } 3798 } 3799 3800 if (!found) 3801 return -EINVAL; 3802 3803 return count; 3804 } 3805 3806 static int debugfs_bist_linkrate_v3_hw_open(struct inode *inode, 3807 struct file *filp) 3808 { 3809 return single_open(filp, debugfs_bist_linkrate_v3_hw_show, 3810 inode->i_private); 3811 } 3812 3813 static const struct file_operations debugfs_bist_linkrate_v3_hw_fops = { 3814 .open = debugfs_bist_linkrate_v3_hw_open, 3815 .read = seq_read, 3816 .write = debugfs_bist_linkrate_v3_hw_write, 3817 .llseek = seq_lseek, 3818 .release = single_release, 3819 .owner = THIS_MODULE, 3820 }; 3821 3822 static const struct { 3823 int value; 3824 char *name; 3825 } debugfs_loop_code_mode_v3_hw[] = { 3826 { HISI_SAS_BIST_CODE_MODE_PRBS7, "PRBS7" }, 3827 { HISI_SAS_BIST_CODE_MODE_PRBS23, "PRBS23" }, 3828 { HISI_SAS_BIST_CODE_MODE_PRBS31, "PRBS31" }, 3829 { HISI_SAS_BIST_CODE_MODE_JTPAT, "JTPAT" }, 3830 { HISI_SAS_BIST_CODE_MODE_CJTPAT, "CJTPAT" }, 3831 { HISI_SAS_BIST_CODE_MODE_SCRAMBED_0, "SCRAMBED_0" }, 3832 { HISI_SAS_BIST_CODE_MODE_TRAIN, "TRAIN" }, 3833 { HISI_SAS_BIST_CODE_MODE_TRAIN_DONE, "TRAIN_DONE" }, 3834 { HISI_SAS_BIST_CODE_MODE_HFTP, "HFTP" }, 3835 { HISI_SAS_BIST_CODE_MODE_MFTP, "MFTP" }, 3836 { HISI_SAS_BIST_CODE_MODE_LFTP, "LFTP" }, 3837 { HISI_SAS_BIST_CODE_MODE_FIXED_DATA, "FIXED_DATA" }, 3838 }; 3839 3840 static int debugfs_bist_code_mode_v3_hw_show(struct seq_file *s, void *p) 3841 { 3842 struct hisi_hba *hisi_hba = s->private; 3843 int i; 3844 3845 for (i = 0; i < ARRAY_SIZE(debugfs_loop_code_mode_v3_hw); i++) { 3846 int match = (hisi_hba->debugfs_bist_code_mode == 3847 debugfs_loop_code_mode_v3_hw[i].value); 3848 3849 seq_printf(s, "%s%s%s ", match ? "[" : "", 3850 debugfs_loop_code_mode_v3_hw[i].name, 3851 match ? "]" : ""); 3852 } 3853 seq_puts(s, "\n"); 3854 3855 return 0; 3856 } 3857 3858 static ssize_t debugfs_bist_code_mode_v3_hw_write(struct file *filp, 3859 const char __user *buf, 3860 size_t count, 3861 loff_t *ppos) 3862 { 3863 struct seq_file *m = filp->private_data; 3864 struct hisi_hba *hisi_hba = m->private; 3865 char kbuf[16] = {}, *pkbuf; 3866 bool found = false; 3867 int i; 3868 3869 if (hisi_hba->debugfs_bist_enable) 3870 return -EPERM; 3871 3872 if (count >= sizeof(kbuf)) 3873 return -EINVAL; 3874 3875 if (copy_from_user(kbuf, buf, count)) 3876 return -EOVERFLOW; 3877 3878 pkbuf = strstrip(kbuf); 3879 3880 for (i = 0; i < ARRAY_SIZE(debugfs_loop_code_mode_v3_hw); i++) { 3881 if (!strncmp(debugfs_loop_code_mode_v3_hw[i].name, 3882 pkbuf, 16)) { 3883 hisi_hba->debugfs_bist_code_mode = 3884 debugfs_loop_code_mode_v3_hw[i].value; 3885 found = true; 3886 break; 3887 } 3888 } 3889 3890 if (!found) 3891 return -EINVAL; 3892 3893 return count; 3894 } 3895 3896 static int debugfs_bist_code_mode_v3_hw_open(struct inode *inode, 3897 struct file *filp) 3898 { 3899 return single_open(filp, debugfs_bist_code_mode_v3_hw_show, 3900 inode->i_private); 3901 } 3902 3903 static const struct file_operations debugfs_bist_code_mode_v3_hw_fops = { 3904 .open = debugfs_bist_code_mode_v3_hw_open, 3905 .read = seq_read, 3906 .write = debugfs_bist_code_mode_v3_hw_write, 3907 .llseek = seq_lseek, 3908 .release = single_release, 3909 .owner = THIS_MODULE, 3910 }; 3911 3912 static ssize_t debugfs_bist_phy_v3_hw_write(struct file *filp, 3913 const char __user *buf, 3914 size_t count, loff_t *ppos) 3915 { 3916 struct seq_file *m = filp->private_data; 3917 struct hisi_hba *hisi_hba = m->private; 3918 unsigned int phy_no; 3919 int val; 3920 3921 if (hisi_hba->debugfs_bist_enable) 3922 return -EPERM; 3923 3924 val = kstrtouint_from_user(buf, count, 0, &phy_no); 3925 if (val) 3926 return val; 3927 3928 if (phy_no >= hisi_hba->n_phy) 3929 return -EINVAL; 3930 3931 hisi_hba->debugfs_bist_phy_no = phy_no; 3932 3933 return count; 3934 } 3935 3936 static int debugfs_bist_phy_v3_hw_show(struct seq_file *s, void *p) 3937 { 3938 struct hisi_hba *hisi_hba = s->private; 3939 3940 seq_printf(s, "%d\n", hisi_hba->debugfs_bist_phy_no); 3941 3942 return 0; 3943 } 3944 3945 static int debugfs_bist_phy_v3_hw_open(struct inode *inode, 3946 struct file *filp) 3947 { 3948 return single_open(filp, debugfs_bist_phy_v3_hw_show, 3949 inode->i_private); 3950 } 3951 3952 static const struct file_operations debugfs_bist_phy_v3_hw_fops = { 3953 .open = debugfs_bist_phy_v3_hw_open, 3954 .read = seq_read, 3955 .write = debugfs_bist_phy_v3_hw_write, 3956 .llseek = seq_lseek, 3957 .release = single_release, 3958 .owner = THIS_MODULE, 3959 }; 3960 3961 static const struct { 3962 int value; 3963 char *name; 3964 } debugfs_loop_modes_v3_hw[] = { 3965 { HISI_SAS_BIST_LOOPBACK_MODE_DIGITAL, "digital" }, 3966 { HISI_SAS_BIST_LOOPBACK_MODE_SERDES, "serdes" }, 3967 { HISI_SAS_BIST_LOOPBACK_MODE_REMOTE, "remote" }, 3968 }; 3969 3970 static int debugfs_bist_mode_v3_hw_show(struct seq_file *s, void *p) 3971 { 3972 struct hisi_hba *hisi_hba = s->private; 3973 int i; 3974 3975 for (i = 0; i < ARRAY_SIZE(debugfs_loop_modes_v3_hw); i++) { 3976 int match = (hisi_hba->debugfs_bist_mode == 3977 debugfs_loop_modes_v3_hw[i].value); 3978 3979 seq_printf(s, "%s%s%s ", match ? "[" : "", 3980 debugfs_loop_modes_v3_hw[i].name, 3981 match ? "]" : ""); 3982 } 3983 seq_puts(s, "\n"); 3984 3985 return 0; 3986 } 3987 3988 static ssize_t debugfs_bist_mode_v3_hw_write(struct file *filp, 3989 const char __user *buf, 3990 size_t count, loff_t *ppos) 3991 { 3992 struct seq_file *m = filp->private_data; 3993 struct hisi_hba *hisi_hba = m->private; 3994 char kbuf[16] = {}, *pkbuf; 3995 bool found = false; 3996 int i; 3997 3998 if (hisi_hba->debugfs_bist_enable) 3999 return -EPERM; 4000 4001 if (count >= sizeof(kbuf)) 4002 return -EINVAL; 4003 4004 if (copy_from_user(kbuf, buf, count)) 4005 return -EOVERFLOW; 4006 4007 pkbuf = strstrip(kbuf); 4008 4009 for (i = 0; i < ARRAY_SIZE(debugfs_loop_modes_v3_hw); i++) { 4010 if (!strncmp(debugfs_loop_modes_v3_hw[i].name, pkbuf, 16)) { 4011 hisi_hba->debugfs_bist_mode = 4012 debugfs_loop_modes_v3_hw[i].value; 4013 found = true; 4014 break; 4015 } 4016 } 4017 4018 if (!found) 4019 return -EINVAL; 4020 4021 return count; 4022 } 4023 4024 static int debugfs_bist_mode_v3_hw_open(struct inode *inode, 4025 struct file *filp) 4026 { 4027 return single_open(filp, debugfs_bist_mode_v3_hw_show, 4028 inode->i_private); 4029 } 4030 4031 static const struct file_operations debugfs_bist_mode_v3_hw_fops = { 4032 .open = debugfs_bist_mode_v3_hw_open, 4033 .read = seq_read, 4034 .write = debugfs_bist_mode_v3_hw_write, 4035 .llseek = seq_lseek, 4036 .release = single_release, 4037 .owner = THIS_MODULE, 4038 }; 4039 4040 static ssize_t debugfs_bist_enable_v3_hw_write(struct file *filp, 4041 const char __user *buf, 4042 size_t count, loff_t *ppos) 4043 { 4044 struct seq_file *m = filp->private_data; 4045 struct hisi_hba *hisi_hba = m->private; 4046 unsigned int enable; 4047 int val; 4048 4049 val = kstrtouint_from_user(buf, count, 0, &enable); 4050 if (val) 4051 return val; 4052 4053 if (enable > 1) 4054 return -EINVAL; 4055 4056 if (enable == hisi_hba->debugfs_bist_enable) 4057 return count; 4058 4059 val = debugfs_set_bist_v3_hw(hisi_hba, enable); 4060 if (val < 0) 4061 return val; 4062 4063 hisi_hba->debugfs_bist_enable = enable; 4064 4065 return count; 4066 } 4067 4068 static int debugfs_bist_enable_v3_hw_show(struct seq_file *s, void *p) 4069 { 4070 struct hisi_hba *hisi_hba = s->private; 4071 4072 seq_printf(s, "%d\n", hisi_hba->debugfs_bist_enable); 4073 4074 return 0; 4075 } 4076 4077 static int debugfs_bist_enable_v3_hw_open(struct inode *inode, 4078 struct file *filp) 4079 { 4080 return single_open(filp, debugfs_bist_enable_v3_hw_show, 4081 inode->i_private); 4082 } 4083 4084 static const struct file_operations debugfs_bist_enable_v3_hw_fops = { 4085 .open = debugfs_bist_enable_v3_hw_open, 4086 .read = seq_read, 4087 .write = debugfs_bist_enable_v3_hw_write, 4088 .llseek = seq_lseek, 4089 .release = single_release, 4090 .owner = THIS_MODULE, 4091 }; 4092 4093 static const struct { 4094 char *name; 4095 } debugfs_ffe_name_v3_hw[FFE_CFG_MAX] = { 4096 { "SAS_1_5_GBPS" }, 4097 { "SAS_3_0_GBPS" }, 4098 { "SAS_6_0_GBPS" }, 4099 { "SAS_12_0_GBPS" }, 4100 { "FFE_RESV" }, 4101 { "SATA_1_5_GBPS" }, 4102 { "SATA_3_0_GBPS" }, 4103 { "SATA_6_0_GBPS" }, 4104 }; 4105 4106 static ssize_t debugfs_v3_hw_write(struct file *filp, 4107 const char __user *buf, 4108 size_t count, loff_t *ppos) 4109 { 4110 struct seq_file *m = filp->private_data; 4111 u32 *val = m->private; 4112 int res; 4113 4114 res = kstrtouint_from_user(buf, count, 0, val); 4115 if (res) 4116 return res; 4117 4118 return count; 4119 } 4120 4121 static int debugfs_v3_hw_show(struct seq_file *s, void *p) 4122 { 4123 u32 *val = s->private; 4124 4125 seq_printf(s, "0x%x\n", *val); 4126 4127 return 0; 4128 } 4129 4130 static int debugfs_v3_hw_open(struct inode *inode, struct file *filp) 4131 { 4132 return single_open(filp, debugfs_v3_hw_show, 4133 inode->i_private); 4134 } 4135 4136 static const struct file_operations debugfs_v3_hw_fops = { 4137 .open = debugfs_v3_hw_open, 4138 .read = seq_read, 4139 .write = debugfs_v3_hw_write, 4140 .llseek = seq_lseek, 4141 .release = single_release, 4142 .owner = THIS_MODULE, 4143 }; 4144 4145 static ssize_t debugfs_phy_down_cnt_v3_hw_write(struct file *filp, 4146 const char __user *buf, 4147 size_t count, loff_t *ppos) 4148 { 4149 struct seq_file *s = filp->private_data; 4150 struct hisi_sas_phy *phy = s->private; 4151 unsigned int set_val; 4152 int res; 4153 4154 res = kstrtouint_from_user(buf, count, 0, &set_val); 4155 if (res) 4156 return res; 4157 4158 if (set_val > 0) 4159 return -EINVAL; 4160 4161 atomic_set(&phy->down_cnt, 0); 4162 4163 return count; 4164 } 4165 4166 static int debugfs_phy_down_cnt_v3_hw_show(struct seq_file *s, void *p) 4167 { 4168 struct hisi_sas_phy *phy = s->private; 4169 4170 seq_printf(s, "%d\n", atomic_read(&phy->down_cnt)); 4171 4172 return 0; 4173 } 4174 4175 static int debugfs_phy_down_cnt_v3_hw_open(struct inode *inode, 4176 struct file *filp) 4177 { 4178 return single_open(filp, debugfs_phy_down_cnt_v3_hw_show, 4179 inode->i_private); 4180 } 4181 4182 static const struct file_operations debugfs_phy_down_cnt_v3_hw_fops = { 4183 .open = debugfs_phy_down_cnt_v3_hw_open, 4184 .read = seq_read, 4185 .write = debugfs_phy_down_cnt_v3_hw_write, 4186 .llseek = seq_lseek, 4187 .release = single_release, 4188 .owner = THIS_MODULE, 4189 }; 4190 4191 enum fifo_dump_mode_v3_hw { 4192 FIFO_DUMP_FORVER = (1U << 0), 4193 FIFO_DUMP_AFTER_TRIGGER = (1U << 1), 4194 FIFO_DUMP_UNTILL_TRIGGER = (1U << 2), 4195 }; 4196 4197 enum fifo_trigger_mode_v3_hw { 4198 FIFO_TRIGGER_EDGE = (1U << 0), 4199 FIFO_TRIGGER_SAME_LEVEL = (1U << 1), 4200 FIFO_TRIGGER_DIFF_LEVEL = (1U << 2), 4201 }; 4202 4203 static int debugfs_is_fifo_config_valid_v3_hw(struct hisi_sas_phy *phy) 4204 { 4205 struct hisi_hba *hisi_hba = phy->hisi_hba; 4206 4207 if (phy->fifo.signal_sel > 0xf) { 4208 dev_info(hisi_hba->dev, "Invalid signal select: %u\n", 4209 phy->fifo.signal_sel); 4210 return -EINVAL; 4211 } 4212 4213 switch (phy->fifo.dump_mode) { 4214 case FIFO_DUMP_FORVER: 4215 case FIFO_DUMP_AFTER_TRIGGER: 4216 case FIFO_DUMP_UNTILL_TRIGGER: 4217 break; 4218 default: 4219 dev_info(hisi_hba->dev, "Invalid dump mode: %u\n", 4220 phy->fifo.dump_mode); 4221 return -EINVAL; 4222 } 4223 4224 /* when FIFO_DUMP_FORVER, no need to check trigger_mode */ 4225 if (phy->fifo.dump_mode == FIFO_DUMP_FORVER) 4226 return 0; 4227 4228 switch (phy->fifo.trigger_mode) { 4229 case FIFO_TRIGGER_EDGE: 4230 case FIFO_TRIGGER_SAME_LEVEL: 4231 case FIFO_TRIGGER_DIFF_LEVEL: 4232 break; 4233 default: 4234 dev_info(hisi_hba->dev, "Invalid trigger mode: %u\n", 4235 phy->fifo.trigger_mode); 4236 return -EINVAL; 4237 } 4238 return 0; 4239 } 4240 4241 static int debugfs_update_fifo_config_v3_hw(struct hisi_sas_phy *phy) 4242 { 4243 u32 trigger_mode = phy->fifo.trigger_mode; 4244 u32 signal_sel = phy->fifo.signal_sel; 4245 u32 dump_mode = phy->fifo.dump_mode; 4246 struct hisi_hba *hisi_hba = phy->hisi_hba; 4247 int phy_no = phy->sas_phy.id; 4248 u32 reg_val; 4249 int res; 4250 4251 /* Check the validity of trace FIFO configuration */ 4252 res = debugfs_is_fifo_config_valid_v3_hw(phy); 4253 if (res) 4254 return res; 4255 4256 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_CTRL); 4257 /* Disable trace FIFO before update configuration */ 4258 reg_val |= DFX_FIFO_CTRL_DUMP_DISABLE_MSK; 4259 4260 /* Update trace FIFO configuration */ 4261 reg_val &= ~(DFX_FIFO_CTRL_DUMP_MODE_MSK | 4262 DFX_FIFO_CTRL_SIGNAL_SEL_MSK | 4263 DFX_FIFO_CTRL_TRIGGER_MODE_MSK); 4264 4265 reg_val |= ((trigger_mode << DFX_FIFO_CTRL_TRIGGER_MODE_OFF) | 4266 (dump_mode << DFX_FIFO_CTRL_DUMP_MODE_OFF) | 4267 (signal_sel << DFX_FIFO_CTRL_SIGNAL_SEL_OFF)); 4268 hisi_sas_phy_write32(hisi_hba, phy_no, DFX_FIFO_CTRL, reg_val); 4269 4270 hisi_sas_phy_write32(hisi_hba, phy_no, DFX_FIFO_DUMP_MSK, 4271 phy->fifo.dump_msk); 4272 4273 hisi_sas_phy_write32(hisi_hba, phy_no, DFX_FIFO_TRIGGER, 4274 phy->fifo.trigger); 4275 4276 hisi_sas_phy_write32(hisi_hba, phy_no, DFX_FIFO_TRIGGER_MSK, 4277 phy->fifo.trigger_msk); 4278 4279 /* Enable trace FIFO after updated configuration */ 4280 reg_val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_CTRL); 4281 reg_val &= ~DFX_FIFO_CTRL_DUMP_DISABLE_MSK; 4282 hisi_sas_phy_write32(hisi_hba, phy_no, DFX_FIFO_CTRL, reg_val); 4283 4284 return 0; 4285 } 4286 4287 static ssize_t debugfs_fifo_update_cfg_v3_hw_write(struct file *filp, 4288 const char __user *buf, 4289 size_t count, loff_t *ppos) 4290 { 4291 struct hisi_sas_phy *phy = filp->private_data; 4292 bool update; 4293 int val; 4294 4295 val = kstrtobool_from_user(buf, count, &update); 4296 if (val) 4297 return val; 4298 4299 if (update != 1) 4300 return -EINVAL; 4301 4302 val = debugfs_update_fifo_config_v3_hw(phy); 4303 if (val) 4304 return val; 4305 4306 return count; 4307 } 4308 4309 static const struct file_operations debugfs_fifo_update_cfg_v3_hw_fops = { 4310 .open = simple_open, 4311 .write = debugfs_fifo_update_cfg_v3_hw_write, 4312 .owner = THIS_MODULE, 4313 }; 4314 4315 static void debugfs_read_fifo_data_v3_hw(struct hisi_sas_phy *phy) 4316 { 4317 struct hisi_hba *hisi_hba = phy->hisi_hba; 4318 u32 *buf = phy->fifo.rd_data; 4319 int phy_no = phy->sas_phy.id; 4320 u32 val; 4321 int i; 4322 4323 memset(buf, 0, sizeof(phy->fifo.rd_data)); 4324 4325 /* Disable trace FIFO before read data */ 4326 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_CTRL); 4327 val |= DFX_FIFO_CTRL_DUMP_DISABLE_MSK; 4328 hisi_sas_phy_write32(hisi_hba, phy_no, DFX_FIFO_CTRL, val); 4329 4330 for (i = 0; i < HISI_SAS_FIFO_DATA_DW_SIZE; i++) { 4331 val = hisi_sas_phy_read32(hisi_hba, phy_no, 4332 DFX_FIFO_RD_DATA); 4333 buf[i] = val; 4334 } 4335 4336 /* Enable trace FIFO after read data */ 4337 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_CTRL); 4338 val &= ~DFX_FIFO_CTRL_DUMP_DISABLE_MSK; 4339 hisi_sas_phy_write32(hisi_hba, phy_no, DFX_FIFO_CTRL, val); 4340 } 4341 4342 static int debugfs_fifo_data_v3_hw_show(struct seq_file *s, void *p) 4343 { 4344 struct hisi_sas_phy *phy = s->private; 4345 4346 debugfs_read_fifo_data_v3_hw(phy); 4347 4348 debugfs_show_row_32_v3_hw(s, 0, HISI_SAS_FIFO_DATA_DW_SIZE * 4, 4349 phy->fifo.rd_data); 4350 4351 return 0; 4352 } 4353 DEFINE_SHOW_ATTRIBUTE(debugfs_fifo_data_v3_hw); 4354 4355 static void debugfs_fifo_init_v3_hw(struct hisi_hba *hisi_hba) 4356 { 4357 int phy_no; 4358 4359 hisi_hba->debugfs_fifo_dentry = 4360 debugfs_create_dir("fifo", hisi_hba->debugfs_dir); 4361 4362 for (phy_no = 0; phy_no < hisi_hba->n_phy; phy_no++) { 4363 struct hisi_sas_phy *phy = &hisi_hba->phy[phy_no]; 4364 struct dentry *port_dentry; 4365 char name[256]; 4366 u32 val; 4367 4368 /* get default configuration for trace FIFO */ 4369 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_CTRL); 4370 val &= DFX_FIFO_CTRL_DUMP_MODE_MSK; 4371 val >>= DFX_FIFO_CTRL_DUMP_MODE_OFF; 4372 phy->fifo.dump_mode = val; 4373 4374 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_CTRL); 4375 val &= DFX_FIFO_CTRL_TRIGGER_MODE_MSK; 4376 val >>= DFX_FIFO_CTRL_TRIGGER_MODE_OFF; 4377 phy->fifo.trigger_mode = val; 4378 4379 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_CTRL); 4380 val &= DFX_FIFO_CTRL_SIGNAL_SEL_MSK; 4381 val >>= DFX_FIFO_CTRL_SIGNAL_SEL_OFF; 4382 phy->fifo.signal_sel = val; 4383 4384 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_DUMP_MSK); 4385 phy->fifo.dump_msk = val; 4386 4387 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_TRIGGER); 4388 phy->fifo.trigger = val; 4389 val = hisi_sas_phy_read32(hisi_hba, phy_no, DFX_FIFO_TRIGGER_MSK); 4390 phy->fifo.trigger_msk = val; 4391 4392 snprintf(name, 256, "%d", phy_no); 4393 port_dentry = debugfs_create_dir(name, 4394 hisi_hba->debugfs_fifo_dentry); 4395 4396 debugfs_create_file("update_config", 0200, port_dentry, phy, 4397 &debugfs_fifo_update_cfg_v3_hw_fops); 4398 4399 debugfs_create_file("signal_sel", 0600, port_dentry, 4400 &phy->fifo.signal_sel, 4401 &debugfs_v3_hw_fops); 4402 4403 debugfs_create_file("dump_msk", 0600, port_dentry, 4404 &phy->fifo.dump_msk, 4405 &debugfs_v3_hw_fops); 4406 4407 debugfs_create_file("dump_mode", 0600, port_dentry, 4408 &phy->fifo.dump_mode, 4409 &debugfs_v3_hw_fops); 4410 4411 debugfs_create_file("trigger_mode", 0600, port_dentry, 4412 &phy->fifo.trigger_mode, 4413 &debugfs_v3_hw_fops); 4414 4415 debugfs_create_file("trigger", 0600, port_dentry, 4416 &phy->fifo.trigger, 4417 &debugfs_v3_hw_fops); 4418 4419 debugfs_create_file("trigger_msk", 0600, port_dentry, 4420 &phy->fifo.trigger_msk, 4421 &debugfs_v3_hw_fops); 4422 4423 debugfs_create_file("fifo_data", 0400, port_dentry, phy, 4424 &debugfs_fifo_data_v3_hw_fops); 4425 } 4426 } 4427 4428 static void debugfs_work_handler_v3_hw(struct work_struct *work) 4429 { 4430 struct hisi_hba *hisi_hba = 4431 container_of(work, struct hisi_hba, debugfs_work); 4432 4433 debugfs_snapshot_regs_v3_hw(hisi_hba); 4434 } 4435 4436 static void debugfs_release_v3_hw(struct hisi_hba *hisi_hba, int dump_index) 4437 { 4438 struct device *dev = hisi_hba->dev; 4439 int i; 4440 4441 devm_kfree(dev, hisi_hba->debugfs_iost_cache[dump_index].cache); 4442 devm_kfree(dev, hisi_hba->debugfs_itct_cache[dump_index].cache); 4443 devm_kfree(dev, hisi_hba->debugfs_iost[dump_index].iost); 4444 devm_kfree(dev, hisi_hba->debugfs_itct[dump_index].itct); 4445 4446 for (i = 0; i < hisi_hba->queue_count; i++) 4447 devm_kfree(dev, hisi_hba->debugfs_dq[dump_index][i].hdr); 4448 4449 for (i = 0; i < hisi_hba->queue_count; i++) 4450 devm_kfree(dev, 4451 hisi_hba->debugfs_cq[dump_index][i].complete_hdr); 4452 4453 for (i = 0; i < DEBUGFS_REGS_NUM; i++) 4454 devm_kfree(dev, hisi_hba->debugfs_regs[dump_index][i].data); 4455 4456 for (i = 0; i < hisi_hba->n_phy; i++) 4457 devm_kfree(dev, hisi_hba->debugfs_port_reg[dump_index][i].data); 4458 } 4459 4460 static const struct hisi_sas_debugfs_reg *debugfs_reg_array_v3_hw[DEBUGFS_REGS_NUM] = { 4461 [DEBUGFS_GLOBAL] = &debugfs_global_reg, 4462 [DEBUGFS_AXI] = &debugfs_axi_reg, 4463 [DEBUGFS_RAS] = &debugfs_ras_reg, 4464 }; 4465 4466 static int debugfs_alloc_v3_hw(struct hisi_hba *hisi_hba, int dump_index) 4467 { 4468 const struct hisi_sas_hw *hw = hisi_hba->hw; 4469 struct device *dev = hisi_hba->dev; 4470 int p, c, d, r, i; 4471 size_t sz; 4472 4473 for (r = 0; r < DEBUGFS_REGS_NUM; r++) { 4474 struct hisi_sas_debugfs_regs *regs = 4475 &hisi_hba->debugfs_regs[dump_index][r]; 4476 4477 sz = debugfs_reg_array_v3_hw[r]->count * 4; 4478 regs->data = devm_kmalloc(dev, sz, GFP_KERNEL); 4479 if (!regs->data) 4480 goto fail; 4481 regs->hisi_hba = hisi_hba; 4482 } 4483 4484 sz = debugfs_port_reg.count * 4; 4485 for (p = 0; p < hisi_hba->n_phy; p++) { 4486 struct hisi_sas_debugfs_port *port = 4487 &hisi_hba->debugfs_port_reg[dump_index][p]; 4488 4489 port->data = devm_kmalloc(dev, sz, GFP_KERNEL); 4490 if (!port->data) 4491 goto fail; 4492 port->phy = &hisi_hba->phy[p]; 4493 } 4494 4495 sz = hw->complete_hdr_size * HISI_SAS_QUEUE_SLOTS; 4496 for (c = 0; c < hisi_hba->queue_count; c++) { 4497 struct hisi_sas_debugfs_cq *cq = 4498 &hisi_hba->debugfs_cq[dump_index][c]; 4499 4500 cq->complete_hdr = devm_kmalloc(dev, sz, GFP_KERNEL); 4501 if (!cq->complete_hdr) 4502 goto fail; 4503 cq->cq = &hisi_hba->cq[c]; 4504 } 4505 4506 sz = sizeof(struct hisi_sas_cmd_hdr) * HISI_SAS_QUEUE_SLOTS; 4507 for (d = 0; d < hisi_hba->queue_count; d++) { 4508 struct hisi_sas_debugfs_dq *dq = 4509 &hisi_hba->debugfs_dq[dump_index][d]; 4510 4511 dq->hdr = devm_kmalloc(dev, sz, GFP_KERNEL); 4512 if (!dq->hdr) 4513 goto fail; 4514 dq->dq = &hisi_hba->dq[d]; 4515 } 4516 4517 sz = HISI_SAS_MAX_COMMANDS * sizeof(struct hisi_sas_iost); 4518 4519 hisi_hba->debugfs_iost[dump_index].iost = 4520 devm_kmalloc(dev, sz, GFP_KERNEL); 4521 if (!hisi_hba->debugfs_iost[dump_index].iost) 4522 goto fail; 4523 4524 sz = HISI_SAS_IOST_ITCT_CACHE_NUM * 4525 sizeof(struct hisi_sas_iost_itct_cache); 4526 4527 hisi_hba->debugfs_iost_cache[dump_index].cache = 4528 devm_kmalloc(dev, sz, GFP_KERNEL); 4529 if (!hisi_hba->debugfs_iost_cache[dump_index].cache) 4530 goto fail; 4531 4532 sz = HISI_SAS_IOST_ITCT_CACHE_NUM * 4533 sizeof(struct hisi_sas_iost_itct_cache); 4534 4535 hisi_hba->debugfs_itct_cache[dump_index].cache = 4536 devm_kmalloc(dev, sz, GFP_KERNEL); 4537 if (!hisi_hba->debugfs_itct_cache[dump_index].cache) 4538 goto fail; 4539 4540 /* New memory allocation must be locate before itct */ 4541 sz = HISI_SAS_MAX_ITCT_ENTRIES * sizeof(struct hisi_sas_itct); 4542 4543 hisi_hba->debugfs_itct[dump_index].itct = 4544 devm_kmalloc(dev, sz, GFP_KERNEL); 4545 if (!hisi_hba->debugfs_itct[dump_index].itct) 4546 goto fail; 4547 4548 return 0; 4549 fail: 4550 for (i = 0; i < hisi_sas_debugfs_dump_count; i++) 4551 debugfs_release_v3_hw(hisi_hba, i); 4552 return -ENOMEM; 4553 } 4554 4555 static void debugfs_phy_down_cnt_init_v3_hw(struct hisi_hba *hisi_hba) 4556 { 4557 struct dentry *dir = debugfs_create_dir("phy_down_cnt", 4558 hisi_hba->debugfs_dir); 4559 char name[16]; 4560 int phy_no; 4561 4562 for (phy_no = 0; phy_no < hisi_hba->n_phy; phy_no++) { 4563 snprintf(name, 16, "%d", phy_no); 4564 debugfs_create_file(name, 0600, dir, 4565 &hisi_hba->phy[phy_no], 4566 &debugfs_phy_down_cnt_v3_hw_fops); 4567 } 4568 } 4569 4570 static void debugfs_bist_init_v3_hw(struct hisi_hba *hisi_hba) 4571 { 4572 struct dentry *ports_dentry; 4573 int phy_no; 4574 4575 hisi_hba->debugfs_bist_dentry = 4576 debugfs_create_dir("bist", hisi_hba->debugfs_dir); 4577 debugfs_create_file("link_rate", 0600, 4578 hisi_hba->debugfs_bist_dentry, hisi_hba, 4579 &debugfs_bist_linkrate_v3_hw_fops); 4580 4581 debugfs_create_file("code_mode", 0600, 4582 hisi_hba->debugfs_bist_dentry, hisi_hba, 4583 &debugfs_bist_code_mode_v3_hw_fops); 4584 4585 debugfs_create_file("fixed_code", 0600, 4586 hisi_hba->debugfs_bist_dentry, 4587 &hisi_hba->debugfs_bist_fixed_code[0], 4588 &debugfs_v3_hw_fops); 4589 4590 debugfs_create_file("fixed_code_1", 0600, 4591 hisi_hba->debugfs_bist_dentry, 4592 &hisi_hba->debugfs_bist_fixed_code[1], 4593 &debugfs_v3_hw_fops); 4594 4595 debugfs_create_file("phy_id", 0600, hisi_hba->debugfs_bist_dentry, 4596 hisi_hba, &debugfs_bist_phy_v3_hw_fops); 4597 4598 debugfs_create_u32("cnt", 0600, hisi_hba->debugfs_bist_dentry, 4599 &hisi_hba->debugfs_bist_cnt); 4600 4601 debugfs_create_file("loopback_mode", 0600, 4602 hisi_hba->debugfs_bist_dentry, 4603 hisi_hba, &debugfs_bist_mode_v3_hw_fops); 4604 4605 debugfs_create_file("enable", 0600, hisi_hba->debugfs_bist_dentry, 4606 hisi_hba, &debugfs_bist_enable_v3_hw_fops); 4607 4608 ports_dentry = debugfs_create_dir("port", hisi_hba->debugfs_bist_dentry); 4609 4610 for (phy_no = 0; phy_no < hisi_hba->n_phy; phy_no++) { 4611 struct dentry *port_dentry; 4612 struct dentry *ffe_dentry; 4613 char name[256]; 4614 int i; 4615 4616 snprintf(name, 256, "%d", phy_no); 4617 port_dentry = debugfs_create_dir(name, ports_dentry); 4618 ffe_dentry = debugfs_create_dir("ffe", port_dentry); 4619 for (i = 0; i < FFE_CFG_MAX; i++) { 4620 if (i == FFE_RESV) 4621 continue; 4622 debugfs_create_file(debugfs_ffe_name_v3_hw[i].name, 4623 0600, ffe_dentry, 4624 &hisi_hba->debugfs_bist_ffe[phy_no][i], 4625 &debugfs_v3_hw_fops); 4626 } 4627 } 4628 4629 hisi_hba->debugfs_bist_linkrate = SAS_LINK_RATE_1_5_GBPS; 4630 } 4631 4632 static void debugfs_init_v3_hw(struct hisi_hba *hisi_hba) 4633 { 4634 struct device *dev = hisi_hba->dev; 4635 int i; 4636 4637 hisi_hba->debugfs_dir = debugfs_create_dir(dev_name(dev), 4638 hisi_sas_debugfs_dir); 4639 debugfs_create_file("trigger_dump", 0200, 4640 hisi_hba->debugfs_dir, 4641 hisi_hba, 4642 &debugfs_trigger_dump_v3_hw_fops); 4643 4644 /* create bist structures */ 4645 debugfs_bist_init_v3_hw(hisi_hba); 4646 4647 hisi_hba->debugfs_dump_dentry = 4648 debugfs_create_dir("dump", hisi_hba->debugfs_dir); 4649 4650 debugfs_phy_down_cnt_init_v3_hw(hisi_hba); 4651 debugfs_fifo_init_v3_hw(hisi_hba); 4652 4653 for (i = 0; i < hisi_sas_debugfs_dump_count; i++) { 4654 if (debugfs_alloc_v3_hw(hisi_hba, i)) { 4655 debugfs_remove_recursive(hisi_hba->debugfs_dir); 4656 dev_dbg(dev, "failed to init debugfs!\n"); 4657 break; 4658 } 4659 } 4660 } 4661 4662 static void debugfs_exit_v3_hw(struct hisi_hba *hisi_hba) 4663 { 4664 debugfs_remove_recursive(hisi_hba->debugfs_dir); 4665 } 4666 4667 static int 4668 hisi_sas_v3_probe(struct pci_dev *pdev, const struct pci_device_id *id) 4669 { 4670 struct Scsi_Host *shost; 4671 struct hisi_hba *hisi_hba; 4672 struct device *dev = &pdev->dev; 4673 struct asd_sas_phy **arr_phy; 4674 struct asd_sas_port **arr_port; 4675 struct sas_ha_struct *sha; 4676 int rc, phy_nr, port_nr, i; 4677 4678 rc = pcim_enable_device(pdev); 4679 if (rc) 4680 goto err_out; 4681 4682 pci_set_master(pdev); 4683 4684 rc = pcim_iomap_regions(pdev, 1 << BAR_NO_V3_HW, DRV_NAME); 4685 if (rc) 4686 goto err_out; 4687 4688 rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(64)); 4689 if (rc) 4690 rc = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32)); 4691 if (rc) { 4692 dev_err(dev, "No usable DMA addressing method\n"); 4693 rc = -ENODEV; 4694 goto err_out; 4695 } 4696 4697 shost = hisi_sas_shost_alloc_pci(pdev); 4698 if (!shost) { 4699 rc = -ENOMEM; 4700 goto err_out; 4701 } 4702 4703 sha = SHOST_TO_SAS_HA(shost); 4704 hisi_hba = shost_priv(shost); 4705 dev_set_drvdata(dev, sha); 4706 4707 hisi_hba->regs = pcim_iomap_table(pdev)[BAR_NO_V3_HW]; 4708 if (!hisi_hba->regs) { 4709 dev_err(dev, "cannot map register\n"); 4710 rc = -ENOMEM; 4711 goto err_out_ha; 4712 } 4713 4714 phy_nr = port_nr = hisi_hba->n_phy; 4715 4716 arr_phy = devm_kcalloc(dev, phy_nr, sizeof(void *), GFP_KERNEL); 4717 arr_port = devm_kcalloc(dev, port_nr, sizeof(void *), GFP_KERNEL); 4718 if (!arr_phy || !arr_port) { 4719 rc = -ENOMEM; 4720 goto err_out_ha; 4721 } 4722 4723 sha->sas_phy = arr_phy; 4724 sha->sas_port = arr_port; 4725 sha->core.shost = shost; 4726 sha->lldd_ha = hisi_hba; 4727 4728 shost->transportt = hisi_sas_stt; 4729 shost->max_id = HISI_SAS_MAX_DEVICES; 4730 shost->max_lun = ~0; 4731 shost->max_channel = 1; 4732 shost->max_cmd_len = 16; 4733 shost->can_queue = HISI_SAS_UNRESERVED_IPTT; 4734 shost->cmd_per_lun = HISI_SAS_UNRESERVED_IPTT; 4735 4736 sha->sas_ha_name = DRV_NAME; 4737 sha->dev = dev; 4738 sha->lldd_module = THIS_MODULE; 4739 sha->sas_addr = &hisi_hba->sas_addr[0]; 4740 sha->num_phys = hisi_hba->n_phy; 4741 4742 for (i = 0; i < hisi_hba->n_phy; i++) { 4743 sha->sas_phy[i] = &hisi_hba->phy[i].sas_phy; 4744 sha->sas_port[i] = &hisi_hba->port[i].sas_port; 4745 } 4746 4747 if (hisi_hba->prot_mask) { 4748 dev_info(dev, "Registering for DIF/DIX prot_mask=0x%x\n", 4749 prot_mask); 4750 scsi_host_set_prot(hisi_hba->shost, prot_mask); 4751 if (hisi_hba->prot_mask & HISI_SAS_DIX_PROT_MASK) 4752 scsi_host_set_guard(hisi_hba->shost, 4753 SHOST_DIX_GUARD_CRC); 4754 } 4755 4756 if (hisi_sas_debugfs_enable) 4757 debugfs_init_v3_hw(hisi_hba); 4758 4759 rc = interrupt_preinit_v3_hw(hisi_hba); 4760 if (rc) 4761 goto err_out_debugfs; 4762 4763 rc = scsi_add_host(shost, dev); 4764 if (rc) 4765 goto err_out_free_irq_vectors; 4766 4767 rc = sas_register_ha(sha); 4768 if (rc) 4769 goto err_out_register_ha; 4770 4771 rc = hisi_sas_v3_init(hisi_hba); 4772 if (rc) 4773 goto err_out_hw_init; 4774 4775 scsi_scan_host(shost); 4776 4777 /* 4778 * For the situation that there are ATA disks connected with SAS 4779 * controller, it additionally creates ata_port which will affect the 4780 * child_count of hisi_hba->dev. Even if suspended all the disks, 4781 * ata_port is still and the child_count of hisi_hba->dev is not 0. 4782 * So use pm_suspend_ignore_children() to ignore the effect to 4783 * hisi_hba->dev. 4784 */ 4785 pm_suspend_ignore_children(dev, true); 4786 pm_runtime_put_noidle(&pdev->dev); 4787 4788 return 0; 4789 4790 err_out_hw_init: 4791 sas_unregister_ha(sha); 4792 err_out_register_ha: 4793 scsi_remove_host(shost); 4794 err_out_free_irq_vectors: 4795 pci_free_irq_vectors(pdev); 4796 err_out_debugfs: 4797 debugfs_exit_v3_hw(hisi_hba); 4798 err_out_ha: 4799 hisi_sas_free(hisi_hba); 4800 scsi_host_put(shost); 4801 err_out: 4802 return rc; 4803 } 4804 4805 static void 4806 hisi_sas_v3_destroy_irqs(struct pci_dev *pdev, struct hisi_hba *hisi_hba) 4807 { 4808 int i; 4809 4810 devm_free_irq(&pdev->dev, pci_irq_vector(pdev, 1), hisi_hba); 4811 devm_free_irq(&pdev->dev, pci_irq_vector(pdev, 2), hisi_hba); 4812 devm_free_irq(&pdev->dev, pci_irq_vector(pdev, 11), hisi_hba); 4813 for (i = 0; i < hisi_hba->cq_nvecs; i++) { 4814 struct hisi_sas_cq *cq = &hisi_hba->cq[i]; 4815 int nr = hisi_sas_intr_conv ? 16 : 16 + i; 4816 4817 devm_free_irq(&pdev->dev, pci_irq_vector(pdev, nr), cq); 4818 } 4819 pci_free_irq_vectors(pdev); 4820 } 4821 4822 static void hisi_sas_v3_remove(struct pci_dev *pdev) 4823 { 4824 struct device *dev = &pdev->dev; 4825 struct sas_ha_struct *sha = dev_get_drvdata(dev); 4826 struct hisi_hba *hisi_hba = sha->lldd_ha; 4827 struct Scsi_Host *shost = sha->core.shost; 4828 4829 pm_runtime_get_noresume(dev); 4830 del_timer_sync(&hisi_hba->timer); 4831 4832 sas_unregister_ha(sha); 4833 flush_workqueue(hisi_hba->wq); 4834 sas_remove_host(sha->core.shost); 4835 4836 hisi_sas_v3_destroy_irqs(pdev, hisi_hba); 4837 hisi_sas_free(hisi_hba); 4838 debugfs_exit_v3_hw(hisi_hba); 4839 scsi_host_put(shost); 4840 } 4841 4842 static void hisi_sas_reset_prepare_v3_hw(struct pci_dev *pdev) 4843 { 4844 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 4845 struct hisi_hba *hisi_hba = sha->lldd_ha; 4846 struct device *dev = hisi_hba->dev; 4847 int rc; 4848 4849 dev_info(dev, "FLR prepare\n"); 4850 set_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags); 4851 hisi_sas_controller_reset_prepare(hisi_hba); 4852 4853 rc = disable_host_v3_hw(hisi_hba); 4854 if (rc) 4855 dev_err(dev, "FLR: disable host failed rc=%d\n", rc); 4856 } 4857 4858 static void hisi_sas_reset_done_v3_hw(struct pci_dev *pdev) 4859 { 4860 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 4861 struct hisi_hba *hisi_hba = sha->lldd_ha; 4862 struct device *dev = hisi_hba->dev; 4863 int rc; 4864 4865 hisi_sas_init_mem(hisi_hba); 4866 4867 rc = hw_init_v3_hw(hisi_hba); 4868 if (rc) { 4869 dev_err(dev, "FLR: hw init failed rc=%d\n", rc); 4870 return; 4871 } 4872 4873 hisi_sas_controller_reset_done(hisi_hba); 4874 dev_info(dev, "FLR done\n"); 4875 } 4876 4877 enum { 4878 /* instances of the controller */ 4879 hip08, 4880 }; 4881 4882 static int _suspend_v3_hw(struct device *device) 4883 { 4884 struct pci_dev *pdev = to_pci_dev(device); 4885 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 4886 struct hisi_hba *hisi_hba = sha->lldd_ha; 4887 struct device *dev = hisi_hba->dev; 4888 struct Scsi_Host *shost = hisi_hba->shost; 4889 int rc; 4890 4891 if (!pdev->pm_cap) { 4892 dev_err(dev, "PCI PM not supported\n"); 4893 return -ENODEV; 4894 } 4895 4896 if (test_and_set_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags)) 4897 return -1; 4898 4899 scsi_block_requests(shost); 4900 set_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); 4901 flush_workqueue(hisi_hba->wq); 4902 4903 rc = disable_host_v3_hw(hisi_hba); 4904 if (rc) { 4905 dev_err(dev, "PM suspend: disable host failed rc=%d\n", rc); 4906 clear_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); 4907 clear_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags); 4908 scsi_unblock_requests(shost); 4909 return rc; 4910 } 4911 4912 hisi_sas_init_mem(hisi_hba); 4913 4914 dev_warn(dev, "entering suspend state\n"); 4915 4916 hisi_sas_release_tasks(hisi_hba); 4917 4918 sas_suspend_ha(sha); 4919 return 0; 4920 } 4921 4922 static int _resume_v3_hw(struct device *device) 4923 { 4924 struct pci_dev *pdev = to_pci_dev(device); 4925 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 4926 struct hisi_hba *hisi_hba = sha->lldd_ha; 4927 struct Scsi_Host *shost = hisi_hba->shost; 4928 struct device *dev = hisi_hba->dev; 4929 unsigned int rc; 4930 pci_power_t device_state = pdev->current_state; 4931 4932 dev_warn(dev, "resuming from operating state [D%d]\n", 4933 device_state); 4934 4935 scsi_unblock_requests(shost); 4936 clear_bit(HISI_SAS_REJECT_CMD_BIT, &hisi_hba->flags); 4937 4938 sas_prep_resume_ha(sha); 4939 rc = hw_init_v3_hw(hisi_hba); 4940 if (rc) { 4941 scsi_remove_host(shost); 4942 return rc; 4943 } 4944 phys_init_v3_hw(hisi_hba); 4945 sas_resume_ha(sha); 4946 clear_bit(HISI_SAS_RESETTING_BIT, &hisi_hba->flags); 4947 4948 return 0; 4949 } 4950 4951 static int __maybe_unused suspend_v3_hw(struct device *device) 4952 { 4953 struct pci_dev *pdev = to_pci_dev(device); 4954 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 4955 struct hisi_hba *hisi_hba = sha->lldd_ha; 4956 int rc; 4957 4958 set_bit(HISI_SAS_PM_BIT, &hisi_hba->flags); 4959 4960 rc = _suspend_v3_hw(device); 4961 if (rc) 4962 clear_bit(HISI_SAS_PM_BIT, &hisi_hba->flags); 4963 4964 return rc; 4965 } 4966 4967 static int __maybe_unused resume_v3_hw(struct device *device) 4968 { 4969 struct pci_dev *pdev = to_pci_dev(device); 4970 struct sas_ha_struct *sha = pci_get_drvdata(pdev); 4971 struct hisi_hba *hisi_hba = sha->lldd_ha; 4972 int rc = _resume_v3_hw(device); 4973 4974 clear_bit(HISI_SAS_PM_BIT, &hisi_hba->flags); 4975 4976 return rc; 4977 } 4978 4979 static const struct pci_device_id sas_v3_pci_table[] = { 4980 { PCI_VDEVICE(HUAWEI, 0xa230), hip08 }, 4981 {} 4982 }; 4983 MODULE_DEVICE_TABLE(pci, sas_v3_pci_table); 4984 4985 static const struct pci_error_handlers hisi_sas_err_handler = { 4986 .reset_prepare = hisi_sas_reset_prepare_v3_hw, 4987 .reset_done = hisi_sas_reset_done_v3_hw, 4988 }; 4989 4990 static UNIVERSAL_DEV_PM_OPS(hisi_sas_v3_pm_ops, 4991 suspend_v3_hw, 4992 resume_v3_hw, 4993 NULL); 4994 4995 static struct pci_driver sas_v3_pci_driver = { 4996 .name = DRV_NAME, 4997 .id_table = sas_v3_pci_table, 4998 .probe = hisi_sas_v3_probe, 4999 .remove = hisi_sas_v3_remove, 5000 .err_handler = &hisi_sas_err_handler, 5001 .driver.pm = &hisi_sas_v3_pm_ops, 5002 }; 5003 5004 module_pci_driver(sas_v3_pci_driver); 5005 module_param_named(intr_conv, hisi_sas_intr_conv, bool, 0444); 5006 5007 MODULE_LICENSE("GPL"); 5008 MODULE_AUTHOR("John Garry <john.garry@huawei.com>"); 5009 MODULE_DESCRIPTION("HISILICON SAS controller v3 hw driver based on pci device"); 5010 MODULE_ALIAS("pci:" DRV_NAME); 5011