我有找到比较两个轨迹(曲线)的方法的问题。 第一个原始包含点(x,y)。 第二个可以是偏移,更小或更大的比例,也可以是旋转 - 也可以是带点(x,y)的数组
我做的第一个方法是找到两点之间的最小距离,并在每次迭代中重复这个过程,它的总和除以点数 - 然后我的结果告诉我值每点的平均误差: http://www.mathopenref.com/coorddist.html
我也找到了这个方法: https://help.scilab.org/docs/6.0.0/en_US/fminsearch.html
但我无法弄清楚如何使用它。 我想比较两个轨迹但我的结果必须包括旋转,或者至少是开始的偏移。
我当前的结果是每点计算误差(距离)
如果我们与原始轨迹进行比较,我的结果描述了每个点的平均误差(距离)。
但是如果轨迹被旋转,缩放或移位,我无法想象如何处理。
请查看我的示例轨迹:
答案 0 :(得分:3)
所以你需要比较旋转,平移和比例不变的2条曲线的形状。
<强>解决方案强>
假设2个sinwaves进行测试。旋转和缩放都具有相同的纵横比,并且具有增加的噪声。我用这样的C ++生成它们:
struct _pnt2D
{
double x,y;
// inline
_pnt2D() {}
_pnt2D(_pnt2D& a) { *this=a; }
~_pnt2D() {}
_pnt2D* operator = (const _pnt2D *a) { *this=*a; return this; }
//_pnt2D* operator = (const _pnt2D &a) { ...copy... return this; }
};
List<_pnt2D> curve0,curve1; // curves points
_pnt2D p0,u0,v0,p1,u1,v1; // curves OBBs
const double deg=M_PI/180.0;
const double rad=180.0/M_PI;
void rotate2D(double alfa,double x0,double y0,double &x,double &y)
{
double a=x-x0,b=y-y0,c,s;
c=cos(alfa);
s=sin(alfa);
x=x0+a*c-b*s;
y=y0+a*s+b*c;
}
// this code is the init stuff:
int i;
double x,y,a;
_pnt2D p,*pp;
Randomize();
for (x=0;x<2.0*M_PI;x+=0.01)
{
y=sin(x);
p.x= 50.0+(100.0*x);
p.y=180.0-( 50.0*y);
rotate2D(+15.0*deg,200,180,p.x,p.y);
curve0.add(p);
p.x=150.0+( 50.0*x);
p.y=200.0-( 25.0*y)+5.0*Random();
rotate2D(-25.0*deg,250,100,p.x,p.y);
curve1.add(p);
}
面向OBB的边界框
计算OBB,它将找到两条曲线的旋转角度和位置,以便旋转其中一条曲线,使它们从相同的位置开始,并具有相同的方向。
如果OBB尺寸太大,则曲线不同。
对于上面的例子,它可以得出这个结果:
每个OBB由起点P
和基础向量U,V
定义,其中|U|>=|V|
和U x V
的z坐标为正。这将确保所有OBB的绕组相同。可以在OBBox_compute
中将其添加到结尾:
// |U|>=|V|
if ((u.x*u.x)+(u.y*u.y)<(v.x*v.x)+(v.y*v.y)) { _pnt2D p; p=u; u=v; v=p; }
// (U x V).z > 0
if ((u.x*v.y)-(u.y*v.x)<0.0)
{
p0.x+=v.x;
p0.y+=v.y;
v.x=-v.x;
v.y=-v.y;
}
因此curve0
有p0,u0,v0
而curve1
有p1,u1,v1
。
现在我们要重新缩放,翻译和轮播curve1
以匹配curve0
可以这样做:
// compute OBB
OBBox_compute(p0,u0,v0,curve0.dat,curve0.num);
OBBox_compute(p1,u1,v1,curve1.dat,curve1.num);
// difference angle = - acos((U0.U1)/(|U0|.|U1|))
a=-acos(((u0.x*u1.x)+(u0.y*u1.y))/(sqrt((u0.x*u0.x)+(u0.y*u0.y))*sqrt((u1.x*u1.x)+(u1.y*u1.y))));
// rotate curve1
for (pp=curve1.dat,i=0;i<curve1.num;i++,pp++)
rotate2D(a,p1.x,p1.y,pp->x,pp->y);
// rotate OBB1
rotate2D(a,0.0,0.0,u1.x,u1.y);
rotate2D(a,0.0,0.0,v1.x,v1.y);
// translation difference = P0-P1
x=p0.x-p1.x;
y=p0.y-p1.y;
// translate curve1
for (pp=curve1.dat,i=0;i<curve1.num;i++,pp++)
{
pp->x+=x;
pp->y+=y;
}
// translate OBB1
p1.x+=x;
p1.y+=y;
// scale difference = |P0|/|P1|
x=sqrt((u0.x*u0.x)+(u0.y*u0.y))/sqrt((u1.x*u1.x)+(u1.y*u1.y));
// scale curve1
for (pp=curve1.dat,i=0;i<curve1.num;i++,pp++)
{
pp->x=((pp->x-p0.x)*x)+p0.x;
pp->y=((pp->y-p0.y)*x)+p0.y;
}
// scale OBB1
u1.x*=x;
u1.y*=x;
v1.x*=x;
v1.y*=x;
您可以使用Understanding 4x4 homogenous transform matrices一步完成所有这些操作。结果如下:
<强>取样强>
如果曲线之间或其任何部分之间的点密度不均匀或非常不同,则应重新对曲线进行采样以获得公共点密度。您可以使用线性或多项式插值。您也不需要将新采样存储在内存中,而是可以构建函数,该函数返回从开始以弧长度参数化的每条曲线的点。
point curve0(double distance);
point curve1(double distance);
<强>比较强>
现在你可以减去2条曲线并总结差异的绝对值。然后将其除以曲线长度和阈值结果。
for (double sum=0.0,l=0.0;d<=bigger_curve_length;l+=step)
sum+=fabs(curve0(l)-curve1(l));
sum/=bigger_curve_length;
if (sum>threshold) curves are different
else curves match
你应该尝试使用+ 180度旋转,因为与 OBB 的方向差异只有真实范围的一半。
这里几个相关的QAs: