CPU queues on vslib

Signed-off-by: Prabhu Sreenivasan <[email protected]>

Author: Prabhu Sreenivasan

vslib/inc/SwitchBCM56850.h

@@ -24,6 +24,9 @@ namespace saivs
 
         protected:
 
+            sai_status_t create_cpu_qos_queues(
+                    _In_ sai_object_id_t port_id);
+
             virtual sai_status_t create_qos_queues_per_port(
                     _In_ sai_object_id_t port_id) override;
 

vslib/src/SwitchBCM56850.cpp

@@ -78,6 +78,56 @@ sai_status_t SwitchBCM56850::create_qos_queues_per_port(
     return SAI_STATUS_SUCCESS;
 }
 
+sai_status_t SwitchBCM56850::create_cpu_qos_queues(
+        _In_ sai_object_id_t port_id)
+{
+    SWSS_LOG_ENTER();
+
+    sai_attribute_t attr;
+
+    // CPU queues are of type multicast queues
+    const uint32_t port_qos_queues_count = 32;
+
+    std::vector<sai_object_id_t> queues;
+
+    for (uint32_t i = 0; i < port_qos_queues_count; ++i)
+    {
+        sai_object_id_t queue_id;
+
+        CHECK_STATUS(create(SAI_OBJECT_TYPE_QUEUE, &queue_id, m_switch_id, 0, NULL));
+
+        queues.push_back(queue_id);
+
+        attr.id = SAI_QUEUE_ATTR_TYPE;
+        attr.value.s32 = SAI_QUEUE_TYPE_MULTICAST;
+
+        CHECK_STATUS(set(SAI_OBJECT_TYPE_QUEUE, queue_id, &attr));
+
+        attr.id = SAI_QUEUE_ATTR_INDEX;
+        attr.value.u8 = (uint8_t)i;
+
+        CHECK_STATUS(set(SAI_OBJECT_TYPE_QUEUE, queue_id, &attr));
+
+        attr.id = SAI_QUEUE_ATTR_PORT;
+        attr.value.oid = port_id;
+
+        CHECK_STATUS(set(SAI_OBJECT_TYPE_QUEUE, queue_id, &attr));
+    }
+
+    attr.id = SAI_PORT_ATTR_QOS_NUMBER_OF_QUEUES;
+    attr.value.u32 = port_qos_queues_count;
+
+    CHECK_STATUS(set(SAI_OBJECT_TYPE_PORT, port_id, &attr));
+
+    attr.id = SAI_PORT_ATTR_QOS_QUEUE_LIST;
+    attr.value.objlist.count = port_qos_queues_count;
+    attr.value.objlist.list = queues.data();
+
+    CHECK_STATUS(set(SAI_OBJECT_TYPE_PORT, port_id, &attr));
+
+    return SAI_STATUS_SUCCESS;
+}
+
 sai_status_t SwitchBCM56850::create_qos_queues()
 {
     SWSS_LOG_ENTER();
@@ -91,6 +141,8 @@ sai_status_t SwitchBCM56850::create_qos_queues()
         CHECK_STATUS(create_qos_queues_per_port(port_id));
     }
 
+    CHECK_STATUS(create_cpu_qos_queues(m_cpu_port_id));
+
     return SAI_STATUS_SUCCESS;
 }