ardupilot/libraries/AP_AnalogSource/examples/AnalogSource_Arduino/AnalogSource_Arduino.pde

43 lines
1023 B
Plaintext

// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: t -*-
/*
* Example of AnalogSource Arduino
*/
#include <FastSerial.h>
#include <AP_Math.h>
#include <AP_Common.h>
#include <AP_Param.h>
#include <Arduino_Mega_ISR_Registry.h>
#include <AP_PeriodicProcess.h>
#include <AP_AnalogSource.h>
Arduino_Mega_ISR_Registry isr_registry;
AP_TimerProcess scheduler;
FastSerialPort0(Serial);
AP_AnalogSource_Arduino vcc_source(ANALOG_PIN_VCC);
AP_AnalogSource_Arduino pin0(0);
AP_AnalogSource_Arduino pin1(1);
void setup()
{
Serial.begin(115200);
isr_registry.init();
scheduler.init(&isr_registry);
AP_AnalogSource_Arduino::init_timer(&scheduler);
}
void loop()
{
while (true) {
delay(1000);
Serial.printf("Vcc: %u PIN0: %u PIN1: %u PIN1_avg: %u\n",
(unsigned)vcc_source.read_vcc(),
(unsigned)pin0.read_raw(),
(unsigned)pin1.read_raw(),
(unsigned)pin1.read_average());
}
}