Fixed output. Made turning and stopping go to timed out states correctly. Fixed buffer size to 1 instead of 0 which solved old wall distance messages coming through at a later time.