stepus53/EggbotWireless
1
0
Fork 0
mirror of https://github.com/usatiuk/EggbotWireless.git synced 2025-10-26 08:47:49 +01:00
Code Issues Packages Projects Releases Wiki Activity

fix pen commands

Browse Source 
Signed-off-by: Stepan Usatyuk <usaatyuk@ustk.me>
This commit is contained in:
Stepan Usatiuk
2019-05-18 15:27:34 +03:00
parent 704fe420e7
commit a1d59ea6b0
5 changed files with 17 additions and 19 deletions
Download Patch File Download Diff File Expand all files Collapse all files

18
Firmware/MotorControl/src/main.cpp
View File

@@ -84,21 +84,23 @@ void execCommand(float *command) {
needAdjust = false;
}
if (command[X] != -1) {
if (!isnan(command[X])) {
servoStepper.moveTo(command[X]);
}
if (command[Y] != -1) {
if (!isnan(command[Y])) {
eggStepper.moveTo(command[Y]);
}
if (command[Z] < 0) {
pen.engage();
if (!isnan(command[Z])) {
if (command[Z] < 0) {
pen.engage();
}
if (command[Z] >= 0) {
pen.disengage();
}
}
if (command[Z] >= 0) {
pen.disengage();
}
adjustRPM();
return;