planner works
ready to try on robot
need to solve lag issue. also, can only send commands with groovy, so move taubin to separate node. and create launch files for everything