Embedded Motion Control 2013 Group 7/Recap4

PICO is able to move straight in a corridor without hitting the walls during the simulation. Though, a more precise algorithm that returns the angle for the orientation computation is being developed. A simple exit detection algorithm is being developed as well and has to be tested in the next few days. Every different task is fulfilled by a different routine. After the corridor competition we will use a more modular approach.