First successful IEEE experiment. Modified some mode logic and reduced position controller limits.