File content as of revision 24:f6aa0e64c5e1:

// Copyright (c) Microsoft. All rights reserved.
// Licensed under the MIT license. See LICENSE file in the project root for full license information.

#include "mbed.h"
#include "rtos.h"

#include <Terminal.h>
#include "ControllerIo.h"


using namespace std;

Terminal pc(USBTX, USBRX);

extern void PrepareController();
extern void RunController();
extern bool StartIothubThread();


int main()
{
    pc.baud(115200); 

    pc.cls();
    pc.foreground(Yellow);
    pc.background(Black);

    pc.locate(0, 0);
    pc.printf("**********************\r\n");
    pc.printf("RobotArmDemo start\r\n");
    pc.printf("**********************\r\n");

    pc.foreground(Teal);
    pc.background(Black);

    ShowLedGreen();
    
    // prepare the motion sequences
    PrepareController();
    
    // start IotHub connection
    StartIothubThread();
    
    // time delay is to allow the position encoders to come online after initial power supply event ~ 5 secs
    Thread::wait(5000);
    
    pc.printf("Initialization done. Ready to run. \r\n");

    // try running this thread at a higher priority
    osThreadId maintid = osThreadGetId();
    osThreadSetPriority(maintid, osPriorityHigh);
    
    RunController(); 
}