summaryrefslogtreecommitdiffhomepage
path: root/digital/asserv/src/asserv/simu.host.c
diff options
context:
space:
mode:
Diffstat (limited to 'digital/asserv/src/asserv/simu.host.c')
-rw-r--r--digital/asserv/src/asserv/simu.host.c6
1 files changed, 6 insertions, 0 deletions
diff --git a/digital/asserv/src/asserv/simu.host.c b/digital/asserv/src/asserv/simu.host.c
index 8b499123..64fc38db 100644
--- a/digital/asserv/src/asserv/simu.host.c
+++ b/digital/asserv/src/asserv/simu.host.c
@@ -131,6 +131,7 @@ simu_pos_update (double dl, double dr, double footing)
static void
simu_sensor_update (void)
{
+ /** Micro-switch sensors. */
static const double sensors[][2] =
{
{ -70.0, 200.0 },
@@ -153,6 +154,11 @@ simu_sensor_update (void)
PINC |= bit;
bit <<= 1;
}
+ /** Top zero sensor. */
+ double aa = simu_aux0_model.th / simu_aux0_model.m.i_G * 3;
+ if (!(cos (aa) > 0 && fabs (sin (aa)) * 80.0 < 7.5))
+ PINC |= bit;
+ bit <<= 1;
}
/** Do a simulation step. */