30#include "generated/airframe.h"
32#include "pprzlink/dl_protocol.h"
35#define GIMBAL_CADDX_PAN_MAX RadOfDeg(160.f)
36#define GIMBAL_CADDX_TILT_MAX RadOfDeg(120.f)
37#define GIMBAL_CADDX_ROLL_MAX RadOfDeg(60.f)
38#define GIMBAL_CADDX_TILT_OFFSET RadOfDeg(15.f)
57 *tilt = asinf(-
dir.z / cosf(roll));
58 *pan = atan2f(
dir.y - sinf(roll)*tanf(*tilt)*
dir.x,
dir.x);
70#ifdef SERVO_GIMBAL_CADDX_MODE_NEUTRAL
71 ActuatorSet(GIMBAL_CADDX_MODE,
MIN_PPRZ);
73#ifdef SERVO_GIMBAL_CADDX_SENS_NEUTRAL
74 ActuatorSet(GIMBAL_CADDX_SENS, 0);
78#ifdef SERVO_GIMBAL_CADDX_ROLL_NEUTRAL
80 ActuatorSet(GIMBAL_CADDX_ROLL, 0);
86#ifdef SERVO_GIMBAL_CADDX_ROLL_NEUTRAL
88 ActuatorSet(GIMBAL_CADDX_ROLL, roll_cmd);
void cam_gimbal_setup_angles(struct CamGimbal *cam, float pan_max, float pan_min, float tilt_max, float tilt_min)
void cam_gimbal_set_angles_callback(struct CamGimbal *cam, cam_angles_from_dir compute_angles)
struct CamGimbal cam_gimbal
Pan/Tilt camera gimbal control.
Handling of messages coming from ground and other A/Cs.
#define GIMBAL_CADDX_TILT_MAX
void gimbal_caddx_gm3_periodic(void)
#define GIMBAL_CADDX_PAN_MAX
static void gimbal_caddx_compute_angles(struct FloatVect3 dir, float *pan, float *tilt)
Compute pan and tilt angle for the 3-axis gimbal CaddX GM3.
#define GIMBAL_CADDX_ROLL_MAX
void gimbal_caddx_gm3_init(void)
float gimbal_caddx_gm3_roll
Hardware independent API for actuators (servos, motor controllers).