Add implementation of C4_28_ResetMatrix