Add unit test 9
Add unit test 10, code refactorisation
Begin compute mean ground plan
Least squares unit test