updated dual motor control code to hopefully work (not tested), and removed unused variable in motor control code