Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-11 10:28:29 -04:00
Code Issues Packages Projects Releases Wiki Activity

updated ADC test for new API

Browse Source
This commit is contained in:
Andrew Tridgell 2011-09-15 18:46:47 +10:00
parent 1c5e8f0381
commit 812cd3562f
1 changed files with 34 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

53
libraries/AP_ADC/examples/AP_ADC_test/AP_ADC_test.pde
View File

@ -1,37 +1,52 @@
/*
Example of APM_ADC library.
Code by Jordi Muñoz and Jose Julio. DIYDrones.com
*/
#include <FastSerial.h>
#include <AP_ADC.h> // ArduPilot Mega ADC Library
unsigned long timer;
FastSerialPort0(Serial); // FTDI/console
unsigned long timer;
AP_ADC_ADS7844 adc;
void setup()
{
adc.Init(); // APM ADC initialization
Serial.begin(57600);
Serial.println("ArduPilot Mega ADC library test");
delay(1000);
timer = millis();
Serial.begin(115200, 128, 128);
Serial.println("ArduPilot Mega ADC library test");
delay(1000);
adc.Init(); // APM ADC initialization
delay(1000);
timer = millis();
}
static const uint8_t channel_map[6] = { 1, 2, 0, 4, 5, 6};
static uint16_t sin_count;
float v;
uint32_t last_usec = 0;
void loop()
{
int ch;
if((millis()- timer) > 20)
{
timer = millis();
for (ch=0;ch<7;ch++)
{
Serial.print(adc.Ch(ch));
Serial.print(",");
}
Serial.println();
}
v = sin(millis());
sin_count++;
if ((millis() - timer) > 200) {
uint16_t result[6];
uint32_t deltat;
uint16_t ch3;
timer = millis();
ch3 = adc.Ch(3);
deltat = adc.Ch6(channel_map, result);
Serial.printf("gx=%u gy=%u gz=%u ax=%u ay=%u az=%u gt=%u deltat=%lu sin_count=%u\n",
result[0], result[1], result[2],
result[3], result[4], result[5],
ch3, deltat, sin_count);
sin_count = 0;
}
}
// end of test program