ardupilot/libraries/DataFlash/examples/DataFlash_test/DataFlash_test.cpp

126 lines
2.8 KiB
C++
Raw Normal View History

/*
2014-12-02 17:39:36 -04:00
* Example of DataFlash library.
* originally based on code by Jordi MuÒoz and Jose Julio
*/
#include <AP_HAL/AP_HAL.h>
#include <DataFlash/DataFlash.h>
2017-07-02 19:56:13 -03:00
#include <GCS_MAVLink/GCS_Dummy.h>
2017-06-28 07:42:03 -03:00
#include <stdio.h>
const AP_HAL::HAL& hal = AP_HAL::get_HAL();
#define LOG_TEST_MSG 1
struct PACKED log_Test {
LOG_PACKET_HEADER;
2013-01-12 02:21:21 -04:00
uint16_t v1, v2, v3, v4;
int32_t l1, l2;
};
static const struct LogStructure log_structure[] = {
LOG_COMMON_STRUCTURES,
{ LOG_TEST_MSG, sizeof(log_Test),
2017-09-18 09:27:19 -03:00
"TEST",
"HHHHii",
"V1,V2,V3,V4,L1,L2",
"------",
"------"
}
};
#define NUM_PACKETS 500
2012-01-09 00:26:56 -04:00
static uint16_t log_num;
class DataFlashTest {
public:
void setup();
void loop();
private:
AP_Int32 log_bitmask;
DataFlash_Class dataflash{log_bitmask};
};
static DataFlashTest dataflashtest;
void DataFlashTest::setup(void)
{
hal.console->printf("Dataflash Log Test 1.0\n");
log_bitmask = (uint32_t)-1;
dataflash.Init(log_structure, ARRAY_SIZE(log_structure));
2017-06-11 09:32:49 -03:00
dataflash.set_vehicle_armed(true);
dataflash.Log_Write_Message("DataFlash Test");
// Test
2012-12-12 18:21:04 -04:00
hal.scheduler->delay(20);
2013-01-12 02:21:21 -04:00
// We start to write some info (sequentialy) starting from page 1
// This is similar to what we will do...
2015-12-04 16:02:27 -04:00
log_num = dataflash.find_last_log();
hal.console->printf("Using log number %u\n", log_num);
hal.console->printf("Writing to flash... wait...\n");
2013-01-12 02:21:21 -04:00
uint32_t total_micros = 0;
uint16_t i;
for (i = 0; i < NUM_PACKETS; i++) {
uint32_t start = AP_HAL::micros();
2013-01-12 02:21:21 -04:00
// note that we use g++ style initialisers to make larger
// structures easier to follow
struct log_Test pkt = {
LOG_PACKET_HEADER_INIT(LOG_TEST_MSG),
v1 : (uint16_t)(2000 + i),
v2 : (uint16_t)(2001 + i),
v3 : (uint16_t)(2002 + i),
v4 : (uint16_t)(2003 + i),
2015-08-03 02:58:57 -03:00
l1 : (int32_t)(i * 5000),
l2 : (int32_t)(i * 16268)
2013-01-12 02:21:21 -04:00
};
dataflash.WriteBlock(&pkt, sizeof(pkt));
total_micros += AP_HAL::micros() - start;
hal.scheduler->delay(20);
}
2013-01-12 02:21:21 -04:00
hal.console->printf("Average write time %.1f usec/byte\n",
2015-08-03 02:58:57 -03:00
(double)total_micros/((double)i*sizeof(struct log_Test)));
#if CONFIG_HAL_BOARD == HAL_BOARD_SITL || CONFIG_HAL_BOARD == HAL_BOARD_LINUX
dataflash.flush();
#endif
2013-01-12 02:21:21 -04:00
2012-12-12 18:21:04 -04:00
hal.scheduler->delay(100);
}
void DataFlashTest::loop(void)
{
hal.console->printf("\nTest complete.\n");
2012-12-12 18:21:04 -04:00
hal.scheduler->delay(20000);
}
2012-12-12 18:21:04 -04:00
/*
compatibility with old pde style build
*/
void setup(void);
void loop(void);
void setup()
{
dataflashtest.setup();
}
void loop()
{
dataflashtest.loop();
}
2017-07-02 19:56:13 -03:00
const struct AP_Param::GroupInfo GCS_MAVLINK::var_info[] = {
AP_GROUPEND
2017-06-28 07:42:03 -03:00
};
2017-07-02 19:56:13 -03:00
GCS_Dummy _gcs;
2017-06-28 07:42:03 -03:00
2012-12-12 18:21:04 -04:00
AP_HAL_MAIN();