|
|
@ -72,10 +72,14 @@ block_t* Stepper::current_block = NULL; // A pointer to the block currently bei
|
|
|
|
bool Stepper::performing_homing = false;
|
|
|
|
bool Stepper::performing_homing = false;
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_MOTOR_CURRENT_PWM
|
|
|
|
|
|
|
|
uint32_t Stepper::motor_current_setting[3] = PWM_MOTOR_CURRENT;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
|
|
// private:
|
|
|
|
// private:
|
|
|
|
|
|
|
|
|
|
|
|
unsigned char Stepper::last_direction_bits = 0; // The next stepping-bits to be output
|
|
|
|
uint8_t Stepper::last_direction_bits = 0; // The next stepping-bits to be output
|
|
|
|
unsigned int Stepper::cleaning_buffer_counter = 0;
|
|
|
|
uint16_t Stepper::cleaning_buffer_counter = 0;
|
|
|
|
|
|
|
|
|
|
|
|
#if ENABLED(Z_DUAL_ENDSTOPS)
|
|
|
|
#if ENABLED(Z_DUAL_ENDSTOPS)
|
|
|
|
bool Stepper::locked_z_motor = false;
|
|
|
|
bool Stepper::locked_z_motor = false;
|
|
|
@ -1447,62 +1451,98 @@ void Stepper::report_positions() {
|
|
|
|
#if HAS_DIGIPOTSS
|
|
|
|
#if HAS_DIGIPOTSS
|
|
|
|
|
|
|
|
|
|
|
|
// From Arduino DigitalPotControl example
|
|
|
|
// From Arduino DigitalPotControl example
|
|
|
|
void Stepper::digitalPotWrite(int address, int value) {
|
|
|
|
void Stepper::digitalPotWrite(const int16_t address, const int16_t value) {
|
|
|
|
WRITE(DIGIPOTSS_PIN, LOW); // take the SS pin low to select the chip
|
|
|
|
WRITE(DIGIPOTSS_PIN, LOW); // Take the SS pin low to select the chip
|
|
|
|
SPI.transfer(address); // send in the address and value via SPI:
|
|
|
|
SPI.transfer(address); // Send the address and value via SPI
|
|
|
|
SPI.transfer(value);
|
|
|
|
SPI.transfer(value);
|
|
|
|
WRITE(DIGIPOTSS_PIN, HIGH); // take the SS pin high to de-select the chip:
|
|
|
|
WRITE(DIGIPOTSS_PIN, HIGH); // Take the SS pin high to de-select the chip
|
|
|
|
//delay(10);
|
|
|
|
//delay(10);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#endif // HAS_DIGIPOTSS
|
|
|
|
#endif // HAS_DIGIPOTSS
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_MOTOR_CURRENT_PWM
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Stepper::refresh_motor_power() {
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < COUNT(motor_current_setting); ++i) {
|
|
|
|
|
|
|
|
switch (i) {
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_XY)
|
|
|
|
|
|
|
|
case 0:
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_Z)
|
|
|
|
|
|
|
|
case 1:
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_E)
|
|
|
|
|
|
|
|
case 2:
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
digipot_current(i, motor_current_setting[i]);
|
|
|
|
|
|
|
|
default: break;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#endif // HAS_MOTOR_CURRENT_PWM
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_DIGIPOTSS || HAS_MOTOR_CURRENT_PWM
|
|
|
|
#if HAS_DIGIPOTSS || HAS_MOTOR_CURRENT_PWM
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Stepper::digipot_current(const uint8_t driver, const int current) {
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_DIGIPOTSS
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
const uint8_t digipot_ch[] = DIGIPOT_CHANNELS;
|
|
|
|
|
|
|
|
digitalPotWrite(digipot_ch[driver], current);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#elif HAS_MOTOR_CURRENT_PWM
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
if (WITHIN(driver, 0, 2))
|
|
|
|
|
|
|
|
motor_current_setting[driver] = current; // update motor_current_setting
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#define _WRITE_CURRENT_PWM(P) analogWrite(MOTOR_CURRENT_PWM_## P ##_PIN, 255L * current / (MOTOR_CURRENT_PWM_RANGE))
|
|
|
|
|
|
|
|
switch (driver) {
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_XY)
|
|
|
|
|
|
|
|
case 0: _WRITE_CURRENT_PWM(XY); break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_Z)
|
|
|
|
|
|
|
|
case 1: _WRITE_CURRENT_PWM(Z); break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_E)
|
|
|
|
|
|
|
|
case 2: _WRITE_CURRENT_PWM(E); break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void Stepper::digipot_init() {
|
|
|
|
void Stepper::digipot_init() {
|
|
|
|
|
|
|
|
|
|
|
|
#if HAS_DIGIPOTSS
|
|
|
|
#if HAS_DIGIPOTSS
|
|
|
|
|
|
|
|
|
|
|
|
static const uint8_t digipot_motor_current[] = DIGIPOT_MOTOR_CURRENT;
|
|
|
|
static const uint8_t digipot_motor_current[] = DIGIPOT_MOTOR_CURRENT;
|
|
|
|
|
|
|
|
|
|
|
|
SPI.begin();
|
|
|
|
SPI.begin();
|
|
|
|
SET_OUTPUT(DIGIPOTSS_PIN);
|
|
|
|
SET_OUTPUT(DIGIPOTSS_PIN);
|
|
|
|
|
|
|
|
|
|
|
|
for (uint8_t i = 0; i < COUNT(digipot_motor_current); i++) {
|
|
|
|
for (uint8_t i = 0; i < COUNT(digipot_motor_current); i++) {
|
|
|
|
//digitalPotWrite(digipot_ch[i], digipot_motor_current[i]);
|
|
|
|
//digitalPotWrite(digipot_ch[i], digipot_motor_current[i]);
|
|
|
|
digipot_current(i, digipot_motor_current[i]);
|
|
|
|
digipot_current(i, digipot_motor_current[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
#elif HAS_MOTOR_CURRENT_PWM
|
|
|
|
#elif HAS_MOTOR_CURRENT_PWM
|
|
|
|
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_XY)
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_XY)
|
|
|
|
SET_OUTPUT(MOTOR_CURRENT_PWM_XY_PIN);
|
|
|
|
SET_OUTPUT(MOTOR_CURRENT_PWM_XY_PIN);
|
|
|
|
digipot_current(0, motor_current_setting[0]);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_Z)
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_Z)
|
|
|
|
SET_OUTPUT(MOTOR_CURRENT_PWM_Z_PIN);
|
|
|
|
SET_OUTPUT(MOTOR_CURRENT_PWM_Z_PIN);
|
|
|
|
digipot_current(1, motor_current_setting[1]);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_E)
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_E)
|
|
|
|
SET_OUTPUT(MOTOR_CURRENT_PWM_E_PIN);
|
|
|
|
SET_OUTPUT(MOTOR_CURRENT_PWM_E_PIN);
|
|
|
|
digipot_current(2, motor_current_setting[2]);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
//Set timer5 to 31khz so the PWM of the motor power is as constant as possible. (removes a buzzing noise)
|
|
|
|
|
|
|
|
TCCR5B = (TCCR5B & ~(_BV(CS50) | _BV(CS51) | _BV(CS52))) | _BV(CS50);
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
void Stepper::digipot_current(uint8_t driver, int current) {
|
|
|
|
refresh_motor_power();
|
|
|
|
#if HAS_DIGIPOTSS
|
|
|
|
|
|
|
|
const uint8_t digipot_ch[] = DIGIPOT_CHANNELS;
|
|
|
|
// Set Timer5 to 31khz so the PWM of the motor power is as constant as possible. (removes a buzzing noise)
|
|
|
|
digitalPotWrite(digipot_ch[driver], current);
|
|
|
|
SET_CS5(PRESCALER_1);
|
|
|
|
#elif HAS_MOTOR_CURRENT_PWM
|
|
|
|
|
|
|
|
#define _WRITE_CURRENT_PWM(P) analogWrite(P, 255L * current / (MOTOR_CURRENT_PWM_RANGE))
|
|
|
|
|
|
|
|
switch (driver) {
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_XY)
|
|
|
|
|
|
|
|
case 0: _WRITE_CURRENT_PWM(MOTOR_CURRENT_PWM_XY_PIN); break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_Z)
|
|
|
|
|
|
|
|
case 1: _WRITE_CURRENT_PWM(MOTOR_CURRENT_PWM_Z_PIN); break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
#if PIN_EXISTS(MOTOR_CURRENT_PWM_E)
|
|
|
|
|
|
|
|
case 2: _WRITE_CURRENT_PWM(MOTOR_CURRENT_PWM_E_PIN); break;
|
|
|
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
|
|
#endif
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
@ -1550,7 +1590,7 @@ void Stepper::report_positions() {
|
|
|
|
microstep_mode(i, microstep_modes[i]);
|
|
|
|
microstep_mode(i, microstep_modes[i]);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void Stepper::microstep_ms(uint8_t driver, int8_t ms1, int8_t ms2) {
|
|
|
|
void Stepper::microstep_ms(const uint8_t driver, const int8_t ms1, const int8_t ms2) {
|
|
|
|
if (ms1 >= 0) switch (driver) {
|
|
|
|
if (ms1 >= 0) switch (driver) {
|
|
|
|
case 0: WRITE(X_MS1_PIN, ms1); break;
|
|
|
|
case 0: WRITE(X_MS1_PIN, ms1); break;
|
|
|
|
#if HAS_Y_MICROSTEPS
|
|
|
|
#if HAS_Y_MICROSTEPS
|
|
|
@ -1601,7 +1641,7 @@ void Stepper::report_positions() {
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void Stepper::microstep_mode(uint8_t driver, uint8_t stepping_mode) {
|
|
|
|
void Stepper::microstep_mode(const uint8_t driver, const uint8_t stepping_mode) {
|
|
|
|
switch (stepping_mode) {
|
|
|
|
switch (stepping_mode) {
|
|
|
|
case 1: microstep_ms(driver, MICROSTEP1); break;
|
|
|
|
case 1: microstep_ms(driver, MICROSTEP1); break;
|
|
|
|
case 2: microstep_ms(driver, MICROSTEP2); break;
|
|
|
|
case 2: microstep_ms(driver, MICROSTEP2); break;
|
|
|
|