added covariance publishers

-added DaoubleMatrixStamped message
-publishers for core state covariance, aux state covariance, and core-aux cross-cov
-extended state definition and counters for core error state counting