added CPose2D::distance2DFrobeniusTo(CPose & p)