public static Matrix3D BodyToWorldMatrix(Body body, Point3D position, Vector3D direction) { Matrix3D result = Math3D.CreateZDirectionMatrix(position, direction); result.Append(body.Transform.Value); return(result); }