Results 7 issues of Adrian

Possible bug in point-to-plane implementation but submitting to meet the deadline