Color sensor reset at the end of calibration added. sensor id auto assignment was changed to be a fixed value assignment to avoid sensor id shift when some sensor is absent.

Dependencies:   UniGraphic mbed vt100

Revision:
0:ce97f6d34336
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/af_utils/DebugIO.hpp	Fri Feb 23 05:40:22 2018 +0000
@@ -0,0 +1,26 @@
+#ifndef _MARUSOL_DEBUG_IO_HPP_
+#define _MARUSOL_DEBUG_IO_HPP_
+
+#if defined (TARGET_TEENSY3_1)
+    #include "USBSerial.h"
+#else
+    #include "mbed.h"
+#endif
+
+// #define SERIAL_PRINT_DBG_ON
+#ifdef  SERIAL_PRINT_DBG_ON
+    #define SERIAL_PRINT_DBG(...)  (printf(__VA_ARGS__))
+    #define SERIAL_PRINT_DBG_FUNCNAME() (printf("%s,%d,%s\n",__FILE__,__LINE__,__PRETTY_FUNCTION__))
+#else
+    #define SERIAL_PRINT_DBG(...)
+    #define SERIAL_PRINT_DBG_FUNCNAME()
+#endif //SERIAL_PRINT_DBG_ON
+
+// #define SERIAL_PRINT_DBG_ASR_ON
+#ifdef  SERIAL_PRINT_DBG_ASR_ON
+    #define SERIAL_PRINT_DBG_ASR(...)  (printf(__VA_ARGS__))
+#else
+    #define SERIAL_PRINT_DBG_ASR(...)
+#endif //SERIAL_PRINT_DBG_ASR_ON
+
+#endif //_MARUSOL_DEBUG_IO_HPP_
\ No newline at end of file