summaryrefslogtreecommitdiffhomepage
path: root/digital
diff options
context:
space:
mode:
Diffstat (limited to 'digital')
-rw-r--r--digital/mimot/src/dirty/models.host.c7
1 files changed, 7 insertions, 0 deletions
diff --git a/digital/mimot/src/dirty/models.host.c b/digital/mimot/src/dirty/models.host.c
index a551c63a..40586673 100644
--- a/digital/mimot/src/dirty/models.host.c
+++ b/digital/mimot/src/dirty/models.host.c
@@ -153,5 +153,12 @@ simu_sensor_update_robospierre (void)
static void
simu_sensor_update_guybrush (void)
{
+ PINC = 0xf0;
+ double rem = fmod (simu_aux_model[0].th / simu_aux_model[0].m.i_G,
+ 2 * M_PI);
+ if (rem < 0.0)
+ rem += 2 * M_PI;
+ if (rem > 0.01)
+ PINC |= IO_BV (CONTACT_AUX0_ZERO_IO);
}