|
@@ -23,21 +23,21 @@ var mutex sync.Mutex
|
|
func main() {
|
|
func main() {
|
|
lastTime = time.Now()
|
|
lastTime = time.Now()
|
|
|
|
|
|
- //// 1 启动 shell 脚本 dpi_start.sh
|
|
|
|
- //_, s, err := util.ExecuteWithDirSync("/data", "sh", "dpi_start.sh")
|
|
|
|
- //if err != nil {
|
|
|
|
- // fmt.Println("执行启动命令报错,执行结果为:", s, ",错误信息为:", err)
|
|
|
|
- // os.Exit(1)
|
|
|
|
- //}
|
|
|
|
- //fmt.Println("执行启动命令 sh dpi_start.sh 成功,执行结果为:", s)
|
|
|
|
- //
|
|
|
|
- //time.Sleep(5 * time.Second)
|
|
|
|
|
|
+ // 1 启动 shell 脚本 dpi_start.sh
|
|
|
|
+ _, s, err := util.ExecuteWithDirSync("/data", "sh", "dpi_start.sh")
|
|
|
|
+ if err != nil {
|
|
|
|
+ fmt.Println("执行启动命令报错,执行结果为:", s, ",错误信息为:", err)
|
|
|
|
+ os.Exit(1)
|
|
|
|
+ }
|
|
|
|
+ fmt.Println("执行启动命令 sh dpi_start.sh 成功,执行结果为:", s)
|
|
|
|
+
|
|
|
|
+ time.Sleep(5 * time.Second)
|
|
// 2 监听 ros 话题 /heartbeat_info
|
|
// 2 监听 ros 话题 /heartbeat_info
|
|
rosNode, _ := goroslib.NewNode(goroslib.NodeConf{
|
|
rosNode, _ := goroslib.NewNode(goroslib.NodeConf{
|
|
Name: "dpi_with_heartbeatInfo",
|
|
Name: "dpi_with_heartbeatInfo",
|
|
MasterAddress: "127.0.0.1:11311",
|
|
MasterAddress: "127.0.0.1:11311",
|
|
})
|
|
})
|
|
- _, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
|
|
|
|
+ _, err = goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: rosNode,
|
|
Node: rosNode,
|
|
Topic: "/heartbeat_info",
|
|
Topic: "/heartbeat_info",
|
|
Callback: func(data *HeartBeatInfo) {
|
|
Callback: func(data *HeartBeatInfo) {
|