implement meter object create function.

Signed-off-by: Jasvinder Singh <jasvinder.si...@intel.com>
---
 drivers/net/softnic/rte_eth_softnic_internals.h |  4 ++
 drivers/net/softnic/rte_eth_softnic_meter.c     | 92 ++++++++++++++++++++++++-
 2 files changed, 95 insertions(+), 1 deletion(-)

diff --git a/drivers/net/softnic/rte_eth_softnic_internals.h 
b/drivers/net/softnic/rte_eth_softnic_internals.h
index 14ea57d..4e2ad56 100644
--- a/drivers/net/softnic/rte_eth_softnic_internals.h
+++ b/drivers/net/softnic/rte_eth_softnic_internals.h
@@ -612,6 +612,10 @@ softnic_mtr_init(struct pmd_internals *p);
 void
 softnic_mtr_free(struct pmd_internals *p);
 
+struct softnic_mtr *
+softnic_mtr_find(struct pmd_internals *p,
+       uint32_t mtr_id);
+
 struct softnic_mtr_meter_profile *
 softnic_mtr_meter_profile_find(struct pmd_internals *p,
        uint32_t meter_profile_id);
diff --git a/drivers/net/softnic/rte_eth_softnic_meter.c 
b/drivers/net/softnic/rte_eth_softnic_meter.c
index 1d6af0c..261a6a3 100644
--- a/drivers/net/softnic/rte_eth_softnic_meter.c
+++ b/drivers/net/softnic/rte_eth_softnic_meter.c
@@ -179,13 +179,103 @@ pmd_mtr_meter_profile_delete(struct rte_eth_dev *dev,
        return 0;
 }
 
+struct softnic_mtr *
+softnic_mtr_find(struct pmd_internals *p, uint32_t mtr_id)
+{
+       struct softnic_mtr_list *ml = &p->mtr.mtrs;
+       struct softnic_mtr *m;
+
+       TAILQ_FOREACH(m, ml, node)
+               if (m->mtr_id == mtr_id)
+                       return m;
+
+       return NULL;
+}
+
+
+/* MTR object create */
+static int
+pmd_mtr_create(struct rte_eth_dev *dev,
+       uint32_t mtr_id,
+       struct rte_mtr_params *params,
+       int shared,
+       struct rte_mtr_error *error)
+{
+       struct pmd_internals *p = dev->data->dev_private;
+       struct softnic_mtr_list *ml = &p->mtr.mtrs;
+       struct softnic_mtr_meter_profile *mp;
+       struct softnic_mtr *m;
+
+       /* MTR id valid  */
+       if (softnic_mtr_find(p, mtr_id))
+               return -rte_mtr_error_set(error,
+                       EEXIST,
+                       RTE_MTR_ERROR_TYPE_MTR_ID,
+                       NULL,
+                       rte_strerror(EEXIST));
+
+       /* MTR params must not be NULL */
+       if (params == NULL)
+               return -rte_mtr_error_set(error,
+                       EINVAL,
+                       RTE_MTR_ERROR_TYPE_MTR_PARAMS,
+                       NULL,
+                       rte_strerror(EINVAL));
+
+       /* Meter profile must exist */
+       mp = softnic_mtr_meter_profile_find(p, params->meter_profile_id);
+       if (mp == NULL)
+               return -rte_mtr_error_set(error,
+                       EINVAL,
+                       RTE_MTR_ERROR_TYPE_METER_PROFILE_ID,
+                       NULL,
+                       rte_strerror(EINVAL));
+
+       /* Previous meter color not supported */
+       if (params->use_prev_mtr_color)
+               return -rte_mtr_error_set(error,
+                       EINVAL,
+                       RTE_MTR_ERROR_TYPE_MTR_PARAMS,
+                       NULL,
+                       rte_strerror(EINVAL));
+
+       /* Shared MTR object not supported */
+       if (shared)
+               return -rte_mtr_error_set(error,
+                       EINVAL,
+                       RTE_MTR_ERROR_TYPE_SHARED,
+                       NULL,
+                       rte_strerror(EINVAL));
+
+       /* Memory allocation */
+       m = calloc(1, sizeof(struct softnic_mtr));
+       if (m == NULL)
+               return -rte_mtr_error_set(error,
+                       ENOMEM,
+                       RTE_MTR_ERROR_TYPE_UNSPECIFIED,
+                       NULL,
+                       rte_strerror(ENOMEM));
+
+       /* Fill in */
+       m->mtr_id = mtr_id;
+       memcpy(&m->params, params, sizeof(m->params));
+
+       /* Add to list */
+       TAILQ_INSERT_TAIL(ml, m, node);
+
+       /* Update dependencies */
+       mp->n_users++;
+
+       return 0;
+}
+
 const struct rte_mtr_ops pmd_mtr_ops = {
        .capabilities_get = NULL,
 
        .meter_profile_add = pmd_mtr_meter_profile_add,
        .meter_profile_delete = pmd_mtr_meter_profile_delete,
 
-       .create = NULL,
+       .create = pmd_mtr_create,
        .destroy = NULL,
        .meter_enable = NULL,
        .meter_disable = NULL,
-- 
2.9.3

Reply via email to