FIXED walking angle function