Refactored object avoidance routine with state machine.
Fixed encoder CAN message (removed old Eurobot servo test messages).