Half writen code for fitting plane to point meas; compiles and run, but erroneous
DO NOT USE YET