drive down

Dependencies:   BMP280 BNO055_fusion PowerControl mbed

Fork of TEAM_G_FLOW_RIDA by Edwin Cho

Revision:
10:cf44f4387bc7
Parent:
9:4fc5d70c3bab
Child:
13:c62f975dfcfe
--- a/LOCALIZE.cpp	Wed Mar 23 07:53:32 2016 +0000
+++ b/LOCALIZE.cpp	Wed Mar 23 16:20:53 2016 +0000
@@ -75,7 +75,7 @@
         _ry=_ry_p<_ry_n ? FRAME_H-RY_OFF-_ry_p : _ry_n;
     } else if(abs(_xya.a-90)<R_ERROR) {
         _rx=_ry_p<_ry_n ? FRAME_W-RY_OFF-_ry_p : _ry_n;
-        _ry=_rx_p<_rx_n ? _rx_p : FRAME_H-RX_OFF-_rx_n; 
+        _ry=_rx_p<_rx_n ? _rx_p : FRAME_H-RX_OFF-_rx_n;
     } else {
         //error
         _rx=_rx_p;
@@ -103,4 +103,4 @@
     wait(R_WAIT);
     _ry_p=data[1];
     //printf("%d %d %d %d\n",_rx_p,_rx_n,_ry_p,_ry_n);
-}
+}
\ No newline at end of file