1 /* Broadcom NetXtreme-C/E network driver. 2 * 3 * Copyright (c) 2017 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/pci.h> 11 #include <linux/netdevice.h> 12 #include "bnxt_hsi.h" 13 #include "bnxt.h" 14 #include "bnxt_vfr.h" 15 #include "bnxt_devlink.h" 16 17 static const struct devlink_ops bnxt_dl_ops = { 18 #ifdef CONFIG_BNXT_SRIOV 19 .eswitch_mode_set = bnxt_dl_eswitch_mode_set, 20 .eswitch_mode_get = bnxt_dl_eswitch_mode_get, 21 #endif /* CONFIG_BNXT_SRIOV */ 22 }; 23 24 static const struct bnxt_dl_nvm_param nvm_params[] = { 25 {DEVLINK_PARAM_GENERIC_ID_ENABLE_SRIOV, NVM_OFF_ENABLE_SRIOV, 26 BNXT_NVM_SHARED_CFG, 1}, 27 }; 28 29 static int bnxt_hwrm_nvm_req(struct bnxt *bp, u32 param_id, void *msg, 30 int msg_len, union devlink_param_value *val) 31 { 32 struct hwrm_nvm_get_variable_input *req = msg; 33 void *data_addr = NULL, *buf = NULL; 34 struct bnxt_dl_nvm_param nvm_param; 35 int bytesize, idx = 0, rc, i; 36 dma_addr_t data_dma_addr; 37 38 /* Get/Set NVM CFG parameter is supported only on PFs */ 39 if (BNXT_VF(bp)) 40 return -EPERM; 41 42 for (i = 0; i < ARRAY_SIZE(nvm_params); i++) { 43 if (nvm_params[i].id == param_id) { 44 nvm_param = nvm_params[i]; 45 break; 46 } 47 } 48 49 if (i == ARRAY_SIZE(nvm_params)) 50 return -EOPNOTSUPP; 51 52 if (nvm_param.dir_type == BNXT_NVM_PORT_CFG) 53 idx = bp->pf.port_id; 54 else if (nvm_param.dir_type == BNXT_NVM_FUNC_CFG) 55 idx = bp->pf.fw_fid - BNXT_FIRST_PF_FID; 56 57 bytesize = roundup(nvm_param.num_bits, BITS_PER_BYTE) / BITS_PER_BYTE; 58 if (nvm_param.num_bits == 1) 59 buf = &val->vbool; 60 61 data_addr = dma_zalloc_coherent(&bp->pdev->dev, bytesize, 62 &data_dma_addr, GFP_KERNEL); 63 if (!data_addr) 64 return -ENOMEM; 65 66 req->dest_data_addr = cpu_to_le64(data_dma_addr); 67 req->data_len = cpu_to_le16(nvm_param.num_bits); 68 req->option_num = cpu_to_le16(nvm_param.offset); 69 req->index_0 = cpu_to_le16(idx); 70 if (idx) 71 req->dimensions = cpu_to_le16(1); 72 73 if (req->req_type == cpu_to_le16(HWRM_NVM_SET_VARIABLE)) 74 memcpy(data_addr, buf, bytesize); 75 76 rc = hwrm_send_message(bp, msg, msg_len, HWRM_CMD_TIMEOUT); 77 if (!rc && req->req_type == cpu_to_le16(HWRM_NVM_GET_VARIABLE)) 78 memcpy(buf, data_addr, bytesize); 79 80 dma_free_coherent(&bp->pdev->dev, bytesize, data_addr, data_dma_addr); 81 if (rc) 82 return -EIO; 83 return 0; 84 } 85 86 static int bnxt_dl_nvm_param_get(struct devlink *dl, u32 id, 87 struct devlink_param_gset_ctx *ctx) 88 { 89 struct hwrm_nvm_get_variable_input req = {0}; 90 struct bnxt *bp = bnxt_get_bp_from_dl(dl); 91 92 bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_GET_VARIABLE, -1, -1); 93 return bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val); 94 } 95 96 static int bnxt_dl_nvm_param_set(struct devlink *dl, u32 id, 97 struct devlink_param_gset_ctx *ctx) 98 { 99 struct hwrm_nvm_set_variable_input req = {0}; 100 struct bnxt *bp = bnxt_get_bp_from_dl(dl); 101 102 bnxt_hwrm_cmd_hdr_init(bp, &req, HWRM_NVM_SET_VARIABLE, -1, -1); 103 return bnxt_hwrm_nvm_req(bp, id, &req, sizeof(req), &ctx->val); 104 } 105 106 static const struct devlink_param bnxt_dl_params[] = { 107 DEVLINK_PARAM_GENERIC(ENABLE_SRIOV, 108 BIT(DEVLINK_PARAM_CMODE_PERMANENT), 109 bnxt_dl_nvm_param_get, bnxt_dl_nvm_param_set, 110 NULL), 111 }; 112 113 int bnxt_dl_register(struct bnxt *bp) 114 { 115 struct devlink *dl; 116 int rc; 117 118 if (bp->hwrm_spec_code < 0x10600) { 119 netdev_warn(bp->dev, "Firmware does not support NVM params"); 120 return -ENOTSUPP; 121 } 122 123 dl = devlink_alloc(&bnxt_dl_ops, sizeof(struct bnxt_dl)); 124 if (!dl) { 125 netdev_warn(bp->dev, "devlink_alloc failed"); 126 return -ENOMEM; 127 } 128 129 bnxt_link_bp_to_dl(bp, dl); 130 131 /* Add switchdev eswitch mode setting, if SRIOV supported */ 132 if (pci_find_ext_capability(bp->pdev, PCI_EXT_CAP_ID_SRIOV) && 133 bp->hwrm_spec_code > 0x10803) 134 bp->eswitch_mode = DEVLINK_ESWITCH_MODE_LEGACY; 135 136 rc = devlink_register(dl, &bp->pdev->dev); 137 if (rc) { 138 netdev_warn(bp->dev, "devlink_register failed. rc=%d", rc); 139 goto err_dl_free; 140 } 141 142 rc = devlink_params_register(dl, bnxt_dl_params, 143 ARRAY_SIZE(bnxt_dl_params)); 144 if (rc) { 145 netdev_warn(bp->dev, "devlink_params_register failed. rc=%d", 146 rc); 147 goto err_dl_unreg; 148 } 149 150 return 0; 151 152 err_dl_unreg: 153 devlink_unregister(dl); 154 err_dl_free: 155 bnxt_link_bp_to_dl(bp, NULL); 156 devlink_free(dl); 157 return rc; 158 } 159 160 void bnxt_dl_unregister(struct bnxt *bp) 161 { 162 struct devlink *dl = bp->dl; 163 164 if (!dl) 165 return; 166 167 devlink_params_unregister(dl, bnxt_dl_params, 168 ARRAY_SIZE(bnxt_dl_params)); 169 devlink_unregister(dl); 170 devlink_free(dl); 171 } 172