This repo is my Engineering thesis. This project was developed in the Group of Robots and Intelligent Machines from the Universidad Politécnica de Madrid. . This group is part of the Centre for Automation and Robotics (CAR UPM-CSIC).