File content as of revision 11:f07662c64e26:

#include "mbed.h"

Serial blue(PTC4,PTC3);

//motor select pins
DigitalOut motor_lf(PTE2);
DigitalOut motor_lb(PTE3);
DigitalOut motor_rf(PTE4);
DigitalOut motor_rb(PTE5);


DigitalIn input(PTC1);  //input from sensor array
DigitalOut Line_right(LED_GREEN);//no line detected
//DigitalOut blue(LED_BLUE);

BusOut sensor(PTD7,PTE1,PTE0);//multiplex sensors
AnalogOut level(PTE30);//set comparator level needs to be tuned for each sensor (could create program)


//Frequency of Pulse Width Modulated signal in Hz
#define PWM_FREQ          1000

//PWM pin (Enable 1 and 2)
PwmOut motor_l (PTC2);
PwmOut motor_r (PTE29);

//LED to test
DigitalOut led(LED_RED);

void sensor_select(int x)//converts int to hex for display
{
    switch(x) {
        case 0:
            sensor = 0x2;
            break;
        case 1:
            sensor = 0x1;
            break;
        case 2:
            sensor = 0x0;
            break;
        case 3:
            sensor = 0x3;
            break;
        case 4:
            sensor = 0x5;
            break;
        case 5:
            sensor = 0x7;
            break;
        case 6:
            sensor = 0x6;
            break;
        case 7:
            sensor = 0x4;
            break;
    }

}
int sensor_read()
{
    int val=0;
    int x = 0;

    //static int values[8];
    for(x = 0; x <= 3; x++ ) { //why 3? Don't you want to select through 8 sensors therefore x<=7?
        sensor_select(x);
        //blue = !blue;
        wait(0.1);
        blue.printf("X is %i,   ", x);

        if (input == 1) {
            val=val+2^x; //could you comment on what this is for?
        } else {
            val=val;//+2^x;
        }
    }
    blue.printf("\nVAL : %i\n",val);
    return val;
}


void set_direction( int direction, float duty_l, float duty_r)
{
    switch( direction ) {
        case 0x11: { //forward
            motor_r.write( duty_r);
            //Look up ternary statements -- {condition ? value_if_true : value_if_false} This makes 0<result<1
            motor_l.write( duty_l);

            motor_rf=1;
            motor_rb=0;
            motor_lf=1;
            motor_lb=0;
            blue.printf("Going forward, right:%f ; left:%f\n", duty_r, duty_l);
            break;
        }
        case 0x00: { //backward
            motor_r.write( duty_r);
            motor_l.write( duty_l);

            motor_rf=0;
            motor_rb=1;
            motor_lf=0;
            motor_lb=1;
            blue.printf("Going backward, right:%f ; left:%f\n", duty_r, duty_l);
            break;
        }
        case 0x01: {  //spin left  --     Right forward, left backward
            motor_r.write( duty_r);
            motor_l.write( duty_l);

            motor_rf=1;
            motor_rb=0;
            motor_lf=0;
            motor_lb=1;
            blue.printf("Spinning Left, right:%f ; left:%f\n", duty_r, duty_l);
            break;
        }
        case 0x10: {    //spin right
            motor_r.write( duty_r);
            motor_l.write( duty_l);

            motor_rf=0;
            motor_rb=1;
            motor_lf=1;
            motor_lb=0;
            blue.printf("Spinning Right, right:%f ; left:%f\n", duty_r, duty_l);
            break;
        }
    }
}

void change_direction( int sensor_values) //right hand sensors only
{
    //Line_right = !Line_right;
    switch( sensor_values ) {
        case 0x00: { //no lines robot is lost!!!!
            blue.printf("no lines robot is lost!!!!\n");
            set_direction(0x00, 1.0, 1.0);
            wait(1);
            break;
        }
        case 0x01: { //to far left turn right 0001
            blue.printf("0001\n");
            set_direction(0x11, 0.0, 1.0); //this doesn't turn right; this goes straight at half speed
            wait(1);
            Line_right = !Line_right;
            break;
        }
        case 0x02: {  //left turn right       0010
            blue.printf("0010\n");
            set_direction(0x11, 0, 0.5);
            wait(1);
            break;
        }
        case 0x03: {  //far left turn right   0011
            blue.printf("0011\n");
            set_direction(0x11, 0.0, 0.0);
            wait(1);
            break;
        }
        case 0x4: {    //right turn left      0100
            blue.printf("0100\n");
            set_direction(0x11, 0.5, 0.0);
            wait(1);
            break;
        }
        case 0x5: {    //unknown **           0101
            set_direction(0x11, 0.0, 0.0);
            break;
        }
        case 0x6: {    //perfect              0110
            blue.printf("perfect, 0110\n");
            set_direction(0x00, 1.0, 1.0);
            wait(1);
            break;
        }
        case 0x7: {//corner junction or plate 0111
            blue.printf("0111\n");
            set_direction(0x00, 0.0, 0.0);
            wait(1);
            break;
        }
        case 0x8: {//to far right turn left   1000
            blue.printf("1000\n");
            set_direction(0x11, 1.0, 0.0);
            wait(1);
            break;
        }
        case 0x9: {    //unknown              1001
            set_direction(0x11, 0.0, 0.0);
            wait(1);
            break;
        }
        case 0xA: {    //unknown              1010
            set_direction(0x11, 0.0, 0.0);
            break;
        }
        case 0xB: {    //unknown              1011
            set_direction(0x11, 0.0, 0.0);
            wait(1);
            break;
        }
        case 0xC: { //far right turn left     1100
            blue.printf("1100\n");
            set_direction(0x00, 0.0, 0.0);
            wait(1);
            break;
        }
        case 0xD: {    //unknown              1101
            set_direction(0x11, 0.0, 0.0);
            break;
        }
        case 0xE: {    //corner or plate      1110
            blue.printf("1110\n");
            set_direction(0x00, 0.0, 0.0);
            wait(1);
            break;
        }
        case 0xF: {    //corner               1111
            blue.printf("1111\n");
            set_direction(0x11, 0.0, 0.0);
            wait(1);
            break;
        }
    }
}
int main()
{
    level = 0.3; //Analogout Level for black line into comparator
//Set PWM frequency to 1000Hz
    motor_l.period( 1.0f / (float) PWM_FREQ);
    motor_r.period( 1.0f / (float) PWM_FREQ);
//Initialise direction to nothing.
    motor_rf=0;
    motor_rb=0;
    motor_lf=0;
    motor_lb=0;

    while(1) {
        //Working
        /*
                led = !led;
                wait(4);
                blue.printf("Forward, full\n");
                set_direction(0x11, 1.0,1.0);//forward full speed
                wait(4);
                blue.printf("Forward, left half\n");
                led = !led;
                set_direction(0x11, 0.5 ,0); //forward left half
                wait(4);
                blue.printf("Forward, right half\n");
                led = !led;
                set_direction(0x11, 0 ,0.5); //forward right half
                wait(4);
                led = !led;
                blue.printf("stop\n");
                set_direction(0x00, 0 ,0); //stop
                wait(4);
                led = !led;
                blue.printf("Back, full\n");
                set_direction(0x00, 1.0 ,1.0); //backward full speed
                wait(4);
                led = !led;
                blue.printf("Back, left\n");
                set_direction(0x00, 0.5 ,0);
                wait(4);
                blue.printf("Back, right\n");
                led = !led;
                set_direction(0x00, 0 ,0.5);

        */

        //Sensor Code + Motor Test
        int values = 0;
        values = sensor_read();
        change_direction(values);

    }
}