1 // SPDX-License-Identifier: GPL-2.0 OR Linux-OpenIB 2 /* Copyright (c) 2015 - 2021 Intel Corporation */ 3 #include "main.h" 4 #include "../../../net/ethernet/intel/ice/ice.h" 5 6 MODULE_ALIAS("i40iw"); 7 MODULE_AUTHOR("Intel Corporation, <e1000-rdma@lists.sourceforge.net>"); 8 MODULE_DESCRIPTION("Intel(R) Ethernet Protocol Driver for RDMA"); 9 MODULE_LICENSE("Dual BSD/GPL"); 10 11 static struct notifier_block irdma_inetaddr_notifier = { 12 .notifier_call = irdma_inetaddr_event 13 }; 14 15 static struct notifier_block irdma_inetaddr6_notifier = { 16 .notifier_call = irdma_inet6addr_event 17 }; 18 19 static struct notifier_block irdma_net_notifier = { 20 .notifier_call = irdma_net_event 21 }; 22 23 static struct notifier_block irdma_netdevice_notifier = { 24 .notifier_call = irdma_netdevice_event 25 }; 26 27 static void irdma_register_notifiers(void) 28 { 29 register_inetaddr_notifier(&irdma_inetaddr_notifier); 30 register_inet6addr_notifier(&irdma_inetaddr6_notifier); 31 register_netevent_notifier(&irdma_net_notifier); 32 register_netdevice_notifier(&irdma_netdevice_notifier); 33 } 34 35 static void irdma_unregister_notifiers(void) 36 { 37 unregister_netevent_notifier(&irdma_net_notifier); 38 unregister_inetaddr_notifier(&irdma_inetaddr_notifier); 39 unregister_inet6addr_notifier(&irdma_inetaddr6_notifier); 40 unregister_netdevice_notifier(&irdma_netdevice_notifier); 41 } 42 43 static void irdma_prep_tc_change(struct irdma_device *iwdev) 44 { 45 iwdev->vsi.tc_change_pending = true; 46 irdma_sc_suspend_resume_qps(&iwdev->vsi, IRDMA_OP_SUSPEND); 47 48 /* Wait for all qp's to suspend */ 49 wait_event_timeout(iwdev->suspend_wq, 50 !atomic_read(&iwdev->vsi.qp_suspend_reqs), 51 msecs_to_jiffies(IRDMA_EVENT_TIMEOUT_MS)); 52 irdma_ws_reset(&iwdev->vsi); 53 } 54 55 static void irdma_log_invalid_mtu(u16 mtu, struct irdma_sc_dev *dev) 56 { 57 if (mtu < IRDMA_MIN_MTU_IPV4) 58 ibdev_warn(to_ibdev(dev), "MTU setting [%d] too low for RDMA traffic. Minimum MTU is 576 for IPv4\n", mtu); 59 else if (mtu < IRDMA_MIN_MTU_IPV6) 60 ibdev_warn(to_ibdev(dev), "MTU setting [%d] too low for RDMA traffic. Minimum MTU is 1280 for IPv6\\n", mtu); 61 } 62 63 static void irdma_fill_qos_info(struct irdma_l2params *l2params, 64 struct iidc_qos_params *qos_info) 65 { 66 int i; 67 68 l2params->num_tc = qos_info->num_tc; 69 l2params->vsi_prio_type = qos_info->vport_priority_type; 70 l2params->vsi_rel_bw = qos_info->vport_relative_bw; 71 for (i = 0; i < l2params->num_tc; i++) { 72 l2params->tc_info[i].egress_virt_up = 73 qos_info->tc_info[i].egress_virt_up; 74 l2params->tc_info[i].ingress_virt_up = 75 qos_info->tc_info[i].ingress_virt_up; 76 l2params->tc_info[i].prio_type = qos_info->tc_info[i].prio_type; 77 l2params->tc_info[i].rel_bw = qos_info->tc_info[i].rel_bw; 78 l2params->tc_info[i].tc_ctx = qos_info->tc_info[i].tc_ctx; 79 } 80 for (i = 0; i < IIDC_MAX_USER_PRIORITY; i++) 81 l2params->up2tc[i] = qos_info->up2tc[i]; 82 if (qos_info->pfc_mode == IIDC_DSCP_PFC_MODE) { 83 l2params->dscp_mode = true; 84 memcpy(l2params->dscp_map, qos_info->dscp_map, sizeof(l2params->dscp_map)); 85 } 86 } 87 88 static void irdma_iidc_event_handler(struct ice_pf *pf, struct iidc_event *event) 89 { 90 struct irdma_device *iwdev = dev_get_drvdata(&pf->adev->dev); 91 struct irdma_l2params l2params = {}; 92 93 if (*event->type & BIT(IIDC_EVENT_AFTER_MTU_CHANGE)) { 94 ibdev_dbg(&iwdev->ibdev, "CLNT: new MTU = %d\n", iwdev->netdev->mtu); 95 if (iwdev->vsi.mtu != iwdev->netdev->mtu) { 96 l2params.mtu = iwdev->netdev->mtu; 97 l2params.mtu_changed = true; 98 irdma_log_invalid_mtu(l2params.mtu, &iwdev->rf->sc_dev); 99 irdma_change_l2params(&iwdev->vsi, &l2params); 100 } 101 } else if (*event->type & BIT(IIDC_EVENT_BEFORE_TC_CHANGE)) { 102 if (iwdev->vsi.tc_change_pending) 103 return; 104 105 irdma_prep_tc_change(iwdev); 106 } else if (*event->type & BIT(IIDC_EVENT_AFTER_TC_CHANGE)) { 107 struct iidc_qos_params qos_info = {}; 108 109 if (!iwdev->vsi.tc_change_pending) 110 return; 111 112 l2params.tc_changed = true; 113 ibdev_dbg(&iwdev->ibdev, "CLNT: TC Change\n"); 114 ice_get_qos_params(pf, &qos_info); 115 irdma_fill_qos_info(&l2params, &qos_info); 116 if (iwdev->rf->protocol_used != IRDMA_IWARP_PROTOCOL_ONLY) 117 iwdev->dcb_vlan_mode = qos_info.num_tc > 1 && !l2params.dscp_mode; 118 irdma_change_l2params(&iwdev->vsi, &l2params); 119 } else if (*event->type & BIT(IIDC_EVENT_CRIT_ERR)) { 120 ibdev_warn(&iwdev->ibdev, "ICE OICR event notification: oicr = 0x%08x\n", 121 event->reg); 122 if (event->reg & IRDMAPFINT_OICR_PE_CRITERR_M) { 123 u32 pe_criterr; 124 125 pe_criterr = readl(iwdev->rf->sc_dev.hw_regs[IRDMA_GLPE_CRITERR]); 126 #define IRDMA_Q1_RESOURCE_ERR 0x0001024d 127 if (pe_criterr != IRDMA_Q1_RESOURCE_ERR) { 128 ibdev_err(&iwdev->ibdev, "critical PE Error, GLPE_CRITERR=0x%08x\n", 129 pe_criterr); 130 iwdev->rf->reset = true; 131 } else { 132 ibdev_warn(&iwdev->ibdev, "Q1 Resource Check\n"); 133 } 134 } 135 if (event->reg & IRDMAPFINT_OICR_HMC_ERR_M) { 136 ibdev_err(&iwdev->ibdev, "HMC Error\n"); 137 iwdev->rf->reset = true; 138 } 139 if (event->reg & IRDMAPFINT_OICR_PE_PUSH_M) { 140 ibdev_err(&iwdev->ibdev, "PE Push Error\n"); 141 iwdev->rf->reset = true; 142 } 143 if (iwdev->rf->reset) 144 iwdev->rf->gen_ops.request_reset(iwdev->rf); 145 } 146 } 147 148 /** 149 * irdma_request_reset - Request a reset 150 * @rf: RDMA PCI function 151 */ 152 static void irdma_request_reset(struct irdma_pci_f *rf) 153 { 154 struct ice_pf *pf = rf->cdev; 155 156 ibdev_warn(&rf->iwdev->ibdev, "Requesting a reset\n"); 157 ice_rdma_request_reset(pf, IIDC_PFR); 158 } 159 160 /** 161 * irdma_lan_register_qset - Register qset with LAN driver 162 * @vsi: vsi structure 163 * @tc_node: Traffic class node 164 */ 165 static int irdma_lan_register_qset(struct irdma_sc_vsi *vsi, 166 struct irdma_ws_node *tc_node) 167 { 168 struct irdma_device *iwdev = vsi->back_vsi; 169 struct ice_pf *pf = iwdev->rf->cdev; 170 struct iidc_rdma_qset_params qset = {}; 171 int ret; 172 173 qset.qs_handle = tc_node->qs_handle; 174 qset.tc = tc_node->traffic_class; 175 qset.vport_id = vsi->vsi_idx; 176 ret = ice_add_rdma_qset(pf, &qset); 177 if (ret) { 178 ibdev_dbg(&iwdev->ibdev, "WS: LAN alloc_res for rdma qset failed.\n"); 179 return ret; 180 } 181 182 tc_node->l2_sched_node_id = qset.teid; 183 vsi->qos[tc_node->user_pri].l2_sched_node_id = qset.teid; 184 185 return 0; 186 } 187 188 /** 189 * irdma_lan_unregister_qset - Unregister qset with LAN driver 190 * @vsi: vsi structure 191 * @tc_node: Traffic class node 192 */ 193 static void irdma_lan_unregister_qset(struct irdma_sc_vsi *vsi, 194 struct irdma_ws_node *tc_node) 195 { 196 struct irdma_device *iwdev = vsi->back_vsi; 197 struct ice_pf *pf = iwdev->rf->cdev; 198 struct iidc_rdma_qset_params qset = {}; 199 200 qset.qs_handle = tc_node->qs_handle; 201 qset.tc = tc_node->traffic_class; 202 qset.vport_id = vsi->vsi_idx; 203 qset.teid = tc_node->l2_sched_node_id; 204 205 if (ice_del_rdma_qset(pf, &qset)) 206 ibdev_dbg(&iwdev->ibdev, "WS: LAN free_res for rdma qset failed.\n"); 207 } 208 209 static int irdma_init_interrupts(struct irdma_pci_f *rf, struct ice_pf *pf) 210 { 211 int i; 212 213 rf->msix_count = num_online_cpus() + IRDMA_NUM_AEQ_MSIX; 214 rf->msix_entries = kcalloc(rf->msix_count, sizeof(*rf->msix_entries), 215 GFP_KERNEL); 216 if (!rf->msix_entries) 217 return -ENOMEM; 218 219 for (i = 0; i < rf->msix_count; i++) 220 if (ice_alloc_rdma_qvector(pf, &rf->msix_entries[i])) 221 break; 222 223 if (i < IRDMA_MIN_MSIX) { 224 while (--i >= 0) 225 ice_free_rdma_qvector(pf, &rf->msix_entries[i]); 226 227 kfree(rf->msix_entries); 228 return -ENOMEM; 229 } 230 231 rf->msix_count = i; 232 233 return 0; 234 } 235 236 static void irdma_deinit_interrupts(struct irdma_pci_f *rf, struct ice_pf *pf) 237 { 238 int i; 239 240 for (i = 0; i < rf->msix_count; i++) 241 ice_free_rdma_qvector(pf, &rf->msix_entries[i]); 242 243 kfree(rf->msix_entries); 244 } 245 246 static void irdma_remove(struct auxiliary_device *aux_dev) 247 { 248 struct iidc_auxiliary_dev *iidc_adev = container_of(aux_dev, 249 struct iidc_auxiliary_dev, 250 adev); 251 struct ice_pf *pf = iidc_adev->pf; 252 struct irdma_device *iwdev = auxiliary_get_drvdata(aux_dev); 253 254 irdma_ib_unregister_device(iwdev); 255 ice_rdma_update_vsi_filter(pf, iwdev->vsi_num, false); 256 irdma_deinit_interrupts(iwdev->rf, pf); 257 258 kfree(iwdev->rf); 259 260 pr_debug("INIT: Gen2 PF[%d] device remove success\n", PCI_FUNC(pf->pdev->devfn)); 261 } 262 263 static void irdma_fill_device_info(struct irdma_device *iwdev, struct ice_pf *pf, 264 struct ice_vsi *vsi) 265 { 266 struct irdma_pci_f *rf = iwdev->rf; 267 268 rf->cdev = pf; 269 rf->gen_ops.register_qset = irdma_lan_register_qset; 270 rf->gen_ops.unregister_qset = irdma_lan_unregister_qset; 271 rf->hw.hw_addr = pf->hw.hw_addr; 272 rf->pcidev = pf->pdev; 273 rf->pf_id = pf->hw.pf_id; 274 rf->default_vsi.vsi_idx = vsi->vsi_num; 275 rf->protocol_used = pf->rdma_mode & IIDC_RDMA_PROTOCOL_ROCEV2 ? 276 IRDMA_ROCE_PROTOCOL_ONLY : IRDMA_IWARP_PROTOCOL_ONLY; 277 rf->rdma_ver = IRDMA_GEN_2; 278 rf->rsrc_profile = IRDMA_HMC_PROFILE_DEFAULT; 279 rf->rst_to = IRDMA_RST_TIMEOUT_HZ; 280 rf->gen_ops.request_reset = irdma_request_reset; 281 rf->limits_sel = 7; 282 rf->iwdev = iwdev; 283 mutex_init(&iwdev->ah_tbl_lock); 284 iwdev->netdev = vsi->netdev; 285 iwdev->vsi_num = vsi->vsi_num; 286 iwdev->init_state = INITIAL_STATE; 287 iwdev->roce_cwnd = IRDMA_ROCE_CWND_DEFAULT; 288 iwdev->roce_ackcreds = IRDMA_ROCE_ACKCREDS_DEFAULT; 289 iwdev->rcv_wnd = IRDMA_CM_DEFAULT_RCV_WND_SCALED; 290 iwdev->rcv_wscale = IRDMA_CM_DEFAULT_RCV_WND_SCALE; 291 if (rf->protocol_used == IRDMA_ROCE_PROTOCOL_ONLY) 292 iwdev->roce_mode = true; 293 } 294 295 static int irdma_probe(struct auxiliary_device *aux_dev, const struct auxiliary_device_id *id) 296 { 297 struct iidc_auxiliary_dev *iidc_adev = container_of(aux_dev, 298 struct iidc_auxiliary_dev, 299 adev); 300 struct ice_pf *pf = iidc_adev->pf; 301 struct ice_vsi *vsi = ice_get_main_vsi(pf); 302 struct iidc_qos_params qos_info = {}; 303 struct irdma_device *iwdev; 304 struct irdma_pci_f *rf; 305 struct irdma_l2params l2params = {}; 306 int err; 307 308 if (!vsi) 309 return -EIO; 310 iwdev = ib_alloc_device(irdma_device, ibdev); 311 if (!iwdev) 312 return -ENOMEM; 313 iwdev->rf = kzalloc(sizeof(*rf), GFP_KERNEL); 314 if (!iwdev->rf) { 315 ib_dealloc_device(&iwdev->ibdev); 316 return -ENOMEM; 317 } 318 319 irdma_fill_device_info(iwdev, pf, vsi); 320 rf = iwdev->rf; 321 322 err = irdma_init_interrupts(rf, pf); 323 if (err) 324 goto err_init_interrupts; 325 326 err = irdma_ctrl_init_hw(rf); 327 if (err) 328 goto err_ctrl_init; 329 330 l2params.mtu = iwdev->netdev->mtu; 331 ice_get_qos_params(pf, &qos_info); 332 irdma_fill_qos_info(&l2params, &qos_info); 333 if (iwdev->rf->protocol_used != IRDMA_IWARP_PROTOCOL_ONLY) 334 iwdev->dcb_vlan_mode = l2params.num_tc > 1 && !l2params.dscp_mode; 335 336 err = irdma_rt_init_hw(iwdev, &l2params); 337 if (err) 338 goto err_rt_init; 339 340 err = irdma_ib_register_device(iwdev); 341 if (err) 342 goto err_ibreg; 343 344 ice_rdma_update_vsi_filter(pf, iwdev->vsi_num, true); 345 346 ibdev_dbg(&iwdev->ibdev, "INIT: Gen2 PF[%d] device probe success\n", PCI_FUNC(rf->pcidev->devfn)); 347 auxiliary_set_drvdata(aux_dev, iwdev); 348 349 return 0; 350 351 err_ibreg: 352 irdma_rt_deinit_hw(iwdev); 353 err_rt_init: 354 irdma_ctrl_deinit_hw(rf); 355 err_ctrl_init: 356 irdma_deinit_interrupts(rf, pf); 357 err_init_interrupts: 358 kfree(iwdev->rf); 359 ib_dealloc_device(&iwdev->ibdev); 360 361 return err; 362 } 363 364 static const struct auxiliary_device_id irdma_auxiliary_id_table[] = { 365 {.name = "ice.iwarp", }, 366 {.name = "ice.roce", }, 367 {}, 368 }; 369 370 MODULE_DEVICE_TABLE(auxiliary, irdma_auxiliary_id_table); 371 372 static struct iidc_auxiliary_drv irdma_auxiliary_drv = { 373 .adrv = { 374 .id_table = irdma_auxiliary_id_table, 375 .probe = irdma_probe, 376 .remove = irdma_remove, 377 }, 378 .event_handler = irdma_iidc_event_handler, 379 }; 380 381 static int __init irdma_init_module(void) 382 { 383 int ret; 384 385 ret = auxiliary_driver_register(&i40iw_auxiliary_drv); 386 if (ret) { 387 pr_err("Failed i40iw(gen_1) auxiliary_driver_register() ret=%d\n", 388 ret); 389 return ret; 390 } 391 392 ret = auxiliary_driver_register(&irdma_auxiliary_drv.adrv); 393 if (ret) { 394 auxiliary_driver_unregister(&i40iw_auxiliary_drv); 395 pr_err("Failed irdma auxiliary_driver_register() ret=%d\n", 396 ret); 397 return ret; 398 } 399 400 irdma_register_notifiers(); 401 402 return 0; 403 } 404 405 static void __exit irdma_exit_module(void) 406 { 407 irdma_unregister_notifiers(); 408 auxiliary_driver_unregister(&irdma_auxiliary_drv.adrv); 409 auxiliary_driver_unregister(&i40iw_auxiliary_drv); 410 } 411 412 module_init(irdma_init_module); 413 module_exit(irdma_exit_module); 414