summaryrefslogtreecommitdiffstats
path: root/src/plugins/marvell/pp2/output.c
diff options
context:
space:
mode:
authorDamjan Marion <damjan.marion@gmail.com>2017-12-26 13:40:13 +0000
committerDamjan Marion <dmarion.lists@gmail.com>2018-01-15 16:36:09 +0000
commit92cdd72058a80d0b8b28c00495b3051a0390d545 (patch)
tree9d3743739f6cbd3e6e63c5c90a2f0cb7ee3b7fae /src/plugins/marvell/pp2/output.c
parentc5239ad59716a833a15523755b03418a47e02a5a (diff)
Marvell device plugin
Depends in musdk 17.10 [1], tested on MACCHIATObin [2] board. currently only coves PP2. musdk must be compiled with: ./configure --enable-bpool-dma=64 [1] https://github.com/MarvellEmbeddedProcessors/musdk-marvell [2] http://macchiatobin.net Change-Id: I0247a6b860b0a067c54190eae0bd3fe08de234ad Signed-off-by: Damjan Marion <damarion@cisco.com>
Diffstat (limited to 'src/plugins/marvell/pp2/output.c')
-rw-r--r--src/plugins/marvell/pp2/output.c121
1 files changed, 121 insertions, 0 deletions
diff --git a/src/plugins/marvell/pp2/output.c b/src/plugins/marvell/pp2/output.c
new file mode 100644
index 00000000000..64529945f18
--- /dev/null
+++ b/src/plugins/marvell/pp2/output.c
@@ -0,0 +1,121 @@
+/*
+ *------------------------------------------------------------------
+ * Copyright (c) 2018 Cisco and/or its affiliates.
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at:
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *------------------------------------------------------------------
+ */
+
+#include <stdint.h>
+#include <net/if.h>
+#include <sys/ioctl.h>
+#include <sys/uio.h>
+
+#include <vlib/vlib.h>
+#include <vlib/unix/unix.h>
+#include <vnet/ethernet/ethernet.h>
+#include <vnet/devices/devices.h>
+
+#include <marvell/pp2/pp2.h>
+
+uword
+mrvl_pp2_interface_tx (vlib_main_t * vm,
+ vlib_node_runtime_t * node, vlib_frame_t * frame)
+{
+ mrvl_pp2_main_t *ppm = &mrvl_pp2_main;
+ vnet_interface_output_runtime_t *rd = (void *) node->runtime_data;
+ mrvl_pp2_if_t *ppif = pool_elt_at_index (ppm->interfaces, rd->dev_instance);
+ u32 thread_index = vlib_get_thread_index ();
+ mrvl_pp2_per_thread_data_t *ptd =
+ vec_elt_at_index (ppm->per_thread_data, thread_index);
+ u8 qid = thread_index;
+ mrvl_pp2_outq_t *outq = vec_elt_at_index (ppif->outqs, qid);
+ u32 *buffers = vlib_frame_args (frame);
+ u16 n_desc = frame->n_vectors, n_left = n_desc, n_sent = n_desc, n_done;
+ struct pp2_ppio_desc *d;
+ u16 mask = outq->size - 1;
+
+ if (PREDICT_FALSE (pp2_ppio_get_num_outq_done (ppif->ppio, ptd->hif, qid,
+ &n_done)))
+ {
+ n_done = 0;
+ vlib_error_count (vm, node->node_index,
+ MRVL_PP2_TX_ERROR_PPIO_GET_NUM_OUTQ_DONE, 1);
+ }
+
+ if (n_done)
+ {
+ u16 n_free = clib_min (n_done, outq->size - (outq->tail & mask));
+ vlib_buffer_free (vm, outq->buffers + (outq->tail & mask), n_free);
+ if (PREDICT_FALSE (n_free < n_done))
+ vlib_buffer_free (vm, outq->buffers, n_done - n_free);
+ outq->tail += n_done;
+ }
+
+ vec_validate_aligned (ptd->descs, n_left, CLIB_CACHE_LINE_BYTES);
+ d = ptd->descs;
+ while (n_left)
+ {
+ u32 bi0 = buffers[0];
+ vlib_buffer_t *b0 = vlib_get_buffer (vm, bi0);
+ u64 paddr = vlib_get_buffer_data_physical_address (vm, bi0);
+
+ pp2_ppio_outq_desc_reset (d);
+ pp2_ppio_outq_desc_set_phys_addr (d, paddr + b0->current_data);
+ pp2_ppio_outq_desc_set_pkt_offset (d, 0);
+ pp2_ppio_outq_desc_set_pkt_len (d, b0->current_length);
+ d++;
+ buffers++;
+ n_left--;
+ }
+
+ if (pp2_ppio_send (ppif->ppio, ptd->hif, qid, ptd->descs, &n_sent))
+ {
+ n_sent = 0;
+ vlib_error_count (vm, node->node_index, MRVL_PP2_TX_ERROR_PPIO_SEND, 1);
+ }
+
+ /* free unsent buffers */
+ if (PREDICT_FALSE (n_sent != n_desc))
+ {
+ vlib_buffer_free (vm, vlib_frame_args (frame) + n_sent,
+ frame->n_vectors - n_sent);
+ vlib_error_count (vm, node->node_index, MRVL_PP2_TX_ERROR_NO_FREE_SLOTS,
+ frame->n_vectors - n_sent);
+ }
+
+ /* store buffer index for each enqueued packet into the ring
+ so we can know what to free after packet is sent */
+ if (n_sent)
+ {
+ u16 slot = outq->head & mask;
+ buffers = vlib_frame_args (frame);
+ u16 n_copy = clib_min (outq->size - slot, n_sent);
+
+ clib_memcpy (outq->buffers + slot, buffers, n_copy * sizeof (u32));
+ if (PREDICT_FALSE (n_copy < n_sent))
+ clib_memcpy (outq->buffers, buffers + n_copy,
+ (n_sent - n_copy) * sizeof (u32));
+
+ outq->head += n_sent;
+ }
+
+ return n_sent;
+}
+
+/*
+ * fd.io coding-style-patch-verification: ON
+ *
+ * Local Variables:
+ * eval: (c-set-style "gnu")
+ * End:
+ */