mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-09 17:38:32 -04:00
Edited CH7 options to include Do Nothing and RTL.
This commit is contained in:
parent
b2b28cc90c
commit
020062498b
@ -48,11 +48,13 @@
|
|||||||
CH6_TRAVERSE_SPEED
|
CH6_TRAVERSE_SPEED
|
||||||
*/
|
*/
|
||||||
|
|
||||||
# define CH7_OPTION DO_SET_HOVER
|
# define CH7_OPTION CH7_DO_NOTHING
|
||||||
/*
|
/*
|
||||||
DO_SET_HOVER
|
CH7_DO_NOTHING
|
||||||
DO_FLIP
|
CH7_SET_HOVER
|
||||||
SIMPLE_MODE_CONTROL
|
CH7_FLIP
|
||||||
|
CH7_SIMPLE_MODE
|
||||||
|
CH7_RTL
|
||||||
*/
|
*/
|
||||||
|
|
||||||
// See the config.h and defines.h files for how to set this up!
|
// See the config.h and defines.h files for how to set this up!
|
||||||
|
@ -525,7 +525,6 @@ void loop()
|
|||||||
//PORTK |= B00010000;
|
//PORTK |= B00010000;
|
||||||
G_Dt = (float)(timer - fast_loopTimer) / 1000000.f; // used by PI Loops
|
G_Dt = (float)(timer - fast_loopTimer) / 1000000.f; // used by PI Loops
|
||||||
fast_loopTimer = timer;
|
fast_loopTimer = timer;
|
||||||
//Serial.printf("%1.5f\n", G_Dt);
|
|
||||||
|
|
||||||
// Execute the fast loop
|
// Execute the fast loop
|
||||||
// ---------------------
|
// ---------------------
|
||||||
|
@ -51,17 +51,22 @@ static boolean trim_flag;
|
|||||||
// set this to your trainer switch
|
// set this to your trainer switch
|
||||||
static void read_trim_switch()
|
static void read_trim_switch()
|
||||||
{
|
{
|
||||||
#if CH7_OPTION == DO_FLIP
|
#if CH7_OPTION == CH7_FLIP
|
||||||
if (g.rc_7.control_in > 800 && g.rc_3.control_in != 0){
|
if (g.rc_7.control_in > 800 && g.rc_3.control_in != 0){
|
||||||
do_flip = true;
|
do_flip = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
#elif CH7_OPTION == SIMPLE_MODE_CONTROL
|
#elif CH7_OPTION == CH7_SIMPLE_MODE
|
||||||
|
|
||||||
do_simple = (g.rc_7.control_in > 800);
|
do_simple = (g.rc_7.control_in > 800);
|
||||||
//Serial.println(g.rc_7.control_in, DEC);
|
//Serial.println(g.rc_7.control_in, DEC);
|
||||||
|
|
||||||
#elif CH7_OPTION == DO_SET_HOVER
|
#elif CH7_OPTION == CH7_RTL
|
||||||
|
set_mode(RTL);
|
||||||
|
//do_simple = (g.rc_7.control_in > 800);
|
||||||
|
//Serial.println(g.rc_7.control_in, DEC);
|
||||||
|
|
||||||
|
#elif CH7_OPTION == CH7_SET_HOVER
|
||||||
// switch is engaged
|
// switch is engaged
|
||||||
if (g.rc_7.control_in > 800){
|
if (g.rc_7.control_in > 800){
|
||||||
trim_flag = true;
|
trim_flag = true;
|
||||||
@ -76,7 +81,6 @@ static void read_trim_switch()
|
|||||||
//Serial.printf("tnom %d\n", g.throttle_cruise.get());
|
//Serial.printf("tnom %d\n", g.throttle_cruise.get());
|
||||||
}
|
}
|
||||||
trim_flag = false;
|
trim_flag = false;
|
||||||
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
|
@ -27,9 +27,11 @@
|
|||||||
#define BARO 1
|
#define BARO 1
|
||||||
|
|
||||||
// CH 7 control
|
// CH 7 control
|
||||||
#define DO_SET_HOVER 0
|
#define CH7_DO_NOTHING 0
|
||||||
#define DO_FLIP 1
|
#define CH7_SET_HOVER 1
|
||||||
#define SIMPLE_MODE_CONTROL 2
|
#define CH7_FLIP 2
|
||||||
|
#define CH7_SIMPLE_MODE 3
|
||||||
|
#define CH7_RTL 4
|
||||||
|
|
||||||
// Frame types
|
// Frame types
|
||||||
#define QUAD_FRAME 0
|
#define QUAD_FRAME 0
|
||||||
|
Loading…
Reference in New Issue
Block a user