My design of Extended Kalman filter is for a Heavy vehicle dynamics wherein I need to estimate grade and mass using the filter and velocity sensor only with Torque as the control input. I have completed the coding but need to tune the covariance matrices P,Q & R for error,process and measurement covariance.