tuned filter weights and loop rate
fixed indexing error for waypoint input
added launchfile to test without estimator
reorganized high_level package, added test_state_input matlab file
Merge branch 'master' of https://github.com/leonard-lab/dcslROS