Lift function

Added a lift function for autonomous. And edited trim value.