Added methods for zeroing a Matrix3d and setting a Matrix3d to identity.