Added Veldpaus transformation calculation.
Also moved rotation matrix into c3d.util.transform.