From 4b954db9a8bc6eeccf14a39178aa0fa7536b72c9 Mon Sep 17 00:00:00 2001 From: Nicolas Schodet Date: Mon, 14 May 2012 20:54:52 +0200 Subject: digital/asserv, digital/mimot: stop outputs before reset --- digital/mimot/src/dirty/cs.c | 13 +++++++++++++ 1 file changed, 13 insertions(+) (limited to 'digital/mimot/src/dirty/cs.c') diff --git a/digital/mimot/src/dirty/cs.c b/digital/mimot/src/dirty/cs.c index 73c2cbd1..fad1bc98 100644 --- a/digital/mimot/src/dirty/cs.c +++ b/digital/mimot/src/dirty/cs.c @@ -67,3 +67,16 @@ cs_update (void) control_system_single_update (&cs_aux[i]); } +void +cs_reset (void) +{ + uint8_t i; + for (i = 0; i < AC_ASSERV_AUX_NB; i++) + { + output_set (&output_aux[i], 0); + output_brake (&output_aux[i], 0); + control_state_set_mode (&cs_aux[i].state, CS_MODE_NONE, 0); + } + output_update (); +} + -- cgit v1.2.3