Combined signals to motor 3 and 4
Combined signals to motor 5 and 6
Took out some comments
Made variables easier to read i.e.: M1_1= M1_F or M3_2 = M3_D