|
Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
|
Data Structures | |
| struct | Uint8Vect3 |
| struct | Int8Vect3 |
| struct | Uint16Vect3 |
| struct | Int16Vect3 |
| struct | Int32Vect2 |
| struct | Int32Vect3 |
| struct | Int32Quat |
| Rotation quaternion. More... | |
| struct | Int64Quat |
| struct | Int16Eulers |
| struct | Int32Eulers |
| euler angles More... | |
| struct | Int32RMat |
| rotation matrix More... | |
| struct | Int32Mat33 |
| struct | Int16Rates |
| struct | Int32Rates |
| angular rates More... | |
| struct | Int64Rates |
| struct | Int64Vect2 |
| struct | Int64Vect3 |
Macros | |
| #define | INT32_POS_FRAC 8 |
| #define | INT32_POS_OF_CM 2.56 |
| #define | INT32_POS_OF_CM_NUM 64 |
| #define | INT32_POS_OF_CM_DEN 25 |
| #define | INT32_SPEED_FRAC 19 |
| #define | INT32_SPEED_OF_CM_S 5242.88 |
| #define | INT32_SPEED_OF_CM_S_NUM 41943 |
| #define | INT32_SPEED_OF_CM_S_DEN 8 |
| #define | INT32_ACCEL_FRAC 10 |
| #define | INT32_MAG_FRAC 11 |
| #define | INT32_PERCENTAGE_FRAC 10 |
| #define | INT32_QUAT_FRAC 15 |
| #define | INT32_ANGLE_FRAC 12 |
| #define | INT32_RATE_FRAC 12 |
| #define | INT32_ANGLE_PI_4 (int32_t)ANGLE_BFP_OF_REAL( 0.7853981633974483096156608458198757) |
| #define | INT32_ANGLE_PI_2 (int32_t)ANGLE_BFP_OF_REAL( 1.5707963267948966192313216916397514) |
| #define | INT32_ANGLE_PI (int32_t)ANGLE_BFP_OF_REAL( 3.1415926535897932384626433832795029) |
| #define | INT32_ANGLE_2_PI (int32_t)ANGLE_BFP_OF_REAL(2.*3.1415926535897932384626433832795029) |
| #define | INT32_RAD_OF_DEG(_deg) |
| #define | INT32_DEG_OF_RAD(_rad) |
| #define | INT32_ANGLE_NORMALIZE(_a) |
| #define | INT32_COURSE_NORMALIZE(_a) |
| #define | INT32_TRIG_FRAC 14 |
| #define | LBFP_OF_REAL(_vr, _frac) |
| #define | BFP_OF_REAL(_vr, _frac) |
| #define | FLOAT_OF_BFP(_vbfp, _frac) |
| #define | DOUBLE_OF_BFP(_vbfp, _frac) |
| #define | RATE_BFP_OF_REAL(_af) |
| #define | RATE_FLOAT_OF_BFP(_ai) |
| #define | ANGLE_BFP_OF_REAL(_af) |
| #define | ANGLE_FLOAT_OF_BFP(_ai) |
| #define | QUAT1_BFP_OF_REAL(_qf) |
| #define | QUAT1_FLOAT_OF_BFP(_qi) |
| #define | TRIG_BFP_OF_REAL(_tf) |
| #define | TRIG_FLOAT_OF_BFP(_ti) |
| #define | POS_BFP_OF_REAL(_af) |
| #define | POS_FLOAT_OF_BFP(_ai) |
| #define | SPEED_BFP_OF_REAL(_af) |
| #define | SPEED_FLOAT_OF_BFP(_ai) |
| #define | ACCEL_BFP_OF_REAL(_af) |
| #define | ACCEL_FLOAT_OF_BFP(_ai) |
| #define | MAG_BFP_OF_REAL(_af) |
| #define | MAG_FLOAT_OF_BFP(_ai) |
| #define | INT_MULT_RSHIFT(_a, _b, _r) |
| #define | INT32_SQRT(_out, _in) |
| #define | INT_VECT2_ZERO(_v) |
| #define | INT32_VECT2_NORM(_v) |
| #define | INT32_VECT2_NORMALIZE(_v, _frac) |
| #define | INT32_VECT2_RSHIFT(_o, _i, _r) |
| #define | INT32_VECT2_LSHIFT(_o, _i, _l) |
| #define | INT32_VECT2_SCALE_2(_a, _b, _num, _den) |
| #define | INT_VECT3_ZERO(_v) |
| #define | INT32_VECT3_ZERO(_v) |
| #define | INT32_VECT3_SCALE_2(_a, _b, _num, _den) |
| #define | INT32_VECT3_NORM(_v) |
| #define | INT32_VECT3_RSHIFT(_o, _i, _r) |
| #define | INT32_VECT3_LSHIFT(_o, _i, _l) |
| #define | INT32_MAT33_ZERO(_m) |
| #define | INT32_MAT33_DIAG(_m, _d00, _d11, _d22) |
| #define | int32_rmat_of_eulers int32_rmat_of_eulers_321 |
| Rotation matrix from Euler angles. | |
| #define | INT32_RMAT_COMP(_m_a2c, _m_a2b, _m_b2c) |
| #define | INT32_RMAT_COMP_INV(_m_a2b, _m_a2c, _m_b2c) |
| #define | INT32_RMAT_VMULT(_vb, _m_a2b, _va) |
| #define | INT32_RMAT_TRANSP_VMULT(_vb, _m_b2a, _va) |
| #define | INT32_RMAT_RATEMULT(_rb, _m_a2b, _ra) |
| #define | INT32_RMAT_TRANSP_RATEMULT(_rb, _m_b2a, _ra) |
| #define | INT32_RMAT_OF_QUAT(_rm, _q) |
| #define | INT32_RMAT_OF_EULERS(_rm, _e) |
| #define | INT32_RMAT_OF_EULERS_321(_rm, _e) |
| #define | INT32_RMAT_OF_EULERS_312(_rm, _e) |
| #define | INT32_QUAT_ZERO(_q) |
| #define | INT32_QUAT_NORM(n, q) |
| #define | INT32_QUAT_WRAP_SHORTEST(q) |
| #define | INT32_QUAT_NORMALIZE(q) |
| #define | INT32_QUAT_COMP(_a2c, _a2b, _b2c) |
| #define | INT32_QUAT_COMP_INV(_a2b, _a2c, _b2c) |
| #define | INT32_QUAT_INV_COMP(_b2c, _a2b, _a2c) |
| #define | INT32_QUAT_COMP_NORM_SHORTEST(_a2c, _a2b, _b2c) |
| #define | INT32_QUAT_INV_COMP_NORM_SHORTEST(_b2c, _a2b, _a2c) |
| #define | INT32_QUAT_DERIVATIVE(_qd, _r, _q) |
| #define | INT32_QUAT_INTEGRATE_FI(_q, _hr, _omega, _f) |
| #define | INT32_QUAT_VMULT(v_out, q, v_in) |
| #define | INT32_QUAT_OF_EULERS(_q, _e) |
| #define | INT32_QUAT_OF_AXIS_ANGLE(_q, _uv, _an) |
| #define | INT32_QUAT_OF_RMAT(_q, _r) |
| #define | INT_EULERS_ZERO(_e) |
| #define | INT32_EULERS_OF_RMAT(_e, _rm) |
| #define | INT32_EULERS_OF_QUAT(_e, _q) |
| #define | INT32_EULERS_LSHIFT(_o, _i, _r) |
| #define | INT32_EULERS_RSHIFT(_o, _i, _r) |
| #define | INT_RATES_ZERO(_e) |
| #define | INT_RATES_RSHIFT(_o, _i, _r) |
| #define | INT_RATES_LSHIFT(_o, _i, _r) |
| #define | int32_eulers_dot_of_rates int32_eulers_dot_321_of_rates |
| #define | INT32_RATES_OF_EULERS_DOT_321(_r, _e, _ed) |
| #define | INT32_RATES_OF_EULERS_DOT(_r, _e, _ed) |
| #define | INT32_EULERS_DOT_321_OF_RATES(_ed, _e, _r) |
| #define | INT32_EULERS_DOT_OF_RATES(_ed, _e, _r) |
Functions | |
| uint32_t | int32_sqrt (uint32_t in) |
| uint32_t | int32_gcd (uint32_t a, uint32_t b) |
| static uint32_t | int32_vect2_norm2 (struct Int32Vect2 *v) |
| return squared norm of 2D vector | |
| static uint32_t | int32_vect2_norm (struct Int32Vect2 *v) |
| return norm of 2D vector | |
| static void | int32_vect2_normalize (struct Int32Vect2 *v, uint8_t frac) |
| normalize 2D vector inplace | |
| static void | int32_rmat_identity (struct Int32RMat *rm) |
| initialises a rotation matrix to identity | |
| void | int32_rmat_comp (struct Int32RMat *m_a2c, const struct Int32RMat *m_a2b, const struct Int32RMat *m_b2c) |
| Composition (multiplication) of two rotation matrices. | |
| void | int32_rmat_comp_inv (struct Int32RMat *m_a2b, const struct Int32RMat *m_a2c, const struct Int32RMat *m_b2c) |
| Composition (multiplication) of two rotation matrices. | |
| void | int32_rmat_vmult (struct Int32Vect3 *vb, struct Int32RMat *m_a2b, struct Int32Vect3 *va) |
| rotate 3D vector by rotation matrix. | |
| void | int32_rmat_transp_vmult (struct Int32Vect3 *vb, struct Int32RMat *m_b2a, struct Int32Vect3 *va) |
| rotate 3D vector by transposed rotation matrix. | |
| void | int32_rmat_ratemult (struct Int32Rates *rb, struct Int32RMat *m_a2b, struct Int32Rates *ra) |
| rotate anglular rates by rotation matrix. | |
| void | int32_rmat_transp_ratemult (struct Int32Rates *rb, struct Int32RMat *m_b2a, struct Int32Rates *ra) |
| rotate anglular rates by transposed rotation matrix. | |
| void | int32_rmat_of_quat (struct Int32RMat *rm, struct Int32Quat *q) |
| Convert unit quaternion to rotation matrix. | |
| void | int32_rmat_of_eulers_321 (struct Int32RMat *rm, struct Int32Eulers *e) |
| Rotation matrix from 321 Euler angles (int). | |
| void | int32_rmat_of_eulers_312 (struct Int32RMat *rm, struct Int32Eulers *e) |
| Rotation matrix from 312 Euler angles. | |
| static void | int32_quat_identity (struct Int32Quat *q) |
| initialises a quaternion to identity | |
| static uint32_t | int32_quat_norm (struct Int32Quat *q) |
| Norm of a quaternion. | |
| static void | int32_quat_wrap_shortest (struct Int32Quat *q) |
| static void | int32_quat_normalize (struct Int32Quat *q) |
| normalize a quaternion inplace | |
| void | int32_quat_comp (struct Int32Quat *a2c, struct Int32Quat *a2b, struct Int32Quat *b2c) |
| Composition (multiplication) of two quaternions. | |
| void | int32_quat_comp_inv (struct Int32Quat *a2b, struct Int32Quat *a2c, struct Int32Quat *b2c) |
| Composition (multiplication) of two quaternions. | |
| void | int32_quat_inv_comp (struct Int32Quat *b2c, struct Int32Quat *a2b, struct Int32Quat *a2c) |
| Composition (multiplication) of two quaternions. | |
| void | int32_quat_comp_norm_shortest (struct Int32Quat *a2c, struct Int32Quat *a2b, struct Int32Quat *b2c) |
| Composition (multiplication) of two quaternions with normalization. | |
| void | int32_quat_comp_inv_norm_shortest (struct Int32Quat *a2b, struct Int32Quat *a2c, struct Int32Quat *b2c) |
| Composition (multiplication) of two quaternions with normalization. | |
| void | int32_quat_inv_comp_norm_shortest (struct Int32Quat *b2c, struct Int32Quat *a2b, struct Int32Quat *a2c) |
| Composition (multiplication) of two quaternions with normalization. | |
| void | int32_quat_derivative (struct Int32Quat *qd, const struct Int32Rates *r, struct Int32Quat *q) |
| Quaternion derivative from rotational velocity. | |
| void | int32_quat_integrate_fi (struct Int32Quat *q, struct Int64Quat *hr, struct Int32Rates *omega, int freq) |
| in place quaternion first order integration with constant rotational velocity. | |
| void | int32_quat_vmult (struct Int32Vect3 *v_out, struct Int32Quat *q, struct Int32Vect3 *v_in) |
| rotate 3D vector by quaternion. | |
| void | int32_quat_of_eulers (struct Int32Quat *q, struct Int32Eulers *e) |
| Quaternion from Euler angles. | |
| void | int32_quat_of_axis_angle (struct Int32Quat *q, struct Int32Vect3 *uv, int32_t angle) |
| Quaternion from unit vector and angle. | |
| void | int32_quat_of_rmat (struct Int32Quat *q, struct Int32RMat *r) |
| Quaternion from rotation matrix. | |
| void | int32_eulers_of_rmat (struct Int32Eulers *e, struct Int32RMat *rm) |
| void | int32_eulers_of_quat (struct Int32Eulers *e, struct Int32Quat *q) |
| void | int32_rates_of_eulers_dot_321 (struct Int32Rates *r, struct Int32Eulers *e, struct Int32Eulers *ed) |
| void | int32_eulers_dot_321_of_rates (struct Int32Eulers *ed, struct Int32Eulers *e, struct Int32Rates *r) |
| static void | int32_vect_zero (int32_t *a, const int n) |
| a = 0 | |
| static void | int16_vect_zero (int16_t *a, const int n) |
| a = 0 | |
| static void | int32_vect_set_value (int32_t *a, const int32_t v, const int n) |
| a = v * ones(n,1) | |
| static void | int32_vect_copy (int32_t *a, const int32_t *b, const int n) |
| a = b | |
| static void | int32_vect_sum (int32_t *o, const int32_t *a, const int32_t *b, const int n) |
| o = a + b | |
| static void | int32_vect_diff (int32_t *o, const int32_t *a, const int32_t *b, const int n) |
| o = a - b | |
| static void | int32_vect_mul (int32_t *o, const int32_t *a, const int32_t *b, const int n) |
| o = a * b (element wise) | |
| static void | int32_vect_add (int32_t *a, const int32_t *b, const int n) |
| a += b | |
| static void | int32_vect_sub (int32_t *a, const int32_t *b, const int n) |
| a -= b | |
| static void | int32_vect_smul (int32_t *o, const int32_t *a, const int32_t s, const int n) |
| o = a * s | |
| static bool | int32_vect_find (const int32_t *a, const int32_t s, int *loc, const int n) |
| Find value s in array a. | |
| static void | int32_mat_mul (int32_t **o, int32_t **a, int32_t **b, int m, int n, int l) |
| o = a * b | |
| struct Uint8Vect3 |
Definition at line 44 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| uint8_t | x | |
| uint8_t | y | |
| uint8_t | z | |
| struct Int8Vect3 |
Definition at line 50 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int8_t | x | |
| int8_t | y | |
| int8_t | z | |
| struct Uint16Vect3 |
Definition at line 56 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| uint16_t | x | |
| uint16_t | y | |
| uint16_t | z | |
| struct Int16Vect3 |
Definition at line 62 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int16_t | x | |
| int16_t | y | |
| int16_t | z | |
| struct Int32Vect2 |
Definition at line 83 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int32_t | x | |
| int32_t | y | |
| struct Int32Vect3 |
Definition at line 88 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int32_t | x | |
| int32_t | y | |
| int32_t | z | |
| struct Int32Quat |
Rotation quaternion.
Units: BFP with INT32_QUAT_FRAC
Definition at line 99 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int32_t | qi | |
| int32_t | qx | |
| int32_t | qy | |
| int32_t | qz | |
| struct Int64Quat |
Definition at line 107 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int64_t | qi | |
| int64_t | qx | |
| int64_t | qy | |
| int64_t | qz | |
| struct Int16Eulers |
Definition at line 137 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int16_t | phi | |
| int16_t | psi | |
| int16_t | theta | |
| struct Int32Eulers |
euler angles
Units: rad in BFP with INT32_ANGLE_FRAC
Definition at line 146 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int32_t | phi | in rad with INT32_ANGLE_FRAC |
| int32_t | psi | in rad with INT32_ANGLE_FRAC |
| int32_t | theta | in rad with INT32_ANGLE_FRAC |
| struct Int32RMat |
rotation matrix
Units: rad in BFP with INT32_TRIG_FRAC
Definition at line 159 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int32_t | m[3 *3] | |
| struct Int32Mat33 |
Definition at line 164 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int32_t | m[3 *3] | |
| struct Int16Rates |
Definition at line 169 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int16_t | p | |
| int16_t | q | |
| int16_t | r | |
| struct Int32Rates |
angular rates
Units: rad/s in BFP with INT32_RATE_FRAC
Definition at line 179 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int32_t | p | in rad/s with INT32_RATE_FRAC |
| int32_t | q | in rad/s with INT32_RATE_FRAC |
| int32_t | r | in rad/s with INT32_RATE_FRAC |
| struct Int64Rates |
Definition at line 185 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int64_t | p | |
| int64_t | q | |
| int64_t | r | |
| struct Int64Vect2 |
Definition at line 192 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int64_t | x | |
| int64_t | y | |
| struct Int64Vect3 |
Definition at line 197 of file pprz_algebra_int.h.
| Data Fields | ||
|---|---|---|
| int64_t | x | |
| int64_t | y | |
| int64_t | z | |
| #define ACCEL_BFP_OF_REAL | ( | _af | ) |
Definition at line 221 of file pprz_algebra_int.h.
Referenced by accel_cb(), accel_cb(), ekf_aw_wrapper_fetch(), guidance_h_set_acc(), guidance_h_set_all(), guidance_h_update_reference(), guidance_v_set_all(), gv_adapt_run(), handle_ins_msg(), ins_ekf2_publish_attitude(), ins_int_propagate(), ins_update_from_vff(), invensense3_456_set_scalings(), send_ins(), and send_ins_z().
| #define ACCEL_FLOAT_OF_BFP | ( | _ai | ) |
Definition at line 222 of file pprz_algebra_int.h.
Referenced by accel_cb(), ArduIMU_event(), calibrate_coeff(), calibrate_zero(), guidance_h_update_reference(), guidance_indi_controller(), guidance_indi_controller(), guidance_indi_propagate_filters(), guidance_indi_quadplane_propagate_filters(), guidance_oneloop_nB_run_mode(), guidance_oneloop_run_mode(), hff_propagate(), imu_accel_raw_cb(), imu_nps_init(), ins_int_propagate(), nav_shake_start_acc_cb(), oneloop_andi_propagate_filters(), oneloop_nB_propagate_filters(), and sensors_hitl_init().
| #define ANGLE_BFP_OF_REAL | ( | _af | ) |
Definition at line 211 of file pprz_algebra_int.h.
Referenced by ahrs_int_get_euler_from_accel_mag(), get_rc_pitch(), get_rc_roll(), get_rc_yaw(), guidance_flip_run(), guidance_hybrid_airspeed_to_attitude(), guidance_hybrid_vertical(), guidance_module_run(), guidance_pid_h_run(), imu_cube_init(), imu_pixhawk6x_init(), int32_atan2_2(), int32_eulers_of_quat(), int32_eulers_of_rmat(), mag_hmc58xx_module_init(), mag_ist8310_module_init(), mag_lis3mdl_module_init(), mag_qmc5883l_module_init(), mag_rm3100_module_init(), OA_update(), pprz_itrig_sin(), send_fp(), stabilization_attitude_heli_indi_init(), stabilization_attitude_read_rc_setpoint_eulers(), and vertical_ctrl_module_run().
| #define ANGLE_FLOAT_OF_BFP | ( | _ai | ) |
Definition at line 212 of file pprz_algebra_int.h.
Referenced by ArduIMU_event(), guidance_hybrid_airspeed_to_attitude(), guidance_hybrid_set_cmd_i(), pprz_itrig_sin(), quat_from_earth_cmd_i(), rotorcraft_cam_periodic(), stabilization_attitude_get_heading_i(), and stabilization_attitude_read_rc_setpoint_eulers().
| #define BFP_OF_REAL | ( | _vr, | |
| _frac ) |
Definition at line 206 of file pprz_algebra_int.h.
Referenced by attitude_ref_quat_int_set_max_p(), attitude_ref_quat_int_set_max_pdot(), attitude_ref_quat_int_set_max_q(), attitude_ref_quat_int_set_max_qdot(), attitude_ref_quat_int_set_max_r(), attitude_ref_quat_int_set_max_rdot(), computeOptiTrack(), gain_scheduling_periodic(), get_vertical_thrust_coeff(), guidance_flip_run(), guidance_pid_h_run(), guidance_pid_v_run(), guidance_v_init(), gv_adapt_run(), horizontal_ctrl_module_run(), init_second_order_low_pass_int(), int32_vect2_normalize(), ltp_of_ecef_rmat_from_lla_i(), update_ref_model_p(), update_ref_model_q(), and update_ref_model_r().
| #define DOUBLE_OF_BFP | ( | _vbfp, | |
| _frac ) |
Definition at line 208 of file pprz_algebra_int.h.
| #define FLOAT_OF_BFP | ( | _vbfp, | |
| _frac ) |
Definition at line 207 of file pprz_algebra_int.h.
Referenced by gain_scheduling_periodic(), guidance_hybrid_airspeed_to_attitude(), reset_horizontal_vars(), and stateGetAccelBody_f().
| #define INT32_ACCEL_FRAC 10 |
Definition at line 78 of file pprz_algebra_int.h.
Referenced by guidance_pid_h_run(), guidance_pid_v_run(), guidance_v_update_ref(), gv_adapt_run(), gv_set_ref(), and stateGetAccelBody_f().
| #define INT32_ANGLE_2_PI (int32_t)ANGLE_BFP_OF_REAL(2.*3.1415926535897932384626433832795029) |
Definition at line 121 of file pprz_algebra_int.h.
| #define INT32_ANGLE_FRAC 12 |
Definition at line 116 of file pprz_algebra_int.h.
Referenced by ahrs_icq_update_gps(), ahrs_icq_update_heading(), attitude_ref_euler_int_update(), computeOptiTrack(), guidance_hybrid_airspeed_to_attitude(), guidance_pid_h_run(), horizontal_ctrl_module_run(), int32_atan2_2(), reset_horizontal_vars(), reset_psi_ref_from_body(), send_att_ref(), stabilization_attitude_read_rc_setpoint_eulers(), and stabilization_attitude_run().
| #define INT32_ANGLE_NORMALIZE | ( | _a | ) |
Definition at line 126 of file pprz_algebra_int.h.
Referenced by ahrs_icq_update_heading(), ahrs_int_get_euler_from_accel_mag(), OA_update(), pprz_itrig_sin(), stabilization_attitude_read_rc_setpoint_eulers(), and stabilization_attitude_run().
| #define INT32_ANGLE_PI (int32_t)ANGLE_BFP_OF_REAL( 3.1415926535897932384626433832795029) |
Definition at line 120 of file pprz_algebra_int.h.
Referenced by guidance_hybrid_airspeed_to_attitude(), and pprz_itrig_sin().
| #define INT32_ANGLE_PI_2 (int32_t)ANGLE_BFP_OF_REAL( 1.5707963267948966192313216916397514) |
Definition at line 119 of file pprz_algebra_int.h.
Referenced by guidance_pid_h_run(), pprz_itrig_cos(), pprz_itrig_sin(), and stabilization_attitude_get_heading_i().
| #define INT32_ANGLE_PI_4 (int32_t)ANGLE_BFP_OF_REAL( 0.7853981633974483096156608458198757) |
Definition at line 118 of file pprz_algebra_int.h.
Referenced by int32_atan2(), and int32_atan2_2().
| #define INT32_COURSE_NORMALIZE | ( | _a | ) |
Definition at line 131 of file pprz_algebra_int.h.
Referenced by rotorcraft_cam_periodic(), and stateCalcHorizontalSpeedDir_i().
| #define INT32_DEG_OF_RAD | ( | _rad | ) |
Definition at line 124 of file pprz_algebra_int.h.
| #define INT32_EULERS_DOT_321_OF_RATES | ( | _ed, | |
| _e, | |||
| _r ) |
Definition at line 599 of file pprz_algebra_int.h.
| #define INT32_EULERS_DOT_OF_RATES | ( | _ed, | |
| _e, | |||
| _r ) |
Definition at line 600 of file pprz_algebra_int.h.
| #define int32_eulers_dot_of_rates int32_eulers_dot_321_of_rates |
Definition at line 594 of file pprz_algebra_int.h.
| #define INT32_EULERS_LSHIFT | ( | _o, | |
| _i, | |||
| _r ) |
Definition at line 559 of file pprz_algebra_int.h.
Referenced by attitude_ref_euler_int_update(), send_att_ref(), and stabilization_attitude_run().
| #define INT32_EULERS_OF_QUAT | ( | _e, | |
| _q ) |
Definition at line 557 of file pprz_algebra_int.h.
| #define INT32_EULERS_OF_RMAT | ( | _e, | |
| _rm ) |
Definition at line 556 of file pprz_algebra_int.h.
| #define INT32_EULERS_RSHIFT | ( | _o, | |
| _i, | |||
| _r ) |
Definition at line 565 of file pprz_algebra_int.h.
| #define INT32_MAG_FRAC 11 |
Definition at line 79 of file pprz_algebra_int.h.
Referenced by ahrs_icq_update_mag_2d().
| #define INT32_MAT33_DIAG | ( | _m, | |
| _d00, | |||
| _d11, | |||
| _d22 ) |
Definition at line 328 of file pprz_algebra_int.h.
Referenced by int32_rmat_identity().
| #define INT32_MAT33_ZERO | ( | _m | ) |
Definition at line 316 of file pprz_algebra_int.h.
Referenced by georeference_project().
| #define INT32_PERCENTAGE_FRAC 10 |
Definition at line 81 of file pprz_algebra_int.h.
| #define INT32_POS_FRAC 8 |
Definition at line 68 of file pprz_algebra_int.h.
Referenced by computeOptiTrack(), ecef_of_enu_pos_i(), enu_of_ecef_pos_i(), gh_set_ref(), gh_update_ref_from_pos_sp(), guidance_h_update_reference(), guidance_hybrid_airspeed_to_attitude(), guidance_pid_h_run(), guidance_v_update_ref(), gv_set_ref(), gv_update_ref_from_z_sp(), gv_update_ref_from_zd_sp(), hott_update_eam_msg(), and rotorcraft_cam_periodic().
| #define INT32_POS_OF_CM 2.56 |
Definition at line 69 of file pprz_algebra_int.h.
| #define INT32_POS_OF_CM_DEN 25 |
Definition at line 71 of file pprz_algebra_int.h.
Referenced by gps_cb(), gps_cb(), gps_cb(), ins_float_invariant_update_gps(), ins_int_update_gps(), and ins_module_update_gps().
| #define INT32_POS_OF_CM_NUM 64 |
Definition at line 70 of file pprz_algebra_int.h.
Referenced by gps_cb(), gps_cb(), gps_cb(), ins_float_invariant_update_gps(), ins_int_update_gps(), and ins_module_update_gps().
| #define INT32_QUAT_COMP | ( | _a2c, | |
| _a2b, | |||
| _b2c ) |
Definition at line 531 of file pprz_algebra_int.h.
| #define INT32_QUAT_COMP_INV | ( | _a2b, | |
| _a2c, | |||
| _b2c ) |
Definition at line 532 of file pprz_algebra_int.h.
| #define INT32_QUAT_COMP_NORM_SHORTEST | ( | _a2c, | |
| _a2b, | |||
| _b2c ) |
Definition at line 534 of file pprz_algebra_int.h.
| #define INT32_QUAT_DERIVATIVE | ( | _qd, | |
| _r, | |||
| _q ) |
Definition at line 536 of file pprz_algebra_int.h.
| #define INT32_QUAT_FRAC 15 |
Definition at line 95 of file pprz_algebra_int.h.
Referenced by attitude_ref_quat_int_update(), int32_eulers_of_quat(), int32_quat_comp(), int32_quat_comp_inv(), int32_quat_inv_comp(), int32_quat_of_axis_angle(), int32_quat_of_eulers(), int32_quat_of_rmat(), int32_quat_vmult(), and int32_rmat_of_quat().
| #define INT32_QUAT_INTEGRATE_FI | ( | _q, | |
| _hr, | |||
| _omega, | |||
| _f ) |
Definition at line 537 of file pprz_algebra_int.h.
| #define INT32_QUAT_INV_COMP | ( | _b2c, | |
| _a2b, | |||
| _a2c ) |
Definition at line 533 of file pprz_algebra_int.h.
| #define INT32_QUAT_INV_COMP_NORM_SHORTEST | ( | _b2c, | |
| _a2b, | |||
| _a2c ) |
Definition at line 535 of file pprz_algebra_int.h.
| #define INT32_QUAT_NORM | ( | n, | |
| q ) |
Definition at line 528 of file pprz_algebra_int.h.
| #define INT32_QUAT_NORMALIZE | ( | q | ) |
Definition at line 530 of file pprz_algebra_int.h.
| #define INT32_QUAT_OF_AXIS_ANGLE | ( | _q, | |
| _uv, | |||
| _an ) |
Definition at line 540 of file pprz_algebra_int.h.
| #define INT32_QUAT_OF_EULERS | ( | _q, | |
| _e ) |
Definition at line 539 of file pprz_algebra_int.h.
| #define INT32_QUAT_OF_RMAT | ( | _q, | |
| _r ) |
Definition at line 541 of file pprz_algebra_int.h.
| #define INT32_QUAT_VMULT | ( | v_out, | |
| q, | |||
| v_in ) |
Definition at line 538 of file pprz_algebra_int.h.
| #define INT32_QUAT_WRAP_SHORTEST | ( | q | ) |
Definition at line 529 of file pprz_algebra_int.h.
| #define INT32_QUAT_ZERO | ( | _q | ) |
Definition at line 527 of file pprz_algebra_int.h.
| #define INT32_RAD_OF_DEG | ( | _deg | ) |
Definition at line 123 of file pprz_algebra_int.h.
| #define INT32_RATE_FRAC 12 |
Definition at line 117 of file pprz_algebra_int.h.
Referenced by attitude_ref_quat_int_update(), int32_quat_derivative(), int32_quat_integrate_fi(), stabilization_attitude_run(), and stabilization_attitude_run().
| #define INT32_RATES_OF_EULERS_DOT | ( | _r, | |
| _e, | |||
| _ed ) |
Definition at line 598 of file pprz_algebra_int.h.
| #define INT32_RATES_OF_EULERS_DOT_321 | ( | _r, | |
| _e, | |||
| _ed ) |
Definition at line 597 of file pprz_algebra_int.h.
| #define INT32_RMAT_COMP | ( | _m_a2c, | |
| _m_a2b, | |||
| _m_b2c ) |
Definition at line 412 of file pprz_algebra_int.h.
| #define INT32_RMAT_COMP_INV | ( | _m_a2b, | |
| _m_a2c, | |||
| _m_b2c ) |
Definition at line 413 of file pprz_algebra_int.h.
| #define INT32_RMAT_OF_EULERS | ( | _rm, | |
| _e ) |
Definition at line 420 of file pprz_algebra_int.h.
| #define int32_rmat_of_eulers int32_rmat_of_eulers_321 |
Rotation matrix from Euler angles.
Definition at line 409 of file pprz_algebra_int.h.
Referenced by imu_cube_init(), imu_init(), imu_pixhawk6x_init(), imu_set_body_to_imu_eulers(), mag_hmc58xx_module_init(), mag_ist8310_module_init(), mag_lis3mdl_module_init(), mag_qmc5883l_module_init(), mag_rm3100_module_init(), mag_uavcan_init(), and orientationCalcRMat_i().
| #define INT32_RMAT_OF_EULERS_312 | ( | _rm, | |
| _e ) |
Definition at line 422 of file pprz_algebra_int.h.
| #define INT32_RMAT_OF_EULERS_321 | ( | _rm, | |
| _e ) |
Definition at line 421 of file pprz_algebra_int.h.
| #define INT32_RMAT_OF_QUAT | ( | _rm, | |
| _q ) |
Definition at line 419 of file pprz_algebra_int.h.
| #define INT32_RMAT_RATEMULT | ( | _rb, | |
| _m_a2b, | |||
| _ra ) |
Definition at line 416 of file pprz_algebra_int.h.
| #define INT32_RMAT_TRANSP_RATEMULT | ( | _rb, | |
| _m_b2a, | |||
| _ra ) |
Definition at line 417 of file pprz_algebra_int.h.
| #define INT32_RMAT_TRANSP_VMULT | ( | _vb, | |
| _m_b2a, | |||
| _va ) |
Definition at line 415 of file pprz_algebra_int.h.
| #define INT32_RMAT_VMULT | ( | _vb, | |
| _m_a2b, | |||
| _va ) |
Definition at line 414 of file pprz_algebra_int.h.
| #define INT32_SPEED_FRAC 19 |
Definition at line 73 of file pprz_algebra_int.h.
Referenced by computeOptiTrack(), guidance_pid_h_run(), guidance_v_update_ref(), gv_adapt_run(), gv_set_ref(), gv_update_ref_from_zd_sp(), hott_update_eam_msg(), and stateCalcHorizontalSpeedNorm_i().
| #define INT32_SPEED_OF_CM_S 5242.88 |
Definition at line 74 of file pprz_algebra_int.h.
| #define INT32_SPEED_OF_CM_S_DEN 8 |
Definition at line 76 of file pprz_algebra_int.h.
Referenced by gps_cb(), gps_cb(), ins_int_update_gps(), and ins_module_update_gps().
| #define INT32_SPEED_OF_CM_S_NUM 41943 |
Definition at line 75 of file pprz_algebra_int.h.
Referenced by gps_cb(), gps_cb(), ins_int_update_gps(), and ins_module_update_gps().
| #define INT32_SQRT | ( | _out, | |
| _in ) |
Definition at line 231 of file pprz_algebra_int.h.
| #define INT32_TRIG_FRAC 14 |
Definition at line 154 of file pprz_algebra_int.h.
Referenced by ahrs_int_get_euler_from_accel_mag(), computeOptiTrack(), georeference_project(), get_vertical_thrust_coeff(), guidance_hybrid_airspeed_to_attitude(), guidance_hybrid_groundspeed_to_airspeed(), guidance_pid_h_run(), guidance_pid_v_run(), guidance_v_init(), guidance_v_thrust_adapt(), int32_eulers_dot_321_of_rates(), int32_eulers_of_quat(), int32_quat_of_axis_angle(), int32_quat_of_eulers(), int32_quat_of_rmat(), int32_rates_of_eulers_dot_321(), int32_rmat_comp(), int32_rmat_comp_inv(), int32_rmat_of_eulers_312(), int32_rmat_of_eulers_321(), int32_rmat_of_quat(), int32_rmat_ratemult(), int32_rmat_transp_ratemult(), int32_rmat_transp_vmult(), int32_rmat_vmult(), read_rc_setpoint_speed_i(), stab_sp_rotate_i(), and stabilization_attitude_get_heading_i().
| #define INT32_VECT2_LSHIFT | ( | _o, | |
| _i, | |||
| _l ) |
Definition at line 274 of file pprz_algebra_int.h.
| #define INT32_VECT2_NORM | ( | _v | ) |
Definition at line 241 of file pprz_algebra_int.h.
Referenced by rotorcraft_cam_periodic().
| #define INT32_VECT2_NORMALIZE | ( | _v, | |
| _frac ) |
Definition at line 266 of file pprz_algebra_int.h.
| #define INT32_VECT2_RSHIFT | ( | _o, | |
| _i, | |||
| _r ) |
Definition at line 269 of file pprz_algebra_int.h.
Referenced by guidance_h_update_reference(), guidance_hybrid_determine_wind_estimate(), and rotorcraft_cam_periodic().
| #define INT32_VECT2_SCALE_2 | ( | _a, | |
| _b, | |||
| _num, | |||
| _den ) |
Definition at line 279 of file pprz_algebra_int.h.
Referenced by ins_int_update_gps().
| #define INT32_VECT3_LSHIFT | ( | _o, | |
| _i, | |||
| _l ) |
Definition at line 305 of file pprz_algebra_int.h.
Referenced by enu_of_ecef_pos_i(), and georeference_project().
| #define INT32_VECT3_NORM | ( | _v | ) |
Definition at line 297 of file pprz_algebra_int.h.
| #define INT32_VECT3_RSHIFT | ( | _o, | |
| _i, | |||
| _r ) |
Definition at line 299 of file pprz_algebra_int.h.
Referenced by ahrs_icq_update_accel(), and ecef_of_enu_pos_i().
| #define INT32_VECT3_SCALE_2 | ( | _a, | |
| _b, | |||
| _num, | |||
| _den ) |
Definition at line 291 of file pprz_algebra_int.h.
Referenced by gps_cb(), gps_cb(), gps_cb(), ins_float_invariant_update_gps(), and ins_module_update_gps().
| #define INT32_VECT3_ZERO | ( | _v | ) |
Definition at line 289 of file pprz_algebra_int.h.
Referenced by ahrs_vectornav_init(), georeference_init(), ins_gps_passthrough_init(), ins_int_init(), ins_module_wrapper_init(), and ins_vectornav_init().
| #define INT_EULERS_ZERO | ( | _e | ) |
Definition at line 550 of file pprz_algebra_int.h.
Referenced by attitude_ref_euler_int_init(), attitude_ref_quat_int_init(), guidance_hybrid_init(), int32_eulers_dot_321_of_rates(), stabilization_attitude_enter(), stabilization_attitude_euler_int_init(), and stabilization_attitude_run().
| #define INT_MULT_RSHIFT | ( | _a, | |
| _b, | |||
| _r ) |
Definition at line 226 of file pprz_algebra_int.h.
Referenced by ahrs_int_get_euler_from_accel_mag(), guidance_hybrid_groundspeed_to_airspeed(), int32_eulers_dot_321_of_rates(), int32_eulers_of_quat(), int32_quat_of_eulers(), int32_rates_of_eulers_dot_321(), int32_rmat_of_eulers_312(), int32_rmat_of_eulers_321(), int32_rmat_of_quat(), stabilization_attitude_get_heading_i(), and stabilization_attitude_read_rc_setpoint_eulers().
| #define INT_RATES_LSHIFT | ( | _o, | |
| _i, | |||
| _r ) |
Definition at line 584 of file pprz_algebra_int.h.
Referenced by ahrs_icq_align().
| #define INT_RATES_RSHIFT | ( | _o, | |
| _i, | |||
| _r ) |
Definition at line 578 of file pprz_algebra_int.h.
Referenced by ahrs_icq_update_accel(), ahrs_icq_update_heading(), ahrs_icq_update_mag_2d(), and ahrs_icq_update_mag_full().
| #define INT_RATES_ZERO | ( | _e | ) |
Definition at line 576 of file pprz_algebra_int.h.
Referenced by ahrs_aligner_restart(), ahrs_aligner_run(), ahrs_icq_init(), ahrs_icq_propagate(), attitude_ref_euler_int_init(), attitude_ref_quat_int_enter(), attitude_ref_quat_int_init(), imu_init(), stabilization_attitude_run(), stabilization_direct_enter(), and stabilization_direct_init().
| #define INT_VECT2_ZERO | ( | _v | ) |
Definition at line 238 of file pprz_algebra_int.h.
Referenced by guidance_h_init(), guidance_h_update_reference(), guidance_hybrid_groundspeed_to_airspeed(), guidance_hybrid_init(), guidance_pid_h_run(), guidance_pid_h_run_speed(), guidance_pid_init(), guidance_pid_set_h_igain(), rc_cb(), and reset_guidance_reference_from_current_position().
| #define INT_VECT3_ZERO | ( | _v | ) |
Definition at line 288 of file pprz_algebra_int.h.
Referenced by ahrs_aligner_restart(), ahrs_aligner_run(), imu_init(), ms2100_init(), nav_check_wp_time(), and nav_check_wp_time().
| #define LBFP_OF_REAL | ( | _vr, | |
| _frac ) |
Definition at line 205 of file pprz_algebra_int.h.
Referenced by gh_update_ref_from_accel_sp(), gh_update_ref_from_pos_sp(), and gh_update_ref_from_speed_sp().
| #define MAG_BFP_OF_REAL | ( | _af | ) |
Definition at line 223 of file pprz_algebra_int.h.
Referenced by ahrs_icq_init(), geo_mag_cb(), handle_ins_msg(), and mag_calib_ukf_run().
| #define MAG_FLOAT_OF_BFP | ( | _ai | ) |
Definition at line 224 of file pprz_algebra_int.h.
Referenced by imu_nps_init(), mag_calib_ukf_run(), send_geo_mag(), send_geo_mag(), and sensors_hitl_init().
| #define POS_BFP_OF_REAL | ( | _af | ) |
Definition at line 217 of file pprz_algebra_int.h.
Referenced by acInfoCalcPositionEnu_f(), acInfoCalcPositionEnu_i(), calculateForwards(), calculateForwards(), dc_send_command(), detection_cb(), fc_read_msg(), follow_wp(), guidance_h_set_all(), guidance_h_set_pos(), guidance_hybrid_groundspeed_to_airspeed(), guidance_v_from_nav(), guidance_v_set_all(), guidance_v_set_z(), ins_update_from_vff(), oneloop_andi_run(), oneloop_from_nav(), oneloop_nB_RM(), pos_est_cb(), run_avoid_navigation_onvision(), send_fp(), send_ins(), send_ins_z(), vel_est_cb(), waypoint_localize(), and waypoint_set_alt().
| #define POS_FLOAT_OF_BFP | ( | _ai | ) |
Definition at line 218 of file pprz_algebra_int.h.
Referenced by calculateForwards(), gh_update_ref_from_pos_sp(), guidance_hybrid_airspeed_to_attitude(), guidance_hybrid_groundspeed_to_airspeed(), guidance_indi_controller(), guidance_indi_controller(), guidance_indi_controller(), guidance_oneloop_nB_run_mode(), guidance_oneloop_run_mode(), moveWaypoint(), oneloop_andi_run(), oneloop_from_nav(), oneloop_nB_RM(), waypoint_set_alt_i(), and waypoint_set_xy_i().
| #define QUAT1_BFP_OF_REAL | ( | _qf | ) |
Definition at line 213 of file pprz_algebra_int.h.
Referenced by int32_quat_identity(), int32_quat_normalize(), int32_quat_vmult(), and send_ahrs_quat().
| #define QUAT1_FLOAT_OF_BFP | ( | _qi | ) |
Definition at line 214 of file pprz_algebra_int.h.
Referenced by attitude_run_fb().
| #define RATE_BFP_OF_REAL | ( | _af | ) |
Definition at line 209 of file pprz_algebra_int.h.
Referenced by handle_ins_msg(), and invensense3_456_set_scalings().
| #define RATE_FLOAT_OF_BFP | ( | _ai | ) |
Definition at line 210 of file pprz_algebra_int.h.
Referenced by ArduIMU_event(), attitude_run_fb(), attitude_run_ff(), imu_gyro_raw_cb(), imu_nps_init(), nps_ivy_display(), and sensors_hitl_init().
| #define SPEED_BFP_OF_REAL | ( | _af | ) |
Definition at line 219 of file pprz_algebra_int.h.
Referenced by ahrs_icq_update_gps(), guidance_h_set_all(), guidance_h_set_vel(), guidance_h_update_reference(), guidance_v_from_nav(), guidance_v_set_all(), guidance_v_set_vz(), ins_update_from_vff(), oneloop_from_nav(), rc_cb(), read_rc_setpoint_speed_i(), send_ins(), send_ins_z(), stateCalcAirspeed_i(), stateCalcHorizontalSpeedDir_i(), stateCalcHorizontalSpeedNorm_i(), stateCalcHorizontalWindspeed_i(), stateCalcVerticalWindspeed_i(), and vel_est_cb().
| #define SPEED_FLOAT_OF_BFP | ( | _ai | ) |
Definition at line 220 of file pprz_algebra_int.h.
Referenced by guidance_h_update_reference(), guidance_indi_controller(), guidance_indi_controller(), guidance_indi_controller(), guidance_oneloop_nB_run_mode(), guidance_oneloop_run_mode(), oneloop_from_nav(), reset_guidance_reference_from_current_position(), stateCalcAirspeed_f(), stateCalcHorizontalSpeedDir_f(), stateCalcHorizontalSpeedNorm_f(), stateCalcHorizontalWindspeed_f(), and stateCalcVerticalWindspeed_f().
| #define TRIG_BFP_OF_REAL | ( | _tf | ) |
Definition at line 215 of file pprz_algebra_int.h.
Referenced by ahrs_icq_update_heading(), int32_eulers_of_quat(), int32_quat_of_rmat(), int32_rmat_identity(), and int32_rmat_of_quat().
| #define TRIG_FLOAT_OF_BFP | ( | _ti | ) |
Definition at line 216 of file pprz_algebra_int.h.
Referenced by int32_eulers_of_rmat().
|
inlinestatic |
a = 0
Definition at line 617 of file pprz_algebra_int.h.
|
extern |
Definition at line 603 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, INT_EULERS_ZERO, INT_MULT_RSHIFT, Int32Rates::p, Int32Eulers::phi, PPRZ_ITRIG_COS, PPRZ_ITRIG_SIN, Int32Eulers::psi, Int32Rates::q, Int32Rates::r, and Int32Eulers::theta.
|
extern |
Definition at line 531 of file pprz_algebra_int.c.
References ANGLE_BFP_OF_REAL, INT32_QUAT_FRAC, INT32_TRIG_FRAC, INT_MULT_RSHIFT, Int32Eulers::phi, Int32Eulers::psi, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, Int32Quat::qz, Int32Eulers::theta, and TRIG_BFP_OF_REAL.
Referenced by attitude_ref_quat_int_update(), orientationCalcEulers_i(), send_euler(), send_euler(), and stab_sp_to_eulers_i().
|
extern |
Definition at line 512 of file pprz_algebra_int.c.
References ANGLE_BFP_OF_REAL, Int32RMat::m, Int32Eulers::phi, Int32Eulers::psi, Int32Eulers::theta, and TRIG_FLOAT_OF_BFP.
Referenced by orientationCalcEulers_i().
Definition at line 52 of file pprz_algebra_int.c.
References b.
Referenced by mt9f002_set_blanking().
o = a * b
a: [m x n] b: [n x l] o: [m x l]
Definition at line 708 of file pprz_algebra_int.h.
References b.
|
extern |
Composition (multiplication) of two quaternions.
a2c = a2b comp b2c , aka a2c = a2b * b2c
Definition at line 277 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, and Int32Quat::qz.
Referenced by guidance_hybrid_set_cmd_i(), and int32_quat_comp_norm_shortest().
|
extern |
Composition (multiplication) of two quaternions.
a2b = a2c comp_inv b2c , aka a2b = a2c * inv(b2c)
Definition at line 285 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, and Int32Quat::qz.
Referenced by int32_quat_comp_inv_norm_shortest(), and stabilization_attitude_run().
|
extern |
Composition (multiplication) of two quaternions with normalization.
a2b = a2c comp_inv b2c , aka a2b = a2c * inv(b2c)
Definition at line 308 of file pprz_algebra_int.c.
References int32_quat_comp_inv(), int32_quat_normalize(), and int32_quat_wrap_shortest().
|
extern |
Composition (multiplication) of two quaternions with normalization.
a2c = a2b comp b2c , aka a2c = a2b * b2c
Definition at line 301 of file pprz_algebra_int.c.
References int32_quat_comp(), int32_quat_normalize(), and int32_quat_wrap_shortest().
Referenced by ahrs_icq_realign_heading().
|
extern |
Quaternion derivative from rotational velocity.
qd = -0.5*omega(r) * q or equally: qd = 0.5 * q * omega(r)
qd = -0.5*omega(r) * q or equally: qd = 0.5 * q * omega(r) Multiplication with 0.5 is done by shifting one more bit to the right.
Definition at line 328 of file pprz_algebra_int.c.
References INT32_RATE_FRAC, Int32Rates::p, Int32Rates::q, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, Int32Quat::qz, and Int32Rates::r.
Referenced by attitude_ref_quat_int_update().
|
inlinestatic |
initialises a quaternion to identity
Definition at line 432 of file pprz_algebra_int.h.
References Int32Quat::qi, QUAT1_BFP_OF_REAL, Int32Quat::qx, Int32Quat::qy, and Int32Quat::qz.
Referenced by ahrs_icq_init(), attitude_ref_quat_int_init(), orientationSetIdentity(), stab_sp_to_quat_i(), stabilization_attitude_enter(), stabilization_attitude_quat_int_init(), and stabilization_attitude_run().
|
extern |
in place quaternion first order integration with constant rotational velocity.
Definition at line 337 of file pprz_algebra_int.c.
References INT32_RATE_FRAC, Int32Rates::p, Int32Rates::q, Int32Quat::qi, Int64Quat::qi, Int32Quat::qx, Int64Quat::qx, Int32Quat::qy, Int64Quat::qy, Int32Quat::qz, Int64Quat::qz, and Int32Rates::r.
Referenced by ahrs_icq_propagate().
|
extern |
Composition (multiplication) of two quaternions.
b2c = a2b inv_comp a2c , aka b2c = inv(_a2b) * a2c
Definition at line 293 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, and Int32Quat::qz.
Referenced by attitude_ref_quat_int_update(), int32_quat_inv_comp_norm_shortest(), stabilization_attitude_run(), and stabilization_attitude_run().
|
extern |
Composition (multiplication) of two quaternions with normalization.
b2c = a2b inv_comp a2c , aka b2c = inv(_a2b) * a2c
Definition at line 315 of file pprz_algebra_int.c.
References int32_quat_inv_comp(), int32_quat_normalize(), and int32_quat_wrap_shortest().
Referenced by ahrs_icq_realign_heading().
Norm of a quaternion.
Definition at line 442 of file pprz_algebra_int.h.
References int32_sqrt(), Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, and Int32Quat::qz.
Referenced by int32_quat_normalize().
|
inlinestatic |
normalize a quaternion inplace
Definition at line 456 of file pprz_algebra_int.h.
References int32_quat_norm(), Int32Quat::qi, QUAT1_BFP_OF_REAL, Int32Quat::qx, Int32Quat::qy, and Int32Quat::qz.
Referenced by ahrs_icq_propagate(), ahrs_icq_realign_heading(), attitude_ref_quat_int_update(), int32_quat_comp_inv_norm_shortest(), int32_quat_comp_norm_shortest(), int32_quat_inv_comp_norm_shortest(), stabilization_attitude_run(), and stabilization_attitude_run().
|
extern |
Quaternion from unit vector and angle.
Output quaternion is not normalized. The output resolution depends on the resolution of the resolution of the unit vector. If the unit vector has no fractional part (ex: [0, 0, 1]), the quaternion is unitary.
Definition at line 417 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, INT32_TRIG_FRAC, PPRZ_ITRIG_COS, PPRZ_ITRIG_SIN, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, Int32Quat::qz, Int32Vect3::x, Int32Vect3::y, and Int32Vect3::z.
Referenced by guidance_hybrid_set_cmd_i().
|
extern |
Quaternion from Euler angles.
Definition at line 383 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, INT32_TRIG_FRAC, INT_MULT_RSHIFT, Int32Eulers::phi, PPRZ_ITRIG_COS, PPRZ_ITRIG_SIN, Int32Eulers::psi, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, Int32Quat::qz, and Int32Eulers::theta.
Referenced by orientationCalcQuat_i(), and stab_sp_to_quat_i().
Quaternion from rotation matrix.
Definition at line 429 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, int32_sqrt(), INT32_TRIG_FRAC, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, Int32Quat::qz, RMAT_ELMT, RMAT_TRACE, and TRIG_BFP_OF_REAL.
Referenced by orientationCalcQuat_i().
|
extern |
rotate 3D vector by quaternion.
vb = q_a2b * va * q_a2b^-1 Doesn't support inplace rotation, meaning v_out mustn't be a pointer to same struct as v_in.
Definition at line 361 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, Int32Quat::qi, QUAT1_BFP_OF_REAL, Int32Quat::qx, Int32Quat::qy, Int32Quat::qz, Int32Vect3::x, Int32Vect3::y, and Int32Vect3::z.
Referenced by ins_int_update_gps().
|
inlinestatic |
Definition at line 448 of file pprz_algebra_int.h.
References Int32Quat::qi, and QUAT_EXPLEMENTARY.
Referenced by attitude_ref_quat_int_update(), int32_quat_comp_inv_norm_shortest(), int32_quat_comp_norm_shortest(), int32_quat_inv_comp_norm_shortest(), stabilization_attitude_run(), and stabilization_attitude_run().
|
extern |
Definition at line 584 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, INT_MULT_RSHIFT, Int32Rates::p, Int32Eulers::phi, PPRZ_ITRIG_COS, PPRZ_ITRIG_SIN, Int32Eulers::psi, Int32Rates::q, Int32Rates::r, and Int32Eulers::theta.
|
extern |
Composition (multiplication) of two rotation matrices.
m_a2c = m_a2b comp m_b2c , aka m_a2c = m_b2c * m_a2b
_m_a2c = _m_a2b comp _m_b2c , aka _m_a2c = _m_b2c * _m_a2b
Definition at line 75 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, and Int32RMat::m.
Referenced by imu_init(), imu_set_body_to_imu_eulers(), imu_set_defaults_accel(), imu_set_defaults_gyro(), and imu_set_defaults_mag().
|
extern |
Composition (multiplication) of two rotation matrices.
m_a2b = m_a2c comp_inv m_b2c , aka m_a2b = inv(_m_b2c) * m_a2c
_m_a2b = _m_a2c comp_inv _m_b2c , aka _m_a2b = inv(_m_b2c) * _m_a2c
Definition at line 91 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, and Int32RMat::m.
Referenced by imu_set_body_to_imu_eulers().
|
inlinestatic |
initialises a rotation matrix to identity
Definition at line 347 of file pprz_algebra_int.h.
References INT32_MAT33_DIAG, and TRIG_BFP_OF_REAL.
Referenced by imu_init().
|
extern |
Rotation matrix from 312 Euler angles.
Definition at line 228 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, INT_MULT_RSHIFT, Int32Eulers::phi, PPRZ_ITRIG_COS, PPRZ_ITRIG_SIN, Int32Eulers::psi, RMAT_ELMT, and Int32Eulers::theta.
|
extern |
Rotation matrix from 321 Euler angles (int).
The Euler angles are interpreted as zy'x'' (intrinsic) rotation. First rotate around z with psi, then around the new y' with theta, then around new x'' with phi. This is the same as a xyz (extrinsic) rotation, rotating around the fixed x, then y then z axis.
| [out] | rm | pointer to rotation matrix |
| [in] | e | pointer to Euler angles |
Definition at line 185 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, INT_MULT_RSHIFT, Int32Eulers::phi, PPRZ_ITRIG_COS, PPRZ_ITRIG_SIN, Int32Eulers::psi, RMAT_ELMT, and Int32Eulers::theta.
Convert unit quaternion to rotation matrix.
Definition at line 156 of file pprz_algebra_int.c.
References INT32_QUAT_FRAC, INT32_TRIG_FRAC, INT_MULT_RSHIFT, Int32RMat::m, Int32Quat::qi, Int32Quat::qx, Int32Quat::qy, Int32Quat::qz, and TRIG_BFP_OF_REAL.
Referenced by ahrs_icq_update_accel(), ahrs_icq_update_heading(), ahrs_icq_update_mag_2d(), ahrs_icq_update_mag_full(), and orientationCalcRMat_i().
|
extern |
rotate anglular rates by rotation matrix.
rb = m_a2b * ra
Definition at line 127 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, Int32RMat::m, Int32Rates::p, Int32Rates::q, and Int32Rates::r.
|
extern |
rotate anglular rates by transposed rotation matrix.
rb = m_b2a^T * ra
Definition at line 141 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, Int32RMat::m, Int32Rates::p, Int32Rates::q, and Int32Rates::r.
Referenced by imu_gyro_raw_cb().
|
extern |
rotate 3D vector by transposed rotation matrix.
vb = m_b2a^T * va
Definition at line 117 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, Int32RMat::m, Int32Vect3::x, Int32Vect3::y, and Int32Vect3::z.
Referenced by accel_cb(), accel_cb(), ahrs_icq_update_mag_2d(), georeference_project(), hff_propagate(), imu_accel_raw_cb(), imu_mag_raw_cb(), ins_int_propagate(), and ins_module_propagate().
|
extern |
rotate 3D vector by rotation matrix.
vb = m_a2b * va
Definition at line 107 of file pprz_algebra_int.c.
References INT32_TRIG_FRAC, Int32RMat::m, Int32Vect3::x, Int32Vect3::y, and Int32Vect3::z.
Referenced by ahrs_icq_update_heading(), ahrs_icq_update_mag_2d(), ahrs_icq_update_mag_full(), ekf_aw_wrapper_fetch(), imu_bebop_event(), mag_hmc58xx_module_event(), mag_pitot_parse_msg(), mag_qmc5883l_module_event(), mag_rm3100_module_event(), and stabilization_attitude_run().
Definition at line 30 of file pprz_algebra_int.c.
References INT32_SQRT_MAX_ITER.
Referenced by int32_quat_norm(), int32_quat_of_rmat(), int32_vect2_norm(), sbp_vel_ned_callback(), and stateCalcHorizontalSpeedNorm_i().
|
inlinestatic |
return norm of 2D vector
Definition at line 250 of file pprz_algebra_int.h.
References int32_sqrt(), and int32_vect2_norm2().
Referenced by guidance_hybrid_airspeed_to_attitude(), guidance_hybrid_groundspeed_to_airspeed(), and int32_vect2_normalize().
|
inlinestatic |
return squared norm of 2D vector
Definition at line 244 of file pprz_algebra_int.h.
References Int32Vect2::x, and Int32Vect2::y.
Referenced by int32_vect2_norm().
|
inlinestatic |
normalize 2D vector inplace
Definition at line 256 of file pprz_algebra_int.h.
References BFP_OF_REAL, f, int32_vect2_norm(), Int32Vect2::x, and Int32Vect2::y.
Referenced by ahrs_icq_update_mag_2d().
a = b
Definition at line 632 of file pprz_algebra_int.h.
References b.
Referenced by stabilization_attitude_run().
|
inlinestatic |
o = a - b
Definition at line 646 of file pprz_algebra_int.h.
References b.
Referenced by stabilization_attitude_run().
Find value s in array a.
Returns 1 if found, 0 if not found. If the value is found loc = index of found value in array, else loc = -1
Definition at line 683 of file pprz_algebra_int.h.
References s.
Referenced by range_msg_callback().
a = v * ones(n,1)
Definition at line 624 of file pprz_algebra_int.h.
Referenced by relative_localization_filter_init().
o = a + b
Definition at line 639 of file pprz_algebra_int.h.
References b.
Referenced by stabilization_attitude_run().
|
inlinestatic |
a = 0
Definition at line 610 of file pprz_algebra_int.h.