Added R mode to avoid regenerating mesh unnecessarily.
Added point cache to avoid reprobing the same spot twice in a row.
Fixed relevel.py and re-added debug printing
Fixed firmware. It seems to bed-compensate in firmware correctly now (x,y,z) E not retested yet.