Added i1 = i3 test, need to finish i1 = i4 and i2 = i4. Then ensuring correct
movement.