should now compile without octomap stuff, user now controls the uav with respect to the body frame, also have a maximum velocity to avoid huge jumps, integration depends on a the timestep instead of the ros rate
should now compile without octomap stuff, user now controls the uav with respect to the body frame, also have a maximum velocity to avoid huge jumps, integration depends on a the timestep instead of the ros rate