2018 revision to classic DataBus AVC code.

Dependencies:   LSM303DLM Servo SerialGraphicLCD L3G4200D IncrementalEncoder SimpleShell

Revision:
42:8d99f64f5898
Parent:
41:f07bf1039ba3
--- a/Display/Display.cpp	Wed Jan 02 18:55:57 2019 +0000
+++ b/Display/Display.cpp	Thu Jan 03 17:50:44 2019 +0000
@@ -20,10 +20,25 @@
     lcd->printf("sv:%-2d h:%-3.0f s:%-4.1f ", d.svcount, d.course, d.speed);
 }
 
+
 void Display::imu(SensorData d) 
 {
+    lcd->pos(0,3);
+    lcd->printf("gyr: z:%4d ", d.gyro[2]);
+    lcd->pos(0,2);
+    lcd->printf("acc: x:%4d y:%4d ", d.accel[0], d.accel[1]);
+    lcd->pos(0,1);
+    lcd->printf("mag: x:%4d y:%4d ", d.mag[0], d.mag[1]);
 }
 
+
+void Display::cpu(int idle)
+{
+    lcd->pos(13,7);
+    lcd->printf("idle:%3d%%", idle);
+}
+
+
 void Display::status(char *s) 
 {
     char line[LCDWIDTH+1];