ardupilot/libraries/AP_HAL_FLYMAPLE/examples/UtilityStringTest/UtilityStringTest.cpp

56 lines
1.1 KiB
C++

// -*- Mode: C++; c-basic-offset: 8; indent-tabs-mode: nil -*-
#include <string.h>
#include <AP_Common.h>
#include <AP_Math.h>
#include <AP_Param.h>
#include <AP_Progmem.h>
#include <AP_HAL.h>
#include <AP_HAL_FLYMAPLE.h>
const AP_HAL::HAL& hal = AP_HAL_BOARD_DRIVER;
void test_snprintf_P() {
char test[40];
memset(test,0,40);
hal.util->snprintf_P(test, 40, PSTR("hello %d from prog %f %S\r\n"),
10, 1.2345, PSTR("progmem"));
hal.console->write((const uint8_t*)test, strlen(test));
}
void test_snprintf() {
char test[40];
memset(test,0,40);
hal.util->snprintf(test, 40, "hello %d world %f %s\r\n",
20, 2.3456, "sarg");
hal.console->write((const uint8_t*)test, strlen(test));
}
void setup(void)
{
//
// HAL will start serial port at 115200.
//
//
// Test printing things
//
hal.console->println("Utility String Library Test");
hal.console->println("Test snprintf:");
test_snprintf();
hal.console->println("Test snprintf_P:");
test_snprintf_P();
hal.console->println("done");
}
void loop(void) { }
AP_HAL_MAIN();