![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Colour sensors calibrated
Dependencies: mbed-rtos mbed Servo QEI
Fork of ICRSEurobot13 by
supportfuncs.h
- Committer:
- xiaxia686
- Date:
- 2013-04-12
- Revision:
- 46:adcd57a5e402
- Parent:
- 20:70d651156779
File content as of revision 46:adcd57a5e402:
#ifndef SUPPORTFUNCS_H #define SUPPORTFUNCS_H #include <cmath> #include "globals.h" #include "tvmet/Matrix.h" //Constrains agles to +/- pi inline float constrainAngle(float x){ x = fmod(x + PI, 2*PI); if (x < 0) x += 2*PI; return x - PI; } template <typename T> tvmet::Matrix <T, 2, 2> Rotmatrix(T theta) { tvmet::Matrix <T, 2, 2> outmatrix; outmatrix = cos(theta), -sin(theta), sin(theta), cos(theta); return outmatrix; } #endif //SUPPORTFUNCS_H