Create normalization method for rotation matrix #17
Description
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.