Consistency check for the quaternionEKF module

[jeljaik]

The module as of today is fully written and should be "functional". This doesn't mean that the estimate is correct. This issue has been created simply to analyze in an organized way the filtering process in this module. Up next, the different stages by which it is composed

• Correct initialization
• All the filter parameters are passed and set correctly to their initial values in the corresponding configuration file.
• Initial gaussian system noise uncertainty (mean and covariance) makes sense.
• Initial gaussian measurement noise uncertainty (mean and covariance) makes sense.
• Priors make sense (mu and covariance)
• Online Estimation
• Convert read angular velocity to rad/s
• nonLinearAnalyticConditionalGaussian::ExpectedValueGet() should return the state prior prediction.
• nonLinearAnalyticConditionalGaussian::dfGet() should return the transition matrix.
• nonLinearMeasurementGaussianPdf::ExpectedValueGet()` should return the acceleration model output.
• nonLinearMeasurementGaussianPdf::dfGet() should return the jacobian evaluated at the current estimate.