Reverted senseAvoidSmooth to previous version

Done due to fact that servos did not move well when continuously being reattached.