Create normalization method for rotation matrix

[ikrukov]

Rotation matrix in KnotWrapper due to accumulated error may cease to be orthogonal. It's necessary to develop normalization method for matrix orthogonalization and use it after each matrix change.