Subversion Repositories FlightCtrl

Rev

Rev 1868 | Rev 1963 | Go to most recent revision | Details | Compare with Previous | Last modification | View Log | RSS feed

Rev Author Line No. Line
1612 dongfang 1
#include <inttypes.h>
2
/*
3
 * An attempt to define a generic control. That could be an R/C receiver, an external control
4
 * (serial over Bluetooth, Wi232, XBee, whatever) or the NaviCtrl.
5
 * This resembles somewhat an object-oriented class definition (except that there are no virtuals).
6
 * The idea is that the combination of different control inputs, of the way they superimpose upon
1775 - 7
 * each other, the priorities between them and the behavior in case that one fails is simplified,
1612 dongfang 8
 * and all in one place.
9
 */
1821 - 10
 
1612 dongfang 11
/*
12
 * Signal qualities, used to determine the availability of a control.
13
 * NO_SIGNAL means there was never a signal. SIGNAL_LOST that there was a signal, but it was lost.
14
 * SIGNAL_BAD is too bad for flight. This is the hysteresis range for deciding whether to engage
15
 * or disengage emergency landing.
16
 * SIGNAL_OK means the signal is usable for flight.
17
 * SIGNAL_GOOD means the signal can also be used for setting parameters.
18
 */
19
#define NO_SIGNAL   0
20
#define SIGNAL_LOST 1
21
#define SIGNAL_BAD  2
22
#define SIGNAL_OK   3
23
#define SIGNAL_GOOD 4
24
 
25
/*
26
 * The PRTY arrays
27
 */
1775 - 28
#define CONTROL_PITCH    0
29
#define CONTROL_ROLL     1
1612 dongfang 30
#define CONTROL_THROTTLE 2
1775 - 31
#define CONTROL_YAW      3
1612 dongfang 32
 
33
/*
34
 * Looping flags.
35
 * LOOPING_UP || LOOPING_DOWN <=> LOOPING_PITCH_AXIS
36
 * LOOPING_LEFT || LOOPING_RIGHT <=> LOOPING_ROLL_AXIS
37
 */
38
#define LOOPING_UP         (1<<0)
39
#define LOOPING_DOWN       (1<<1)
40
#define LOOPING_LEFT       (1<<2)
41
#define LOOPING_RIGHT      (1<<3)
42
#define LOOPING_PITCH_AXIS (1<<4)
43
#define LOOPING_ROLL_AXIS  (1<<5)
44
 
45
/*
46
 * This is only relevant for "abstract controls" ie. all control sources have the
47
 * same interface. This struct of code pointers is used like an abstract class
48
 * definition from object-oriented languages, and all control input implementations
49
 * will declare an instance of the stuct (=implementation of the abstract class).
1821 - 50
 */
1612 dongfang 51
typedef struct {
1821 - 52
        /* Get the pitch input in the nominal range [-STICK_RANGE, STICK_RANGE]. */
53
        int16_t(*getPitch)(void);
1612 dongfang 54
 
55
        /* Get the roll input in the nominal range [-STICK_RANGE, STICK_RANGE]. */
1821 - 56
        int16_t(*getRoll)(void);
1612 dongfang 57
 
1821 - 58
        /* Get the yaw input in the nominal range [-STICK_RANGE, STICK_RANGE]. */
59
        int16_t(*getYaw)(void);
1612 dongfang 60
 
1821 - 61
        /* Get the throttle input in the nominal range [0, THROTTLE_RANGE]. */
62
        uint16_t(*getThrottle)(void);
63
 
64
        /* Signal quality, by the above SIGNAL_... definitions. */
65
        uint8_t (*getSignalQuality)(void);
66
 
67
        /* Calibrate sticks to their center positions (only relevant for R/C, really) */
68
        void (*calibrate)(void);
1612 dongfang 69
} t_control;
70
 
71
/*
72
 * Our output.
73
 */
1908 - 74
extern int16_t controls[4];
75
//extern int16_t controlYaw, controlThrottle;
76
extern uint16_t controlActivity;
77
//extern uint16_t maxControl[2];
1612 dongfang 78
extern uint8_t looping;
79
 
1775 - 80
extern volatile uint8_t MKFlags;
81
extern uint16_t isFlying;
82
 
1612 dongfang 83
void controlMixer_initVariables(void);
84
void controlMixer_updateVariables(void);
85
 
1775 - 86
void controlMixer_setNeutral(void);
1612 dongfang 87
 
88
/*
89
 * Update the exported variables. Called at every flight control cycle.
90
 */
91
void controlMixer_update(void);
92
 
93
/*
94
 * Get the current command. See the COMMAND_.... define's
95
 */
96
uint8_t controlMixer_getCommand(void);
97
 
98
void controlMixer_performCalibrationCommands(uint8_t command);
99
 
100
uint8_t controlMixer_getSignalQuality(void);
101
 
1645 - 102
/*
1868 - 103
 * The controls operate in [-1024, 1024] just about.
104
 * Throttle is [0..255] just about.
1645 - 105
 */
1868 - 106
// Scale controls to 1 byte:
1775 - 107
#define CONTROL_SCALING (1024/256)
1868 - 108
 
109
// Scale throttle levels to byte:
1843 - 110
#define MOTOR_SCALING (1024/256)
1612 dongfang 111
 
112
/*
113
 * Gets the argument for the current command (a number).
114
 *
115
 * Stick position to argument values (for stick control):
116
 * 2--3--4
117
 * |     |  +
118
 * 1  9  5  ^ 0
119
 * |     |  |  
120
 * 8--7--6
121
 *    
122
 * + <--
123
 *    0
124
 *
125
 * Not in any of these positions: 0
126
 */
1775 - 127
// void controlMixer_handleCommands(void);
1612 dongfang 128
uint8_t controlMixer_getArgument(void);
129
uint8_t controlMixer_isCommandRepeated(void);
130
// TODO: Abstract away if possible.
1775 - 131
uint8_t controlMixer_testCompassCalState(void);