can now directly pipe into gnuplot
first implementation of RDT
RDT sure seems to work, now make it goal directed... later
debugged stepping during path growing
now it is planning. will need to work out a cooler scenario though