Curtis Belknap
/
LSM303DLHTest
LSM303DLH Test Program for get angle.
Fork of LSM303DLHTest by
Diff: main.cpp
- Revision:
- 5:05d5e64e76f2
- Parent:
- 4:3c677edffb13
--- a/main.cpp Sun May 06 05:30:44 2012 +0000 +++ b/main.cpp Wed Mar 18 16:48:45 2015 +0000 @@ -1,4 +1,3 @@ - #include "mbed.h" #include "LSM303DLH.h" @@ -11,16 +10,18 @@ vector acc; vector mag; debug.format(8,Serial::None,1); - debug.baud(115200); - debug.printf("LSM303DLH Test\x0d\x0a"); - compass.setOffset(0.00,0.00,0.00); // example calibration + debug.baud(9600); + debug.printf("LSM303DLH Test\r\n"); + compass.setOffset(0,0,0); // example calibration compass.setScale(1.00,1.00,1.00); // example calibration while(1) { compass.read(acc,mag); hdg = compass.heading(); - hdgV = atan2(acc.y,acc.z) * 180/M_PI; - debug.printf("ACC: %6.2f %6.2f %6.2f Heading: %6.2f %6.2f\n",acc.x,acc.y,acc.z,hdgV,hdg); - wait(0.1); + hdgV = atan2(acc.y,acc.x) * 180/M_PI; + debug.printf("ACC: %6.2f %6.2f %6.2f\r\n",acc.x,acc.y,acc.z); + debug.printf("MAG: %6.2f %6.2f %6.2f\r\n",mag.x,mag.y,mag.z); + debug.printf("HEAD: %6.2f %6.2f\r\n",hdgV,hdg); + debug.printf("\r\n"); + wait(1); } -} - \ No newline at end of file +} \ No newline at end of file