Add Standup from Crouching

Remove naive logic for standing up and add real get up from crouch
logic.