lefake/S4-P3-Projet
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Bug fixes

Browse Source 
Fix emergency state issue
This commit is contained in:
Marc-Antoine Lafreniere
2019-04-06 12:47:06 -04:00
parent 98c01ad36e
commit 06da9b8bb4
1 changed files with 3 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

11
pcbdevice/opencrcontroler/GcodeInterpreter/GcodeInterpreter.ino
View File

@@ -93,7 +93,8 @@ void setup()
pinMode(xSwitchPin, INPUT_PULLUP); pinMode(xSwitchPin, INPUT_PULLUP);
pinMode(ySwitchPin, INPUT_PULLUP); pinMode(ySwitchPin, INPUT_PULLUP);
pinMode(zSwitchPin, INPUT_PULLUP); pinMode(zSwitchPin, INPUT_PULLUP);
attachInterrupt(digitalPinToInterrupt(emergencySwitchPin), LimiteSwitch, FALLING); pinMode(emergencySwitchPin, INPUT_PULLUP);
attachInterrupt(digitalPinToInterrupt(emergencySwitchPin), LimiteSwitch, RISING);
Serial.begin(57600); Serial.begin(57600);
while(!Serial); // Open a Serial Monitor while(!Serial); // Open a Serial Monitor
@@ -136,9 +137,9 @@ void loop()
if (Serial.available()) if (Serial.available())
{ {
String read_string = Serial.readStringUntil('\n');
if(!isEmegencyState) if(!isEmegencyState)
{ {
String read_string = Serial.readStringUntil('\n');
String words[] = {"", "", ""}; String words[] = {"", "", ""};
int start = 0; int start = 0;
@@ -303,12 +304,6 @@ int MovingTick(uint8_t id, int32_t value){
void LimiteSwitch(){ void LimiteSwitch(){
if(!homing){ if(!homing){
TorqueOffAll();
Led(idX, !digitalRead(xSwitchPin));
Led(idY, !digitalRead(ySwitchPin));
Led(idZ, !digitalRead(zSwitchPin));
isEmegencyState = true; isEmegencyState = true;
} }
} }