Diff: main.cpp

Revision:

11:3695280eeffd

Parent:

8:39ecd15538f9

Child:

15:e0fbd2ddd2a9

diff -r 55795f30572e -r 3695280eeffd main.cpp
--- a/main.cpp	Wed Oct 18 12:59:14 2017 +0000
+++ b/main.cpp	Sat Mar 23 21:30:31 2019 +0000
@@ -1,12 +1,10 @@
 /**
  ******************************************************************************
  * @file    main.cpp
- * @author  CLab
+ * @author  Tarek Lule, based on code by CLab
  * @version V1.0.0
- * @date    5-September-2017
- * @brief   Simple Example application for using X_NUCLEO_IKS01A2  
- *          MEMS Inertial & Environmental Sensor Nucleo expansion and 
- *          B-L475E-IOT01A2 boards.
+ * @date    13-March-2019
+ * @brief   Simple Example application for using TOF  Sensors
  ******************************************************************************
  * @attention
  *
@@ -39,177 +37,69 @@
 
 /* Includes */
 #include "mbed.h"
-#include "HTS221Sensor.h"
-#include "LPS22HBSensor.h"
-#include "LSM6DSLSensor.h"
-
-#ifdef TARGET_DISCO_L475VG_IOT01A
-
-#include "lis3mdl_class.h"
 #include "VL53L0X.h"
 
-#else // Nucleo-XXX + X-Nucleo-IKS01A2 or SensorTile
-
-#ifdef TARGET_NUCLEO_L476RG
-#define TARGET_SENSOR_TILE   // comment out to use actual NUCLEO-L476RG instead of SensorTile
-#endif
-
-#include "LSM303AGRMagSensor.h"
-#include "LSM303AGRAccSensor.h"
-
-#endif
-
-
-/* Retrieve the composing elements of the expansion board */
-
 /* Interface definition */
-#ifdef TARGET_DISCO_L475VG_IOT01A
 static DevI2C devI2c(PB_11,PB_10);
-#else // X-Nucleo-IKS01A2 or SensorTile
-#ifdef TARGET_SENSOR_TILE
-#define SPI_TYPE_LPS22HB   LPS22HBSensor::SPI3W
-#define SPI_TYPE_LSM6DSL   LSM6DSLSensor::SPI3W
-SPI devSPI(PB_15, NC, PB_13);  // 3-wires SPI on SensorTile  
-static Serial ser(PC_12,PD_2); // Serial with SensorTile Cradle Exp. Board + Nucleo   
-#define printf(...) ser.printf(__VA_ARGS__)     
-#else  // Nucleo-XXX + X-Nucleo-IKS01A2 
-static DevI2C devI2c(D14,D15);
-#endif
-#endif
-
-/* Environmental sensors */
-#ifdef TARGET_SENSOR_TILE
-static LPS22HBSensor press_temp(&devSPI, PA_3, NC, SPI_TYPE_LPS22HB); 
-#else  // Nucleo-XXX + X-Nucleo-IKS01A2 or B-L475E-IOT01A2
-static LPS22HBSensor press_temp(&devI2c);
-static HTS221Sensor hum_temp(&devI2c);
-#endif
-
-/* Motion sensors */
-#ifdef TARGET_DISCO_L475VG_IOT01A
-static LSM6DSLSensor acc_gyro(&devI2c,LSM6DSL_ACC_GYRO_I2C_ADDRESS_LOW,PD_11); // low address
-static LIS3MDL magnetometer(&devI2c);
-#else // X-NUCLEO-IKS01A2 or SensorTile
-#if defined (TARGET_SENSOR_TILE)
-static LSM6DSLSensor acc_gyro(&devSPI,PB_12, NC, PA_2, SPI_TYPE_LSM6DSL); 
-static LSM303AGRMagSensor magnetometer(&devSPI, PB_1);
-static LSM303AGRAccSensor accelerometer(&devSPI, PC_4);
-#else
-static LSM6DSLSensor acc_gyro(&devI2c,LSM6DSL_ACC_GYRO_I2C_ADDRESS_HIGH,D4,D5); // high address
-static LSM303AGRMagSensor magnetometer(&devI2c);
-static LSM303AGRAccSensor accelerometer(&devI2c);
-#endif
-#endif
+Serial midi_uart(PA_0, PA_1);  // PA_0 = Tx, PA_1 = Rx
 
 /* Range sensor - B-L475E-IOT01A2 only */
