Theta detection seems to be close, XY is off
Error detection almost done, there seems to be a slite skew
updated test.prg to home the panel after a few runs