Sweep a servo according to Proximity sensor measure
Dependencies: Servo X_NUCLEO_6180XA1 mbed
Fork of HelloWorld_6180XA1 by
Diff: main.cpp
- Revision:
- 6:f253ca7919af
- Parent:
- 5:fa65d931bd96
- Child:
- 7:865f0c23a183
--- a/main.cpp Fri Sep 25 12:14:00 2015 +0200 +++ b/main.cpp Tue Sep 29 14:51:10 2015 +0200 @@ -29,7 +29,7 @@ int main() { uint8_t buf[8]={1,1,0,0,0,0,0,0}; - + static uint32_t tmp; uint8_t x=0xFF; uint8_t y=0xF7; @@ -37,10 +37,48 @@ uint8_t k=0x17; uint8_t g=0xE7; + DigitalOut led (LED2); + led=1; + DevI2C device_i2c(VL6180X_I2C_SDA, VL6180X_I2C_SCL); - STMPE1600DigiOut exp(device_i2c, GPIO_12, STMPE1600_DEF_DEVICE_ADDRESS); - VL6180X sensor1(device_i2c, exp); + + STMPE1600DigiOut gpio0(device_i2c, GPIO_0, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio1(device_i2c, GPIO_1, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio2(device_i2c, GPIO_2, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio3(device_i2c, GPIO_3, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio4(device_i2c, GPIO_4, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio5(device_i2c, GPIO_5, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio6(device_i2c, GPIO_6, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio7(device_i2c, GPIO_7, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio8(device_i2c, GPIO_8, STMPE1600_DEF_DEVICE_ADDRESS); + + STMPE1600DigiOut gpio9(device_i2c, GPIO_9, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio10(device_i2c, GPIO_10, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiIn gpio11(device_i2c, GPIO_11, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio12(device_i2c, GPIO_12, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio13(device_i2c, GPIO_13, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio14(device_i2c, GPIO_14, STMPE1600_DEF_DEVICE_ADDRESS); + STMPE1600DigiOut gpio15(device_i2c, GPIO_15, STMPE1600_DEF_DEVICE_ADDRESS); + + + + gpio0 = 0; gpio1 = 1; gpio2 = 1; gpio3 = 1; gpio4 = 1; gpio5 = 1; gpio6 = 1; gpio7 = 0; + gpio8 = 1; gpio9 = 1; gpio10 = 1; gpio12 = 1; gpio13 = 1; gpio14 = 1; gpio15 = 1; + +//STMPE1600DigiOut * p_exp = new STMPE1600DigiOut(device_i2c, GPIO_12, STMPE1600_DEF_DEVICE_ADDRESS); + + VL6180X sensor1(device_i2c, gpio12); + + sensor1.VL6180x_On(); +// tmp = sensor1.Init(); + + uint8_t id=0; + id = sensor1.ReadID(); // read id to test + +// VL6180X sensor1(device_i2c, exp); + + while (1); //imposto GPIO di input e output device_i2c.i2c_write(&x, 0x42*2, 0x14, 1);