Several fixes to make the copter be stabilized.