Fixed ultrasonic sensor update task

Todo: still need to convert this one back into a regular FSM