factory Transform.mul(Transform a, Transform b) { final c = Transform.zero(); c.q.setFrom(Rot.mul(a.q, b.q)); c.p.setFrom(Rot.mulVec2(a.q, b.p)); c.p.add(a.p); return c; }