roboticLab_withclass_3_July
Dependencies: ISR_Mini-explorer mbed
Fork of roboticLab_withclass by
Sonar.hpp
- Committer:
- geotsam
- Date:
- 2017-07-03
- Revision:
- 1:20f48907c726
- Parent:
- 0:9f7ee7ed13e4
File content as of revision 1:20f48907c726:
#ifndef SONAR_HPP #define SONAR_HPP #include<math.h> class Sonar { public: float maxRange;//cm float minRange;//Rmin cm float incertitudeRange;//cm float angleRange;//Omega rad float angleFromCenter; float distanceX; float distanceY; //the distance are in the world coordinates Sonar(float angleFromCenter, float distanceXFromRobotCenter, float distanceYFromRobotCenter ); float compute_probability_t(float distanceObstacleDetected, float xCell, float yCell, float xRobotWorld, float yRobotWorld, float theta); //return distance sonar to cell if in range, -1 if not float isInRange(float xCell, float yCell, float xRobotWorld, float yRobotWorld, float thetaWorld); private: //returns the angle between the vectors (x,y) and (xs,ys) float compute_angle_between_vectors(float x, float y,float xs,float ys); //makes the angle inAngle between 0 and 2pi float rad_angle_check(float inAngle); }; #endif