summaryrefslogtreecommitdiff
path: root/digital/io/src/trap.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/io/src/trap.c')
-rw-r--r--digital/io/src/trap.c11
1 files changed, 11 insertions, 0 deletions
diff --git a/digital/io/src/trap.c b/digital/io/src/trap.c
index 0995478c..01259d3c 100644
--- a/digital/io/src/trap.c
+++ b/digital/io/src/trap.c
@@ -116,3 +116,14 @@ trap_setup_path_to_box (trap_box_id_e box)
break;
}
}
+
+/* Set high time value for horizontal and vertical position of a trap. */
+void
+trap_set_high_time (uint8_t servo_id, uint8_t horizontal, uint8_t vertical)
+{
+ if (servo_id < SERVO_NUMBER)
+ {
+ trap_high_time_pos[horizontal][servo_id] = horizontal;
+ trap_high_time_pos[vertical][servo_id] = vertical;
+ }
+}