lib/ev3dev: support u16 and u32 sensor data

This fixes the Ev3devSensor class for sensors that use these types.

Author: laurensvalk

bricks/ev3dev/pbdevice.c

@@ -161,9 +161,15 @@ static pbio_error_t get_values(pbdevice_t *pbdev, uint8_t mode, int32_t *values)
             case LEGO_SENSOR_DATA_TYPE_INT16:
                 values[i] = *((int16_t *)(data + i * 2));
                 break;
+            case LEGO_SENSOR_DATA_TYPE_UINT16:
+                values[i] = *((uint16_t *)(data + i * 2));
+                break;
             case LEGO_SENSOR_DATA_TYPE_INT32:
                 values[i] = *((int32_t *)(data + i * 4));
                 break;
+            case LEGO_SENSOR_DATA_TYPE_UINT32:
+                values[i] = *((uint32_t *)(data + i * 4));
+                break;
             case LEGO_SENSOR_DATA_TYPE_INT16_BE:
                 values[i] = (int16_t) __builtin_bswap16(*(uint16_t *) (data + i * 2));
                 break;

lib/ev3dev/include/ev3dev_stretch/lego_sensor.h

@@ -33,6 +33,14 @@ typedef enum {
      * Unsigned 8-bit integer.
      */
     LEGO_SENSOR_DATA_TYPE_UINT8,
+    /**
+     * Unsigned 16-bit integer.
+     */
+    LEGO_SENSOR_DATA_TYPE_UINT16,
+    /**
+     * Unsigned 32-bit integer.
+     */
+    LEGO_SENSOR_DATA_TYPE_UINT32,
     /**
      * Big-endian, signed 16-bit integer.
      */

lib/ev3dev/src/ev3dev_stretch/lego_sensor.c

@@ -228,9 +228,15 @@ pbio_error_t lego_sensor_get_info(lego_sensor_t *sensor, uint8_t *data_len, lego
     else if (!strcmp(s_data_type, "s16")) {
         *data_type = LEGO_SENSOR_DATA_TYPE_INT16;
     }
+    else if (!strcmp(s_data_type, "u16")) {
+        *data_type = LEGO_SENSOR_DATA_TYPE_UINT16;
+    }
     else if (!strcmp(s_data_type, "s32")) {
         *data_type = LEGO_SENSOR_DATA_TYPE_INT32;
     }
+    else if (!strcmp(s_data_type, "u32")) {
+        *data_type = LEGO_SENSOR_DATA_TYPE_UINT32;
+    }
     else if (!strcmp(s_data_type, "s16_be")) {
         *data_type = LEGO_SENSOR_DATA_TYPE_INT16_BE;
     }