Removed unused winch loop.
Added fixes to get both ES2 and Atlas sensors working.