function for displaying nunchuck values

src/hoverserial.ino

@@ -159,11 +159,11 @@ void Receive()
     if (idx == sizeof(SerialFeedback)) {
         uint16_t checksum;
         checksum =
-            (uint16_t) (NewFeedback.start ^ NewFeedback.
-                        cmd1 ^ NewFeedback.cmd2 ^ NewFeedback.
-                        speedR ^ NewFeedback.speedL ^ NewFeedback.
-                        speedR_meas ^ NewFeedback.speedL_meas ^
-                        NewFeedback.batVoltage ^ NewFeedback.boardTemp);
+            (uint16_t) (NewFeedback.start ^ NewFeedback.cmd1 ^ NewFeedback.
+                        cmd2 ^ NewFeedback.speedR ^ NewFeedback.
+                        speedL ^ NewFeedback.speedR_meas ^ NewFeedback.
+                        speedL_meas ^ NewFeedback.batVoltage ^ NewFeedback.
+                        boardTemp);
 
         // Check validity of the new data
         if (NewFeedback.start == START_FRAME
@@ -201,23 +201,17 @@ void Receive()
     incomingBytePrev = incomingByte;
 }
 
-// ########################## LOOP ##########################
+// ########################## nunchuk ##########################
 
-unsigned long iTimeSend = 0;
-int iTestMax = SPEED_MAX_TEST;
-int iTest = 0;
-
-void loop(void)
+void Nunchuk_display()
 {
-    unsigned long timeNow = millis();
-
-    // Check for new received data
-    Receive();
-    // Get new data from the controller
     if (!nchuk.update()) {
+        if (Serial) {
             Serial.println("Controller disconnected!");
+        }
         nchuk.reconnect();
     } else {
+        if (Serial) {
             // Read a button (on/off, C and Z)
             Serial.print("Z: ");
             nchuk.buttonZ()? Serial.print("On  ") : Serial.print("Off ");
@@ -234,7 +228,25 @@ void loop(void)
             Serial.print(" - The accelerometer's X-axis is at ");
             Serial.println(nchuk.accelX());
         }
+    }
 
+}
+
+// ########################## LOOP ##########################
+
+unsigned long iTimeSend = 0;
+int iTestMax = SPEED_MAX_TEST;
+int iTest = 0;
+int16_t old_cursorX;
+int16_t old_cursorY;
+
+void loop(void)
+{
+    unsigned long timeNow = millis();
+
+    // Check for new received data
+    Receive();
+    Nunchuk_display();
     // Send commands
     if (iTimeSend > timeNow)
         return;