mirror of https://github.com/ArduPilot/ardupilot
76 lines
2.3 KiB
C++
76 lines
2.3 KiB
C++
/// @file AP_MotorsHeli_Quad.h
|
|
/// @brief Motor control class collective pitch quad helicopter (such as stingray)
|
|
|
|
#pragma once
|
|
|
|
#include <AP_Common/AP_Common.h>
|
|
#include <AP_Math/AP_Math.h>
|
|
#include <RC_Channel/RC_Channel.h>
|
|
|
|
#include "AP_MotorsHeli.h"
|
|
#include "AP_MotorsHeli_RSC.h"
|
|
|
|
// default collective min, max and midpoints for the rear swashplate
|
|
#define AP_MOTORS_HELI_QUAD_COLLECTIVE_MIN 1100
|
|
#define AP_MOTORS_HELI_QUAD_COLLECTIVE_MAX 1900
|
|
|
|
#define AP_MOTORS_HELI_QUAD_NUM_MOTORS 4
|
|
|
|
class AP_MotorsHeli_Quad : public AP_MotorsHeli {
|
|
public:
|
|
// constructor
|
|
AP_MotorsHeli_Quad(uint16_t speed_hz = AP_MOTORS_HELI_SPEED_DEFAULT) :
|
|
AP_MotorsHeli(speed_hz)
|
|
{
|
|
AP_Param::setup_object_defaults(this, var_info);
|
|
};
|
|
|
|
// set_update_rate - set update rate to motors
|
|
void set_update_rate( uint16_t speed_hz ) override;
|
|
|
|
// output_to_motors - sends values out to the motors
|
|
void output_to_motors() override;
|
|
|
|
// calculate_scalars - recalculates various scalars used
|
|
void calculate_scalars() override;
|
|
|
|
// calculate_armed_scalars - recalculates scalars that can change while armed
|
|
void calculate_armed_scalars() override;
|
|
|
|
// servo_test - move servos through full range of movement
|
|
void servo_test() override;
|
|
|
|
#if HAL_LOGGING_ENABLED
|
|
// heli motors logging - called at 10 Hz
|
|
void Log_Write(void) override;
|
|
#endif
|
|
|
|
// var_info for holding Parameter information
|
|
static const struct AP_Param::GroupInfo var_info[];
|
|
|
|
protected:
|
|
|
|
// init_outputs
|
|
void init_outputs () override;
|
|
|
|
// update_motor_controls - sends commands to motor controllers
|
|
void update_motor_control(AP_MotorsHeli_RSC::RotorControlState state) override;
|
|
|
|
// calculate_roll_pitch_collective_factors - setup rate factors
|
|
void calculate_roll_pitch_collective_factors ();
|
|
|
|
// move_actuators - moves swash plate to attitude of parameters passed in
|
|
void move_actuators(float roll_out, float pitch_out, float coll_in, float yaw_out) override;
|
|
|
|
const char* _get_frame_string() const override { return "HELI_QUAD"; }
|
|
|
|
// rate factors
|
|
float _rollFactor[AP_MOTORS_HELI_QUAD_NUM_MOTORS];
|
|
float _pitchFactor[AP_MOTORS_HELI_QUAD_NUM_MOTORS];
|
|
float _collectiveFactor[AP_MOTORS_HELI_QUAD_NUM_MOTORS];
|
|
float _yawFactor[AP_MOTORS_HELI_QUAD_NUM_MOTORS];
|
|
float _out[AP_MOTORS_HELI_QUAD_NUM_MOTORS];
|
|
};
|
|
|
|
|