Robotique FIP / Mbed 2 deprecated Coupe-Robotique-FIP-Main

ajout de l'imu pour nucleo

Dependencies:   mbed HC_SR04_Ultrasonic_Library IMU_FIP_nucleo Nucleo_Sensor_Shield VL6180x_lib

main.cpp

Committer:
quentin9696
Date:
2015-09-27
Revision:
16:c2d0a4af388b
Parent:
14:4f85e35de719

File content as of revision 16:c2d0a4af388b:

#include "mbed.h"
#include "ultrasonic.h"
#include "VL6180x.h"
#include "easyspin.h"

#define VL6180X_ADDRESS 0x29

Easyspin myEasyspin;
DigitalInOut sdaDummy(D14);
DigitalInOut sclDummy(D15);

VL6180xIdentification identification;
// mbed uses 8bit addresses shift address by 1 bit left
VL6180x sensor(D14, D15, VL6180X_ADDRESS<<1);

int main()
{
    sdaDummy.mode(PullUp);
    sclDummy.mode(PullUp);
    myEasyspin.Begin(2);
    while(1) {
        if(sensor.getDistance()<255) {
            myEasyspin.Run(0, FORWARD);
            myEasyspin.Run(1, FORWARD);
        } else {
            myEasyspin.Run(0, FORWARD);
            myEasyspin.Run(1, BACKWARD);
        }
        wait_ms(200);
    }
}