precompute some more infomation about scan direction and estimation zone in the SonarEstimation base class
added a method to compute the angle between two vertices
added a class for robust angle estimation of a wall in a given angular range

(untested)