pathplanning now works

doesn't get stuck when either xDistanceLeft or yDistanceLeft are zero.
Also cosmetically not very appealing. sry :(