Kiko Ishimoto
/
angle-example
This is example of ANGLE.lib. We get angle that make from L3GD20 and ADXL345.
main.cpp@1:1d8421cca595, 2014-11-30 (annotated)
- Committer:
- kikoaac
- Date:
- Sun Nov 30 12:04:06 2014 +0000
- Revision:
- 1:1d8421cca595
- Parent:
- 0:acbe7732f472
...
;
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 "angle.h" |
kikoaac | 0:acbe7732f472 | 4 | ANGLE angle(p28, p27); |
kikoaac | 0:acbe7732f472 | 5 | Serial pc(USBTX, USBRX); |
kikoaac | 0:acbe7732f472 | 6 | Ticker T; |
kikoaac | 0:acbe7732f472 | 7 | void led2_thread(void const *argument) { |
kikoaac | 0:acbe7732f472 | 8 | while (true) { |
kikoaac | 0:acbe7732f472 | 9 | angle.set_angle(); |
kikoaac | 0:acbe7732f472 | 10 | Thread::wait(0.001); |
kikoaac | 0:acbe7732f472 | 11 | } |
kikoaac | 0:acbe7732f472 | 12 | } |
kikoaac | 0:acbe7732f472 | 13 | |
kikoaac | 0:acbe7732f472 | 14 | int main(){ |
kikoaac | 0:acbe7732f472 | 15 | double g[3]; |
kikoaac | 0:acbe7732f472 | 16 | Thread thread(led2_thread); |
kikoaac | 0:acbe7732f472 | 17 | //double angle[3]; |
kikoaac | 0:acbe7732f472 | 18 | int d[3]; |
kikoaac | 0:acbe7732f472 | 19 | short rate[3]; |
kikoaac | 0:acbe7732f472 | 20 | Thread::wait(1.0); |
kikoaac | 0:acbe7732f472 | 21 | //T.attach(&angle,&ANGLE::set_angle,0.001); |
kikoaac | 0:acbe7732f472 | 22 | while(1) |
kikoaac | 0:acbe7732f472 | 23 | { |
kikoaac | 0:acbe7732f472 | 24 | //gyro.get_rate(g,g+1,g+2); |
kikoaac | 0:acbe7732f472 | 25 | angle.get_Comp_angle(g,g+1); |
kikoaac | 0:acbe7732f472 | 26 | pc.printf("%lf, %lf, %lf\n", g[0], g[1], g[2]); |
kikoaac | 0:acbe7732f472 | 27 | |
kikoaac | 0:acbe7732f472 | 28 | } |
kikoaac | 0:acbe7732f472 | 29 | } |
kikoaac | 0:acbe7732f472 | 30 | |
kikoaac | 0:acbe7732f472 | 31 |