I've put quite a lot more hours into it the last week, mainly on soft, I'm trying to get ZProbe to work in order to be able to calibrate it really easy : I'll modify my MATLAB script so that it takes Z errors with more impact and I'll feed in the difference between where I think Z=0 is and where Z=0 is really, this way I'll have something I (I think) that will converge really quickly to the real calibrated values (I'm guessing 3-4 runs will be enough).
Right now I can't do anything, the GUS is in transport, will be able to get back to it next week.