File content as of revision 80:92b9d083322d:

#include "StartUp.h"

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

int idle()
{

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

int idle2()
{

    if(get_user() == false && stb2) {
        return 25; 
    } else {
        stb2 = true;
        wait_ms(100);
        return 11;
    }
}


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


int inital_arm_positioning(){
    open_grabber();
    arm_position_release();
    return 17;
    }


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 28;
}