mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-11 10:28:29 -04:00
uncrustify libraries/APM_RC/examples/APM2_radio/APM2_radio.pde
This commit is contained in:
parent
496553898e
commit
695c0e5239
@ -1,10 +1,10 @@
|
|||||||
/*
|
/*
|
||||||
Example of APM_RC library.
|
* Example of APM_RC library.
|
||||||
Code by Jordi MuÒoz and Jose Julio. DIYDrones.com
|
* Code by Jordi MuÒoz and Jose Julio. DIYDrones.com
|
||||||
|
*
|
||||||
Print Input values and send Output to the servos
|
* Print Input values and send Output to the servos
|
||||||
(Works with last PPM_encoder firmware)
|
* (Works with last PPM_encoder firmware)
|
||||||
*/
|
*/
|
||||||
|
|
||||||
#include <Arduino_Mega_ISR_Registry.h>
|
#include <Arduino_Mega_ISR_Registry.h>
|
||||||
#include <APM_RC.h> // ArduPilot Mega RC Library
|
#include <APM_RC.h> // ArduPilot Mega RC Library
|
||||||
@ -15,32 +15,32 @@ APM_RC_APM2 APM_RC;
|
|||||||
void setup()
|
void setup()
|
||||||
{
|
{
|
||||||
isr_registry.init();
|
isr_registry.init();
|
||||||
APM_RC.Init(&isr_registry); // APM Radio initialization
|
APM_RC.Init(&isr_registry); // APM Radio initialization
|
||||||
|
|
||||||
APM_RC.enable_out(CH_1);
|
APM_RC.enable_out(CH_1);
|
||||||
APM_RC.enable_out(CH_2);
|
APM_RC.enable_out(CH_2);
|
||||||
APM_RC.enable_out(CH_3);
|
APM_RC.enable_out(CH_3);
|
||||||
APM_RC.enable_out(CH_4);
|
APM_RC.enable_out(CH_4);
|
||||||
APM_RC.enable_out(CH_5);
|
APM_RC.enable_out(CH_5);
|
||||||
APM_RC.enable_out(CH_6);
|
APM_RC.enable_out(CH_6);
|
||||||
APM_RC.enable_out(CH_7);
|
APM_RC.enable_out(CH_7);
|
||||||
APM_RC.enable_out(CH_8);
|
APM_RC.enable_out(CH_8);
|
||||||
|
|
||||||
Serial.begin(115200);
|
Serial.begin(115200);
|
||||||
Serial.println("ArduPilot Mega RC library test");
|
Serial.println("ArduPilot Mega RC library test");
|
||||||
delay(1000);
|
delay(1000);
|
||||||
}
|
}
|
||||||
|
|
||||||
void loop()
|
void loop()
|
||||||
{
|
{
|
||||||
// New radio frame? (we could use also if((millis()- timer) > 20)
|
// New radio frame? (we could use also if((millis()- timer) > 20)
|
||||||
if (APM_RC.GetState() == 1){
|
if (APM_RC.GetState() == 1) {
|
||||||
Serial.print("CH:");
|
Serial.print("CH:");
|
||||||
for(int i = 0; i < 8; i++){
|
for(int i = 0; i < 8; i++) {
|
||||||
Serial.print(APM_RC.InputCh(i)); // Print channel values
|
Serial.print(APM_RC.InputCh(i)); // Print channel values
|
||||||
Serial.print(",");
|
Serial.print(",");
|
||||||
APM_RC.OutputCh(i, APM_RC.InputCh(i)); // Copy input to Servos
|
APM_RC.OutputCh(i, APM_RC.InputCh(i)); // Copy input to Servos
|
||||||
}
|
}
|
||||||
Serial.println();
|
Serial.println();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user