Browse Source

camera_trigger : switch to queued publisher

sbg
Mohammed Kabir 8 years ago committed by Lorenz Meier
parent
commit
3ba0275952
  1. 3
      msg/camera_trigger.msg
  2. 10
      src/drivers/camera_trigger/camera_trigger.cpp

3
msg/camera_trigger.msg

@ -1,3 +1,4 @@ @@ -1,3 +1,4 @@
uint32 seq # Image sequence number
uint32 seq # Image sequence
uint32 ORB_QUEUE_LENGTH = 3

10
src/drivers/camera_trigger/camera_trigger.cpp

@ -631,8 +631,14 @@ CameraTrigger::engage(void *arg) @@ -631,8 +631,14 @@ CameraTrigger::engage(void *arg)
report.seq = trig->_trigger_seq++;
int instance_id = 0;
orb_publish_auto(ORB_ID(camera_trigger), &trig->_trigger_pub, &report, &instance_id, ORB_PRIO_DEFAULT);
if (trig->_trigger_pub == nullptr) {
trig->_trigger_pub = orb_advertise_queue(ORB_ID(camera_trigger), &report,
camera_trigger_s::ORB_QUEUE_LENGTH);
} else {
orb_publish(ORB_ID(camera_trigger), trig->_trigger_pub, &report);
}
}
void

Loading…
Cancel
Save