Raj Patel / Mbed 2 deprecated RoboticMappingControl

Dependencies:   mbed mbed-rtos Motor LSM9DS1_Library_cal X_NUCLEO_53L0A1

main.cpp

Committer:
rpatelpj
Date:
2019-04-22
Revision:
8:bfa4bf23522c
Parent:
6:c119cc5d48d6
Child:
9:552805fac195
Child:
11:531208aca075

File content as of revision 8:bfa4bf23522c:

#include "globals.h"
#include "DataDistributor.h"
#include "RobotController.h"

Serial pc(USBTX, USBRX);
BusOut led(LED1, LED2, LED3, LED4);
DigitalIn pb(p23);

float* obstacles = new float[360];
int trajectoryLength = 0;
float* trajectory = new float[0];

int main() {
    delete []trajectory;
    DataDistributor dataDistributor;
    RobotController robotController(p21, p15, p16, p22, p18, p19, p13, p14);

    while(1) {
        robotController.detectObstacles();
        dataDistributor.transmitObstacles();
        dataDistributor.receiveTrajectory();
        robotController.followTrajectory();
    }
}