27#include "generated/airframe.h"
46static void send_att(
struct transport_tx *trans,
struct link_device *
dev)
51 pprz_msg_send_STAB_ATTITUDE_FLOAT(trans,
dev, AC_ID,
52 &(body_rate->
p), &(body_rate->
q), &(body_rate->
r),
74 STABILIZATION_PLANE_PHI_PGAIN,
75 STABILIZATION_PLANE_THETA_PGAIN,
79 STABILIZATION_PLANE_PHI_DGAIN,
80 STABILIZATION_PLANE_THETA_DGAIN,
84 STABILIZATION_PLANE_PHI_IGAIN,
85 STABILIZATION_PLANE_THETA_IGAIN,
100#define MAX_SUM_ERR 200
142 cmd[COMMAND_YAW] = 0;
148 BoundAbs(cmd[COMMAND_YAW],
MAX_PPRZ);
149 BoundAbs(cmd[COMMAND_THRUST],
MAX_PPRZ);
static struct uart_periph * dev
#define FLOAT_EULERS_ZERO(_e)
#define FLOAT_RATES_ZERO(_r)
#define EULERS_BOUND_CUBE(_v, _min, _max)
#define EULERS_SDIV(_eo, _ei, _s)
#define EULERS_DIFF(_c, _a, _b)
#define VECT3_ASSIGN(_a, _x, _y, _z)
#define EULERS_ADD(_a, _b)
#define RATES_DIFF(_c, _a, _b)
static struct FloatEulers * stateGetNedToBodyEulers_f(void)
Get vehicle body attitude euler angles (float).
static struct FloatRates * stateGetBodyRates_f(void)
Get vehicle body angular rate (float).
Paparazzi floating point algebra.
struct Stabilization stabilization
struct FloatEulers stab_sp_to_eulers_f(struct StabilizationSetpoint *sp)
int32_t th_sp_to_thrust_i(struct ThrustSetpoint *th, int32_t thrust, uint8_t axis)
static struct FloatEulers stab_att_sp_euler
static void send_att(struct transport_tx *trans, struct link_device *dev)
struct PlaneAttitudeGains stab_plane_gains
void stabilization_attitude_plane_pid_run(bool in_flight, struct StabilizationSetpoint *sp, struct ThrustSetpoint *thrust, int32_t *cmd)
void stabilization_attitude_plane_pid_init(void)
struct FloatEulers stab_plane_att_sum_err
float stab_plane_att_cmd[COMMANDS_NB]
static void send_att(struct transport_tx *trans, struct link_device *dev)
void stabilization_attitude_plane_pid_enter(void)
Basic fixed-wing attitude stabilization in euler float version.
API to get/set the generic vehicle states.
Thrust setpoint // TODO to a setpoint header Structure to store the desired thrust vector with differ...
int16_t register_periodic_telemetry(struct periodic_telemetry *_pt, uint16_t _id, telemetry_cb _cb)
Register a telemetry callback function.
Periodic telemetry system header (includes downlink utility and generated code).
#define DefaultPeriodic
Set default periodic telemetry.
int int32_t
Typedef defining 32 bit int type.