Python Motion Planning Tool