added sonar structure servoing task