File content as of revision 8:ce5b1bf38077:

#ifndef Movement_H
#define Movement_H

#include "Sensors.h"
#include "Motors.h"



void moveNORTH()
{
    switch(orientation)
    {
        case NORTH:
            // go forward...
            break;
        case WEST:
            // turn right then forward
            break;            
        case SOUTH:
            // turn around then forward
            break;            
        case EAST:
            // turn left then forward
            break;            
    }
    orientation = NORTH;
}
void moveSOUTH()
{
    switch(orientation)
    {
        case NORTH:
            // turn around then forward...
            break;
        case WEST:
            // turn left then forward
            break;            
        case SOUTH:
            // go forward
            break;            
        case EAST:
            // turn right then forward
            break;            
    }
    orientation = SOUTH;
}
void moveEAST()
{
    switch(orientation)
    {
        case NORTH:
            // turn right then forward...
            break;
        case WEST:
            // turn around then foward
            break;            
        case SOUTH:
            // turn left then forward
            break;            
        case EAST:
            // go forward
            break;            
    }
    orientation = EAST;
}
void moveWEST()
{
    switch(orientation)
    {
        case NORTH:
            // turn left then forward...
            break;
        case WEST:
            // go forward
            break;            
        case SOUTH:
            // turn left then forward
            break;            
        case EAST:
            // turn around then forward
            break;            
    }
    orientation = WEST;
}

//////////////////////////////////////////////////////////////////////

void Move()
{
    
    switch(flood_findPath(Xpos, Ypos))
    {
        case M_NORTH:
            moveNORTH();
            break;
     
        case M_SOUTH:
            moveSOUTH();
            break;
     
        case M_WEST:
            moveWEST();
            break;
        
        case M_EAST:
            moveEAST();
            break;             
        
    } 
}


#endif