Store servo angles in EEPROM
This commit is contained in:
@@ -30,6 +30,7 @@
|
||||
#include "../HAL/shared/servo.h"
|
||||
|
||||
extern HAL_SERVO_LIB servo[NUM_SERVOS];
|
||||
extern uint8_t servo_angles[NUM_SERVOS][2];
|
||||
extern void servo_init();
|
||||
|
||||
#define MOVE_SERVO(I, P) servo[I].move(P)
|
||||
@@ -37,8 +38,8 @@ extern void servo_init();
|
||||
#include "../inc/MarlinConfig.h"
|
||||
|
||||
#if HAS_Z_SERVO_PROBE
|
||||
#define DEPLOY_Z_SERVO() MOVE_SERVO(Z_PROBE_SERVO_NR, z_servo_angle[0])
|
||||
#define STOW_Z_SERVO() MOVE_SERVO(Z_PROBE_SERVO_NR, z_servo_angle[1])
|
||||
#define DEPLOY_Z_SERVO() MOVE_SERVO(Z_PROBE_SERVO_NR, servo_angles[Z_PROBE_SERVO_NR][0])
|
||||
#define STOW_Z_SERVO() MOVE_SERVO(Z_PROBE_SERVO_NR, servo_angles[Z_PROBE_SERVO_NR][1])
|
||||
#endif
|
||||
|
||||
#endif // _SERVO_H_
|
||||
|
||||
Reference in New Issue
Block a user