This is a simple implementation of a Path Follower algorithm. The onlyaddition I made is about reducing speed when turning.
Please read the disclaimer