path planning + path tracking in Python