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_rgtr_async_events(bp, NULL, 0); 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 int max_idx, max_cp_rings; 117 int avail_msix, idx; 118 int rc = 0; 119 120 ASSERT_RTNL(); 121 if (ulp_id != BNXT_ROCE_ULP) 122 return -EINVAL; 123 124 if (!(bp->flags & BNXT_FLAG_USING_MSIX)) 125 return -ENODEV; 126 127 if (edev->ulp_tbl[ulp_id].msix_requested) 128 return -EAGAIN; 129 130 max_cp_rings = bnxt_get_max_func_cp_rings(bp); 131 avail_msix = bnxt_get_avail_msix(bp, num_msix); 132 if (!avail_msix) 133 return -ENOMEM; 134 if (avail_msix > num_msix) 135 avail_msix = num_msix; 136 137 if (BNXT_NEW_RM(bp)) { 138 idx = bp->cp_nr_rings; 139 } else { 140 max_idx = min_t(int, bp->total_irqs, max_cp_rings); 141 idx = max_idx - avail_msix; 142 } 143 edev->ulp_tbl[ulp_id].msix_base = idx; 144 edev->ulp_tbl[ulp_id].msix_requested = avail_msix; 145 if (bp->total_irqs < (idx + avail_msix)) { 146 if (netif_running(dev)) { 147 bnxt_close_nic(bp, true, false); 148 rc = bnxt_open_nic(bp, true, false); 149 } else { 150 rc = bnxt_reserve_rings(bp, true); 151 } 152 } 153 if (rc) { 154 edev->ulp_tbl[ulp_id].msix_requested = 0; 155 return -EAGAIN; 156 } 157 158 if (BNXT_NEW_RM(bp)) { 159 struct bnxt_hw_resc *hw_resc = &bp->hw_resc; 160 int resv_msix; 161 162 resv_msix = hw_resc->resv_irqs - bp->cp_nr_rings; 163 avail_msix = min_t(int, resv_msix, avail_msix); 164 edev->ulp_tbl[ulp_id].msix_requested = avail_msix; 165 } 166 bnxt_fill_msix_vecs(bp, ent); 167 edev->flags |= BNXT_EN_FLAG_MSIX_REQUESTED; 168 return avail_msix; 169 } 170 171 static int bnxt_free_msix_vecs(struct bnxt_en_dev *edev, int ulp_id) 172 { 173 struct net_device *dev = edev->net; 174 struct bnxt *bp = netdev_priv(dev); 175 176 ASSERT_RTNL(); 177 if (ulp_id != BNXT_ROCE_ULP) 178 return -EINVAL; 179 180 if (!(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED)) 181 return 0; 182 183 edev->ulp_tbl[ulp_id].msix_requested = 0; 184 edev->flags &= ~BNXT_EN_FLAG_MSIX_REQUESTED; 185 if (netif_running(dev)) { 186 bnxt_close_nic(bp, true, false); 187 bnxt_open_nic(bp, true, false); 188 } 189 return 0; 190 } 191 192 int bnxt_get_ulp_msix_num(struct bnxt *bp) 193 { 194 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 195 struct bnxt_en_dev *edev = bp->edev; 196 197 return edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested; 198 } 199 return 0; 200 } 201 202 int bnxt_get_ulp_msix_base(struct bnxt *bp) 203 { 204 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 205 struct bnxt_en_dev *edev = bp->edev; 206 207 if (edev->ulp_tbl[BNXT_ROCE_ULP].msix_requested) 208 return edev->ulp_tbl[BNXT_ROCE_ULP].msix_base; 209 } 210 return 0; 211 } 212 213 int bnxt_get_ulp_stat_ctxs(struct bnxt *bp) 214 { 215 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) 216 return BNXT_MIN_ROCE_STAT_CTXS; 217 218 return 0; 219 } 220 221 static int bnxt_send_msg(struct bnxt_en_dev *edev, int ulp_id, 222 struct bnxt_fw_msg *fw_msg) 223 { 224 struct net_device *dev = edev->net; 225 struct bnxt *bp = netdev_priv(dev); 226 struct input *req; 227 int rc; 228 229 if (ulp_id != BNXT_ROCE_ULP && bp->fw_reset_state) 230 return -EBUSY; 231 232 mutex_lock(&bp->hwrm_cmd_lock); 233 req = fw_msg->msg; 234 req->resp_addr = cpu_to_le64(bp->hwrm_cmd_resp_dma_addr); 235 rc = _hwrm_send_message(bp, fw_msg->msg, fw_msg->msg_len, 236 fw_msg->timeout); 237 if (!rc) { 238 struct output *resp = bp->hwrm_cmd_resp_addr; 239 u32 len = le16_to_cpu(resp->resp_len); 240 241 if (fw_msg->resp_max_len < len) 242 len = fw_msg->resp_max_len; 243 244 memcpy(fw_msg->resp, resp, len); 245 } 246 mutex_unlock(&bp->hwrm_cmd_lock); 247 return rc; 248 } 249 250 static void bnxt_ulp_get(struct bnxt_ulp *ulp) 251 { 252 atomic_inc(&ulp->ref_count); 253 } 254 255 static void bnxt_ulp_put(struct bnxt_ulp *ulp) 256 { 257 atomic_dec(&ulp->ref_count); 258 } 259 260 void bnxt_ulp_stop(struct bnxt *bp) 261 { 262 struct bnxt_en_dev *edev = bp->edev; 263 struct bnxt_ulp_ops *ops; 264 int i; 265 266 if (!edev) 267 return; 268 269 for (i = 0; i < BNXT_MAX_ULP; i++) { 270 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 271 272 ops = rtnl_dereference(ulp->ulp_ops); 273 if (!ops || !ops->ulp_stop) 274 continue; 275 ops->ulp_stop(ulp->handle); 276 } 277 } 278 279 void bnxt_ulp_start(struct bnxt *bp) 280 { 281 struct bnxt_en_dev *edev = bp->edev; 282 struct bnxt_ulp_ops *ops; 283 int i; 284 285 if (!edev) 286 return; 287 288 for (i = 0; i < BNXT_MAX_ULP; i++) { 289 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 290 291 ops = rtnl_dereference(ulp->ulp_ops); 292 if (!ops || !ops->ulp_start) 293 continue; 294 ops->ulp_start(ulp->handle); 295 } 296 } 297 298 void bnxt_ulp_sriov_cfg(struct bnxt *bp, int num_vfs) 299 { 300 struct bnxt_en_dev *edev = bp->edev; 301 struct bnxt_ulp_ops *ops; 302 int i; 303 304 if (!edev) 305 return; 306 307 for (i = 0; i < BNXT_MAX_ULP; i++) { 308 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 309 310 rcu_read_lock(); 311 ops = rcu_dereference(ulp->ulp_ops); 312 if (!ops || !ops->ulp_sriov_config) { 313 rcu_read_unlock(); 314 continue; 315 } 316 bnxt_ulp_get(ulp); 317 rcu_read_unlock(); 318 ops->ulp_sriov_config(ulp->handle, num_vfs); 319 bnxt_ulp_put(ulp); 320 } 321 } 322 323 void bnxt_ulp_shutdown(struct bnxt *bp) 324 { 325 struct bnxt_en_dev *edev = bp->edev; 326 struct bnxt_ulp_ops *ops; 327 int i; 328 329 if (!edev) 330 return; 331 332 for (i = 0; i < BNXT_MAX_ULP; i++) { 333 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 334 335 ops = rtnl_dereference(ulp->ulp_ops); 336 if (!ops || !ops->ulp_shutdown) 337 continue; 338 ops->ulp_shutdown(ulp->handle); 339 } 340 } 341 342 void bnxt_ulp_irq_stop(struct bnxt *bp) 343 { 344 struct bnxt_en_dev *edev = bp->edev; 345 struct bnxt_ulp_ops *ops; 346 347 if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED)) 348 return; 349 350 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 351 struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP]; 352 353 if (!ulp->msix_requested) 354 return; 355 356 ops = rtnl_dereference(ulp->ulp_ops); 357 if (!ops || !ops->ulp_irq_stop) 358 return; 359 ops->ulp_irq_stop(ulp->handle); 360 } 361 } 362 363 void bnxt_ulp_irq_restart(struct bnxt *bp, int err) 364 { 365 struct bnxt_en_dev *edev = bp->edev; 366 struct bnxt_ulp_ops *ops; 367 368 if (!edev || !(edev->flags & BNXT_EN_FLAG_MSIX_REQUESTED)) 369 return; 370 371 if (bnxt_ulp_registered(bp->edev, BNXT_ROCE_ULP)) { 372 struct bnxt_ulp *ulp = &edev->ulp_tbl[BNXT_ROCE_ULP]; 373 struct bnxt_msix_entry *ent = NULL; 374 375 if (!ulp->msix_requested) 376 return; 377 378 ops = rtnl_dereference(ulp->ulp_ops); 379 if (!ops || !ops->ulp_irq_restart) 380 return; 381 382 if (!err) { 383 ent = kcalloc(ulp->msix_requested, sizeof(*ent), 384 GFP_KERNEL); 385 if (!ent) 386 return; 387 bnxt_fill_msix_vecs(bp, ent); 388 } 389 ops->ulp_irq_restart(ulp->handle, ent); 390 kfree(ent); 391 } 392 } 393 394 void bnxt_ulp_async_events(struct bnxt *bp, struct hwrm_async_event_cmpl *cmpl) 395 { 396 u16 event_id = le16_to_cpu(cmpl->event_id); 397 struct bnxt_en_dev *edev = bp->edev; 398 struct bnxt_ulp_ops *ops; 399 int i; 400 401 if (!edev) 402 return; 403 404 rcu_read_lock(); 405 for (i = 0; i < BNXT_MAX_ULP; i++) { 406 struct bnxt_ulp *ulp = &edev->ulp_tbl[i]; 407 408 ops = rcu_dereference(ulp->ulp_ops); 409 if (!ops || !ops->ulp_async_notifier) 410 continue; 411 if (!ulp->async_events_bmap || 412 event_id > ulp->max_async_event_id) 413 continue; 414 415 /* Read max_async_event_id first before testing the bitmap. */ 416 smp_rmb(); 417 if (test_bit(event_id, ulp->async_events_bmap)) 418 ops->ulp_async_notifier(ulp->handle, cmpl); 419 } 420 rcu_read_unlock(); 421 } 422 423 static int bnxt_register_async_events(struct bnxt_en_dev *edev, int ulp_id, 424 unsigned long *events_bmap, u16 max_id) 425 { 426 struct net_device *dev = edev->net; 427 struct bnxt *bp = netdev_priv(dev); 428 struct bnxt_ulp *ulp; 429 430 if (ulp_id >= BNXT_MAX_ULP) 431 return -EINVAL; 432 433 ulp = &edev->ulp_tbl[ulp_id]; 434 ulp->async_events_bmap = events_bmap; 435 /* Make sure bnxt_ulp_async_events() sees this order */ 436 smp_wmb(); 437 ulp->max_async_event_id = max_id; 438 bnxt_hwrm_func_rgtr_async_events(bp, events_bmap, max_id + 1); 439 return 0; 440 } 441 442 static const struct bnxt_en_ops bnxt_en_ops_tbl = { 443 .bnxt_register_device = bnxt_register_dev, 444 .bnxt_unregister_device = bnxt_unregister_dev, 445 .bnxt_request_msix = bnxt_req_msix_vecs, 446 .bnxt_free_msix = bnxt_free_msix_vecs, 447 .bnxt_send_fw_msg = bnxt_send_msg, 448 .bnxt_register_fw_async_events = bnxt_register_async_events, 449 }; 450 451 struct bnxt_en_dev *bnxt_ulp_probe(struct net_device *dev) 452 { 453 struct bnxt *bp = netdev_priv(dev); 454 struct bnxt_en_dev *edev; 455 456 edev = bp->edev; 457 if (!edev) { 458 edev = kzalloc(sizeof(*edev), GFP_KERNEL); 459 if (!edev) 460 return ERR_PTR(-ENOMEM); 461 edev->en_ops = &bnxt_en_ops_tbl; 462 if (bp->flags & BNXT_FLAG_ROCEV1_CAP) 463 edev->flags |= BNXT_EN_FLAG_ROCEV1_CAP; 464 if (bp->flags & BNXT_FLAG_ROCEV2_CAP) 465 edev->flags |= BNXT_EN_FLAG_ROCEV2_CAP; 466 edev->net = dev; 467 edev->pdev = bp->pdev; 468 bp->edev = edev; 469 } 470 return bp->edev; 471 } 472