aboutsummaryrefslogtreecommitdiffstats
path: root/ucs2-lib/src/ucs_amtp.c
diff options
context:
space:
mode:
Diffstat (limited to 'ucs2-lib/src/ucs_amtp.c')
-rw-r--r--ucs2-lib/src/ucs_amtp.c114
1 files changed, 114 insertions, 0 deletions
diff --git a/ucs2-lib/src/ucs_amtp.c b/ucs2-lib/src/ucs_amtp.c
new file mode 100644
index 0000000..e4550d6
--- /dev/null
+++ b/ucs2-lib/src/ucs_amtp.c
@@ -0,0 +1,114 @@
+/*------------------------------------------------------------------------------------------------*/
+/* UNICENS V2.1.0-3491 */
+/* Copyright (c) 2017 Microchip Technology Germany II GmbH & Co. KG. */
+/* */
+/* This program is free software: you can redistribute it and/or modify */
+/* it under the terms of the GNU General Public License as published by */
+/* the Free Software Foundation, either version 2 of the License, or */
+/* (at your option) any later version. */
+/* */
+/* This program is distributed in the hope that it will be useful, */
+/* but WITHOUT ANY WARRANTY; without even the implied warranty of */
+/* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the */
+/* GNU General Public License for more details. */
+/* */
+/* You should have received a copy of the GNU General Public License */
+/* along with this program. If not, see <http://www.gnu.org/licenses/>. */
+/* */
+/* You may also obtain this software under a propriety license from Microchip. */
+/* Please contact Microchip for further information. */
+/*------------------------------------------------------------------------------------------------*/
+
+/*!
+ * \file
+ * \brief Implementation of Application Message Tx Pool
+ *
+ * \cond UCS_INTERNAL_DOC
+ * \addtogroup G_AMTP
+ * @{
+ */
+
+/*------------------------------------------------------------------------------------------------*/
+/* Includes */
+/*------------------------------------------------------------------------------------------------*/
+#include "ucs_amtp.h"
+#include "ucs_misc.h"
+
+/*------------------------------------------------------------------------------------------------*/
+/* Internal prototypes */
+/*------------------------------------------------------------------------------------------------*/
+static void Amtp_OnMsgFreed(void *self, Ucs_AmsTx_Msg_t* msg_ptr);
+
+/*------------------------------------------------------------------------------------------------*/
+/* Initialization */
+/*------------------------------------------------------------------------------------------------*/
+/*! \brief Constructor of class CAmtp
+ * \param self The instance
+ * \param msg_ptr Reference to an array of Amsg_IntMsgTx_t objects
+ * \param data_ptr Reference to payload data which is required for the payload of all messages.
+ * The data size must be the product of message_cnt and payload_cnt.
+ * \param msg_cnt The number of message objects in the array
+ * \param payload_sz The payload size for each message. The size must be a multiple of "4".
+ * \param ucs_user_ptr User reference that needs to be passed in every callback function
+ */
+void Amtp_Ctor(CAmtp *self, Amsg_IntMsgTx_t msg_ptr[], uint8_t data_ptr[], uint8_t msg_cnt, uint16_t payload_sz, void *ucs_user_ptr)
+{
+ uint8_t i = 0U;
+ uint32_t mem_idx = 0U;
+ Ucs_AmsTx_Msg_t *tx_ptr;
+
+ self->ucs_user_ptr = ucs_user_ptr;
+ TR_ASSERT(self->ucs_user_ptr, "[AMTP]", ((payload_sz % 4U) == 0U)); /* payload_sz shall be rounded to full quadlet */
+ TR_ASSERT(self->ucs_user_ptr, "[AMTP]", ((payload_sz * msg_cnt) <= 65535U)); /* total data shall be referenced by uint32_t index */
+
+ Dl_Ctor(&self->msg_queue, self->ucs_user_ptr);
+
+ for (i = 0U; i < msg_cnt; i++)
+ {
+ tx_ptr = (Ucs_AmsTx_Msg_t*)(void*)&(msg_ptr[i]);
+ Amsg_TxCtor(tx_ptr, NULL, &Amtp_OnMsgFreed, self);
+
+ if (payload_sz > 0U)
+ {
+ Amsg_TxSetInternalPayload(tx_ptr, &data_ptr[mem_idx], payload_sz, NULL);
+ mem_idx += payload_sz;
+ }
+
+ Amsg_TxEnqueue(tx_ptr, &self->msg_queue);
+ }
+
+}
+
+/*! \brief Retrieves a Tx application message object
+ * \param self The instance
+ * \return Retrieves the reference to a Tx application message object if the allocation
+ * succeeded, otherwise \c NULL.
+ */
+Ucs_AmsTx_Msg_t* Amtp_AllocMsg(CAmtp *self)
+{
+ return Amsg_TxDequeue(&self->msg_queue);
+}
+
+/*! \brief Callback function which is invoked if the message object is freed
+ * by the AMS
+ * \param self The instance
+ * \param msg_ptr Reference to the freed application Tx message object
+ */
+static void Amtp_OnMsgFreed(void *self, Ucs_AmsTx_Msg_t* msg_ptr)
+{
+ CAmtp *self_ = (CAmtp*)self;
+
+ Amsg_TxReuse(msg_ptr);
+ Amsg_TxEnqueue(msg_ptr, &self_->msg_queue);
+}
+
+
+/*!
+ * @}
+ * \endcond
+ */
+
+/*------------------------------------------------------------------------------------------------*/
+/* End of file */
+/*------------------------------------------------------------------------------------------------*/
+