|
@@ -1,13 +1,13 @@
|
|
|
package main
|
|
|
|
|
|
import (
|
|
|
- "cicv-data-closedloop/common/entity"
|
|
|
"cicv-data-closedloop/pjisuv_msgs"
|
|
|
+ "cicv-data-closedloop/pjisuv_param"
|
|
|
"math"
|
|
|
)
|
|
|
|
|
|
func Topic() string {
|
|
|
- return "/cicv_location"
|
|
|
+ return "/cicv_amr_trajectory"
|
|
|
}
|
|
|
|
|
|
// Label todo 禁止存在下划线_
|
|
@@ -15,7 +15,7 @@ func Label() string {
|
|
|
return "controljump"
|
|
|
}
|
|
|
|
|
|
-func Rule(data *pjisuv_msgs.Trajectory, param entity.PjisuvParam) string {
|
|
|
+func Rule(data *pjisuv_msgs.Trajectory, param pjisuv_param.PjisuvParam) string {
|
|
|
var currentCurvateres []float64
|
|
|
for _, point := range data.Trajectoryinfo.Trajectorypoints {
|
|
|
currentCurvateres = append(currentCurvateres, math.Abs(float64(point.Curvature)))
|