|
@@ -57,6 +57,7 @@ func polygonLineIntersect(polygon []pjisuv_msgs.Point64, A, B pjisuv_msgs.Point6
|
|
|
return true
|
|
|
}
|
|
|
}
|
|
|
+
|
|
|
return false
|
|
|
}
|
|
|
|
|
@@ -73,7 +74,7 @@ func Rule(data *pjisuv_msgs.PolygonStamped, param *pjisuv_param.PjisuvParam) str
|
|
|
for i := 0; i < len(Points)-1; i++ {
|
|
|
A := Points[i]
|
|
|
B := Points[i+1]
|
|
|
- if polygonLineIntersect(corners, A, B) {
|
|
|
+ if polygonLineIntersect(corners, A, B) && param.AutomodeOfPjVehicleFdbPub == 1 {
|
|
|
return "OutOfLane"
|
|
|
}
|
|
|
}
|