public static void mulToOut(Transform A, Transform B, Transform out_) { Rot.mul(A.q, B.q, out_.q); Rot.mulToOut(A.q, B.p, out_.p); out_.p.addLocal(A.p); }