Added comments, and dimensions test.

Added comments to top of KalmanFilter documenting the attributes
of the class. Also added a dimensionality test method that tries to
ensure that the size of all the matrices are correct.