Added winch timeout.
Modified stuff to make it work better.