added lots of test/simulator nodes
initial driver node (not finished)
sensor_helper package with helper python packages for managing/dealing with sensor data
messages for plan and plan steps