From c2014ebfff6f26abf0a34d13d5afe30b4af7b789 Mon Sep 17 00:00:00 2001 From: Mohammed Kabir Date: Thu, 13 Apr 2017 15:39:37 +0200 Subject: [PATCH] camera_trigger : add support for resetting trigger sequence --- src/drivers/camera_trigger/camera_trigger.cpp | 9 +++++++-- 1 file changed, 7 insertions(+), 2 deletions(-) diff --git a/src/drivers/camera_trigger/camera_trigger.cpp b/src/drivers/camera_trigger/camera_trigger.cpp index f26f175b4685..80fe6ca901c6 100644 --- a/src/drivers/camera_trigger/camera_trigger.cpp +++ b/src/drivers/camera_trigger/camera_trigger.cpp @@ -456,8 +456,14 @@ CameraTrigger::cycle_trampoline(void *arg) need_ack = true; + if (cmd.param3 > 0.0f) { + // reset trigger sequence + trig->_trigger_seq = 0; + + } + // Set trigger rate from command - if (cmd.param2 > 0) { + if (cmd.param2 > 0.0f) { trig->_interval = cmd.param2; param_set(trig->_p_interval, &(trig->_interval)); } @@ -571,7 +577,6 @@ CameraTrigger::cycle_trampoline(void *arg) // Send ACKs for trigger commands if (updated && need_ack) { - vehicle_command_ack_s command_ack = {}; command_ack.command = cmd.command;