Changed the name of the TServoInfo structure to TServoData to avoid conflicts in the gazebo CM510 simulator.
Problems when the motion file does not exists or is invaid. It needs to be checked before calling the parser function.