Aloïs Wolff
/
testHK10DOF
test program for the HK10DOF library
main.cpp
- Committer:
- pommzorz
- Date:
- 2013-07-17
- Revision:
- 0:06ada7a91fa1
File content as of revision 0:06ada7a91fa1:
#include "mbed.h" #include "math.h" #include "HMC5883L.h" #include "ADXL345_I2C.h" #include "L3G4200D.h" #include "BMP085.h" #include "HK10DOF.h" //#include "PwmIn.h" PwmOut rled(LED_RED); PwmOut gled(LED_GREEN); PwmOut bled(LED_BLUE); HK10DOF imu(PTE0,PTE1); float ypr[3]; float values[9]; int main() { rled=1; gled=1; imu.pc.printf("Ceci est un Test\r\n"); imu.init(true); imu.pc.printf("Test passe\r\n"); float alt=0; while(1) { //imu.getValues(values); imu.getYawPitchRoll(ypr); imu.pc.printf("YAW: %03.0f PITCH: %03.0f ROLL: %03.0f \n\r",ypr[0],ypr[1],ypr[2]); alt=imu.getBaroAlt(); //imu.pc.printf("ALT : %03.0f",alt); //imu.pc.printf("ACC: %04.0f %04.0f %04.0f GYR: %04.0f %04.0f %04.0f MAG: %04.0f %04.0f %04.0f \n\r",values[0], values[1], values[2], values[3], values[4], values[5], values[6], values[7], values[8] ); wait_ms(1); bled=!bled; } }