Browse Source

Ardupilot Hardware RC Library for the 328

git-svn-id: https://arducopter.googlecode.com/svn/trunk@278 f9c3cf11-9bcb-44bc-f272-b75c42450872
master
jasonshort 15 years ago
parent
commit
6eb2dc1301
  1. 48
      libraries/APM_RC/examples/APM_radio/AP_radio.pde

48
libraries/APM_RC/examples/APM_radio/AP_radio.pde

@ -0,0 +1,48 @@ @@ -0,0 +1,48 @@
/*
Example of AP_RC library.
Code by Jordi MuÒoz and Jose Julio. DIYDrones.com
Print Input values and send Output to the servos
(Works with last PPM_encoder firmware)
*/
#include <AP_RC.h> // ArduPilot Mega RC Library
AP_RC rc;
#define CH_ROLL 0
#define CH_PITCH 1
#define CH_THROTTLE 2
#define CH_RUDDER 3
void setup()
{
Serial.begin(38400);
Serial.println("ArduPilot RC library test");
int trims[] = {1500,1500,1200,1500};
rc.init(trims);
delay(1000);
}
void loop()
{
delay(20);
rc.read_pwm();
for(int y=0; y<4; y++) {
rc.set_ch_pwm(y, rc.input[y]); // send to Servos
}
print_pwm();
}
void print_pwm()
{
Serial.print("ch1 ");
Serial.print(rc.input[CH_ROLL],DEC);
Serial.print("\tch2: ");
Serial.print(rc.input[CH_PITCH],DEC);
Serial.print("\tch3 :");
Serial.print(rc.input[CH_THROTTLE],DEC);
Serial.print("\tch4 :");
Serial.println(rc.input[CH_RUDDER],DEC);
}
Loading…
Cancel
Save