Init servo macro, j/b

This commit is contained in:
Scott Lahteine 2019-07-12 04:53:26 -05:00
parent f1eaed7e98
commit d3add3c34f
2 changed files with 10 additions and 8 deletions

View File

@ -37,17 +37,18 @@
void HAL_init(void) {
// Init Servo Pins
#define INIT_SERVO(N) OUT_WRITE(SERVO##N##_PIN, LOW)
#if HAS_SERVO_0
OUT_WRITE(SERVO0_PIN, LOW);
INIT_SERVO(0);
#endif
#if HAS_SERVO_1
OUT_WRITE(SERVO1_PIN, LOW);
INIT_SERVO(1);
#endif
#if HAS_SERVO_2
OUT_WRITE(SERVO2_PIN, LOW);
INIT_SERVO(2);
#endif
#if HAS_SERVO_3
OUT_WRITE(SERVO3_PIN, LOW);
INIT_SERVO(3);
#endif
}

View File

@ -73,17 +73,18 @@ void HAL_init(void) {
#endif
// Init Servo Pins
#define INIT_SERVO(N) OUT_WRITE(SERVO##N##_PIN, LOW)
#if HAS_SERVO_0
OUT_WRITE(SERVO0_PIN, LOW);
INIT_SERVO(0);
#endif
#if HAS_SERVO_1
OUT_WRITE(SERVO1_PIN, LOW);
INIT_SERVO(1);
#endif
#if HAS_SERVO_2
OUT_WRITE(SERVO2_PIN, LOW);
INIT_SERVO(2);
#endif
#if HAS_SERVO_3
OUT_WRITE(SERVO3_PIN, LOW);
INIT_SERVO(3);
#endif
//debug_frmwrk_init();