File content as of revision 69:1fdcef6a7577:

#include "StartUp.h"

bool stb = false;
bool stb2 = false;
bool stb3 = false;

int idel()
{

    if(get_user() == false && stb) {
        return 15; // button pressed
    } else {
        stb = true;
        return 10;
    }
}

int idel2()
{

    if(get_user() == false && stb2) {
        return 52; // button pressed, 52 for grab test loop
    } else {
        stb2 = true;
        wait_ms(100);
        return 11;
    }
}


int initialisation()
{
    Robot_init_all();
    return 16;
}


int inital_positioning()
{
    printf("positioning...\r\n");
    return 11;
}


int initial_turn()
{
    
    if(stb3 == false) {
        stb3 = true;
        printf("initial turn...\r\n");
        turn_for_deg(180);
    } else {
        printf("turning...\r\n");
        if(1) { // check if turning complete
            printf("turn finished...\r\n");
            return 35;
        }
    }
    return 27;
}