The header is very expensive and is often used in cases where a simple for loop does the exact same thing..

This reduces the amount of headers that are necessary for different use cases

- add setWaypointAx to access the controller from python

- newTarget was not commited to write buffer

- newTarget was not commited to write buffer in
NJointHolonomicPlatformGlobalPositionController

Tested: from orientation -1.3 to 1.5

This reverts commit d40807b1.

This reverts commit 9fe8ba41.

independent updates of the Config (i.e updating the config and the
waypoints seperately) would result in lost data and lead to unwanted
behavior