summaryrefslogtreecommitdiffhomepage
path: root/digital
diff options
context:
space:
mode:
Diffstat (limited to 'digital')
-rw-r--r--digital/io/src/main.c10
1 files changed, 7 insertions, 3 deletions
diff --git a/digital/io/src/main.c b/digital/io/src/main.c
index 580ba883..9c218336 100644
--- a/digital/io/src/main.c
+++ b/digital/io/src/main.c
@@ -414,14 +414,18 @@ proto_callback (uint8_t cmd, uint8_t size, uint8_t *args)
/* Trap */
for (compt = 0; compt < SERVO_NUMBER; compt++)
{
- proto_send2b ('t', trap_high_time_pos[0][compt],
+ proto_send3b ('t', compt, trap_high_time_pos[0][compt],
trap_high_time_pos[1][compt]);
}
/* Sharp */
for (compt = 0; compt < SHARP_NUMBER; compt++)
{
- proto_send2w ('h', sharp_threshold[0][compt],
- sharp_threshold[1][compt]);
+ proto_send5b
+ ('h', compt,
+ v16_to_v8 (sharp_threshold[compt][0], 1),
+ v16_to_v8 (sharp_threshold[compt][0], 0),
+ v16_to_v8 (sharp_threshold[compt][1], 1),
+ v16_to_v8 (sharp_threshold[compt][1], 0));
}
}
break;