PlayBack

Dependencies:   TPixy-Interface

Fork of ObjectFollower by ECE4333 - 2018 - Ahmed & Brandon

main.cpp

Committer:
asobhy
Date:
2018-04-10
Branch:
ManualControl
Revision:
29:83c103d12078
Parent:
19:4fbffc755ed7

File content as of revision 29:83c103d12078:

/******************************************************************************/
// ECE4333
// LAB Partner 1:   Ahmed Sobhy - ID: 3594449
// LAB Partner 2:   Brandon Kingman - ID: 3470444
// Project:         Autonomous Robot Design
// Instructor:      Prof. Chris Diduch
/******************************************************************************/

#include "mbed.h"
#include "WatchdogThread.h"
#include "PiControlThread.h"
#include "ExternalInterruptThread.h"
#include "ui.h"
#include "CameraThread.h"
#include "motor_driver_l.h"
#include "motor_driver_r.h"

/******************************************************************************/



/*******************************************************************************
*                       ******** Main Thread ********
*******************************************************************************/
int main()    // This thread executes first upon reset or power-on.
{
    
    // displays msg on terminal
    displayStartupMsg();

    // Initialize and run the threads below:
    WatchdogThreadInit();
    //CameraThreadInit();
    PiControlThreadInit();
    ExternalInterruptThreadInit();   

    while(1)
    {
        // if robot goes crazy press 'r' to kill it
        if(killRobot == true)
        {
            osThreadTerminate(PiControlId);
            motorDriver_L_stop();
            motorDriver_R_stop(); 
        }
        
        consoleUI(); 
        Thread::wait(20); // Go to sleep for 20 ms  
    }
}