Python Motion Planning