Joo Henriques, Institute of Systems and Robotics - University of Coimbra; Rui Caseiro*, Institute of Systems and Robotics - University of Coimbra; Joao Carreira, University of Coimbra; Jorge Batista, ISR