Changes traj_goal to quadrotor_msgs::PositionCommand type
Running Vicon at 150 fps and remove safety catch