3d-print/anadyr-marlin
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

[2.0.x] Teensy 3.1 and 3.2 support (#11460)

Browse Source
This commit is contained in:
Ilya Bukhonin
2018-08-28 05:49:49 +03:00
committed by Scott Lahteine
parent 409a0632af
commit 7ecb8b4af5
21 changed files with 1173 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files

36
Marlin/src/HAL/HAL_TEENSY31_32/HAL_Servo_Teensy.cpp Normal file
View File

@@ -0,0 +1,36 @@
#ifdef __MK20DX256__
#include "../../inc/MarlinConfig.h"
#if HAS_SERVOS
#include "HAL_Servo_Teensy.h"
uint8_t servoPin[MAX_SERVOS] = { 0 };
int8_t libServo::attach(const int pin) {
if (this->servoIndex >= MAX_SERVOS) return -1;
if (pin > 0) servoPin[this->servoIndex] = pin;
return Servo::attach(servoPin[this->servoIndex]);
}
int8_t libServo::attach(const int pin, const int min, const int max) {
if (pin > 0) servoPin[this->servoIndex] = pin;
return Servo::attach(servoPin[this->servoIndex], min, max);
}
void libServo::move(const int value) {
constexpr uint16_t servo_delay[] = SERVO_DELAY;
static_assert(COUNT(servo_delay) == NUM_SERVOS, "SERVO_DELAY must be an array NUM_SERVOS long.");
if (this->attach(0) >= 0) {
this->write(value);
safe_delay(servo_delay[this->servoIndex]);
#if ENABLED(DEACTIVATE_SERVOS_AFTER_MOVE)
this->detach();
#endif
}
}
#endif // HAS_SERVOS
#endif // __MK20DX256__