|
@@ -3,7 +3,6 @@ package main
|
|
import (
|
|
import (
|
|
"cicv-data-closedloop/common/entity"
|
|
"cicv-data-closedloop/common/entity"
|
|
"cicv-data-closedloop/pjisuv_msgs"
|
|
"cicv-data-closedloop/pjisuv_msgs"
|
|
- "fmt"
|
|
|
|
"math"
|
|
"math"
|
|
)
|
|
)
|
|
|
|
|
|
@@ -69,8 +68,8 @@ func Rule(data *pjisuv_msgs.PolygonStamped, param entity.PjisuvParam) string {
|
|
A := Points[i]
|
|
A := Points[i]
|
|
B := Points[i+1]
|
|
B := Points[i+1]
|
|
if polygonLineIntersect(corners, A, B) {
|
|
if polygonLineIntersect(corners, A, B) {
|
|
- fmt.Println("outofroad")
|
|
|
|
- return
|
|
|
|
|
|
+ return "outofroad"
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
+ return ""
|
|
}
|
|
}
|