Init servo macro, j/b
This commit is contained in:
		@@ -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();
 | 
				
			||||||
 
 | 
				
			|||||||
		Reference in New Issue
	
	Block a user