|
@@ -66,6 +66,16 @@ void mc_brk_gpio_init(void) {
|
|
|
exti_interrupt_flag_clear(GPIO_BRAKE_EXTI);
|
|
exti_interrupt_flag_clear(GPIO_BRAKE_EXTI);
|
|
|
exti_interrupt_enable(GPIO_BRAKE_EXTI);
|
|
exti_interrupt_enable(GPIO_BRAKE_EXTI);
|
|
|
#endif
|
|
#endif
|
|
|
|
|
+#ifdef GPIO_BRAKE1_IN_GROUP
|
|
|
|
|
+ rcu_periph_clock_enable(GPIO_BRAKE1_IN_RCU);
|
|
|
|
|
+ gpio_init(GPIO_BRAKE1_IN_GROUP, GPIO_BRAKE1_IN_MODE, GPIO_OSPEED_50MHZ, GPIO_BRAKE1_IN_PIN);
|
|
|
|
|
+
|
|
|
|
|
+ gpio_exti_source_select(GPIO_BRAKE1_EXIT_SRC_GROUP, GPIO_BRAKE1_EXIT_SRC_PIN);
|
|
|
|
|
+ exti_init(GPIO_BRAKE1_EXTI, EXTI_INTERRUPT, EXTI_TRIG_BOTH);
|
|
|
|
|
+ nvic_irq_enable(GPIO_BRAKE1_IRQ, EBREAK_IRQ_PRIORITY, 0U);
|
|
|
|
|
+ exti_interrupt_flag_clear(GPIO_BRAKE1_EXTI);
|
|
|
|
|
+ exti_interrupt_enable(GPIO_BRAKE1_EXTI);
|
|
|
|
|
+#endif
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void gpio_mlock_init(void) {
|
|
void gpio_mlock_init(void) {
|
|
@@ -101,6 +111,15 @@ bool mc_get_gpio_brake(void) {
|
|
|
return gpio_input_bit_get(GPIO_BRAKE_IN_GROUP, GPIO_BRAKE_IN_PIN) == SET;
|
|
return gpio_input_bit_get(GPIO_BRAKE_IN_GROUP, GPIO_BRAKE_IN_PIN) == SET;
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
+bool mc_get_gpio_brake1(void) {
|
|
|
|
|
+#ifdef GPIO_BRAKE1_IN_GROUP
|
|
|
|
|
+ return gpio_input_bit_get(GPIO_BRAKE1_IN_GROUP, GPIO_BRAKE1_IN_PIN) == SET;
|
|
|
|
|
+#else
|
|
|
|
|
+ return mc_get_gpio_brake();
|
|
|
|
|
+#endif
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
bool gpio_motor_locked(void) {
|
|
bool gpio_motor_locked(void) {
|
|
|
return gpio_input_bit_get(GPIO_MLOCK_IN_GROUP, GPIO_MLOCK_IN_PIN) == RESET;
|
|
return gpio_input_bit_get(GPIO_MLOCK_IN_GROUP, GPIO_MLOCK_IN_PIN) == RESET;
|
|
|
}
|
|
}
|