Working on WayPoint movement. Fixed transform issue for WPs: TODO: for robot and projection.
Navigation works WayPoint based. Distance measure should evtl. be included. NEXT: GameCFGParser
Added files again. Navigation is now WayPoint based.