Initial Commit

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                                                                                    */
+/*------------------------------------------------------------------------------------------------*/
+