mirror of
https://github.com/paparazzi/paparazzi.git
synced 2026-06-02 05:17:03 +08:00
[rotorcraft] get rid of some warnings in ardrone2_sdk
This commit is contained in:
@@ -30,6 +30,7 @@
|
|||||||
|
|
||||||
#include "state.h"
|
#include "state.h"
|
||||||
#include "firmwares/rotorcraft/stabilization.h"
|
#include "firmwares/rotorcraft/stabilization.h"
|
||||||
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude.h"
|
||||||
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_rc_setpoint.h"
|
#include "firmwares/rotorcraft/stabilization/stabilization_attitude_rc_setpoint.h"
|
||||||
#include "paparazzi.h"
|
#include "paparazzi.h"
|
||||||
|
|
||||||
|
|||||||
@@ -92,8 +92,12 @@ void ins_reset_altitude_ref( void ) {
|
|||||||
|
|
||||||
void ins_propagate(float __attribute__((unused)) dt) {
|
void ins_propagate(float __attribute__((unused)) dt) {
|
||||||
/* untilt accels and speeds */
|
/* untilt accels and speeds */
|
||||||
float_rmat_transp_vmult(&ins_impl.ltp_accel, stateGetNedToBodyRMat_f(), &ahrs_impl.accel);
|
float_rmat_transp_vmult((struct FloatVect3*)&ins_impl.ltp_accel,
|
||||||
float_rmat_transp_vmult(&ins_impl.ltp_speed, stateGetNedToBodyRMat_f(), &ahrs_impl.speed);
|
stateGetNedToBodyRMat_f(),
|
||||||
|
(struct FloatVect3*)&ahrs_impl.accel);
|
||||||
|
float_rmat_transp_vmult((struct FloatVect3*)&ins_impl.ltp_speed,
|
||||||
|
stateGetNedToBodyRMat_f(),
|
||||||
|
(struct FloatVect3*)&ahrs_impl.speed);
|
||||||
|
|
||||||
//Add g to the accelerations
|
//Add g to the accelerations
|
||||||
ins_impl.ltp_accel.z += 9.81;
|
ins_impl.ltp_accel.z += 9.81;
|
||||||
|
|||||||
Reference in New Issue
Block a user