Added Winch

Added winch commands and subsystem.