@@ -611,33 +611,39 @@ void interpretCommandString(String readString){
611
611
if (readString .substring (0 , 3 ) == "G10" ){
612
612
G10 (readString );
613
613
Serial .println ("gready" );
614
+ Serial .println ("ready" );
614
615
readString = "" ;
615
616
}
616
617
617
618
if (readString .substring (0 , 3 ) == "G17" ){ //XY plane is the default so no action is taken
618
619
Serial .println ("gready" );
620
+ Serial .println ("ready" );
619
621
readString = "" ;
620
622
}
621
623
622
624
if (readString .substring (0 , 3 ) == "G20" ){
623
625
setInchesToMillimetersConversion (INCHES );
624
626
Serial .println ("gready" );
627
+ Serial .println ("ready" );
625
628
readString = "" ;
626
629
}
627
630
628
631
if (readString .substring (0 , 3 ) == "G21" ){
629
632
setInchesToMillimetersConversion (MILLIMETERS );
630
633
Serial .println ("gready" );
634
+ Serial .println ("ready" );
631
635
readString = "" ;
632
636
}
633
637
634
638
if (readString .substring (0 , 3 ) == "G90" ){ //G90 is the default so no action is taken
635
639
Serial .println ("gready" );
640
+ Serial .println ("ready" );
636
641
readString = "" ;
637
642
}
638
643
639
644
if (readString .substring (0 , 3 ) == "M06" ){ //Tool change are default so no action is taken
640
645
Serial .println ("gready" );
646
+ Serial .println ("ready" );
641
647
readString = "" ;
642
648
}
643
649
@@ -646,28 +652,23 @@ void interpretCommandString(String readString){
646
652
leftAxis .computeMotorResponse ();
647
653
rightAxis .computeMotorResponse ();
648
654
649
- //Serial.println("Begin motion testing: ");
650
-
651
- /*for(int i = 0; i > -256; i = i - 10){
652
- Serial.print(i);
653
- Serial.print("->");
654
- Serial.println(leftAxis.measureMotorSpeed(i));
655
- }*/
656
-
657
655
readString = "" ;
658
656
Serial .println ("gready" );
657
+ Serial .println ("ready" );
659
658
}
660
659
661
660
if (readString .substring (0 , 3 ) == "B02" ){
662
661
calibrateChainLengths ();
663
662
readString = "" ;
664
663
Serial .println ("gready" );
664
+ Serial .println ("ready" );
665
665
}
666
666
667
667
if (readString .substring (0 , 3 ) == "B03" ){
668
668
updateSettings (readString );
669
669
readString = "" ;
670
670
Serial .println ("gready" );
671
+ Serial .println ("ready" );
671
672
}
672
673
673
674
if (readString .substring (0 , 3 ) == "B04" ){
@@ -681,25 +682,29 @@ void interpretCommandString(String readString){
681
682
Serial .println ("Tests complete." );
682
683
readString = "" ;
683
684
Serial .println ("gready" );
685
+ Serial .println ("ready" );
684
686
}
685
687
686
688
if (readString .substring (0 , 3 ) == "B05" ){
687
689
Serial .print ("Firmware Version " );
688
690
Serial .println (VERSIONNUMBER );
689
691
readString = "" ;
690
692
Serial .println ("gready" );
693
+ Serial .println ("ready" );
691
694
}
692
695
693
696
if ((readString [0 ] == 'T' || readString [0 ] == 't' ) && readString [1 ] != 'e' ){
694
697
Serial .print ("Please insert tool " );
695
698
Serial .println (readString );
696
699
Serial .println ("gready" );
700
+ Serial .println ("ready" );
697
701
readString = "" ;
698
702
}
699
703
700
704
if (readString .length () > 0 ){
701
705
Serial .println (readString );
702
706
readString = "" ;
703
707
Serial .println ("gready" );
708
+ Serial .println ("ready" );
704
709
}
705
710
}
0 commit comments