Add more than 4 servos MKS GEN L v1.0 RAMPS 1.4 September 27, 2021 10:42AM |
Registered: 2 years ago Posts: 4 |
Re: Add more than 4 servos MKS GEN L v1.0 RAMPS 1.4 September 27, 2021 07:30PM |
Admin Registered: 13 years ago Posts: 7,012 |
Re: Add more than 4 servos MKS GEN L v1.0 RAMPS 1.4 September 28, 2021 02:10AM |
Registered: 2 years ago Posts: 4 |
Re: Add more than 4 servos MKS GEN L v1.0 RAMPS 1.4 September 28, 2021 04:53AM |
Admin Registered: 13 years ago Posts: 7,012 |
void HAL_init() { // Init Servo Pins #define INIT_SERVO(N) OUT_WRITE(SERVO##N##_PIN, LOW) #if HAS_SERVO_0 INIT_SERVO(0); #endif #if HAS_SERVO_1 INIT_SERVO(1); #endif #if HAS_SERVO_2 INIT_SERVO(2); #endif #if HAS_SERVO_3 INIT_SERVO(3); #endif }
// Servos #if PIN_EXISTS(SERVO0) && NUM_SERVOS > 0 #define HAS_SERVO_0 1 #endif #if PIN_EXISTS(SERVO1) && NUM_SERVOS > 1 #define HAS_SERVO_1 1 #endif #if PIN_EXISTS(SERVO2) && NUM_SERVOS > 2 #define HAS_SERVO_2 1 #endif #if PIN_EXISTS(SERVO3) && NUM_SERVOS > 3 #define HAS_SERVO_3 1 #endif
void servo_init() { #if NUM_SERVOS >= 1 && HAS_SERVO_0 servo[0].attach(SERVO0_PIN); DETACH_SERVO(0); // Just set up the pin. We don't have a position yet. Don't move to a random position. #endif #if NUM_SERVOS >= 2 && HAS_SERVO_1 servo[1].attach(SERVO1_PIN); DETACH_SERVO(1); #endif #if NUM_SERVOS >= 3 && HAS_SERVO_2 servo[2].attach(SERVO2_PIN); DETACH_SERVO(2); #endif #if NUM_SERVOS >= 4 && HAS_SERVO_3 servo[3].attach(SERVO3_PIN); DETACH_SERVO(3); #endif }
Re: Add more than 4 servos MKS GEN L v1.0 RAMPS 1.4 September 28, 2021 10:36AM |
Registered: 2 years ago Posts: 4 |
Re: Add more than 4 servos MKS GEN L v1.0 RAMPS 1.4 September 28, 2021 09:36PM |
Admin Registered: 13 years ago Posts: 7,012 |
Re: Add more than 4 servos MKS GEN L v1.0 RAMPS 1.4 September 29, 2021 05:23AM |
Registered: 2 years ago Posts: 4 |