This is example of ANGLE.lib. We get angle that make from L3GD20 and ADXL345.

Dependencies:   mbed-rtos mbed

Committer:
kikoaac
Date:
Sun Nov 30 11:07:57 2014 +0000
Revision:
0:acbe7732f472
Child:
1:1d8421cca595
???????????????????

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kikoaac 0:acbe7732f472 1 #include "mbed.h"
kikoaac 0:acbe7732f472 2 #include "rtos.h"
kikoaac 0:acbe7732f472 3 /* #include "ADXL345.h"
kikoaac 0:acbe7732f472 4 #include "kalman.h"
kikoaac 0:acbe7732f472 5 #include "L3GD20.h"*/
kikoaac 0:acbe7732f472 6 #include "angle.h"
kikoaac 0:acbe7732f472 7 ANGLE angle(p28, p27);
kikoaac 0:acbe7732f472 8 Serial pc(USBTX, USBRX);
kikoaac 0:acbe7732f472 9 Ticker T;
kikoaac 0:acbe7732f472 10 void led2_thread(void const *argument) {
kikoaac 0:acbe7732f472 11 while (true) {
kikoaac 0:acbe7732f472 12 angle.set_angle();
kikoaac 0:acbe7732f472 13 Thread::wait(0.001);
kikoaac 0:acbe7732f472 14 }
kikoaac 0:acbe7732f472 15 }
kikoaac 0:acbe7732f472 16
kikoaac 0:acbe7732f472 17 int main(){
kikoaac 0:acbe7732f472 18 double g[3];
kikoaac 0:acbe7732f472 19 Thread thread(led2_thread);
kikoaac 0:acbe7732f472 20 //double angle[3];
kikoaac 0:acbe7732f472 21 int d[3];
kikoaac 0:acbe7732f472 22 short rate[3];
kikoaac 0:acbe7732f472 23 Thread::wait(1.0);
kikoaac 0:acbe7732f472 24 //T.attach(&angle,&ANGLE::set_angle,0.001);
kikoaac 0:acbe7732f472 25 while(1)
kikoaac 0:acbe7732f472 26 {
kikoaac 0:acbe7732f472 27 //gyro.get_rate(g,g+1,g+2);
kikoaac 0:acbe7732f472 28 angle.get_Comp_angle(g,g+1);
kikoaac 0:acbe7732f472 29 pc.printf("%lf, %lf, %lf\n", g[0], g[1], g[2]);
kikoaac 0:acbe7732f472 30
kikoaac 0:acbe7732f472 31 }
kikoaac 0:acbe7732f472 32 }
kikoaac 0:acbe7732f472 33
kikoaac 0:acbe7732f472 34