@@ -1,5 +1,6 @@
package main
+//触发器名称:定位失败
import (
"cicv-data-closedloop/pjibot_delivery_msgs"
)
+//触发器名称:障碍物无法绕行
"github.com/bluenviron/goroslib/v2/pkg/msgs/std_msgs"
+//触发器名称:任务执行失败
@@ -6,7 +6,7 @@ import (
func Topic() string {
- return "/odom"
+ return "/wheel_odom"
}
func Label() string {
@@ -17,7 +17,7 @@ func Rule(data *nav_msgs.Odometry) string {
velocityX := data.Twist.Twist.Linear.X
velocityY := data.Twist.Twist.Linear.Y
absV := math.Pow(math.Pow(velocityX, 2)+math.Pow(velocityY, 2), 0.5)
- if absV*3.6 > 0 {
+ if absV > 1.7 {
return "overspeed"
return ""
@@ -1,5 +1,7 @@
+//触发器名称:冲出车道
+
"cicv-data-closedloop/pjisuv_msgs"
"cicv-data-closedloop/pjisuv_param"