1 /* Broadcom NetXtreme-C/E network driver. 2 * 3 * Copyright (c) 2016-2018 Broadcom Limited 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License as published by 7 * the Free Software Foundation. 8 */ 9 10 #include <linux/module.h> 11 12 #include <linux/kernel.h> 13 #include <linux/errno.h> 14 #include <linux/interrupt.h> 15 #include <linux/pci.h> 16 #include <linux/netdevice.h> 17 #include <linux/rtnetlink.h> 18 #include <linux/bitops.h> 19 #include <linux/irq.h> 20 #include <asm/byteorder.h> 21 #include <linux/bitmap.h> 22 23 #include "bnxt_hsi.h" 24 #include "bnxt.h" 25 #include "bnxt_ulp.h" 26 27 static int bnxt_register_dev(struct bnxt_en_dev *edev, int ulp_id, 28 struct bnxt_ulp_ops *ulp_ops, void *handle) 29 { 30 struct net_device *dev = edev->net; 31 struct bnxt *bp = netdev_priv(dev); 32 struct bnxt_ulp *ulp; 33 34 ASSERT_RTNL(); 35 if (ulp_id >= BNXT_MAX_ULP) 36 return -EINVAL; 37 38 ulp = &edev->ulp_tbl[ulp_id]; 39 if (rcu_access_pointer(ulp->ulp_ops)) { 40 netdev_err(bp->dev, "ulp id %d already registered\n", ulp_id); 41 return -EBUSY; 42 } 43 if (ulp_id == BNXT_ROCE_ULP) { 44 unsigned int max_stat_ctxs; 45 46 max_stat_ctxs = bnxt_get_max_func_stat_ctxs(bp); 47 if (max_stat_ctxs <= BNXT_MIN_ROCE_STAT_CTXS || 48 bp->cp_nr_rings == max_stat_ctxs) 49 return -ENOMEM; 50 } 51 52 atomic_set(&ulp->ref_count, 0); 53 ulp->handle = handle; 54 rcu_assign_pointer(ulp->ulp_ops, ulp_ops); 55 56 if (ulp_id == BNXT_ROCE_ULP) { 57 if (test_bit(BNXT_STATE_OPEN, &bp->state)) 58 bnxt_hwrm_vnic_cfg(bp, 0); 59 } 60 61 return 0; 62 } 63 64 static int bnxt_unregister_dev(struct bnxt_en_dev *edev, int ulp_id) 65 { 66 struct net_device *dev = edev->net; 67 struct bnxt *bp = netdev_priv(dev); 68 struct bnxt_ulp *ulp; 69 int i = 0; 70 71 ASSERT_RTNL(); 72 if (ulp_id >= BNXT_MAX_ULP) 73 return -EINVAL; 74 75 ulp = &edev->ulp_tbl[ulp_id]; 76 if (!rcu_access_pointer(ulp->ulp_ops)) { 77 netdev_err(bp->dev, "ulp id %d not registered\n", ulp_id); 78 return -EINVAL; 79 } 80 if (ulp_id == BNXT_ROCE_ULP && ulp->msix_requested) 81 edev->en_ops->bnxt_free_msix(edev, ulp_id); 82 83 if (ulp->max_async_event_id) 84 bnxt_hwrm_func_drv_rgtr(bp, NULL, 0, true); 85 86 RCU_INIT_POINTER(ulp->ulp_ops, NULL); 87 synchronize_rcu(); 88 ulp->max_async_event_id = 0; 89 ulp->async_events_bmap = NULL; 90 while (atomic_read(&ulp->ref_count) != 0 && i < 10) { 91 msleep(100); 92 i++; 93 } 94 return 0; 95 } 96 97 static void bnxt_fill_msix_vecs(struct bnxt *bp, struct bnxt_msix_entry *ent) 98 { 99 struct bnxt_en_dev *edev = bp->edev; 100 int num_msix, idx, i; 101 102 num_msix = edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested; 103 idx = edev->ulp_tbl[BNXT_ROCE_ULP].msix_base; 104 for (i = 0; i < num_msix; i++) { 105 ent[i].vector = bp->irq_tbl[idx + i].vector; 106 ent[i].ring_idx = idx + i; 107 ent[i].db_offset = (idx + i) * 0x80; 108 } 109 } 110 111 static int bnxt_req_msix_vecs(struct bnxt_en_dev *edev, int ulp_id, 112 struct bnxt_msix_entry *ent, int num_msix) 113 { 114 struct net_device *dev = edev->net; 115 struct bnxt *bp = netdev_priv(dev); 116 struct bnxt_hw_resc *hw_resc; 117 int max_idx, max_cp_rings; 118 int avail_msix, idx; 119 int total_vecs; 120 int rc = 0; 121 122 ASSERT_RTNL(); 123 if (ulp_id != BNXT_ROCE_ULP) 124 return -EINVAL; 125 126 if (!(bp->flags & BNXT_FLAG_USING_MSIX)) 127 return -ENODEV; 128 129 if (edev->ulp_tbl[ulp_id].msix_requested) 130 return -EAGAIN; 131 132 max_cp_rings = bnxt_get_max_func_cp_rings(bp); 133 avail_msix = bnxt_get_avail_msix(bp, num_msix); 134 if (!avail_msix) 135 return -ENOMEM; 136 if (avail_msix > num_msix) 137 avail_msix = num_msix; 138 139 if (BNXT_NEW_RM(bp)) { 140 idx = bp->cp_nr_rings; 141 } else { 142 max_idx = min_t(int, bp->total_irqs, max_cp_rings); 143 idx = max_idx - avail_msix; 144 } 145 edev->ulp_tbl[ulp_id].msix_base = idx; 146 edev->ulp_tbl[ulp_id].msix_requested = avail_msix; 147 hw_resc = &bp->hw_resc; 148 total_vecs = idx + avail_msix; 149 if (bp->total_irqs < total_vecs || 150 (BNXT_NEW_RM(bp) && hw_resc->resv_irqs < total_vecs)) { 151 if (netif_running(dev)) { 152 bnxt_close_nic(bp, true, false); 153 rc = bnxt_open_nic(bp, true, false); 154 } else { 155 rc = bnxt_reserve_rings(bp, true); 156 } 157 } 158 if (rc) { 159 edev->ulp_tbl[ulp_id].msix_requested = 0; 160 return -EAGAIN; 161 } 162 163 if (BNXT_NEW_RM(bp)) { 164 int resv_msix; 165 166 resv_msix = hw_resc->resv_irqs - bp->cp_nr_rings; 167 avail_msix = min_t(int, resv_msix, avail_msix); 168 edev->ulp_tbl[ulp_id].msix_requested = avail_msix; 169 } 170 bnxt_fill_msix_vecs(bp, ent); 171 edev->flags |= BNXT_EN_FLAG_MSIX_REQUESTED; 172 return avail_msix; 173 } 174 175 static int bnxt_free_msix_vecs(struct bnxt_en_dev *edev, int ulp_id) 176 { 177 struct net_device *dev = edev->net; 178 struct bnxt *bp = netdev_priv(dev); 179 180 ASSERT_RTNL(); 181 if (ulp_id != BNXT_ROCE_ULP) 182 return -EINVAL; 183 184 if (!(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED)) 185 return 0; 186 187 edev->ulp_tbl[ulp_id].msix_requested = 0; 188 edev->flags &= ~BNXT_EN_FLAG_MSIX_REQUESTED; 189 if (netif_running(dev) && !(edev->flags & BNXT_EN_FLAG_ULP_STOPPED)) { 190 bnxt_close_nic(bp, true, false); 191 bnxt_open_nic(bp, true, false); 192 } 193 return 0; 194 } 195 196 int bnxt_get_ulp_msix_num(struct bnxt *bp) 197 { 198 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 199 struct bnxt_en_dev *edev = bp->edev; 200 201 return edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested; 202 } 203 return 0; 204 } 205 206 int bnxt_get_ulp_msix_base(struct bnxt *bp) 207 { 208 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 209 struct bnxt_en_dev *edev = bp->edev; 210 211 if (edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested) 212 return edev->ulp_tbl[BNXT_ROCE_ULP].msix_base; 213 } 214 return 0; 215 } 216 217 int bnxt_get_ulp_stat_ctxs(struct bnxt *bp) 218 { 219 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) 220 return BNXT_MIN_ROCE_STAT_CTXS; 221 222 return 0; 223 } 224 225 static int bnxt_send_msg(struct bnxt_en_dev *edev, int ulp_id, 226 struct bnxt_fw_msg *fw_msg) 227 { 228 struct net_device *dev = edev->net; 229 struct bnxt *bp = netdev_priv(dev); 230 struct input *req; 231 int rc; 232 233 if (ulp_id != BNXT_ROCE_ULP && bp->fw_reset_state) 234 return -EBUSY; 235 236 mutex_lock(&bp->hwrm_cmd_lock); 237 req = fw_msg->msg; 238 req->resp_addr = cpu_to_le64(bp->hwrm_cmd_resp_dma_addr); 239 rc = _hwrm_send_message(bp, fw_msg->msg, fw_msg->msg_len, 240 fw_msg->timeout); 241 if (!rc) { 242 struct output *resp = bp->hwrm_cmd_resp_addr; 243 u32 len = le16_to_cpu(resp->resp_len); 244 245 if (fw_msg->resp_max_len < len) 246 len = fw_msg->resp_max_len; 247 248 memcpy(fw_msg->resp, resp, len); 249 } 250 mutex_unlock(&bp->hwrm_cmd_lock); 251 return rc; 252 } 253 254 static void bnxt_ulp_get(struct bnxt_ulp *ulp) 255 { 256 atomic_inc(&ulp->ref_count); 257 } 258 259 static void bnxt_ulp_put(struct bnxt_ulp *ulp) 260 { 261 atomic_dec(&ulp->ref_count); 262 } 263 264 void bnxt_ulp_stop(struct bnxt *bp) 265 { 266 struct bnxt_en_dev *edev = bp->edev; 267 struct bnxt_ulp_ops *ops; 268 int i; 269 270 if (!edev) 271 return; 272 273 edev->flags |= BNXT_EN_FLAG_ULP_STOPPED; 274 for (i = 0; i < BNXT_MAX_ULP; i++) { 275 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 276 277 ops = rtnl_dereference(ulp->ulp_ops); 278 if (!ops || !ops->ulp_stop) 279 continue; 280 ops->ulp_stop(ulp->handle); 281 } 282 } 283 284 void bnxt_ulp_start(struct bnxt *bp, int err) 285 { 286 struct bnxt_en_dev *edev = bp->edev; 287 struct bnxt_ulp_ops *ops; 288 int i; 289 290 if (!edev) 291 return; 292 293 edev->flags &= ~BNXT_EN_FLAG_ULP_STOPPED; 294 295 if (err) 296 return; 297 298 for (i = 0; i < BNXT_MAX_ULP; i++) { 299 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 300 301 ops = rtnl_dereference(ulp->ulp_ops); 302 if (!ops || !ops->ulp_start) 303 continue; 304 ops->ulp_start(ulp->handle); 305 } 306 } 307 308 void bnxt_ulp_sriov_cfg(struct bnxt *bp, int num_vfs) 309 { 310 struct bnxt_en_dev *edev = bp->edev; 311 struct bnxt_ulp_ops *ops; 312 int i; 313 314 if (!edev) 315 return; 316 317 for (i = 0; i < BNXT_MAX_ULP; i++) { 318 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 319 320 rcu_read_lock(); 321 ops = rcu_dereference(ulp->ulp_ops); 322 if (!ops || !ops->ulp_sriov_config) { 323 rcu_read_unlock(); 324 continue; 325 } 326 bnxt_ulp_get(ulp); 327 rcu_read_unlock(); 328 ops->ulp_sriov_config(ulp->handle, num_vfs); 329 bnxt_ulp_put(ulp); 330 } 331 } 332 333 void bnxt_ulp_shutdown(struct bnxt *bp) 334 { 335 struct bnxt_en_dev *edev = bp->edev; 336 struct bnxt_ulp_ops *ops; 337 int i; 338 339 if (!edev) 340 return; 341 342 for (i = 0; i < BNXT_MAX_ULP; i++) { 343 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 344 345 ops = rtnl_dereference(ulp->ulp_ops); 346 if (!ops || !ops->ulp_shutdown) 347 continue; 348 ops->ulp_shutdown(ulp->handle); 349 } 350 } 351 352 void bnxt_ulp_irq_stop(struct bnxt *bp) 353 { 354 struct bnxt_en_dev *edev = bp->edev; 355 struct bnxt_ulp_ops *ops; 356 357 if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED)) 358 return; 359 360 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 361 struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP]; 362 363 if (!ulp->msix_requested) 364 return; 365 366 ops = rtnl_dereference(ulp->ulp_ops); 367 if (!ops || !ops->ulp_irq_stop) 368 return; 369 ops->ulp_irq_stop(ulp->handle); 370 } 371 } 372 373 void bnxt_ulp_irq_restart(struct bnxt *bp, int err) 374 { 375 struct bnxt_en_dev *edev = bp->edev; 376 struct bnxt_ulp_ops *ops; 377 378 if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED)) 379 return; 380 381 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 382 struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP]; 383 struct bnxt_msix_entry *ent = NULL; 384 385 if (!ulp->msix_requested) 386 return; 387 388 ops = rtnl_dereference(ulp->ulp_ops); 389 if (!ops || !ops->ulp_irq_restart) 390 return; 391 392 if (!err) { 393 ent = kcalloc(ulp->msix_requested, sizeof(*ent), 394 GFP_KERNEL); 395 if (!ent) 396 return; 397 bnxt_fill_msix_vecs(bp, ent); 398 } 399 ops->ulp_irq_restart(ulp->handle, ent); 400 kfree(ent); 401 } 402 } 403 404 void bnxt_ulp_async_events(struct bnxt *bp, struct hwrm_async_event_cmpl *cmpl) 405 { 406 u16 event_id = le16_to_cpu(cmpl->event_id); 407 struct bnxt_en_dev *edev = bp->edev; 408 struct bnxt_ulp_ops *ops; 409 int i; 410 411 if (!edev) 412 return; 413 414 rcu_read_lock(); 415 for (i = 0; i < BNXT_MAX_ULP; i++) { 416 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 417 418 ops = rcu_dereference(ulp->ulp_ops); 419 if (!ops || !ops->ulp_async_notifier) 420 continue; 421 if (!ulp->async_events_bmap || 422 event_id > ulp->max_async_event_id) 423 continue; 424 425 /* Read max_async_event_id first before testing the bitmap. */ 426 smp_rmb(); 427 if (test_bit(event_id, ulp->async_events_bmap)) 428 ops->ulp_async_notifier(ulp->handle, cmpl); 429 } 430 rcu_read_unlock(); 431 } 432 433 static int bnxt_register_async_events(struct bnxt_en_dev *edev, int ulp_id, 434 unsigned long *events_bmap, u16 max_id) 435 { 436 struct net_device *dev = edev->net; 437 struct bnxt *bp = netdev_priv(dev); 438 struct bnxt_ulp *ulp; 439 440 if (ulp_id >= BNXT_MAX_ULP) 441 return -EINVAL; 442 443 ulp = &edev->ulp_tbl[ulp_id]; 444 ulp->async_events_bmap = events_bmap; 445 /* Make sure bnxt_ulp_async_events() sees this order */ 446 smp_wmb(); 447 ulp->max_async_event_id = max_id; 448 bnxt_hwrm_func_drv_rgtr(bp, events_bmap, max_id + 1, true); 449 return 0; 450 } 451 452 static const struct bnxt_en_ops bnxt_en_ops_tbl = { 453 .bnxt_register_device = bnxt_register_dev, 454 .bnxt_unregister_device = bnxt_unregister_dev, 455 .bnxt_request_msix = bnxt_req_msix_vecs, 456 .bnxt_free_msix = bnxt_free_msix_vecs, 457 .bnxt_send_fw_msg = bnxt_send_msg, 458 .bnxt_register_fw_async_events = bnxt_register_async_events, 459 }; 460 461 struct bnxt_en_dev *bnxt_ulp_probe(struct net_device *dev) 462 { 463 struct bnxt *bp = netdev_priv(dev); 464 struct bnxt_en_dev *edev; 465 466 edev = bp->edev; 467 if (!edev) { 468 edev = kzalloc(sizeof(*edev), GFP_KERNEL); 469 if (!edev) 470 return ERR_PTR(-ENOMEM); 471 edev->en_ops = &bnxt_en_ops_tbl; 472 if (bp->flags & BNXT_FLAG_ROCEV1_CAP) 473 edev->flags |= BNXT_EN_FLAG_ROCEV1_CAP; 474 if (bp->flags & BNXT_FLAG_ROCEV2_CAP) 475 edev->flags |= BNXT_EN_FLAG_ROCEV2_CAP; 476 edev->net = dev; 477 edev->pdev = bp->pdev; 478 bp->edev = edev; 479 } 480 return bp->edev; 481 } 482