Bugfix: nearestPoint muss zwischengespeichert werden, ansonsten koennte es bei den ersten beiden Messungen unterschiedliche nearestPoints geben, was zu falschen Einstellungen bei der Richtung fuehrt.