Added computeCovarianceMatrix

Signed-off-by: Nicholas Kamper <kampernj@rose-hulman.edu>