Rotational matrix transformation - C#