2010-11-28 03:03:23 -04:00
|
|
|
// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: t -*-
|
|
|
|
|
|
|
|
/// @file RC_Channel.h
|
|
|
|
/// @brief RC_Channel manager, with EEPROM-backed storage of constants.
|
2010-11-23 15:28:19 -04:00
|
|
|
|
|
|
|
#ifndef RC_Channel_h
|
|
|
|
#define RC_Channel_h
|
|
|
|
|
2011-02-14 00:43:44 -04:00
|
|
|
#include <AP_Common.h>
|
2010-11-28 03:03:23 -04:00
|
|
|
|
|
|
|
/// @class RC_Channel
|
|
|
|
/// @brief Object managing one RC channel
|
|
|
|
class RC_Channel{
|
2011-09-09 11:18:38 -03:00
|
|
|
protected:
|
2011-05-02 02:56:21 -03:00
|
|
|
AP_Var_group _group; // must be before all vars to keep ctor init order correct
|
|
|
|
|
2011-02-14 00:43:44 -04:00
|
|
|
public:
|
2010-11-28 03:03:23 -04:00
|
|
|
/// Constructor
|
|
|
|
///
|
2011-02-14 00:43:44 -04:00
|
|
|
/// @param key EEPROM storage key for the channel trim parameters.
|
|
|
|
/// @param name Optional name for the group.
|
2010-11-28 03:03:23 -04:00
|
|
|
///
|
2011-03-21 04:25:48 -03:00
|
|
|
RC_Channel(AP_Var::Key key, const prog_char_t *name) :
|
2011-02-14 00:43:44 -04:00
|
|
|
_group(key, name),
|
2011-09-16 23:06:53 -03:00
|
|
|
radio_min (&_group, 0, 1100, name ? PSTR("MIN") : 0), // suppress name if group has no name
|
2011-02-14 13:43:33 -04:00
|
|
|
radio_trim(&_group, 1, 1500, name ? PSTR("TRIM") : 0),
|
2011-09-16 23:06:53 -03:00
|
|
|
radio_max (&_group, 2, 1900, name ? PSTR("MAX") : 0),
|
2010-11-28 03:03:23 -04:00
|
|
|
_high(1),
|
2010-12-25 21:17:04 -04:00
|
|
|
_filter(true),
|
2011-06-10 00:33:31 -03:00
|
|
|
_reverse (&_group, 3, 1, name ? PSTR("REV") : 0),
|
2011-01-17 00:05:48 -04:00
|
|
|
dead_zone(0),
|
|
|
|
scale_output(1.0)
|
2010-11-28 03:03:23 -04:00
|
|
|
{}
|
|
|
|
|
|
|
|
// setup min and max radio values in CLI
|
2010-11-25 03:10:06 -04:00
|
|
|
void update_min_max();
|
2010-12-25 21:17:04 -04:00
|
|
|
void zero_min_max();
|
2011-02-14 00:43:44 -04:00
|
|
|
|
2010-11-23 15:28:19 -04:00
|
|
|
// startup
|
2010-11-28 03:03:23 -04:00
|
|
|
void load_eeprom(void);
|
2011-02-14 00:43:44 -04:00
|
|
|
void save_eeprom(void);
|
|
|
|
void save_trim(void);
|
2010-11-28 03:03:23 -04:00
|
|
|
void set_filter(bool filter);
|
2011-05-05 14:46:11 -03:00
|
|
|
void set_type(uint8_t t);
|
2010-11-23 15:28:19 -04:00
|
|
|
|
|
|
|
// setup the control preferences
|
2010-11-23 17:20:29 -04:00
|
|
|
void set_range(int low, int high);
|
2010-11-23 15:28:19 -04:00
|
|
|
void set_angle(int angle);
|
2010-12-20 23:53:26 -04:00
|
|
|
void set_reverse(bool reverse);
|
2011-01-27 14:16:22 -04:00
|
|
|
bool get_reverse(void);
|
2010-11-23 15:28:19 -04:00
|
|
|
|
|
|
|
// read input from APM_RC - create a control_in value
|
|
|
|
void set_pwm(int pwm);
|
2011-02-14 00:43:44 -04:00
|
|
|
|
2010-11-25 03:10:06 -04:00
|
|
|
// pwm is stored here
|
|
|
|
int16_t radio_in;
|
|
|
|
|
|
|
|
// call after first set_pwm
|
|
|
|
void trim();
|
2011-02-14 00:43:44 -04:00
|
|
|
|
2010-11-23 15:28:19 -04:00
|
|
|
// did our read come in 50µs below the min?
|
2010-11-28 03:03:23 -04:00
|
|
|
bool get_failsafe(void);
|
2011-02-14 00:43:44 -04:00
|
|
|
|
2010-11-23 15:28:19 -04:00
|
|
|
// value generated from PWM
|
|
|
|
int16_t control_in;
|
2010-11-28 21:44:40 -04:00
|
|
|
int16_t dead_zone; // used to keep noise down and create a dead zone.
|
2011-02-14 00:43:44 -04:00
|
|
|
|
2010-11-26 23:04:30 -04:00
|
|
|
int control_mix(float value);
|
2011-02-14 00:43:44 -04:00
|
|
|
|
2010-11-23 15:28:19 -04:00
|
|
|
// current values to the servos - degrees * 100 (approx assuming servo is -45 to 45 degrees except [3] is 0 to 100
|
|
|
|
int16_t servo_out;
|
|
|
|
|
|
|
|
// generate PWM from servo_out value
|
|
|
|
void calc_pwm(void);
|
|
|
|
|
|
|
|
// PWM is without the offset from radio_min
|
|
|
|
int16_t pwm_out;
|
|
|
|
int16_t radio_out;
|
2010-11-25 03:10:06 -04:00
|
|
|
|
2011-02-14 00:43:44 -04:00
|
|
|
AP_Int16 radio_min;
|
|
|
|
AP_Int16 radio_trim;
|
|
|
|
AP_Int16 radio_max;
|
|
|
|
|
2010-11-23 15:28:19 -04:00
|
|
|
// includes offset from PWM
|
|
|
|
//int16_t get_radio_out(void);
|
2010-12-13 00:08:22 -04:00
|
|
|
|
2010-11-23 15:28:19 -04:00
|
|
|
int16_t pwm_to_angle();
|
2010-12-20 23:53:26 -04:00
|
|
|
float norm_input();
|
|
|
|
float norm_output();
|
2010-11-23 15:28:19 -04:00
|
|
|
int16_t angle_to_pwm();
|
|
|
|
int16_t pwm_to_range();
|
|
|
|
int16_t range_to_pwm();
|
2010-12-25 21:17:04 -04:00
|
|
|
|
|
|
|
float scale_output;
|
2011-02-14 00:43:44 -04:00
|
|
|
|
2010-12-13 00:08:22 -04:00
|
|
|
private:
|
|
|
|
bool _filter;
|
2011-06-10 00:33:31 -03:00
|
|
|
AP_Int8 _reverse;
|
2010-11-23 15:28:19 -04:00
|
|
|
|
2011-05-06 14:51:26 -03:00
|
|
|
uint8_t _type;
|
2010-11-23 15:28:19 -04:00
|
|
|
int16_t _high;
|
|
|
|
int16_t _low;
|
|
|
|
};
|
|
|
|
|
2011-09-11 19:02:47 -03:00
|
|
|
// This is ugly, but it fixes compilation on arduino
|
2011-09-11 18:25:06 -03:00
|
|
|
#include "RC_Channel_aux.h"
|
|
|
|
|
2011-02-14 00:43:44 -04:00
|
|
|
#endif
|