Created a program to control the winch