Continued work on the program. I will have to go back and change the planning section to match the algorithm that I have made with the python.