summaryrefslogtreecommitdiffhomepage
path: root/digital/asserv/src/asserv/twi_proto.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/asserv/src/asserv/twi_proto.c')
-rw-r--r--digital/asserv/src/asserv/twi_proto.c4
1 files changed, 3 insertions, 1 deletions
diff --git a/digital/asserv/src/asserv/twi_proto.c b/digital/asserv/src/asserv/twi_proto.c
index 76639064..3be0367e 100644
--- a/digital/asserv/src/asserv/twi_proto.c
+++ b/digital/asserv/src/asserv/twi_proto.c
@@ -71,7 +71,9 @@ twi_proto_update (void)
twi_proto_callback (buf, sizeof (buf));
/* Update status. */
u8 status[12];
- status[0] = (state_aux0.blocked << 3)
+ status[0] = (speed_theta.cons < 0 ? (1 << 5) : 0)
+ | (speed_theta.cons > 0 ? (1 << 4) : 0)
+ | (state_aux0.blocked << 3)
| (state_aux0.finished << 2)
| (state_main.blocked << 1)
| (state_main.finished << 0);