-#ifdef TARGET_DISCO_L475VG_IOT01A
 static DigitalOut shutdown_pin(PC_6);
-static VL53L0X range(&devI2c, &shutdown_pin, PC_7);
-#endif
+static VL53L0X tof1(&devI2c, &shutdown_pin, PC_7);
 
 /* Simple main function */
 int main() {
-  uint8_t id;
-  float value1, value2;
-//  char buffer1[32], buffer2[32];
-  int32_t axes[3];
-  
+  uint32_t distance;
+  int status;
+  char OldKey, NewKey;
+  VL53L0X_RangingMeasurementData_t p_ranging_measurement_data;
+    
   /* Init all sensors with default params */
-#ifndef TARGET_SENSOR_TILE
-  hum_temp.init(NULL);
-#endif  
-
-  press_temp.init(NULL);
-  magnetometer.init(NULL);
-  acc_gyro.init(NULL);
-  
-#ifdef TARGET_DISCO_L475VG_IOT01A
-  range.init_sensor(VL53L0X_DEFAULT_ADDRESS);
-#else // X-NUCLEO-IKS01A2 or SensorTile
-  accelerometer.init(NULL);
-#endif
-
-
-  
-  /* Enable all sensors */
-#ifndef TARGET_SENSOR_TILE  
-  hum_temp.enable();
-#endif  
-  press_temp.enable();
-#ifndef TARGET_DISCO_L475VG_IOT01A // X-NUCLEO-IKS01A2
-  magnetometer.enable();
-  accelerometer.enable();
-#endif
-  acc_gyro.enable_x();
-  acc_gyro.enable_g();
-  
-  printf("\033[2J\033[20A");
-  printf ("\r\n--- Starting new run ---\r\n\r\n");
-
-#ifndef TARGET_SENSOR_TILE
-  hum_temp.read_id(&id);
-  printf("HTS221  humidity & temperature    = 0x%X\r\n", id);
-#endif  
-  press_temp.read_id(&id);
-  printf("LPS22HB pressure & temperature    = 0x%X\r\n", id);
-  magnetometer.read_id(&id);
-#ifdef TARGET_DISCO_L475VG_IOT01A
-  printf("LIS3MDL magnetometer              = 0x%X\r\n", id);
-#else // X-NUCLEO-IKS01A2 or SensorTile
-  printf("LSM303AGR magnetometer            = 0x%X\r\n", id);
-  accelerometer.read_id(&id);
-  printf("LSM303AGR accelerometer           = 0x%X\r\n", id); 
-#endif
-  acc_gyro.read_id(&id);
-  printf("LSM6DSL accelerometer & gyroscope = 0x%X\r\n", id);
-  
-  printf("\n\r--- Reading sensor values ---\n\r"); ;
+  tof1.init_sensor(VL53L0X_DEFAULT_ADDRESS);
+  status = tof1.start_measurement(range_continuous_polling, NULL);
+  if (status) 
+     {  printf("\n\r--- Error Initializing the TOF sensor ---\n\r"); 
+        //while(1) { }; // consider to hang up the device here
+     }
+  printf("\n\r--- Read Init of TOF ---\n\r"); ;
+         
+  OldKey = 0x00; // Remembers the old key, start with value thats normallz unused 
+  midi_uart.baud( 31250 );
+  midi_uart.format( 8, SerialBase::None, 2);
  
-  while(1) {
-    printf("\r\n");
-
-#ifndef TARGET_SENSOR_TILE    
-    hum_temp.get_temperature(&value1);
-    hum_temp.get_humidity(&value2);
-    printf("HTS221:  [temp] %.2f C, [hum]   %.2f%%\r\n", value1, value2);
-#endif    
-    value1=value2=0;    
-    press_temp.get_temperature(&value1);
-    press_temp.get_pressure(&value2);
-    printf("LPS22HB: [temp] %.2f C, [press] %.2f mbar\r\n", value1, value2);
-
-    printf("---\r\n");
-
-    magnetometer.get_m_axes(axes);
-#ifdef TARGET_DISCO_L475VG_IOT01A
-    printf("LIS3MDL [mag/mgauss]:    %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);
-#else // X-NUCLEO-IKS01A2 or SensorTile
-    printf("LSM303AGR [mag/mgauss]:  %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);
-    accelerometer.get_x_axes(axes);
-    printf("LSM303AGR [acc/mg]:      %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);    
-#endif    
-
-    acc_gyro.get_x_axes(axes);
-    printf("LSM6DSL [acc/mg]:        %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);
-
-    acc_gyro.get_g_axes(axes);
-    printf("LSM6DSL [gyro/mdps]:     %6ld, %6ld, %6ld\r\n", axes[0], axes[1], axes[2]);
-
-#ifdef TARGET_DISCO_L475VG_IOT01A
-    uint32_t distance;
-    int status = range.get_distance(&distance);
-    if (status == VL53L0X_ERROR_NONE) {
-        printf("VL53L0X [mm]:            %6ld\r\n", distance);
-    } else {
-        printf("VL53L0X [mm]:                --\r\n");
-    }
-#endif
-
-#if defined (TARGET_SENSOR_TILE)  
-    printf("\033[7A");
-#else    
-    printf("\033[8A");
-#endif
-    wait(0.5);
-  }
-}
+  while(1)
+    { status =  tof1.get_measurement(range_continuous_polling, &p_ranging_measurement_data);
+        
+    if ( (status == VL53L0X_ERROR_NONE) && (p_ranging_measurement_data.RangeStatus == 0) )
+        { // we have a valid range.
+        distance = p_ranging_measurement_data.RangeMilliMeter;
+        // printf("%6ld\r", distance); // Distance is ~1700 when looking at the ceiling, so approximately 1 per mm. A really usable distance range is only up to 1270. 
+        distance = (int) (distance / 10) + 20; // scaling factor 10 between distance and key note
+        if (distance >= 0x6F) NewKey = 0x00; // cap the New Key Value on the top, beyond 127 we discard the note as 'no Note'
+            else NewKey = distance; // pass through everything below; remember: distance is uint, so no negatives can occur
+        } 
+      else 
+        { // printf("  --\r");
+        NewKey = 0x00;
+        }
+    printf("%6ld\r", NewKey);
+    if ( OldKey!=NewKey )
+      {
+        if (OldKey != 0x00) 
+            { // turn off the old note first, if there was one
+            midi_uart.putc(0x80);   // Midi Channel 0, Note OFF, 
+            midi_uart.putc(OldKey); // Byte 2: Old Key Number [0 - 127]   
+            midi_uart.putc(0x3F);   // Byte 3: Velocity [0 - 127]; here fixed=63 
+            }
+        // wait(0.1);
+        if (NewKey != 0x00)
+            { // turn on the new note now, if there is a valid one
+            midi_uart.putc(0x90);  // Midi Channel 0, Note ON, 
+            midi_uart.putc(NewKey);// Byte 2: New Key Number [0 - 127]   
+            midi_uart.putc(0x3F);  // Byte 3: Velocity [0 - 127]; here fixed=63 
+            }
+        OldKey = NewKey;
+        // wait(0.1);
+      } // if ( OldKey!=NewKey )
+  } // while(1)
+} // int main()