Path following bugfixes