mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-19 06:23:33 +08:00
muorb: clean up of forgotton merge conflict
This commit is contained in:
@@ -69,115 +69,6 @@ px4muorb::KraitRpcWrapper::~KraitRpcWrapper()
|
|||||||
}
|
}
|
||||||
|
|
||||||
bool px4muorb::KraitRpcWrapper::Initialize()
|
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;
|
bool rc = true;
|
||||||
|
|
||||||
@@ -307,42 +198,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveData(int32_t *msg_type, char **topic,
|
|||||||
return rc;
|
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 px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t *length_in_bytes, int32_t *topic_count)
|
||||||
{
|
{
|
||||||
int32_t rc = -1;
|
int32_t rc = -1;
|
||||||
@@ -365,8 +220,6 @@ int32_t px4muorb::KraitRpcWrapper::ReceiveBulkData(uint8_t **bulk_data, int32_t
|
|||||||
return rc;
|
return rc;
|
||||||
}
|
}
|
||||||
|
|
||||||
=======
|
|
||||||
>>>>>>> Added rpcmem.a to posix_eagle_release build
|
|
||||||
int32_t px4muorb::KraitRpcWrapper::UnblockReceiveData()
|
int32_t px4muorb::KraitRpcWrapper::UnblockReceiveData()
|
||||||
{
|
{
|
||||||
return (_Initialized ? px4muorb_unblock_recieve_msg() : -1);
|
return (_Initialized ? px4muorb_unblock_recieve_msg() : -1);
|
||||||
|
|||||||
Reference in New Issue
Block a user