Activate sonar, allow for named joints in controller