AP_HAL_AVR: UtilityStringTest added

libraries/AP_HAL_AVR/examples/UtilityStringTest/Makefile

@@ -0,0 +1,2 @@
+BOARD	=	mega
+include ../../../../mk/Arduino.mk

libraries/AP_HAL_AVR/examples/UtilityStringTest/UtilityStringTest.pde

@@ -0,0 +1,55 @@
+// -*- 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_AVR.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();