line2curve.m

车道检测中弯道的检测

function st=Line2Curve(a,b)
%连接直线和曲线,a在上面,b在下面
temp23 = a.low.x-b.x;
temp31 = b.x-a.top.x;
temp12 = a.top.x-a.low.x;
a.fn(1) = (a.top.y*temp23+a.low.y*temp31+b.y*temp12)/(a.top.x*a.top.x*temp23+a.low.x*a.low.x*temp31+b.x*b.x*temp12);
a.fn(2) = (a.top.y-a.low.y-a.fn(1)*(a.top.x*a.top.x-a.low.x*a.low.x))/(a.top.x-a.low.x);
a.fn(3) = a.top.y-a.fn(1)*a.top.x*a.top.x-a.fn(2)*a.top.x;
a.low = b;
a.length = (a.top.y-b.y)*(a.top.y-b.y)+(a.top.x-b.x)*(a.top.x-b.x);
st=a;