Paparazzi UAS  v5.8.2_stable-0-g6260b7c
Paparazzi is a free software Unmanned Aircraft System.
 All Data Structures Namespaces Files Functions Variables Typedefs Enumerations Enumerator Macros Modules Pages
ahrs_float_mlkf.h
Go to the documentation of this file.
1 /*
2  * Copyright (C) 2011-2012 Antoine Drouin <poinix@gmail.com>
3  * Copyright (C) 2013 Felix Ruess <felix.ruess@gmail.com>
4  *
5  * This file is part of paparazzi.
6  *
7  * paparazzi is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2, or (at your option)
10  * any later version.
11  *
12  * paparazzi is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with paparazzi; see the file COPYING. If not, write to
19  * the Free Software Foundation, 59 Temple Place - Suite 330,
20  * Boston, MA 02111-1307, USA.
21  */
22 
31 #ifndef AHRS_FLOAT_MLKF_H
32 #define AHRS_FLOAT_MLKF_H
33 
34 #include "std.h"
37 
41 };
42 
43 struct AhrsMlkf {
48 
49  struct FloatVect3 mag_h;
50 
52 
54  float P[6][6];
55  float lp_accel;
56 
59 
61  bool_t is_aligned;
62 };
63 
64 extern struct AhrsMlkf ahrs_mlkf;
65 
66 extern void ahrs_mlkf_init(void);
68 extern void ahrs_mlkf_set_body_to_imu_quat(struct FloatQuat *q_b2i);
69 extern bool_t ahrs_mlkf_align(struct Int32Rates *lp_gyro, struct Int32Vect3 *lp_accel,
70  struct Int32Vect3 *lp_mag);
71 extern void ahrs_mlkf_propagate(struct Int32Rates *gyro, float dt);
72 extern void ahrs_mlkf_update_accel(struct Int32Vect3 *accel);
73 extern void ahrs_mlkf_update_mag(struct Int32Vect3 *mag);
74 extern void ahrs_mlkf_update_mag_2d(struct Int32Vect3 *mag);
75 extern void ahrs_mlkf_update_mag_full(struct Int32Vect3 *mag);
76 
77 #endif /* AHRS_FLOAT_MLKF_H */
void ahrs_mlkf_update_accel(struct Int32Vect3 *accel)
angular rates
struct FloatQuat gibbs_cor
struct FloatVect3 mag_noise
struct FloatVect3 mag_h
struct FloatRates imu_rate
Rotational velocity in IMU frame.
float P[6][6]
void ahrs_mlkf_init(void)
float lp_accel
void ahrs_mlkf_set_body_to_imu_quat(struct FloatQuat *q_b2i)
struct FloatRates gyro_bias
struct AhrsMlkf ahrs_mlkf
enum AhrsMlkfStatus status
void ahrs_mlkf_propagate(struct Int32Rates *gyro, float dt)
void ahrs_mlkf_update_mag(struct Int32Vect3 *mag)
Roation quaternion.
void ahrs_mlkf_update_mag_2d(struct Int32Vect3 *mag)
Paparazzi floating point algebra.
void ahrs_mlkf_set_body_to_imu(struct OrientationReps *body_to_imu)
void ahrs_mlkf_update_mag_full(struct Int32Vect3 *mag)
bool_t ahrs_mlkf_align(struct Int32Rates *lp_gyro, struct Int32Vect3 *lp_accel, struct Int32Vect3 *lp_mag)
bool_t is_aligned
struct OrientationReps body_to_imu
body_to_imu rotation
struct FloatQuat ltp_to_imu_quat
Rotation from LocalTangentPlane to IMU frame as unit quaternion.
static struct OrientationReps body_to_imu
Definition: ins_alt_float.c:77
struct FloatQuat ltp_to_body_quat
Rotation from LocalTangentPlane to body frame as unit quaternion.
Generic orientation representation and conversions.
angular rates
AhrsMlkfStatus