求两直线的交点

Point2d  pointOfIntersection(Point2d l1, Point2d l11,Point2d l2, Point2d l22)
{
Point2d lastP;
double k1,k2,b1,b2;


//两条非垂直线
if(l1.x-l11.x!=0 && l2.x-l22.x!=0)
{
b1=(l1.y*l11.x-l11.y*l1.x)/(l11.x-l1.x);
b2=(l2.y*l22.x-l22.y*l2.x)/(l22.x-l2.x);
k1=(l1.y-l11.y)/(l1.x-l11.x);
k2=(l2.y-l22.y)/(l2.x-l22.x);
if(k1-k2 != 0) {
lastP.x=(b2-b1)/(k1-k2);
lastP.y=(k1*b2-k2*b1)/(k1-k2);
}
else {
lastP.x=-1;
lastP.y=-1;
}
}


//两条垂直线
if(l1.x-l11.x==0 && l2.x-l22.x==0)
{
lastP.x=-1;
lastP.y=-1;
}


//一条垂直线
if(l1.x-l11.x==0 && l2.x-l22.x!=0)
{
b2=(l2.y*l22.x-l22.y*l2.x)/(l22.x-l2.x);
k2=(l2.y-l22.y)/(l2.x-l22.x);
lastP.x=l1.x;
lastP.y=k2*l1.x+b2;
}


//一条垂直线
if(l1.x-l11.x!=0 && l2.x-l22.x==0)
{
b1=(l1.y*l11.x-l11.y*l1.x)/(l11.x-l1.x);
k1=(l1.y-l11.y)/(l1.x-l11.x);
lastP.x=l2.x;
lastP.y=k1*l2.x+b1;
}


return lastP;
}