changed param name to n_robots in state_estimator
added command line arg to low_level to choose waypoint or velocity, updated launchfile
added error handling in estimator for message size not matching numRobots
Correct ordered output of measurements in pose array implemented.
Added state estimator to loop (and launch file)
fixed math error in estimator, added debug messages
Vision Tracker Hungarian algorithm implemented to ID robots
added check to make sure robot was tracked in message to estimator
Updated beluga driver for ruggedcircuits motor driver
Merge branch 'master' of https://github.com/leonard-lab/dcslROS
added gtest for miabot state propagation in estimator
Merge branch 'master' of https://github.com/leonard-lab/dcslROS
fixed typos in estimator math
added another (successful) test for estimator
Implemented joystick control for beluga robot
Fixed Hungarian method error when zero robots detected with tracker
Increased accuracy of orientation measurement by using minarearect2 (box) function
Changed remapping of topic from swarm director node to miabotA node
Updated Kalman filter weights for state estimator
Adding estimator testing launch file