Diff: LOCOMOTION.h

Revision:

26:5ae5ef623b72

Parent:

25:f3bf8351bbd4

diff -r f3bf8351bbd4 -r 5ae5ef623b72 LOCOMOTION.h
--- a/LOCOMOTION.h	Tue Apr 05 02:30:40 2016 +0000
+++ b/LOCOMOTION.h	Wed Apr 06 03:54:29 2016 +0000
@@ -14,10 +14,12 @@
 #define X_INCREASE 1
 #define X_DECREASE 2
 #define X_BACKWARDS 3
-#define BACKOFF 30
-#define X_NEAR_GOAL 20
-#define X_FAR_GOAL 80
-#define Y_INCREMENT 20
+#define ROTATE_1 4
+#define ROTATE_2 5
+#define BACKOFF 10
+#define X_NEAR_GOAL 0
+#define X_FAR_GOAL 90
+#define Y_INCREMENT 7
 
 enum {
     ANGLE_TURN  = 0,
@@ -40,11 +42,12 @@
     DigitalOut _led3;
     DigitalOut _led4;
     void eStop(void);
+    void mStop(void);
     bool setXPos(int target, int current, int error, int angle);
     bool setYBias(int target, int current, int error, int angle);
     bool setAngle(int target, int current, int error, int mode);
     
-    void setXstate(int *xCurrState, int *xTarget,bool xGood,bool angleGood,int *angleGoal);
+    void setXstate(int *xCurrState, int *xTarget,bool xGood,bool angleGood,int *angleGoal,int *angleTol );
     void setAngleTol(int *angleTol,bool yGood, bool xGood);
     void setYgoal(bool xGood,bool angleGood,bool yGood,int *yTarget);
     void check_xya(bool *xGood,bool *yGood,bool *angleGood, int xGoal,int angleGoal,int yGoal,LOCALIZE_xya xya,int xErr, int yErr,int angleErr);