using ground truth and cmd_vel directly