diff options
| author | Roy Ben-Shabat <Roy@Twine-s.com> | 2020-06-08 15:49:38 +0300 |
|---|---|---|
| committer | Roy Ben-Shabat <Roy@Twine-s.com> | 2020-06-08 15:49:38 +0300 |
| commit | b9f91e4025d6b6ae35eeb58f603bc2c32dbb4fbc (patch) | |
| tree | a34294c6d5ba6b87c3c1c0df69f4faf5161a2542 /Software/Embedded_SW | |
| parent | 17d8d6a215007024b9021a10d0745a19ad216615 (diff) | |
| parent | 4dda817df3eabbc03d06247213e6e17a0d81c665 (diff) | |
| download | Tango-b9f91e4025d6b6ae35eeb58f603bc2c32dbb4fbc.tar.gz Tango-b9f91e4025d6b6ae35eeb58f603bc2c32dbb4fbc.zip | |
Merge branch 'master' of https://twinetfs.visualstudio.com/_git/Tango
Diffstat (limited to 'Software/Embedded_SW')
| -rw-r--r-- | Software/Embedded_SW/Embedded/Drivers/I2C_Communication/Head_Card/IO_Ports/Head_IO.c | 6 |
1 files changed, 6 insertions, 0 deletions
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; |