Rotation matrix around arbitrary vector implementation