yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

micrortps_client.cpp.template: avoid 0-init & check result of orb_copy

Browse Source
This commit is contained in:
Beat Küng
2017-08-02 10:39:09 +02:00
committed by Lorenz Meier
parent de8e0b54b6
commit 77785c01ef
1 changed files with 9 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
msg/templates/uorb/microRTPS_client.cpp.template
View File

@@ -106,9 +106,9 @@ void* send(void* /*unused*/)
if (updated) if (updated)
{ {
// obtained data for the file descriptor // obtained data for the file descriptor
struct @(topic)_s data = {}; struct @(topic)_s data;
// copy raw data into local buffer // copy raw data into local buffer
orb_copy(ORB_ID(@(topic)), fds[@(idx)], &data); if (orb_copy(ORB_ID(@(topic)), fds[@(idx)], &data) == 0) {
serialize_@(topic)(&data, data_buffer, &length, &microCDRWriter); serialize_@(topic)(&data, data_buffer, &length, &microCDRWriter);
if (0 < (read = transport_node->write((char)@(message_id(topic)), data_buffer, length))) if (0 < (read = transport_node->write((char)@(message_id(topic)), data_buffer, length)))
{ {
@@ -116,6 +116,7 @@ void* send(void* /*unused*/)
++sent; ++sent;
} }
} }
}
@[end for]@ @[end for]@
usleep(_options.sleep_ms*1000); usleep(_options.sleep_ms*1000);
@@ -207,7 +208,7 @@ void micrortps_start_topics(struct timespec &begin, int &total_read, uint32_t &r
@[end if]@ @[end if]@
// loop forever if informed loop number is negative // loop forever if informed loop number is negative
if (_options.loops > 0 && loop >= _options.loops) break; if (_options.loops >= 0 && loop >= _options.loops) break;
usleep(_options.sleep_ms*1000); usleep(_options.sleep_ms*1000);
++loop; ++loop;