First step of pathfinding (almost)complete

First step of pathfinding where a forward move, CW rotation and CCW
rotation are added to the pathing list, and some debug gizmos are drawn.
Rotation cost isn't properly calculated, will do tomorrow, must study
for exam.