Init servo macro, j/b
This commit is contained in:
parent
f1eaed7e98
commit
d3add3c34f
2 changed files with 10 additions and 8 deletions
|
@ -37,17 +37,18 @@
|
||||||
|
|
||||||
void HAL_init(void) {
|
void HAL_init(void) {
|
||||||
// Init Servo Pins
|
// Init Servo Pins
|
||||||
|
#define INIT_SERVO(N) OUT_WRITE(SERVO##N##_PIN, LOW)
|
||||||
#if HAS_SERVO_0
|
#if HAS_SERVO_0
|
||||||
OUT_WRITE(SERVO0_PIN, LOW);
|
INIT_SERVO(0);
|
||||||
#endif
|
#endif
|
||||||
#if HAS_SERVO_1
|
#if HAS_SERVO_1
|
||||||
OUT_WRITE(SERVO1_PIN, LOW);
|
INIT_SERVO(1);
|
||||||
#endif
|
#endif
|
||||||
#if HAS_SERVO_2
|
#if HAS_SERVO_2
|
||||||
OUT_WRITE(SERVO2_PIN, LOW);
|
INIT_SERVO(2);
|
||||||
#endif
|
#endif
|
||||||
#if HAS_SERVO_3
|
#if HAS_SERVO_3
|
||||||
OUT_WRITE(SERVO3_PIN, LOW);
|
INIT_SERVO(3);
|
||||||
#endif
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
|
@ -73,17 +73,18 @@ void HAL_init(void) {
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
// Init Servo Pins
|
// Init Servo Pins
|
||||||
|
#define INIT_SERVO(N) OUT_WRITE(SERVO##N##_PIN, LOW)
|
||||||
#if HAS_SERVO_0
|
#if HAS_SERVO_0
|
||||||
OUT_WRITE(SERVO0_PIN, LOW);
|
INIT_SERVO(0);
|
||||||
#endif
|
#endif
|
||||||
#if HAS_SERVO_1
|
#if HAS_SERVO_1
|
||||||
OUT_WRITE(SERVO1_PIN, LOW);
|
INIT_SERVO(1);
|
||||||
#endif
|
#endif
|
||||||
#if HAS_SERVO_2
|
#if HAS_SERVO_2
|
||||||
OUT_WRITE(SERVO2_PIN, LOW);
|
INIT_SERVO(2);
|
||||||
#endif
|
#endif
|
||||||
#if HAS_SERVO_3
|
#if HAS_SERVO_3
|
||||||
OUT_WRITE(SERVO3_PIN, LOW);
|
INIT_SERVO(3);
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
//debug_frmwrk_init();
|
//debug_frmwrk_init();
|
||||||
|
|
Loading…
Reference in a new issue