RC_Channel: fixed example build

This commit is contained in:
Andrew Tridgell 2012-11-24 21:09:00 +11:00
parent 5c48988ed9
commit ff916d3982
2 changed files with 25 additions and 7 deletions

View File

@ -66,6 +66,7 @@ void setup()
{ {
Serial.begin(115200); Serial.begin(115200);
Serial.println("ArduPilot RC Channel test"); Serial.println("ArduPilot RC Channel test");
isr_registry.init();
APM_RC.Init( &isr_registry ); // APM Radio initialization APM_RC.Init( &isr_registry ); // APM Radio initialization
@ -88,7 +89,6 @@ void setup()
rc_4.set_angle(6000); rc_4.set_angle(6000);
rc_4.set_dead_zone(500); rc_4.set_dead_zone(500);
rc_5.set_range(0,1000); rc_5.set_range(0,1000);
rc_5.set_filter(false);
rc_6.set_range(200,800); rc_6.set_range(200,800);
rc_7.set_range(0,1000); rc_7.set_range(0,1000);
rc_8.set_range(0,1000); rc_8.set_range(0,1000);

View File

@ -5,9 +5,16 @@
* *
*/ */
#include <FastSerial.h>
#include <AP_Common.h>
#include <Arduino_Mega_ISR_Registry.h>
#include <AP_Math.h> // ArduPilot Mega Vector/Matrix math Library
#include <APM_RC.h> // ArduPilot Mega RC Library #include <APM_RC.h> // ArduPilot Mega RC Library
#include <RC_Channel.h> // ArduPilot Mega RC Library #include <RC_Channel.h> // ArduPilot Mega RC Library
// set your hardware type here
#define CONFIG_APM_HARDWARE APM_HARDWARE_APM2
#define EE_RADIO_1 0x00 // all gains stored from here #define EE_RADIO_1 0x00 // all gains stored from here
#define EE_RADIO_2 0x06 // all gains stored from here #define EE_RADIO_2 0x06 // all gains stored from here
@ -19,6 +26,17 @@
#define EE_RADIO_8 0x2A // all gains stored from here #define EE_RADIO_8 0x2A // all gains stored from here
////////////////////////////////////////////
// RC Hardware
////////////////////////////////////////////
#if CONFIG_APM_HARDWARE == APM_HARDWARE_APM2
APM_RC_APM2 APM_RC;
#else
APM_RC_APM1 APM_RC;
#endif
Arduino_Mega_ISR_Registry isr_registry;
RC_Channel rc_1(EE_RADIO_1); RC_Channel rc_1(EE_RADIO_1);
RC_Channel rc_2(EE_RADIO_2); RC_Channel rc_2(EE_RADIO_2);
RC_Channel rc_3(EE_RADIO_3); RC_Channel rc_3(EE_RADIO_3);
@ -41,7 +59,8 @@ void setup()
{ {
Serial.begin(38400); Serial.begin(38400);
Serial.println("ArduPilot RC Channel test"); Serial.println("ArduPilot RC Channel test");
APM_RC.Init(); // APM Radio initialization isr_registry.init();
APM_RC.Init( &isr_registry ); // APM Radio initialization
delay(500); delay(500);
@ -82,15 +101,14 @@ void setup()
// set type of output, symmetrical angles or a number range; // set type of output, symmetrical angles or a number range;
rc_1.set_angle(4500); rc_1.set_angle(4500);
rc_1.dead_zone = 80; rc_1.set_dead_zone(80);
rc_2.set_angle(4500); rc_2.set_angle(4500);
rc_2.dead_zone = 80; rc_2.set_dead_zone(80);
rc_3.set_range(0,1000); rc_3.set_range(0,1000);
rc_3.dead_zone = 20; rc_3.set_dead_zone(20);
rc_4.set_angle(6000); rc_4.set_angle(6000);
rc_4.dead_zone = 500; rc_4.set_dead_zone(500);
rc_5.set_range(0,1000); rc_5.set_range(0,1000);
rc_5.set_filter(false);
rc_6.set_range(200,800); rc_6.set_range(200,800);
rc_7.set_range(0,1000); rc_7.set_range(0,1000);
rc_8.set_range(0,1000); rc_8.set_range(0,1000);