|
@@ -1,8 +1,8 @@
|
|
|
package main
|
|
package main
|
|
|
|
|
|
|
|
import (
|
|
import (
|
|
|
- "cicv-data-closedloop/common/entity"
|
|
|
|
|
"cicv-data-closedloop/pjisuv_msgs"
|
|
"cicv-data-closedloop/pjisuv_msgs"
|
|
|
|
|
+ "cicv-data-closedloop/pjisuv_param"
|
|
|
"math"
|
|
"math"
|
|
|
)
|
|
)
|
|
|
|
|
|
|
@@ -59,7 +59,7 @@ func polygonLineIntersect(polygon []pjisuv_msgs.Point64, A, B pjisuv_msgs.Point6
|
|
|
return false
|
|
return false
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
-func Rule(data *pjisuv_msgs.PolygonStamped, param entity.PjisuvParam) string {
|
|
|
|
|
|
|
+func Rule(data *pjisuv_msgs.PolygonStamped, param pjisuv_param.PjisuvParam) string {
|
|
|
Points := data.Polygon.Points
|
|
Points := data.Polygon.Points
|
|
|
D1, D2, D3 := 3.813, 0.952, 1.086
|
|
D1, D2, D3 := 3.813, 0.952, 1.086
|
|
|
corners := getVehicleCorners(param.PositionXOfCicvLocation, param.PositionYOfCicvLocation, D1, D2, D3, param.YawOfCicvLocation)
|
|
corners := getVehicleCorners(param.PositionXOfCicvLocation, param.PositionYOfCicvLocation, D1, D2, D3, param.YawOfCicvLocation)
|
