Development version of a new path tracking algorithm. Handle with care, there might be dragons