Still kinda ugly, but at least basic path following is now working.