Cleaned up code by breaking methods up into different subroutines. Also got both motors to move forward and able to control the speed based off the duty cycle.