Fix arm control mode, and make fitness angle function less permissive.