basic path finding with reversing comelete. large amout of cleaning
stuffs working