could probably do better propigating odometry, e.g. trapezoidal integration
Think about position uncertainty, perhaps get from parameters?
Think about velocity uncertainty