Curtis Belknap / Mbed 2 deprecated LSM303DLHTest

LSM303DLH Test Program for get angle.

Dependencies:   mbed

Fork of LSM303DLHTest by Toshihisa T

main.cpp

Committer:
tosihisa
Date:
2012-05-06
Revision:
3:f3796683b4c9
Parent:
2:39cdefe3c9f2
Child:
4:3c677edffb13

File content as of revision 3:f3796683b4c9:


#include "mbed.h"
 #include "LSM303DLH.h"

 Serial debug(USBTX,USBRX);
 LSM303DLH compass(p28, p27);

 int main() {
   float hdg;
   float hdgV;
   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
   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);
   }
 }