RoboHAZMAT/MotionControl — pull request #5 by gbledt (2014-11-24 20:41:59+00:00)
Title: Update motion model with position instead of speed

Use time difference to update motion model instead of propagating forward 1 second. Makes output estimates more smooth.