1. Stanford Robotics Laboratory, Stanford University, Stanford, CA, USA and Information Engineering Department, University of Siena, Siena, Italy
2. Information Engineering Department, University of Siena, Siena, Italy,
3. Stanford Robotics Laboratory, Stanford University, Stanford, CA, USA