Add MotionModel class for storing and calculating probabilities under
the motion model.
Change the structure of the train method to use this.
//TODO implement the training code