Curtis Belknap
/
LSM303DLHTest
LSM303DLH Test Program for get angle.
Fork of LSM303DLHTest by
main.cpp@5:05d5e64e76f2, 2015-03-18 (annotated)
- Committer:
- cbelknap
- Date:
- Wed Mar 18 16:48:45 2015 +0000
- Revision:
- 5:05d5e64e76f2
- Parent:
- 4:3c677edffb13
Get magnitude, acceleration and heading
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
tosihisa | 0:750784997b84 | 1 | #include "mbed.h" |
tosihisa | 4:3c677edffb13 | 2 | #include "LSM303DLH.h" |
tosihisa | 0:750784997b84 | 3 | |
tosihisa | 4:3c677edffb13 | 4 | Serial debug(USBTX,USBRX); |
tosihisa | 4:3c677edffb13 | 5 | LSM303DLH compass(p28, p27); |
tosihisa | 0:750784997b84 | 6 | |
tosihisa | 4:3c677edffb13 | 7 | int main() { |
tosihisa | 4:3c677edffb13 | 8 | float hdg; |
tosihisa | 4:3c677edffb13 | 9 | float hdgV; |
tosihisa | 4:3c677edffb13 | 10 | vector acc; |
tosihisa | 4:3c677edffb13 | 11 | vector mag; |
tosihisa | 4:3c677edffb13 | 12 | debug.format(8,Serial::None,1); |
cbelknap | 5:05d5e64e76f2 | 13 | debug.baud(9600); |
cbelknap | 5:05d5e64e76f2 | 14 | debug.printf("LSM303DLH Test\r\n"); |
cbelknap | 5:05d5e64e76f2 | 15 | compass.setOffset(0,0,0); // example calibration |
tosihisa | 4:3c677edffb13 | 16 | compass.setScale(1.00,1.00,1.00); // example calibration |
tosihisa | 4:3c677edffb13 | 17 | while(1) { |
tosihisa | 4:3c677edffb13 | 18 | compass.read(acc,mag); |
tosihisa | 4:3c677edffb13 | 19 | hdg = compass.heading(); |
cbelknap | 5:05d5e64e76f2 | 20 | hdgV = atan2(acc.y,acc.x) * 180/M_PI; |
cbelknap | 5:05d5e64e76f2 | 21 | debug.printf("ACC: %6.2f %6.2f %6.2f\r\n",acc.x,acc.y,acc.z); |
cbelknap | 5:05d5e64e76f2 | 22 | debug.printf("MAG: %6.2f %6.2f %6.2f\r\n",mag.x,mag.y,mag.z); |
cbelknap | 5:05d5e64e76f2 | 23 | debug.printf("HEAD: %6.2f %6.2f\r\n",hdgV,hdg); |
cbelknap | 5:05d5e64e76f2 | 24 | debug.printf("\r\n"); |
cbelknap | 5:05d5e64e76f2 | 25 | wait(1); |
tosihisa | 4:3c677edffb13 | 26 | } |
cbelknap | 5:05d5e64e76f2 | 27 | } |