[英]How to calculate ray-line segment intersection preferably in OpenCV? And get its intersection points and distance from origin?
I have 4 lines segment, A, B, C and D. Each line is represented as two points. 我有4条线段,A,B,C和D。每条线表示为两个点。 Eg.
例如。 line A is represented as point A1 and point A2.
线A表示为点A1和点A2。
What I want is 我想要的是
When testing for intersection, line A ray should not 测试相交时,线A射线不应
How do I do this? 我该怎么做呢?
Finally got it working on OpenCV C++. 终于让它可以在OpenCV C ++上运行。 Based on this https://stackoverflow.com/a/32146853/457030 .
基于此https://stackoverflow.com/a/32146853/457030 。
// return the distance of ray origin to intersection point
double GetRayToLineSegmentIntersection(Point2f rayOrigin, Point2f rayDirection, Point2f point1, Point2f point2)
{
Point2f v1 = rayOrigin - point1;
Point2f v2 = point2 - point1;
Point2f v3 = Point2f(-rayDirection.y, rayDirection.x);
float dot = v2.dot(v3);
if (abs(dot) < 0.000001)
return -1.0f;
float t1 = v2.cross(v1) / dot;
float t2 = v1.dot(v3) / dot;
if (t1 >= 0.0 && (t2 >= 0.0 && t2 <= 1.0))
return t1;
return -1.0f;
}
// use this to normalize rayDirection
Point2f NormalizeVector(Point2f pt)
{
float length = sqrt(pt.x*pt.x + pt.y*pt.y);
pt = pt / length;
return pt;
}
// gets the intersection point
Point2f GetRayIntersectionPoint(Point2f origin, Point2f vector, double distance)
{
Point2f pt;
pt.x = origin.x + vector.x * distance;
pt.y = origin.y + vector.y * distance;
return pt;
}
Should be self explanatory. 应该自我解释。
声明:本站的技术帖子网页,遵循CC BY-SA 4.0协议,如果您需要转载,请注明本站网址或者原文地址。任何问题请咨询:yoyou2525@163.com.