Raj Patel / Mbed 2 deprecated RoboticMappingControl

Dependencies:   mbed mbed-rtos Motor LSM9DS1_Library_cal X_NUCLEO_53L0A1

main.cpp

Committer:
rpatelpj
Date:
2019-04-14
Revision:
5:77c6821ae418
Parent:
3:1dce1ba5b8bd
Child:
6:c119cc5d48d6

File content as of revision 5:77c6821ae418:

#include "mbed.h"
#include "DataDistributor.h"
#include "RobotController.h"

extern Serial pc(USBTX, USBRX);

int main() {
    DataDistributor dataDistributor;
    RobotController robotController(p21, p15, p16, p22, p18, p19, p17, p20);

    while(1) {
        float* obstacles = robotController.obstacleDetection();
        dataDistributor.sendObstacles(obstacles);
        float* trajectory = dataDistributor.receiveTrajectory();
        robotController.followTrajectory(trajectory);
        robotController.toOrigin(trajectory);
    }
}