46 lines
1.1 KiB
C++
46 lines
1.1 KiB
C++
// Do not remove the include below
|
|
#include "farmbot_arduino_controller.h"
|
|
#include "pins.h"
|
|
#include "Config.h"
|
|
|
|
static char commandEndChar = 0x0A;
|
|
static GCodeProcessor* gCodeProcessor = new GCodeProcessor();
|
|
|
|
//The setup function is called once at startup of the sketch
|
|
void setup() {
|
|
pinMode(X_STEP_PIN, OUTPUT);
|
|
pinMode(X_DIR_PIN, OUTPUT);
|
|
pinMode(X_ENABLE_PIN, OUTPUT);
|
|
pinMode(X_MIN_PIN, OUTPUT);
|
|
pinMode(X_MAX_PIN, OUTPUT);
|
|
|
|
pinMode(Y_STEP_PIN, OUTPUT);
|
|
pinMode(Y_DIR_PIN, OUTPUT);
|
|
pinMode(Y_ENABLE_PIN, OUTPUT);
|
|
pinMode(Y_MIN_PIN, OUTPUT);
|
|
pinMode(Y_MAX_PIN, OUTPUT);
|
|
|
|
pinMode(Z_STEP_PIN, OUTPUT);
|
|
pinMode(Z_DIR_PIN, OUTPUT);
|
|
pinMode(Z_ENABLE_PIN, OUTPUT);
|
|
pinMode(Z_MIN_PIN, OUTPUT);
|
|
pinMode(Z_MAX_PIN, OUTPUT);
|
|
|
|
Serial.begin(115200);
|
|
}
|
|
|
|
// The loop function is called in an endless loop
|
|
void loop() {
|
|
if (Serial.available()) {
|
|
String commandString = Serial.readStringUntil(commandEndChar);
|
|
if (commandString && commandString.length() > 0) {
|
|
Command* command = new Command(commandString);
|
|
if(LOGGING) {
|
|
command->print();
|
|
}
|
|
gCodeProcessor->execute(command);
|
|
}
|
|
}
|
|
delay(100);
|
|
}
|