Raj Patel / Mbed 2 deprecated RoboticMappingControl

Dependencies:   mbed mbed-rtos Motor LSM9DS1_Library_cal X_NUCLEO_53L0A1

main.cpp

Committer:
abh15
Date:
2019-04-15
Revision:
6:c119cc5d48d6
Parent:
5:77c6821ae418
Child:
8:bfa4bf23522c

File content as of revision 6:c119cc5d48d6:

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

Serial pc(USBTX, USBRX);
DigitalIn pb(p26);

int main() {
    pb.mode(PullUp);
    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);
    }
}