1 files changed, 61 insertions, 2 deletions

diff --git a/fw/v0/pacfgcmn.p b/fw/v0/pacfgcmn.p
index d913fbb..2966da8 100644
--- a/fw/v0/pacfgcmn.p
+++ b/fw/v0/pacfgcmn.p
@@ -274,6 +274,24 @@ f_cfgReply:
 

 l_cfgReply0:

 

+l_cfgReply0_queue_bounce:

+        // Check for Queue Bounce operation

+l_cfgReply0_queue_bounce_ddr:

+        qbbc l_cfgReply0_queue_bounce_msmc, s_paCmd1.replyQueue.t_pa_forward_queue_bounce_ddr

+            clr s_paCmd1.replyQueue.t_pa_forward_queue_bounce_ddr

+            sbco s_paCmd1.replyQueue,  cCdeOutPkt, OFFSET(s_pktDescr.swinfo1) + 2,  2

+            lbco s_paCmd1.replyQueue,  PAMEM_CONST_CUSTOM, OFFSET_QUEUE_BOUNCE_CFG, 2

+            jmp  l_cfgReply0_queue_bounce_end

+

+l_cfgReply0_queue_bounce_msmc:

+        qbbc l_cfgReply0_queue_bounce_end, s_paCmd1.replyQueue.t_pa_forward_queue_bounce_msmc

+            clr s_paCmd1.replyQueue.t_pa_forward_queue_bounce_msmc

+            sbco s_paCmd1.replyQueue,  cCdeOutPkt, OFFSET(s_pktDescr.swinfo1) + 2,  2

+            lbco s_paCmd1.replyQueue,  PAMEM_CONST_CUSTOM, OFFSET_QUEUE_BOUNCE_CFG+2, 2

+            // pass through

+

+l_cfgReply0_queue_bounce_end:

+

    mov  s_cdeCmdPkt.psInfoSize,  0

    mov  s_cdeCmdPkt.threadId,    s_paCmd1.replyDest

    mov  s_cdeCmdPkt.destQueue,   s_paCmd1.replyQueue

@@ -341,7 +359,7 @@ l_cfgReply1:
 // *   R17:            | pktCtrl

 // *   R18:            | pktCtrl (MacPaddingCfg)

 // *   R19:            | Events BitMap

-// *   R20:          |

+// *   R20:            | queueBounce

 // *   R21:          |

 // *   R22:     |     

 // *   R23:     |  Packet context - pktScope   

@@ -380,7 +398,7 @@ l_paComConfigPa0:
    xout XID_CDECTRL,           s_cdeCmdWd,    SIZE(s_cdeCmdWd)

    

    // Input configurations for command set, usr stats, queue divert, and packet control

-   xin  XID_CDEDATA,  s_paComCmdSetCfg,  SIZE(s_paComCmdSetCfg) + SIZE(s_paComUsrStats) + SIZE(s_paComQueueDivert) + SIZE(s_paComPktCtrl)

+   xin  XID_CDEDATA,  s_paComCmdSetCfg,  SIZE(s_paComCmdSetCfg) + SIZE(s_paComUsrStats) + SIZE(s_paComQueueDivert) + SIZE(s_paComPktCtrl)+ SIZE(s_paComQueueBounce)

 

 

    qbbc  l_paComConfigPa1,   s_paCmdCfgA.validFlag.t_paCmdConfigValidMaxCount

@@ -548,6 +566,11 @@ l_paComConfigPa6_mbox45_post:
             sbbo r1, r2, FIRMWARE_CMD_PKT_CTRL_CFG_OFFSET, 4             

          

 l_paComConfigPa7:

+   qbbc  l_paComConfigPa8, s_paCmdCfgA.validFlag.t_paCmdConfigValidQueueBounce

+   // Configure queue bounce

+       sbco s_paComQueueBounce,  PAMEM_CONST_CUSTOM,  OFFSET_QUEUE_BOUNCE_CFG,     SIZE(s_paComQueueBounce)

+

