Fix voor pathfinding
Merge branch 'master' of https://github.com/aapman55/WI3620TU-GROUP2