Raj Patel / Mbed 2 deprecated RoboticMappingControl

Dependencies:   mbed mbed-rtos Motor LSM9DS1_Library_cal X_NUCLEO_53L0A1

main.cpp

Committer:
rpatelpj
Date:
2019-04-23
Revision:
11:531208aca075
Parent:
8:bfa4bf23522c
Child:
12:946f56f78d2b

File content as of revision 11:531208aca075:

#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, p9, p10);

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