+l_paComConfigPa8:

    jmp f_cfgReply

 

     .leave cdeScope

@@ -2006,6 +2029,24 @@ l_paMultiFwd5:
     sbco  s_paSr0.swInfo0,  cCdeOutPkt,  OFFSET(s_pktDescr.swinfo0),  SIZE(s_pktDescr.swinfo0)

 

 l_paMultiFwd6:

+l_paMultiFwd6_queue_bounce:

+        // Check for Queue Bounce operation

+l_paMultiFwd6_queue_bounce_ddr:

+        qbbc l_paMultiFwd6_queue_bounce_msmc, s_paSr0.queue.t_pa_forward_queue_bounce_ddr

+            clr s_paSr0.queue.t_pa_forward_queue_bounce_ddr

+            sbco s_paSr0.queue,  cCdeOutPkt, OFFSET(s_pktDescr.swinfo1) + 2,  2

+            lbco s_paSr0.queue,  PAMEM_CONST_CUSTOM, OFFSET_QUEUE_BOUNCE_CFG, 2

+            jmp  l_paMultiFwd6_queue_bounce_end

+

+l_paMultiFwd6_queue_bounce_msmc:

+        qbbc l_paMultiFwd6_queue_bounce_end, s_paSr0.queue.t_pa_forward_queue_bounce_msmc

+            clr s_paSr0.queue.t_pa_forward_queue_bounce_msmc

+            sbco s_paSr0.queue,  cCdeOutPkt, OFFSET(s_pktDescr.swinfo1) + 2,  2

+            lbco s_paSr0.queue,  PAMEM_CONST_CUSTOM, OFFSET_QUEUE_BOUNCE_CFG+2, 2

+            // pass through

+

+l_paMultiFwd6_queue_bounce_end:

+

   zero &s_cdeCmdPkt,            SIZE(s_cdeCmdPkt)

   mov  s_cdeCmdPkt.optionsFlag, CDE_FLG_SET_THREADID | CDE_FLG_SET_FLOWID | CDE_FLG_SET_PSINFO | CDE_FLG_SET_DESTQUEUE

   mov  s_cdeCmdPkt.operation,   CDE_CMD_PACKET_COPY

@@ -2251,6 +2292,24 @@ l_curPktForward1_dscp_priority:
             mov  r2.b2,  PA_DEST_CDMA    

 l_curPktForward1_no_priority:

 

+l_curPktForward1_queue_bounce:

+        // Check for Queue Bounce operation

+l_curPktForward1_queue_bounce_ddr:

+        qbbc l_curPktForward1_queue_bounce_msmc, s_curFwd.queue.t_pa_forward_queue_bounce_ddr

+            clr s_curFwd.queue.t_pa_forward_queue_bounce_ddr

+            sbco s_curFwd.queue,  cCdeOutPkt, OFFSET(s_pktDescr.swinfo1) + 2,  2

+            lbco s_curFwd.queue,  PAMEM_CONST_CUSTOM, OFFSET_QUEUE_BOUNCE_CFG, 2

+            jmp  l_curPktForward1_queue_bounce_end

+

+l_curPktForward1_queue_bounce_msmc:

+        qbbc l_curPktForward1_queue_bounce_end, s_curFwd.queue.t_pa_forward_queue_bounce_msmc

+            clr s_curFwd.queue.t_pa_forward_queue_bounce_msmc

+            sbco s_curFwd.queue,  cCdeOutPkt, OFFSET(s_pktDescr.swinfo1) + 2,  2

+            lbco s_curFwd.queue,  PAMEM_CONST_CUSTOM, OFFSET_QUEUE_BOUNCE_CFG+2, 2

+            // pass through

+

+l_curPktForward1_queue_bounce_end:

+

         // Check whether command set is enabled, which precedes the multi-route option

         qbeq l_curPktForward8,  s_curFwdRxCmdHdr.cmd, PA_RX_CMD_CMDSET

         qbeq l_curPktForward8,  s_curFwdRxCmdHdr.cmd, PA_RX_CMD_CMDSET_USR_STATS