color from byte to integer

Author: gbr1

examples/firmware_01/firmware_01.ino

@@ -80,7 +80,7 @@ void loop(){
         break;
       case 2:
         robot.updateAPDS();
-        msg_size = packeter.packetC3B('c', robot.getRed(), robot.getGreen(), robot.getBlue());
+        msg_size = packeter.packetC3I('c', robot.getRed(), robot.getGreen(), robot.getBlue());
         robot.serial->write(packeter.msg,msg_size);
         break;
       case 3:

src/Arduino_Robot_Firmware.h

@@ -90,9 +90,9 @@ class Arduino_Robot_Firmware{
         void setIlluminator(uint8_t value);         // set white leds       
         void enableIlluminator();                   // white leds on
         void disableIlluminator();                  // white leds off
-        int getRed();                               // red value 0-255
-        int getGreen();                             // green value 0-255
-        int getBlue();                              // blue value 0-255
+        int getRed();                               // red value 0-4095
+        int getGreen();                             // green value 0-4095
+        int getBlue();                              // blue value 0-4095
         int getProximity();                         // proximity value 0-127
 
 

src/sensor_tof_matrix.h

@@ -321,7 +321,7 @@ class SensorTofMatrix{
             int16_t _avg = 0;
             uint8_t n = 0;
 
-            for (int i=(_size==4?5:19); i < (_size==4?13:51) ;i+=_size) {
+            for (int i=(_size==4?5:19); i < (_size==4?9:51) ;i+=_size) {
                 _avg += results.distance_mm[i];
                 n++;
                 _avg += results.distance_mm[i+1];