From 4dda817df3eabbc03d06247213e6e17a0d81c665 Mon Sep 17 00:00:00 2001 From: Avi Levkovich Date: Mon, 8 Jun 2020 15:40:51 +0300 Subject: Enable movement (disable RST) in HeadCard_Actuators_Control --- .../Embedded/Drivers/I2C_Communication/Head_Card/IO_Ports/Head_IO.c | 6 ++++++ 1 file changed, 6 insertions(+) (limited to 'Software') diff --git a/Software/Embedded_SW/Embedded/Drivers/I2C_Communication/Head_Card/IO_Ports/Head_IO.c b/Software/Embedded_SW/Embedded/Drivers/I2C_Communication/Head_Card/IO_Ports/Head_IO.c index e659550a9..1a161b9f4 100644 --- a/Software/Embedded_SW/Embedded/Drivers/I2C_Communication/Head_Card/IO_Ports/Head_IO.c +++ b/Software/Embedded_SW/Embedded/Drivers/I2C_Communication/Head_Card/IO_Ports/Head_IO.c @@ -422,6 +422,12 @@ uint32_t HeadCard_Actuators_Control(ACTUATORS Act_ID, bool Direction) { uint32_t status = OK; + if(Head_I2C_EXP2_0x42.bits.OUTPUT_ACTLOW_ACT_RST == 0x00)//Disable movement + { + Head_I2C_EXP2_0x42.bits.OUTPUT_ACTLOW_ACT_RST = 0x01;//Enable movement + status |= Head_Write_IO_Reg(0x42,HIGH); + } + if(Act_ID == ACTIN)//0 { Head_I2C_EXP4_0x46.bits.OUTPUT_ACTLOW_ACTIN_ON = LOW; -- cgit v1.3.1