drivers/net/ethernet/marvell/octeontx2/nic/otx2_devlink.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Marvell RVU PF/VF Netdev Devlink
   3  *
   4  * Copyright (C) 2021 Marvell.
   5  */
   6
   7 #include "otx2_common.h"
   8
   9 /* Devlink Params APIs */
  10 static int otx2_dl_mcam_count_validate(struct devlink *devlink, u32 id,
  11                                        union devlink_param_value val,
  12                                        struct netlink_ext_ack *extack)
  13 {
  14         struct otx2_devlink *otx2_dl = devlink_priv(devlink);
  15         struct otx2_nic *pfvf = otx2_dl->pfvf;
  16         struct otx2_flow_config *flow_cfg;
  17
  18         if (!pfvf->flow_cfg) {
  19                 NL_SET_ERR_MSG_MOD(extack,
  20                                    "pfvf->flow_cfg not initialized");
  21                 return -EINVAL;
  22         }
  23
  24         flow_cfg = pfvf->flow_cfg;
  25         if (flow_cfg && flow_cfg->nr_flows) {
  26                 NL_SET_ERR_MSG_MOD(extack,
  27                                    "Cannot modify count when there are active rules");
  28                 return -EINVAL;
  29         }
  30
  31         return 0;
  32 }
  33
  34 static int otx2_dl_mcam_count_set(struct devlink *devlink, u32 id,
  35                                   struct devlink_param_gset_ctx *ctx)
  36 {
  37         struct otx2_devlink *otx2_dl = devlink_priv(devlink);
  38         struct otx2_nic *pfvf = otx2_dl->pfvf;
  39
  40         if (!pfvf->flow_cfg)
  41                 return 0;
  42
  43         otx2_alloc_mcam_entries(pfvf, ctx->val.vu16);
  44
  45         return 0;
  46 }
  47
  48 static int otx2_dl_mcam_count_get(struct devlink *devlink, u32 id,
  49                                   struct devlink_param_gset_ctx *ctx)
  50 {
  51         struct otx2_devlink *otx2_dl = devlink_priv(devlink);
  52         struct otx2_nic *pfvf = otx2_dl->pfvf;
  53         struct otx2_flow_config *flow_cfg;
  54
  55         if (!pfvf->flow_cfg) {
  56                 ctx->val.vu16 = 0;
  57                 return 0;
  58         }
  59
  60         flow_cfg = pfvf->flow_cfg;
  61         ctx->val.vu16 = flow_cfg->max_flows;
  62
  63         return 0;
  64 }
  65
  66 enum otx2_dl_param_id {
  67         OTX2_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
  68         OTX2_DEVLINK_PARAM_ID_MCAM_COUNT,
  69 };
  70
  71 static const struct devlink_param otx2_dl_params[] = {
  72         DEVLINK_PARAM_DRIVER(OTX2_DEVLINK_PARAM_ID_MCAM_COUNT,
  73                              "mcam_count", DEVLINK_PARAM_TYPE_U16,
  74                              BIT(DEVLINK_PARAM_CMODE_RUNTIME),
  75                              otx2_dl_mcam_count_get, otx2_dl_mcam_count_set,
  76                              otx2_dl_mcam_count_validate),
  77 };
  78
  79 static const struct devlink_ops otx2_devlink_ops = {
  80 };
  81
  82 int otx2_register_dl(struct otx2_nic *pfvf)
  83 {
  84         struct otx2_devlink *otx2_dl;
  85         struct devlink *dl;
  86         int err;
  87
  88         dl = devlink_alloc(&otx2_devlink_ops,
  89                            sizeof(struct otx2_devlink), pfvf->dev);
  90         if (!dl) {
  91                 dev_warn(pfvf->dev, "devlink_alloc failed\n");
  92                 return -ENOMEM;
  93         }
  94
  95         otx2_dl = devlink_priv(dl);
  96         otx2_dl->dl = dl;
  97         otx2_dl->pfvf = pfvf;
  98         pfvf->dl = otx2_dl;
  99
 100         err = devlink_params_register(dl, otx2_dl_params,
 101                                       ARRAY_SIZE(otx2_dl_params));
 102         if (err) {
 103                 dev_err(pfvf->dev,
 104                         "devlink params register failed with error %d", err);
 105                 goto err_dl;
 106         }
 107
 108         devlink_register(dl);
 109         return 0;
 110
 111 err_dl:
 112         devlink_free(dl);
 113         return err;
 114 }
 115
 116 void otx2_unregister_dl(struct otx2_nic *pfvf)
 117 {
 118         struct otx2_devlink *otx2_dl = pfvf->dl;
 119         struct devlink *dl = otx2_dl->dl;
 120
 121         devlink_unregister(dl);
 122         devlink_params_unregister(dl, otx2_dl_params,
 123                                   ARRAY_SIZE(otx2_dl_params));
 124         devlink_free(dl);
 125 }