net: dcb: add helper functions to retrieve PCP and DSCP rewrite maps

Add two new helper functions to retrieve a mapping of priority to PCP
and DSCP bitmasks, where each bitmap contains ones in positions that
match a rewrite entry.

dcb_ieee_getrewr_prio_dscp_mask_map() reuses the dcb_ieee_app_prio_map,
as this struct is already used for a similar mapping in the app table.

Signed-off-by: Daniel Machon <daniel.machon@microchip.com>
Reviewed-by: Petr Machata <petrm@nvidia.com>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/include/net/dcbnl.h b/include/net/dcbnl.h
index fe7dfb8..42207fc 100644 (file)
--- a/include/net/dcbnl.h
+++ b/include/net/dcbnl.h
@@ -29,12 +29,22 @@ int dcb_ieee_setapp(struct net_device *, struct dcb_app *);
 int dcb_ieee_delapp(struct net_device *, struct dcb_app *);
 u8 dcb_ieee_getapp_mask(struct net_device *, struct dcb_app *);
 
+struct dcb_rewr_prio_pcp_map {
+       u16 map[IEEE_8021QAZ_MAX_TCS];
+};
+
+void dcb_getrewr_prio_pcp_mask_map(const struct net_device *dev,
+                                  struct dcb_rewr_prio_pcp_map *p_map);
+
 struct dcb_ieee_app_prio_map {
        u64 map[IEEE_8021QAZ_MAX_TCS];
 };
 void dcb_ieee_getapp_prio_dscp_mask_map(const struct net_device *dev,
                                        struct dcb_ieee_app_prio_map *p_map);
 
+void dcb_getrewr_prio_dscp_mask_map(const struct net_device *dev,
+                                   struct dcb_ieee_app_prio_map *p_map);
+
 struct dcb_ieee_app_dscp_map {
        u8 map[64];
 };

diff --git a/net/dcb/dcbnl.c b/net/dcb/dcbnl.c
index 2ca7fff..c0c4381 100644 (file)
--- a/net/dcb/dcbnl.c
+++ b/net/dcb/dcbnl.c
@@ -2232,6 +2232,58 @@ int dcb_ieee_delapp(struct net_device *dev, struct dcb_app *del)
 }
 EXPORT_SYMBOL(dcb_ieee_delapp);
 
+/* dcb_getrewr_prio_pcp_mask_map - For a given device, find mapping from
+ * priorities to the PCP and DEI values assigned to that priority.
+ */
+void dcb_getrewr_prio_pcp_mask_map(const struct net_device *dev,
+                                  struct dcb_rewr_prio_pcp_map *p_map)
+{
+       int ifindex = dev->ifindex;
+       struct dcb_app_type *itr;
+       u8 prio;
+
+       memset(p_map->map, 0, sizeof(p_map->map));
+
+       spin_lock_bh(&dcb_lock);
+       list_for_each_entry(itr, &dcb_rewr_list, list) {
+               if (itr->ifindex == ifindex &&
+                   itr->app.selector == DCB_APP_SEL_PCP &&
+                   itr->app.protocol < 16 &&
+                   itr->app.priority < IEEE_8021QAZ_MAX_TCS) {
+                       prio = itr->app.priority;
+                       p_map->map[prio] |= 1 << itr->app.protocol;
+               }
+       }
+       spin_unlock_bh(&dcb_lock);
+}
+EXPORT_SYMBOL(dcb_getrewr_prio_pcp_mask_map);
+
+/* dcb_getrewr_prio_dscp_mask_map - For a given device, find mapping from
+ * priorities to the DSCP values assigned to that priority.
+ */
+void dcb_getrewr_prio_dscp_mask_map(const struct net_device *dev,
+                                   struct dcb_ieee_app_prio_map *p_map)
+{
+       int ifindex = dev->ifindex;
+       struct dcb_app_type *itr;
+       u8 prio;
+
+       memset(p_map->map, 0, sizeof(p_map->map));
+
+       spin_lock_bh(&dcb_lock);
+       list_for_each_entry(itr, &dcb_rewr_list, list) {
+               if (itr->ifindex == ifindex &&
+                   itr->app.selector == IEEE_8021QAZ_APP_SEL_DSCP &&
+                   itr->app.protocol < 64 &&
+                   itr->app.priority < IEEE_8021QAZ_MAX_TCS) {
+                       prio = itr->app.priority;
+                       p_map->map[prio] |= 1ULL << itr->app.protocol;
+               }
+       }
+       spin_unlock_bh(&dcb_lock);
+}
+EXPORT_SYMBOL(dcb_getrewr_prio_dscp_mask_map);
+
 /*
  * dcb_ieee_getapp_prio_dscp_mask_map - For a given device, find mapping from
  * priorities to the DSCP values assigned to that priority. Initialize p_map