|
|
|
@ -69,7 +69,6 @@ px4muorb::KraitRpcWrapper::~KraitRpcWrapper()
@@ -69,7 +69,6 @@ px4muorb::KraitRpcWrapper::~KraitRpcWrapper()
|
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
bool px4muorb::KraitRpcWrapper::Initialize() |
|
|
|
|
<<<<<<< 7fb496f94489542ed49b7734042db4543136ee4b |
|
|
|
|
{ |
|
|
|
|
bool rc = true; |
|
|
|
|
|
|
|
|
@ -177,143 +176,10 @@ int32_t px4muorb::KraitRpcWrapper::SendData(const char *topic, int32_t length_in
@@ -177,143 +176,10 @@ int32_t px4muorb::KraitRpcWrapper::SendData(const char *topic, int32_t length_in
|
|
|
|
|
|
|
|
|
|
int32_t px4muorb::KraitRpcWrapper::ReceiveData(int32_t *msg_type, char **topic, int32_t *length_in_bytes, |
|
|
|
|
uint8_t **data) |
|
|
|
|
======= |
|
|
|
|
{ |
|
|
|
|
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) |
|
|
|
|
{ |
|
|
|
|
int32_t rc = -1; |
|
|
|
|
|
|
|
|
|
if (_Initialized) { |
|
|
|
|
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"); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
} else { |
|
|
|
|
PX4_ERR("ERROR: FastRpcWrapper Not Initialized"); |
|
|
|
|
} |
|
|
|
|
|
|
|
|
|
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); |
|
|
|
|
|
|
|
|
@ -323,16 +189,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t
@@ -323,16 +189,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t
|
|
|
|
|
|
|
|
|
|
} 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 { |
|
|
|
@ -342,7 +198,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t
@@ -342,7 +198,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t
|
|
|
|
|
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
@@ -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); |
|
|
|
|