Mekatronics Team G
Dependencies: BNO055_fusion PowerControl mbed BMP280
Fork of DEMO3 by
Diff: LOCALIZE.cpp
- Revision:
- 10:cf44f4387bc7
- Parent:
- 9:4fc5d70c3bab
- Child:
- 13:c62f975dfcfe
diff -r 4fc5d70c3bab -r cf44f4387bc7 LOCALIZE.cpp --- 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