You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
72 lines
2.6 KiB
72 lines
2.6 KiB
11 years ago
|
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
|
||
|
|
|
||
|
|
/// @file AP_Parachute.h
|
||
|
|
/// @brief Parachute release library
|
||
|
|
|
||
|
|
#ifndef AP_PARACHUTE_H
|
||
|
|
#define AP_PARACHUTE_H
|
||
|
|
|
||
|
|
#include <AP_Param.h>
|
||
|
|
#include <AP_Common.h>
|
||
|
|
#include <AP_Relay.h>
|
||
|
|
|
||
|
|
#define AP_PARACHUTE_TRIGGER_TYPE_RELAY_0 0
|
||
|
|
#define AP_PARACHUTE_TRIGGER_TYPE_RELAY_1 1
|
||
|
|
#define AP_PARACHUTE_TRIGGER_TYPE_RELAY_2 2
|
||
|
|
#define AP_PARACHUTE_TRIGGER_TYPE_RELAY_3 3
|
||
|
|
#define AP_PARACHUTE_TRIGGER_TYPE_SERVO 10
|
||
|
|
|
||
|
|
#define AP_PARACHUTE_RELEASE_DURATION_MS 1000 // when parachute is released, servo or relay stay at their released position/value for 1000ms (1second)
|
||
|
|
|
||
|
|
#define AP_PARACHUTE_SERVO_ON_PWM_DEFAULT 1300 // default PWM value to move servo to when shutter is activated
|
||
|
|
#define AP_PARACHUTE_SERVO_OFF_PWM_DEFAULT 1100 // default PWM value to move servo to when shutter is deactivated
|
||
|
|
|
||
|
|
#define AP_PARACHUTE_ALT_MIN_DEFAULT 1000 // default min altitude the vehicle should have before parachute is released
|
||
|
|
|
||
|
|
/// @class AP_Parachute
|
||
|
|
/// @brief Class managing the release of a parachute
|
||
|
|
class AP_Parachute {
|
||
|
|
|
||
|
|
public:
|
||
|
|
|
||
|
|
/// Constructor
|
||
|
|
AP_Parachute(AP_Relay& relay) :
|
||
|
|
_relay(relay),
|
||
|
|
_release_time(0)
|
||
|
|
{
|
||
|
|
// setup parameter defaults
|
||
|
|
AP_Param::setup_object_defaults(this, var_info);
|
||
|
|
}
|
||
|
|
|
||
|
|
/// enabled - enable or disable parachute release
|
||
|
|
void enabled(bool on_off) { _enabled = on_off; }
|
||
|
|
|
||
|
|
/// enabled - returns true if parachute release is enabled
|
||
|
|
bool enabled() const { return _enabled; }
|
||
|
|
|
||
|
|
/// release - release parachute
|
||
|
|
void release();
|
||
|
|
|
||
|
|
/// update - shuts off the trigger should be called at about 10hz
|
||
|
|
void update();
|
||
|
|
|
||
|
|
/// alt_min_cm - returns the min altitude above home the vehicle should have before parachute is released
|
||
|
|
int16_t alt_min_cm() const { return _alt_min_cm; }
|
||
|
|
|
||
|
|
static const struct AP_Param::GroupInfo var_info[];
|
||
|
|
|
||
|
|
private:
|
||
|
|
// Parameters
|
||
|
|
AP_Int8 _enabled; // 1 if parachute release is enabled
|
||
|
|
AP_Int8 _release_type; // 0:Servo,1:Relay
|
||
|
|
AP_Int16 _servo_on_pwm; // PWM value to move servo to when shutter is activated
|
||
|
|
AP_Int16 _servo_off_pwm; // PWM value to move servo to when shutter is deactivated
|
||
|
|
AP_Int16 _alt_min_cm; // min altitude the vehicle should have before parachute is released
|
||
|
|
|
||
|
|
// internal variables
|
||
|
|
AP_Relay& _relay; // pointer to relay object from the base class Relay. The subclasses could be AP_Relay_APM1 or AP_Relay_APM2
|
||
|
|
uint32_t _release_time; // count of number of cycles servo or relay has been at on position
|
||
|
|
};
|
||
|
|
|
||
|
|
#endif /* AP_PARACHUTE_H */
|