Added gravity/"local acceleration" compensation to flight controller