|
@@ -1,11 +1,11 @@
|
|
package main
|
|
package main
|
|
|
|
|
|
import (
|
|
import (
|
|
- pjiConfig "cicv-data-closedloop/aarch64/pji/master/package/config"
|
|
|
|
|
|
+ pjibotGuideConfig "cicv-data-closedloop/aarch64/pjibot_guide/master/package/config"
|
|
pjisuvConfig "cicv-data-closedloop/aarch64/pjisuv/master/config"
|
|
pjisuvConfig "cicv-data-closedloop/aarch64/pjisuv/master/config"
|
|
"cicv-data-closedloop/common/util"
|
|
"cicv-data-closedloop/common/util"
|
|
"cicv-data-closedloop/kinglong_msgs"
|
|
"cicv-data-closedloop/kinglong_msgs"
|
|
- "cicv-data-closedloop/pji_msgs"
|
|
|
|
|
|
+ "cicv-data-closedloop/pjibot_guide_msgs"
|
|
"cicv-data-closedloop/pjisuv_msgs"
|
|
"cicv-data-closedloop/pjisuv_msgs"
|
|
"fmt"
|
|
"fmt"
|
|
"github.com/bluenviron/goroslib/v2"
|
|
"github.com/bluenviron/goroslib/v2"
|
|
@@ -28,9 +28,9 @@ func main() {
|
|
eType := util.ToString(os.Args[1])
|
|
eType := util.ToString(os.Args[1])
|
|
topic := util.ToString(os.Args[2])
|
|
topic := util.ToString(os.Args[2])
|
|
|
|
|
|
- if eType == "pjibot" {
|
|
|
|
|
|
+ if eType == "pjibot_guide" {
|
|
//1 一致
|
|
//1 一致
|
|
- if topic == pjiConfig.TopicOfDiagnostics {
|
|
|
|
|
|
+ if topic == pjibotGuideConfig.TopicOfDiagnostics {
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: rosNode,
|
|
Node: rosNode,
|
|
Topic: topic,
|
|
Topic: topic,
|
|
@@ -39,7 +39,7 @@ func main() {
|
|
}})
|
|
}})
|
|
}
|
|
}
|
|
//2 一致
|
|
//2 一致
|
|
- if topic == pjiConfig.TopicOfImu {
|
|
|
|
|
|
+ if topic == pjibotGuideConfig.TopicOfImu {
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: rosNode,
|
|
Node: rosNode,
|
|
Topic: topic,
|
|
Topic: topic,
|
|
@@ -48,16 +48,16 @@ func main() {
|
|
}})
|
|
}})
|
|
}
|
|
}
|
|
//3 一致
|
|
//3 一致
|
|
- if topic == pjiConfig.TopicOfLocateInfo {
|
|
|
|
|
|
+ if topic == pjibotGuideConfig.TopicOfLocateInfo {
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: rosNode,
|
|
Node: rosNode,
|
|
Topic: topic,
|
|
Topic: topic,
|
|
- Callback: func(data *pji_msgs.LocateInfo) {
|
|
|
|
|
|
+ Callback: func(data *pjibot_guide_msgs.LocateInfo) {
|
|
fmt.Println("收到话题", topic, "的数据", data)
|
|
fmt.Println("收到话题", topic, "的数据", data)
|
|
}})
|
|
}})
|
|
}
|
|
}
|
|
//4 一致
|
|
//4 一致
|
|
- if topic == pjiConfig.TopicOfObstacleDetection {
|
|
|
|
|
|
+ if topic == pjibotGuideConfig.TopicOfObstacleDetection {
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: rosNode,
|
|
Node: rosNode,
|
|
Topic: topic,
|
|
Topic: topic,
|
|
@@ -66,7 +66,7 @@ func main() {
|
|
}})
|
|
}})
|
|
}
|
|
}
|
|
//5 一致
|
|
//5 一致
|
|
- if topic == pjiConfig.TopicOfOdom {
|
|
|
|
|
|
+ if topic == pjibotGuideConfig.TopicOfOdom {
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: rosNode,
|
|
Node: rosNode,
|
|
Topic: topic,
|
|
Topic: topic,
|
|
@@ -75,11 +75,11 @@ func main() {
|
|
}})
|
|
}})
|
|
}
|
|
}
|
|
//6 一致
|
|
//6 一致
|
|
- if topic == pjiConfig.TopicOfSysInfo {
|
|
|
|
|
|
+ if topic == pjibotGuideConfig.TopicOfSysInfo {
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
_, _ = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: rosNode,
|
|
Node: rosNode,
|
|
Topic: topic,
|
|
Topic: topic,
|
|
- Callback: func(data *pji_msgs.SysInfo) {
|
|
|
|
|
|
+ Callback: func(data *pjibot_guide_msgs.SysInfo) {
|
|
fmt.Println("收到话题", topic, "的数据", data)
|
|
fmt.Println("收到话题", topic, "的数据", data)
|
|
}})
|
|
}})
|
|
}
|
|
}
|