![](/media/cache/group/default_image.jpg.50x50_q85.jpg)
Testing ekf implementation for Quadro_1.
Diff: EKF_RPY.cpp
- Revision:
- 1:6b803652d032
- Parent:
- 0:a0e9705be9c4
- Child:
- 7:bcbcc23983de
--- a/EKF_RPY.cpp Fri Oct 18 14:55:53 2019 +0000 +++ b/EKF_RPY.cpp Fri Oct 18 21:15:52 2019 +0000 @@ -75,12 +75,12 @@ void EKF_RPY::update_angles() { - s1 = sinf(x(0)); - c1 = cosf(x(0)); - s2 = sinf(x(1)); - c2 = cosf(x(1)); - s3 = sinf(x(2)); - c3 = cosf(x(2)); + s1 = sin(x(0)); + c1 = cos(x(0)); + s2 = sin(x(1)); + c2 = cos(x(1)); + s3 = sin(x(2)); + c3 = cos(x(2)); } void EKF_RPY::update_F()