|
@@ -342,6 +342,10 @@ static void step_dir_set(bool_t assert)
|
|
|
}
|
|
|
#define step_dir_out() step_dir_set(FALSE)
|
|
|
#define step_dir_in() step_dir_set(TRUE)
|
|
|
+#if MCU == STM32F8
|
|
|
+static void get_tg43_info(void){
|
|
|
+}
|
|
|
+#endif
|
|
|
#if MCU == STM32F7
|
|
|
static void get_tg43_info(void){
|
|
|
struct unit *u;
|
|
@@ -355,21 +359,22 @@ static void get_tg43_info(void){
|
|
|
}
|
|
|
writing=get_wgate();
|
|
|
u = &unit[unit_nr];
|
|
|
- if (u->cyl>=43 && !active && !writing){ /* Check TR43*/
|
|
|
+ if (!active){
|
|
|
+ if (u->cyl>=43 && !active && !writing){ //Check TR43
|
|
|
act_led2(TRUE);
|
|
|
gpio_write_pin(gpio_dsel, pin_dsel, HIGH);
|
|
|
}else{
|
|
|
act_led2(FALSE);
|
|
|
gpio_write_pin(gpio_dsel, pin_dsel, LOW);
|
|
|
}
|
|
|
- if (u->cyl>=60 && !active && writing){ /* Check TR43*/
|
|
|
+ if (u->cyl>=60 && !active && writing){ //Check TR43
|
|
|
act_led2(TRUE);
|
|
|
gpio_write_pin(gpio_dsel, pin_dsel, HIGH);
|
|
|
}else{
|
|
|
act_led2(FALSE);
|
|
|
gpio_write_pin(gpio_dsel, pin_dsel, LOW);
|
|
|
}
|
|
|
-
|
|
|
+}
|
|
|
}
|
|
|
#endif
|
|
|
static void step_once(void)
|