![](/media/cache/profiles/e2fb52675e06ed2b9c143270ad44bdc2.jpg.50x50_q85.jpg)
This is example of ANGLE.lib. We get angle that make from L3GD20 and ADXL345.
main.cpp@0:acbe7732f472, 2014-11-30 (annotated)
- Committer:
- kikoaac
- Date:
- Sun Nov 30 11:07:57 2014 +0000
- Revision:
- 0:acbe7732f472
- Child:
- 1:1d8421cca595
???????????????????
Who changed what in which revision?
User | Revision | Line number | New 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 |