fix for diagonal follow path #664