This is the first commit. Although this is the 2nd version of the program.
It has a "generalization" of motor commands that cause the end-effector to move in the same dirrection. However, this has to be thourougly tested.