test morning
Dependencies: ISR_Mini-explorer mbed
Fork of roboticLab_withclass_3_July by
Diff: Sonar.cpp
- Revision:
- 13:b0ddd71e8f08
- Parent:
- 12:1e80471c5c6c
--- a/Sonar.cpp Tue Jul 11 16:55:13 2017 +0000 +++ b/Sonar.cpp Wed Jul 12 09:07:31 2017 +0000 @@ -26,7 +26,7 @@ //float anglePointToSonar=this->compute_angle_between_vectors(xCell,yCell,xSonar,ySonar);//angle beetween the point and the sonar beam float angleCellToSonar=atan2(yCell-yRobotWorld,xCell-xRobotWorld);//like world system - float angleOriginToMidleOfBeam=thetaWorld+this->angleFromCenter;// + float angleOriginToMidleOfBeam=thetaWorld+this->angleFromCenter;// float angleDifference=angleCellToSonar-angleOriginToMidleOfBeam; if(angleDifference > PI)