diff options
Diffstat (limited to 'lib/avtp_pipeline/adp/openavb_adp.c')
| -rw-r--r-- | lib/avtp_pipeline/adp/openavb_adp.c | 181 |
1 files changed, 181 insertions, 0 deletions
diff --git a/lib/avtp_pipeline/adp/openavb_adp.c b/lib/avtp_pipeline/adp/openavb_adp.c new file mode 100644 index 00000000..474c8d3e --- /dev/null +++ b/lib/avtp_pipeline/adp/openavb_adp.c @@ -0,0 +1,181 @@ +/*************************************************************************************************************
+Copyright (c) 2012-2015, Symphony Teleca Corporation, a Harman International Industries, Incorporated company
+Copyright (c) 2016-2017, Harman International Industries, Incorporated
+All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+
+1. Redistributions of source code must retain the above copyright notice, this
+ list of conditions and the following disclaimer.
+2. Redistributions in binary form must reproduce the above copyright notice,
+ this list of conditions and the following disclaimer in the documentation
+ and/or other materials provided with the distribution.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS LISTED "AS IS" AND
+ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
+WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
+DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS LISTED BE LIABLE FOR
+ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
+(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
+LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
+ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
+SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+
+Attributions: The inih library portion of the source code is licensed from
+Brush Technology and Ben Hoyt - Copyright (c) 2009, Brush Technology and Copyright (c) 2009, Ben Hoyt.
+Complete license and copyright information can be found at
+https://github.com/benhoyt/inih/commit/74d2ca064fb293bc60a77b0bd068075b293cf175.
+*************************************************************************************************************/
+
+/*
+ ******************************************************************
+ * MODULE : ADP - AVDECC Discovery Protocol
+ * MODULE SUMMARY : Implements the 1722.1 (AVDECC) discovery protocol
+ ******************************************************************
+ */
+
+#include "openavb_platform.h"
+
+#include <signal.h>
+
+#define AVB_LOG_COMPONENT "ADP"
+#include "openavb_log.h"
+
+#include "openavb_aem.h"
+#include "openavb_adp.h"
+#include "openavb_adp_sm_advertise_entity.h"
+#include "openavb_adp_sm_advertise_interface.h"
+#include "openavb_adp_message.h"
+
+#ifdef AVB_PTP_AVAILABLE
+#include "openavb_ptp_api.h"
+
+// PTP declarations
+openavbRC openavbPtpInitializeSharedMemory ();
+void openavbPtpReleaseSharedMemory ();
+openavbRC openavbPtpUpdateSharedMemoryEntry ();
+openavbRC openavbPtpFindLatestSharedMemoryEntry(U32 *index);
+extern gmChangeTable_t openavbPtpGMChageTable;
+#endif // AVB_PTP_AVAILABLE
+
+openavb_adp_sm_global_vars_t openavbAdpSMGlobalVars;
+
+MUTEX_HANDLE(openavbAdpMutex);
+#define ADP_LOCK() { MUTEX_CREATE_ERR(); MUTEX_LOCK(openavbAdpMutex); MUTEX_LOG_ERR("Mutex lock failure"); }
+#define ADP_UNLOCK() { MUTEX_CREATE_ERR(); MUTEX_UNLOCK(openavbAdpMutex); MUTEX_LOG_ERR("Mutex unlock failure"); }
+
+extern openavb_avdecc_cfg_t gAvdeccCfg;
+
+static bool s_bPreviousHaveTL = false;
+
+openavbRC openavbAdpStart()
+{
+ AVB_TRACE_ENTRY(AVB_TRACE_ADP);
+
+ openavb_avdecc_entity_model_t *pAem = openavbAemGetModel();
+ if (!pAem) {
+ AVB_RC_LOG_TRACE_RET(AVB_RC(OPENAVB_AVDECC_FAILURE | OPENAVBAVDECC_RC_ENTITY_MODEL_MISSING), AVB_TRACE_ADP);
+ }
+
+ {
+ MUTEX_ATTR_HANDLE(mta);
+ MUTEX_ATTR_INIT(mta);
+ MUTEX_ATTR_SET_TYPE(mta, MUTEX_ATTR_TYPE_DEFAULT);
+ MUTEX_ATTR_SET_NAME(mta, "openavbAdpMutex");
+ MUTEX_CREATE_ERR();
+ MUTEX_CREATE(openavbAdpMutex, mta);
+ MUTEX_LOG_ERR("Could not create/initialize 'openavbAdpMutex' mutex");
+ }
+
+ ADP_LOCK();
+ {
+ // Populate global ADP vars
+ openavb_adp_control_header_t *pHeader = &openavbAdpSMGlobalVars.entityInfo.header;
+
+ pHeader->cd = 1;
+ pHeader->subtype = OPENAVB_ADP_AVTP_SUBTYPE;
+ pHeader->sv = 0;
+ pHeader->version = 0;
+ pHeader->message_type = 0; // Set later depending on message type
+ pHeader->valid_time = gAvdeccCfg.valid_time;
+ pHeader->control_data_length = 56;
+ memcpy(pHeader->entity_id, pAem->pDescriptorEntity->entity_id, sizeof(pAem->pDescriptorEntity->entity_id));
+ }
+
+ {
+ // Populate global ADP PDU vars
+ openavb_adp_data_unit_t *pPdu = &openavbAdpSMGlobalVars.entityInfo.pdu;
+
+#ifdef AVB_PTP_AVAILABLE
+ openavbRC retCode = OPENAVB_PTP_FAILURE;
+ retCode = openavbPtpInitializeSharedMemory();
+ if (IS_OPENAVB_FAILURE(retCode)) {
+ AVB_LOG_WARNING("Failed to init PTP shared memory");
+ }
+#endif // AVB_PTP_AVAILABLE
+
+ memcpy(pPdu->entity_model_id, pAem->pDescriptorEntity->entity_model_id, sizeof(pPdu->entity_model_id));
+ pPdu->entity_capabilities = pAem->pDescriptorEntity->entity_capabilities;
+ pPdu->talker_stream_sources = pAem->pDescriptorEntity->talker_stream_sources;
+ pPdu->talker_capabilities = pAem->pDescriptorEntity->talker_capabilities;
+ pPdu->listener_stream_sinks = pAem->pDescriptorEntity->listener_stream_sinks;
+ pPdu->listener_capabilities = pAem->pDescriptorEntity->listener_capabilities;
+ pPdu->controller_capabilities = pAem->pDescriptorEntity->controller_capabilities;
+ pPdu->available_index = pAem->pDescriptorEntity->available_index;
+ // The pPdu->gptp_grandmaster_id and pPdu->gptp_domain_number will be filled in when the ADPDU is transmitted.
+ // pPdu->reserved0;
+ // pPdu->identify_control_index = ???; // AVDECC_TODO
+ // pPdu->interface_index = ???; // AVDECC_TODO
+ memcpy(pPdu->association_id, pAem->pDescriptorEntity->association_id, sizeof(pPdu->association_id));
+ // pPdu->reserved1;
+ }
+ ADP_UNLOCK();
+
+ // Wait until we are notified that we have a Talker or Listener before supporting discover.
+ s_bPreviousHaveTL = false;
+
+ AVB_RC_TRACE_RET(OPENAVB_AVDECC_SUCCESS, AVB_TRACE_ADP);
+}
+
+void openavbAdpStop()
+{
+ AVB_TRACE_ENTRY(AVB_TRACE_ADP);
+
+#ifdef AVB_PTP_AVAILABLE
+ openavbPtpReleaseSharedMemory();
+#endif // AVB_PTP_AVAILABLE
+
+ // Stop Advertising and supporting Discovery.
+ openavbAdpHaveTL(false);
+
+ AVB_TRACE_EXIT(AVB_TRACE_ADP);
+}
+
+
+openavbRC openavbAdpHaveTL(bool bHaveTL)
+{
+ AVB_TRACE_ENTRY(AVB_TRACE_ADP);
+
+ if (bHaveTL && !s_bPreviousHaveTL) {
+ // Start Advertising and supporting Discovery.
+ openavbRC rc = openavbAdpMessageHandlerStart();
+ if (IS_OPENAVB_FAILURE(rc)) {
+ AVB_RC_TRACE_RET(rc, AVB_TRACE_ADP);
+ }
+
+ openavbAdpSMAdvertiseInterfaceStart();
+ openavbAdpSMAdvertiseEntityStart();
+ s_bPreviousHaveTL = true;
+ }
+ else if (!bHaveTL && s_bPreviousHaveTL) {
+ // Stop Advertising and supporting Discovery.
+ openavbAdpSMAdvertiseInterfaceStop();
+ openavbAdpSMAdvertiseEntityStop();
+ openavbAdpMessageHandlerStop();
+ s_bPreviousHaveTL = false;
+ }
+
+ AVB_RC_TRACE_RET(OPENAVB_AVDECC_SUCCESS, AVB_TRACE_ADP);
+}
|