Started a program to solve the calibration of world coord to robot coords.