Fix openrave traj parser