Add&nbsp;support&nbsp;for&nbsp;zsdadev&nbsp;queue&nbsp;dequeue.<br />
<br />Signed-off-by:&nbsp;Hanxiao&nbsp;Li&nbsp;&lt;li.hanxiao@zte.com.cn&gt;
<br />---<br />&nbsp;drivers/common/zsda/zsda_qp.c&nbsp;|&nbsp;56&nbsp;+++++++++++++++++++++++++++++++++++<br />&nbsp;drivers/common/zsda/zsda_qp.h&nbsp;|&nbsp;&nbsp;1&nbsp;+<br />&nbsp;2&nbsp;files&nbsp;changed,&nbsp;57&nbsp;insertions(+)<br />
<br />diff&nbsp;--git&nbsp;a/drivers/common/zsda/zsda_qp.c&nbsp;b/drivers/common/zsda/zsda_qp.c<br />index&nbsp;87932597ed..55d3f0702d&nbsp;100644<br />---&nbsp;a/drivers/common/zsda/zsda_qp.c<br />+++&nbsp;b/drivers/common/zsda/zsda_qp.c<br />@@&nbsp;-787,6&nbsp;+787,62&nbsp;@@&nbsp;zsda_enqueue_op_burst(struct&nbsp;zsda_qp&nbsp;*qp,&nbsp;void&nbsp;**ops,&nbsp;uint16_t&nbsp;nb_ops)<br />&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;return&nbsp;nb_send;<br />&nbsp;}<br />&nbsp;
<br />+static&nbsp;void<br />+zsda_dequeue(struct&nbsp;qp_srv&nbsp;*srv,&nbsp;void&nbsp;**ops,&nbsp;const&nbsp;uint16_t&nbsp;nb_ops,&nbsp;uint16_t&nbsp;*nb)<br />+{<br />+&nbsp;&nbsp;&nbsp;&nbsp;uint16_t&nbsp;head;<br />+&nbsp;&nbsp;&nbsp;&nbsp;struct&nbsp;zsda_cqe&nbsp;*cqe;<br />+&nbsp;&nbsp;&nbsp;&nbsp;struct&nbsp;zsda_queue&nbsp;*queue&nbsp;=&nbsp;&amp;srv-&gt;rx_q;<br />+&nbsp;&nbsp;&nbsp;&nbsp;struct&nbsp;zsda_op_cookie&nbsp;*cookie;<br />+&nbsp;&nbsp;&nbsp;&nbsp;head&nbsp;=&nbsp;queue-&gt;head;<br />+<br />+&nbsp;&nbsp;&nbsp;&nbsp;while&nbsp;(*nb&nbsp;&lt;&nbsp;nb_ops)&nbsp;{<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;cqe&nbsp;=&nbsp;(struct&nbsp;zsda_cqe&nbsp;*)(<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;(uint8_t&nbsp;*)queue-&gt;base_addr&nbsp;+&nbsp;head&nbsp;*&nbsp;queue-&gt;msg_size);<br />+<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;if&nbsp;(!CQE_VALID(cqe-&gt;err1))<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;break;<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;cookie&nbsp;=&nbsp;srv-&gt;op_cookies[cqe-&gt;sid];<br />+<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;ops[*nb]&nbsp;=&nbsp;cookie-&gt;op;<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;if&nbsp;(srv-&gt;rx_cb(cookie,&nbsp;cqe)&nbsp;==&nbsp;ZSDA_SUCCESS)<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;srv-&gt;stats.dequeued_count++;<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;else&nbsp;{<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;ZSDA_LOG(ERR,<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&quot;ERR!&nbsp;Cqe,&nbsp;opcode&nbsp;0x%x,&nbsp;sid&nbsp;0x%x,&nbsp;&quot;
<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&quot;tx_real_length&nbsp;0x%x,&nbsp;err0&nbsp;0x%x,&nbsp;err1&nbsp;0x%x&quot;,<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;cqe-&gt;op_code,&nbsp;cqe-&gt;sid,&nbsp;cqe-&gt;tx_real_length,<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;cqe-&gt;err0,&nbsp;cqe-&gt;err1);<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;srv-&gt;stats.dequeue_err_count++;<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;}<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;(*nb)++;<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;cookie-&gt;used&nbsp;=&nbsp;false;<br />+<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;head&nbsp;=&nbsp;zsda_modulo_16(head&nbsp;+&nbsp;1,&nbsp;queue-&gt;modulo_mask);<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;queue-&gt;head&nbsp;=&nbsp;head;<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;WRITE_CSR_CQ_HEAD(queue-&gt;io_addr,&nbsp;queue-&gt;hw_queue_number,&nbsp;head);<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;memset(cqe,&nbsp;0x0,&nbsp;sizeof(struct&nbsp;zsda_cqe));<br />+&nbsp;&nbsp;&nbsp;&nbsp;}<br />+}<br />+<br />+uint16_t<br />+zsda_dequeue_op_burst(struct&nbsp;zsda_qp&nbsp;*qp,&nbsp;void&nbsp;**ops,&nbsp;const&nbsp;uint16_t&nbsp;nb_ops)<br />+{<br />+&nbsp;&nbsp;&nbsp;&nbsp;uint16_t&nbsp;nb&nbsp;=&nbsp;0;<br />+&nbsp;&nbsp;&nbsp;&nbsp;uint32_t&nbsp;type&nbsp;=&nbsp;0;<br />+&nbsp;&nbsp;&nbsp;&nbsp;struct&nbsp;qp_srv&nbsp;*srv;<br />+<br />+&nbsp;&nbsp;&nbsp;&nbsp;for&nbsp;(type&nbsp;=&nbsp;0;&nbsp;type&nbsp;&lt;&nbsp;ZSDA_SERVICE_INVALID;&nbsp;type++)&nbsp;{<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;if&nbsp;(!qp-&gt;srv[type].used)<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;continue;<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;srv&nbsp;=&nbsp;&amp;qp-&gt;srv[type];<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;zsda_dequeue(srv,&nbsp;ops,&nbsp;nb_ops,&nbsp;&amp;nb);<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;if&nbsp;(nb&nbsp;&gt;=&nbsp;nb_ops)<br />+&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;return&nbsp;nb_ops;<br />+&nbsp;&nbsp;&nbsp;&nbsp;}<br />+&nbsp;&nbsp;&nbsp;&nbsp;return&nbsp;nb;<br />+}<br />+<br />&nbsp;int<br />&nbsp;zsda_common_setup_qp(uint32_t&nbsp;zsda_dev_id,&nbsp;struct&nbsp;zsda_qp&nbsp;**qp_addr,<br />&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;const&nbsp;uint16_t&nbsp;queue_pair_id,&nbsp;const&nbsp;struct&nbsp;zsda_qp_config&nbsp;*conf)<br />diff&nbsp;--git&nbsp;a/drivers/common/zsda/zsda_qp.h&nbsp;b/drivers/common/zsda/zsda_qp.h<br />index&nbsp;f9efff0e5a..7c61a7b486&nbsp;100644<br />---&nbsp;a/drivers/common/zsda/zsda_qp.h<br />+++&nbsp;b/drivers/common/zsda/zsda_qp.h<br />@@&nbsp;-136,6&nbsp;+136,7&nbsp;@@&nbsp;int&nbsp;zsda_get_queue_cfg(struct&nbsp;zsda_pci_device&nbsp;*zsda_pci_dev);<br />&nbsp;int&nbsp;zsda_queue_pair_release(struct&nbsp;zsda_qp&nbsp;**qp_addr);<br />&nbsp;
<br />&nbsp;uint16_t&nbsp;zsda_enqueue_op_burst(struct&nbsp;zsda_qp&nbsp;*qp,&nbsp;void&nbsp;**ops,&nbsp;const&nbsp;uint16_t&nbsp;nb_ops);<br />+uint16_t&nbsp;zsda_dequeue_op_burst(struct&nbsp;zsda_qp&nbsp;*qp,&nbsp;void&nbsp;**ops,&nbsp;const&nbsp;uint16_t&nbsp;nb_ops);<br />&nbsp;
<br />&nbsp;int&nbsp;zsda_common_setup_qp(uint32_t&nbsp;dev_id,&nbsp;struct&nbsp;zsda_qp&nbsp;**qp_addr,<br />&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;&nbsp;const&nbsp;uint16_t&nbsp;queue_pair_id,<br />--&nbsp;
<br />2.27.0<br />