mirror of
https://github.com/ArduPilot/ardupilot
synced 2025-01-11 10:28:29 -04:00
uncrustify libraries/AP_Common/tools/eedump_apparam.c
This commit is contained in:
uncrustify
Pat Hickey
parent
eb1fff9584
commit
3bfe5e9774
@ -6,19 +6,19 @@
|
||||
#include <stdlib.h>
|
||||
#include <stdint.h>
|
||||
|
||||
uint8_t eeprom[0x1000];
|
||||
uint8_t eeprom[0x1000];
|
||||
|
||||
#pragma pack(1)
|
||||
|
||||
struct EEPROM_header {
|
||||
uint8_t magic[2];
|
||||
uint8_t revision;
|
||||
uint8_t spare;
|
||||
uint8_t magic[2];
|
||||
uint8_t revision;
|
||||
uint8_t spare;
|
||||
};
|
||||
|
||||
static const uint16_t k_EEPROM_magic0 = 0x50;
|
||||
static const uint16_t k_EEPROM_magic1 = 0x41;
|
||||
static const uint16_t k_EEPROM_revision = 6;
|
||||
static const uint16_t k_EEPROM_magic0 = 0x50;
|
||||
static const uint16_t k_EEPROM_magic1 = 0x41;
|
||||
static const uint16_t k_EEPROM_revision = 6;
|
||||
|
||||
enum ap_var_type {
|
||||
AP_PARAM_NONE = 0,
|
||||
@ -33,19 +33,19 @@ enum ap_var_type {
|
||||
};
|
||||
|
||||
static const char *type_names[8] = {
|
||||
"NONE", "INT8", "INT16", "INT32", "FLOAT", "VECTOR3F", "MATRIX6F", "GROUP"
|
||||
"NONE", "INT8", "INT16", "INT32", "FLOAT", "VECTOR3F", "MATRIX6F", "GROUP"
|
||||
};
|
||||
|
||||
struct Param_header {
|
||||
uint32_t key:8;
|
||||
uint32_t type:6;
|
||||
uint32_t group_element:18;
|
||||
uint32_t key : 8;
|
||||
uint32_t type : 6;
|
||||
uint32_t group_element : 18;
|
||||
};
|
||||
|
||||
|
||||
static const uint8_t _sentinal_key = 0xFF;
|
||||
static const uint8_t _sentinal_type = 0xFF;
|
||||
static const uint8_t _sentinal_group = 0xFF;
|
||||
static const uint8_t _sentinal_key = 0xFF;
|
||||
static const uint8_t _sentinal_type = 0xFF;
|
||||
static const uint8_t _sentinal_group = 0xFF;
|
||||
|
||||
static uint8_t type_size(enum ap_var_type type)
|
||||
{
|
||||
@ -75,107 +75,107 @@ static uint8_t type_size(enum ap_var_type type)
|
||||
static void
|
||||
fail(const char *why)
|
||||
{
|
||||
fprintf(stderr, "ERROR: %s\n", why);
|
||||
exit(1);
|
||||
fprintf(stderr, "ERROR: %s\n", why);
|
||||
exit(1);
|
||||
}
|
||||
|
||||
int
|
||||
main(int argc, char *argv[])
|
||||
{
|
||||
FILE *fp;
|
||||
struct EEPROM_header *header;
|
||||
struct Param_header *var;
|
||||
unsigned index;
|
||||
unsigned i;
|
||||
FILE *fp;
|
||||
struct EEPROM_header *header;
|
||||
struct Param_header *var;
|
||||
unsigned index;
|
||||
unsigned i;
|
||||
|
||||
if (argc != 2) {
|
||||
fail("missing EEPROM file name");
|
||||
}
|
||||
if (NULL == (fp = fopen(argv[1], "rb"))) {
|
||||
fail("can't open EEPROM file");
|
||||
}
|
||||
if (1 != fread(eeprom, sizeof(eeprom), 1, fp)) {
|
||||
fail("can't read EEPROM file");
|
||||
}
|
||||
fclose(fp);
|
||||
if (argc != 2) {
|
||||
fail("missing EEPROM file name");
|
||||
}
|
||||
if (NULL == (fp = fopen(argv[1], "rb"))) {
|
||||
fail("can't open EEPROM file");
|
||||
}
|
||||
if (1 != fread(eeprom, sizeof(eeprom), 1, fp)) {
|
||||
fail("can't read EEPROM file");
|
||||
}
|
||||
fclose(fp);
|
||||
|
||||
header = (struct EEPROM_header *)&eeprom[0];
|
||||
if (header->magic[0] != k_EEPROM_magic0 ||
|
||||
header->magic[1] != k_EEPROM_magic1) {
|
||||
fail("bad magic in EEPROM file");
|
||||
}
|
||||
if (header->revision != k_EEPROM_revision) {
|
||||
fail("unsupported EEPROM format revision");
|
||||
}
|
||||
printf("Header OK\n");
|
||||
header = (struct EEPROM_header *)&eeprom[0];
|
||||
if (header->magic[0] != k_EEPROM_magic0 ||
|
||||
header->magic[1] != k_EEPROM_magic1) {
|
||||
fail("bad magic in EEPROM file");
|
||||
}
|
||||
if (header->revision != k_EEPROM_revision) {
|
||||
fail("unsupported EEPROM format revision");
|
||||
}
|
||||
printf("Header OK\n");
|
||||
|
||||
index = sizeof(*header);
|
||||
for (;;) {
|
||||
uint8_t size;
|
||||
var = (struct Param_header *)&eeprom[index];
|
||||
if (var->key == _sentinal_key ||
|
||||
var->group_element == _sentinal_group ||
|
||||
var->type == _sentinal_type) {
|
||||
printf("end sentinel at %u\n", index);
|
||||
break;
|
||||
}
|
||||
size = type_size(var->type);
|
||||
printf("%04x: type %u (%s) key %u group_element %u size %d value ",
|
||||
index, var->type, type_names[var->type], var->key, var->group_element, size);
|
||||
index += sizeof(*var);
|
||||
switch (var->type) {
|
||||
case AP_PARAM_INT8:
|
||||
printf("%d\n", (int)*(int8_t *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_INT16:
|
||||
printf("%d\n", (int)*(int16_t *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_INT32:
|
||||
printf("%d\n", (int)*(int32_t *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_FLOAT:
|
||||
printf("%f\n", *(float *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_VECTOR3F:
|
||||
printf("%f %f %f\n",
|
||||
*(float *)&eeprom[index],
|
||||
*(float *)&eeprom[index+4],
|
||||
*(float *)&eeprom[index+8]);
|
||||
break;
|
||||
case AP_PARAM_VECTOR6F:
|
||||
printf("%f %f %f %f %f %f\n",
|
||||
*(float *)&eeprom[index],
|
||||
*(float *)&eeprom[index+4],
|
||||
*(float *)&eeprom[index+8],
|
||||
*(float *)&eeprom[index+12],
|
||||
*(float *)&eeprom[index+16],
|
||||
*(float *)&eeprom[index+20]);
|
||||
break;
|
||||
case AP_PARAM_MATRIX3F:
|
||||
printf("%f %f %f %f %f %f %f %f %f\n",
|
||||
*(float *)&eeprom[index],
|
||||
*(float *)&eeprom[index+4],
|
||||
*(float *)&eeprom[index+8],
|
||||
*(float *)&eeprom[index+12],
|
||||
*(float *)&eeprom[index+16],
|
||||
*(float *)&eeprom[index+20],
|
||||
*(float *)&eeprom[index+24],
|
||||
*(float *)&eeprom[index+28],
|
||||
*(float *)&eeprom[index+32]);
|
||||
break;
|
||||
default:
|
||||
printf("NONE\n");
|
||||
break;
|
||||
}
|
||||
for (i = 0; i < size; i++) {
|
||||
printf(" %02x", eeprom[index + i]);
|
||||
}
|
||||
printf("\n");
|
||||
index += size;
|
||||
if (index >= sizeof(eeprom)) {
|
||||
fflush(stdout);
|
||||
fail("missing end sentinel");
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
index = sizeof(*header);
|
||||
for (;; ) {
|
||||
uint8_t size;
|
||||
var = (struct Param_header *)&eeprom[index];
|
||||
if (var->key == _sentinal_key ||
|
||||
var->group_element == _sentinal_group ||
|
||||
var->type == _sentinal_type) {
|
||||
printf("end sentinel at %u\n", index);
|
||||
break;
|
||||
}
|
||||
size = type_size(var->type);
|
||||
printf("%04x: type %u (%s) key %u group_element %u size %d value ",
|
||||
index, var->type, type_names[var->type], var->key, var->group_element, size);
|
||||
index += sizeof(*var);
|
||||
switch (var->type) {
|
||||
case AP_PARAM_INT8:
|
||||
printf("%d\n", (int)*(int8_t *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_INT16:
|
||||
printf("%d\n", (int)*(int16_t *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_INT32:
|
||||
printf("%d\n", (int)*(int32_t *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_FLOAT:
|
||||
printf("%f\n", *(float *)&eeprom[index]);
|
||||
break;
|
||||
case AP_PARAM_VECTOR3F:
|
||||
printf("%f %f %f\n",
|
||||
*(float *)&eeprom[index],
|
||||
*(float *)&eeprom[index+4],
|
||||
*(float *)&eeprom[index+8]);
|
||||
break;
|
||||
case AP_PARAM_VECTOR6F:
|
||||
printf("%f %f %f %f %f %f\n",
|
||||
*(float *)&eeprom[index],
|
||||
*(float *)&eeprom[index+4],
|
||||
*(float *)&eeprom[index+8],
|
||||
*(float *)&eeprom[index+12],
|
||||
*(float *)&eeprom[index+16],
|
||||
*(float *)&eeprom[index+20]);
|
||||
break;
|
||||
case AP_PARAM_MATRIX3F:
|
||||
printf("%f %f %f %f %f %f %f %f %f\n",
|
||||
*(float *)&eeprom[index],
|
||||
*(float *)&eeprom[index+4],
|
||||
*(float *)&eeprom[index+8],
|
||||
*(float *)&eeprom[index+12],
|
||||
*(float *)&eeprom[index+16],
|
||||
*(float *)&eeprom[index+20],
|
||||
*(float *)&eeprom[index+24],
|
||||
*(float *)&eeprom[index+28],
|
||||
*(float *)&eeprom[index+32]);
|
||||
break;
|
||||
default:
|
||||
printf("NONE\n");
|
||||
break;
|
||||
}
|
||||
for (i = 0; i < size; i++) {
|
||||
printf(" %02x", eeprom[index + i]);
|
||||
}
|
||||
printf("\n");
|
||||
index += size;
|
||||
if (index >= sizeof(eeprom)) {
|
||||
fflush(stdout);
|
||||
fail("missing end sentinel");
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue
Block a user