Added DoubleMotor
Added Code for DoubleMotor...PID for Winch almost set up