mirror of
https://gitee.com/mirrors_PX4/PX4-Autopilot.git
synced 2026-10-26 07:43:33 +08:00
Selected adjustments / fixes to make old apps compatible with new-style ADC driver
This commit is contained in:
Lorenz Meier
+19
-75
@@ -53,96 +53,40 @@
|
||||
#include "tests.h"
|
||||
|
||||
#include <nuttx/analog/adc.h>
|
||||
#include <drivers/drv_adc.h>
|
||||
#include <systemlib/err.h>
|
||||
|
||||
int test_adc(int argc, char *argv[])
|
||||
{
|
||||
int fd0 = 0;
|
||||
int ret = 0;
|
||||
int fd = open(ADC_DEVICE_PATH, O_RDONLY);
|
||||
|
||||
#pragma pack(push,1)
|
||||
struct adc_msg4_s {
|
||||
uint8_t am_channel1; /**< The 8-bit ADC Channel 1 */
|
||||
int32_t am_data1; /**< ADC convert result 1 (4 bytes) */
|
||||
uint8_t am_channel2; /**< The 8-bit ADC Channel 2 */
|
||||
int32_t am_data2; /**< ADC convert result 2 (4 bytes) */
|
||||
uint8_t am_channel3; /**< The 8-bit ADC Channel 3 */
|
||||
int32_t am_data3; /**< ADC convert result 3 (4 bytes) */
|
||||
uint8_t am_channel4; /**< The 8-bit ADC Channel 4 */
|
||||
int32_t am_data4; /**< ADC convert result 4 (4 bytes) */
|
||||
};
|
||||
#pragma pack(pop)
|
||||
if (fd < 0)
|
||||
err(1, "can't open ADC device");
|
||||
|
||||
struct adc_msg4_s sample1;
|
||||
for (unsigned i = 0; i < 5; i++) {
|
||||
/* make space for a maximum of eight channels */
|
||||
struct adc_msg_s data[8];
|
||||
/* read all channels available */
|
||||
ssize_t count = read(fd, data, sizeof(data));
|
||||
|
||||
ssize_t nbytes;
|
||||
int j;
|
||||
int errval;
|
||||
if (count < 0)
|
||||
goto errout_with_dev;
|
||||
|
||||
fd0 = open("/dev/adc0", O_RDONLY | O_NONBLOCK);
|
||||
unsigned channels = count / sizeof(data[0]);
|
||||
|
||||
if (fd0 <= 0) {
|
||||
message("/dev/adc0 open fail: %d\n", errno);
|
||||
return ERROR;
|
||||
|
||||
} else {
|
||||
message("opened /dev/adc0 successfully\n");
|
||||
}
|
||||
usleep(10000);
|
||||
|
||||
for (j = 0; j < 10; j++) {
|
||||
|
||||
/* sleep 20 milliseconds */
|
||||
usleep(20000);
|
||||
nbytes = read(fd0, &sample1, sizeof(sample1));
|
||||
|
||||
/* Handle unexpected return values */
|
||||
|
||||
if (nbytes < 0) {
|
||||
errval = errno;
|
||||
|
||||
if (errval != EINTR) {
|
||||
message("reading /dev/adc0 failed: %d\n", errval);
|
||||
errval = 3;
|
||||
goto errout_with_dev;
|
||||
}
|
||||
|
||||
message("\tinterrupted read..\n");
|
||||
|
||||
} else if (nbytes == 0) {
|
||||
message("\tno data read, ignoring.\n");
|
||||
ret = ERROR;
|
||||
for (unsigned j = 0; j < channels; j++) {
|
||||
printf("%d: %u ", data[j].am_channel, data[j].am_data);
|
||||
}
|
||||
|
||||
/* Print the sample data on successful return */
|
||||
|
||||
else {
|
||||
if (nbytes != sizeof(sample1)) {
|
||||
message("\tsample 1 size %d is not matching struct size %d, ignoring\n",
|
||||
nbytes, sizeof(sample1));
|
||||
ret = ERROR;
|
||||
|
||||
} else {
|
||||
|
||||
message("CYCLE %d:\n", j);
|
||||
|
||||
message("channel: %d value: %d\n",
|
||||
(int)sample1.am_channel1, sample1.am_data1);
|
||||
message("channel: %d value: %d\n",
|
||||
(int)sample1.am_channel2, sample1.am_data2);
|
||||
message("channel: %d value: %d\n",
|
||||
(int)sample1.am_channel3, sample1.am_data3);
|
||||
message("channel: %d value: %d\n",
|
||||
(int)sample1.am_channel4, sample1.am_data4);
|
||||
}
|
||||
}
|
||||
fflush(stdout);
|
||||
printf("\n");
|
||||
usleep(150000);
|
||||
}
|
||||
|
||||
message("\t ADC test successful.\n");
|
||||
|
||||
errout_with_dev:
|
||||
|
||||
if (fd0 != 0) close(fd0);
|
||||
if (fd != 0) close(fd);
|
||||
|
||||
return ret;
|
||||
return OK;
|
||||
}
|
||||
|
||||
@@ -52,7 +52,8 @@
|
||||
#include "tests.h"
|
||||
|
||||
#include <nuttx/analog/adc.h>
|
||||
|
||||
#include <drivers/drv_adc.h>
|
||||
#include <systemlib/err.h>
|
||||
|
||||
/****************************************************************************
|
||||
* Pre-processor Definitions
|
||||
@@ -89,129 +90,79 @@
|
||||
|
||||
int test_jig_voltages(int argc, char *argv[])
|
||||
{
|
||||
int fd0 = 0;
|
||||
int ret = OK;
|
||||
const int nchannels = 4;
|
||||
int fd = open(ADC_DEVICE_PATH, O_RDONLY);
|
||||
int ret = OK;
|
||||
|
||||
struct adc_msg4_s
|
||||
{
|
||||
uint8_t am_channel1; /* The 8-bit ADC Channel */
|
||||
int32_t am_data1; /* ADC convert result (4 bytes) */
|
||||
uint8_t am_channel2; /* The 8-bit ADC Channel */
|
||||
int32_t am_data2; /* ADC convert result (4 bytes) */
|
||||
uint8_t am_channel3; /* The 8-bit ADC Channel */
|
||||
int32_t am_data3; /* ADC convert result (4 bytes) */
|
||||
uint8_t am_channel4; /* The 8-bit ADC Channel */
|
||||
int32_t am_data4; /* ADC convert result (4 bytes) */
|
||||
}__attribute__((__packed__));;
|
||||
|
||||
struct adc_msg4_s sample1[4];
|
||||
|
||||
size_t readsize;
|
||||
ssize_t nbytes;
|
||||
int i = 0;
|
||||
int j = 0;
|
||||
int errval;
|
||||
|
||||
char name[11];
|
||||
sprintf(name, "/dev/adc%d", j);
|
||||
fd0 = open(name, O_RDONLY | O_NONBLOCK);
|
||||
if (fd0 < 0)
|
||||
{
|
||||
printf("ADC: %s open fail\n", name);
|
||||
return ERROR;
|
||||
} else {
|
||||
printf("Opened %s successfully\n", name);
|
||||
if (fd < 0) {
|
||||
warnx("can't open ADC device");
|
||||
return 1;
|
||||
}
|
||||
|
||||
/* make space for a maximum of eight channels */
|
||||
struct adc_msg_s data[8];
|
||||
/* read all channels available */
|
||||
ssize_t count = read(fd, data, sizeof(data));
|
||||
|
||||
if (count < 0) {
|
||||
close(fd);
|
||||
warnx("can't read from ADC driver. Forgot 'adc start' command?");
|
||||
return 1;
|
||||
}
|
||||
|
||||
unsigned channels = count / sizeof(data[0]);
|
||||
|
||||
for (unsigned j = 0; j < channels; j++) {
|
||||
printf("%d: %u ", data[j].am_channel, data[j].am_data);
|
||||
}
|
||||
|
||||
printf("\n");
|
||||
|
||||
warnx("\t ADC operational.\n");
|
||||
|
||||
/* Expected values */
|
||||
int16_t expected_min[] = {2700, 2700, 2200, 2000};
|
||||
int16_t expected_max[] = {3000, 3000, 2500, 2200};
|
||||
char* check_res[nchannels];
|
||||
char *check_res[channels];
|
||||
|
||||
/* first adc read round */
|
||||
readsize = 4 * sizeof(struct adc_msg_s);
|
||||
if (channels < 4) {
|
||||
close(fd);
|
||||
warnx("not all four test channels available, aborting.");
|
||||
return 1;
|
||||
|
||||
/* Empty all buffers */
|
||||
do {
|
||||
nbytes = read(fd0, sample1, readsize);
|
||||
} else {
|
||||
/* Check values */
|
||||
check_res[0] = (expected_min[0] < data[0].am_data && expected_max[0] > data[0].am_data) ? "OK" : "FAIL";
|
||||
check_res[1] = (expected_min[1] < data[1].am_data && expected_max[1] > data[1].am_data) ? "OK" : "FAIL";
|
||||
check_res[2] = (expected_min[2] < data[2].am_data && expected_max[2] > data[2].am_data) ? "OK" : "FAIL";
|
||||
check_res[3] = (expected_min[3] < data[3].am_data && expected_max[3] > data[3].am_data) ? "OK" : "FAIL";
|
||||
|
||||
/* Accumulate result */
|
||||
ret += (expected_min[0] > data[0].am_data || expected_max[0] < data[0].am_data) ? 1 : 0;
|
||||
ret += (expected_min[1] > data[1].am_data || expected_max[1] < data[1].am_data) ? 1 : 0;
|
||||
ret += (expected_min[2] > data[2].am_data || expected_max[2] < data[2].am_data) ? 1 : 0;
|
||||
ret += (expected_min[3] > data[3].am_data || expected_max[3] < data[3].am_data) ? 1 : 0;
|
||||
|
||||
message("Sample:");
|
||||
message("channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
data[0].am_channel, (int)(data[0].am_data), expected_min[0], expected_max[0], check_res[0]);
|
||||
message("channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
data[1].am_channel, (int)(data[1].am_data), expected_min[1], expected_max[1], check_res[1]);
|
||||
message("channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
data[2].am_channel, (int)(data[2].am_data), expected_min[2], expected_max[2], check_res[2]);
|
||||
message("channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
data[3].am_channel, (int)(data[3].am_data), expected_min[3], expected_max[3], check_res[3]);
|
||||
|
||||
if (ret != OK) {
|
||||
printf("\t JIG voltages test FAILED. Some channels where out of allowed range. Check supply voltages.\n");
|
||||
goto errout_with_dev;
|
||||
}
|
||||
}
|
||||
while (nbytes > 0);
|
||||
|
||||
up_udelay(20000);//microseconds
|
||||
/* Take measurements */
|
||||
nbytes = read(fd0, sample1, readsize);
|
||||
printf("\t JIG voltages test successful.\n");
|
||||
|
||||
/* Handle unexpected return values */
|
||||
errout_with_dev:
|
||||
|
||||
if (nbytes <= 0)
|
||||
{
|
||||
errval = errno;
|
||||
if (errval != EINTR)
|
||||
{
|
||||
message("read %s failed: %d\n",
|
||||
name, errval);
|
||||
errval = 3;
|
||||
goto errout_with_dev;
|
||||
}
|
||||
|
||||
message("\tInterrupted read...\n");
|
||||
}
|
||||
else if (nbytes == 0)
|
||||
{
|
||||
message("\tNo data read, Ignoring\n");
|
||||
}
|
||||
|
||||
/* Print the sample data on successful return */
|
||||
|
||||
else
|
||||
{
|
||||
int nsamples = nbytes / sizeof(struct adc_msg_s);
|
||||
if (nsamples * sizeof(struct adc_msg_s) != nbytes)
|
||||
{
|
||||
message("\tread size=%d is not a multiple of sample size=%d, Ignoring\n",
|
||||
nbytes, sizeof(struct adc_msg_s));
|
||||
}
|
||||
else
|
||||
{
|
||||
/* Check values */
|
||||
check_res[0] = (expected_min[0] < sample1[i].am_data1 && expected_max[0] > sample1[i].am_data1) ? "OK" : "FAIL";
|
||||
check_res[1] = (expected_min[1] < sample1[i].am_data2 && expected_max[1] > sample1[i].am_data2) ? "OK" : "FAIL";
|
||||
check_res[2] = (expected_min[2] < sample1[i].am_data3 && expected_max[2] > sample1[i].am_data3) ? "OK" : "FAIL";
|
||||
check_res[3] = (expected_min[3] < sample1[i].am_data4 && expected_max[3] > sample1[i].am_data4) ? "OK" : "FAIL";
|
||||
|
||||
/* Accumulate result */
|
||||
ret += (expected_min[0] > sample1[i].am_data1 || expected_max[0] < sample1[i].am_data1) ? 1 : 0;
|
||||
// XXX Chan 11 not connected on test setup
|
||||
//ret += (expected_min[1] > sample1[i].am_data2 || expected_max[1] < sample1[i].am_data2) ? 1 : 0;
|
||||
ret += (expected_min[2] > sample1[i].am_data3 || expected_max[2] < sample1[i].am_data3) ? 1 : 0;
|
||||
ret += (expected_min[3] > sample1[i].am_data4 || expected_max[3] < sample1[i].am_data4) ? 1 : 0;
|
||||
|
||||
message("Sample:");
|
||||
message("%d: channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
i, sample1[i].am_channel1, sample1[i].am_data1, expected_min[0], expected_max[0], check_res[0]);
|
||||
message("Sample:");
|
||||
message("%d: channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
i, sample1[i].am_channel2, sample1[i].am_data2, expected_min[1], expected_max[1], check_res[1]);
|
||||
message("Sample:");
|
||||
message("%d: channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
i, sample1[i].am_channel3, sample1[i].am_data3, expected_min[2], expected_max[2], check_res[2]);
|
||||
message("Sample:");
|
||||
message("%d: channel: %d value: %d (allowed min: %d, allowed max: %d), result: %s\n",
|
||||
i, sample1[i].am_channel4, sample1[i].am_data4, expected_min[3], expected_max[3], check_res[3]);
|
||||
|
||||
if (ret != OK) {
|
||||
printf("\t ADC test FAILED. Some channels where out of allowed range. Check supply voltages.\n");
|
||||
goto errout_with_dev;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
printf("\t ADC test successful.\n");
|
||||
|
||||
errout_with_dev:
|
||||
if (fd0 != 0) close(fd0);
|
||||
if (fd != 0) close(fd);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user