Combine BHM with floor field
To use the BHM (behavior heuristics model) in scenarios, it is necessary to couple it with the floor fields. At the moment, only the Euclidean distance to the target is used. As a consequence, intermediate targets are necessary which sometimes cause side effects.