From 3a8feaf61761809edd25ff8ee2b803175a57f82d Mon Sep 17 00:00:00 2001 From: Julian Oes Date: Tue, 16 Feb 2016 21:13:10 +0100 Subject: [PATCH] muorb: clean up of forgotton merge conflict --- .../muorb/krait/px4muorb_KraitRpcWrapper.cpp | 147 ------------------ 1 file changed, 147 deletions(-) diff --git a/src/modules/muorb/krait/px4muorb_KraitRpcWrapper.cpp b/src/modules/muorb/krait/px4muorb_KraitRpcWrapper.cpp index b428e000aa..d862384398 100644 --- a/src/modules/muorb/krait/px4muorb_KraitRpcWrapper.cpp +++ b/src/modules/muorb/krait/px4muorb_KraitRpcWrapper.cpp @@ -69,115 +69,6 @@ px4muorb::KraitRpcWrapper::~KraitRpcWrapper() } bool px4muorb::KraitRpcWrapper::Initialize() -<<<<<<< 7fb496f94489542ed49b7734042db4543136ee4b -{ - bool rc = true; - - PX4_DEBUG("%s Now calling rpcmem_init...", __FUNCTION__); - rpcmem_init(); - - PX4_DEBUG("%s Now calling rpcmem_alloc...", __FUNCTION__); - - _BulkTransferBuffer = (uint8_t *) rpcmem_alloc(MUORB_KRAIT_FASTRPC_HEAP_ID, MUORB_KRAIT_FASTRPC_MEM_FLAGS, - _MAX_BULK_TRANSFER_BUFFER_SIZE * sizeof(uint8_t)); - rc = (_BulkTransferBuffer != NULL) ? true : false; - - if (!rc) { - PX4_ERR("%s rpcmem_alloc failed! for bulk transfer buffers", __FUNCTION__); - return rc; - - } else { - PX4_DEBUG("%s rpcmem_alloc passed for Bulk transfer buffers buffer_size: %d addr: %p", - __FUNCTION__, (_MAX_BULK_TRANSFER_BUFFER_SIZE * sizeof(uint8_t)), _BulkTransferBuffer); - } - - _TopicNameBuffer = (char *) rpcmem_alloc(MUORB_KRAIT_FASTRPC_HEAP_ID, - MUORB_KRAIT_FASTRPC_MEM_FLAGS, _MAX_TOPIC_NAME_BUFFER * sizeof(char)); - - rc = (_TopicNameBuffer != NULL) ? true : false; - - if (!rc) { - PX4_ERR("%s rpcmem_alloc failed! for topic_name_buffer", __FUNCTION__); - rpcmem_free(_BulkTransferBuffer); - return rc; - - } else { - PX4_DEBUG("%s rpcmem_alloc passed for topic_name_buffer", __FUNCTION__); - } - - // now allocate the data buffer. - _DataBuffer = (uint8_t *) rpcmem_alloc(MUORB_KRAIT_FASTRPC_HEAP_ID, - MUORB_KRAIT_FASTRPC_MEM_FLAGS, _MAX_DATA_BUFFER_SIZE * sizeof(uint8_t)); - - rc = (_DataBuffer != NULL) ? true : false; - - if (!rc) { - PX4_ERR("%s rpcmem_alloc failed! for DataBuffer", __FUNCTION__); - // free the topic name buffer; - rpcmem_free(_BulkTransferBuffer); - rpcmem_free(_TopicNameBuffer); - _TopicNameBuffer = 0; - return rc; - - } else { - PX4_DEBUG("%s rpcmem_alloc passed for data_buffer", __FUNCTION__); - } - - // call myorb intiialize rotine. - if (px4muorb_orb_initialize() != 0) { - PX4_ERR("%s Error calling the uorb fastrpc initalize method..", __FUNCTION__); - rc = false; - return rc; - } - - _Initialized = true; - return rc; -} - -bool px4muorb::KraitRpcWrapper::Terminate() -{ - if (_BulkTransferBuffer != NULL) { - rpcmem_free(_BulkTransferBuffer); - _BulkTransferBuffer = 0; - } - - if (_TopicNameBuffer != NULL) { - rpcmem_free(_TopicNameBuffer); - _TopicNameBuffer = 0; - } - - if (_DataBuffer != NULL) { - rpcmem_free(_DataBuffer); - _DataBuffer = 0; - } - - _Initialized = false; - return true; -} - -int32_t px4muorb::KraitRpcWrapper::AddSubscriber(const char *topic) -{ - return ((_Initialized) ? px4muorb_add_subscriber(topic) : -1); -} - -int32_t px4muorb::KraitRpcWrapper::RemoveSubscriber(const char *topic) -{ - return (_Initialized ? px4muorb_remove_subscriber(topic) : -1); -} - -int32_t px4muorb::KraitRpcWrapper::IsSubscriberPresent(const char *topic, int32_t *status) -{ - return (_Initialized ? px4muorb_is_subscriber_present(topic, status) : -1); -} - -int32_t px4muorb::KraitRpcWrapper::SendData(const char *topic, int32_t length_in_bytes, const uint8_t *data) -{ - return (_Initialized ? px4muorb_send_topic_data(topic, data, length_in_bytes) : -1); -} - -int32_t px4muorb::KraitRpcWrapper::ReceiveData(int32_t *msg_type, char **topic, int32_t *length_in_bytes, - uint8_t **data) -======= { bool rc = true; @@ -307,42 +198,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveData(int32_t *msg_type, char **topic, return rc; } -int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t *length_in_bytes, int32_t *topic_count) ->>>>>>> Added rpcmem.a to posix_eagle_release build -{ - int32_t rc = -1; - - if (_Initialized) { -<<<<<<< 7fb496f94489542ed49b7734042db4543136ee4b - rc = px4muorb_receive_msg(msg_type, _TopicNameBuffer, _MAX_TOPIC_NAME_BUFFER, _DataBuffer, _MAX_DATA_BUFFER_SIZE, - length_in_bytes); - - if (rc == 0) { - *topic = _TopicNameBuffer; - *data = _DataBuffer; - - } else { - PX4_ERR("ERROR: Getting data from fastRPC link"); -======= - //rc = px4muorb_receive_msg( msg_type, _TopicNameBuffer, _MAX_TOPIC_NAME_BUFFER, _DataBuffer, _MAX_DATA_BUFFER_SIZE, length_in_bytes ); - rc = px4muorb_receive_bulk_data(_BulkTransferBuffer, _MAX_BULK_TRANSFER_BUFFER_SIZE, length_in_bytes, topic_count); - - if (rc == 0) { - *bulk_data = _BulkTransferBuffer; - - } else { - PX4_ERR("ERROR: Getting Bulk data from fastRPC link"); ->>>>>>> Added rpcmem.a to posix_eagle_release build - } - - } else { - PX4_ERR("ERROR: FastRpcWrapper Not Initialized"); - } - - return rc; -} - -<<<<<<< 7fb496f94489542ed49b7734042db4543136ee4b int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t *length_in_bytes, int32_t *topic_count) { int32_t rc = -1; @@ -365,8 +220,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t return rc; } -======= ->>>>>>> Added rpcmem.a to posix_eagle_release build int32_t px4muorb::KraitRpcWrapper::UnblockReceiveData() { return (_Initialized ? px4muorb_unblock_recieve_msg() : -1);