Optimierung Wegfindealgo

Change-Id: I2db7eb181aafb3b75ce42579184e65ae3cc1509b
Signed-off-by: Raffael+Sebastian <user1@text.org>