File content as of revision 4:208f5279143a:

#define PI 3.141

#include "math.h"
#include "mbed.h"
#include "Encoder.h"
#include "lineSensor.h"
#include "P.h"
#include "PID.h"
#include "LWheel.h"
#include "RWheel.h"
#include "Robot.h"


//blue D8
//Green D9
//Red D5
int i = 0;
int main() {
    Serial pc(USBTX, USBRX);
    
    DigitalOut enable(PA_13);
    enable.write(1);
    
    Encoder* RE = new Encoder(PB_3,PB_5);
    Encoder* LE = new Encoder(PB_10,PB_4);
    LWheel* leftWheel = new LWheel(LE,PC_8,PA_9, PA_14);
    RWheel* rightWheel = new RWheel(RE,PC_6,PA_8, PB_6);
    
    //an array of lineSensor pointers params: lineSensor(PinName emitter Pin, PinName reciever Pin, make sure it is from LEFT TO RIGHT
    lineSensor* sensorArray[6] = {new lineSensor(PB_9,A0),new lineSensor(PC_11,A1),new lineSensor(PD_2,A2),new lineSensor(PC_10,A3),new lineSensor(PB_8,A4),new lineSensor(PC_12,A5)};

    leftWheel->init(0);
    
    while(leftWheel->returnAngularVelocity()!= 0)
    {
     pc.printf("Stage 1, speed %f\r\n",leftWheel->returnAngularVelocity());
    }

    rightWheel->init(1);
    while(rightWheel->returnAngularVelocity() != 0)
    {
     pc.printf("Stage 2, speed %f\r\n",rightWheel->returnAngularVelocity()); 
    }
    pc.printf("L , speed%f\r\n",leftWheel->returnMaxAngularVel());
    pc.printf("R , speedM %f\r\n",rightWheel->returnMaxAngularVel());
    //Robot rbt(leftWheel, rightWheel, sensorArray);
    leftWheel->adjustAngularVelocity(40.0f);
    rightWheel->adjustAngularVelocity(-64.0f);
    while(1)
    {
    pc.printf("L , speed%f\r\n",leftWheel->returnAngularVelocity());
    pc.printf("R , speedM %f\r\n",rightWheel->returnAngularVelocity());
    }
    
}
//lineSensor* sensorArray[6] = {new lineSensor(D11,A0),new lineSensor(D7,A1),new lineSensor(D6,A2),new lineSensor(D5,A3),new lineSensor(D4,A4),new lineSensor(D3,A5)};