Change the thrust setpoint, add integrator on thrust velocity
Change the thrust setpoint, add integrator on thrust velocity

gburri/MAVRIC_Library,lis-epfl/MAVRIC_Library,gburri/MAVRIC_Library,lis-epfl/MAVRIC_Library,gburri/MAVRIC_Library,lis-epfl/MAVRIC_Library