TPoint2D mrpt::poses::operator +(const CPose2D &pose, const TPoint2D &u) { const double ccos = pose.phi_cos(); const double ssin = pose.phi_sin(); return TPoint2D( pose.x() + u.x * ccos - u.y * ssin, pose.y() + u.x * ssin + u.y * ccos ); }