Changed changed displayMatrix to take in Matrix33d object, rather than pointer