ros_cfg.go 685 B

12345678910111213141516171819202122232425262728
  1. package cfg
  2. import (
  3. "cicv-data-closedloop/common/config/c_log"
  4. "cicv-data-closedloop/common/util"
  5. "github.com/bluenviron/goroslib/v2"
  6. "time"
  7. )
  8. var RosNode *goroslib.Node
  9. func InitRosConfig() {
  10. var err error
  11. c_log.GlobalLogger.Info("初始化RosNode - 开始")
  12. for {
  13. time.Sleep(time.Duration(2) * time.Second)
  14. if RosNode, err = goroslib.NewNode(goroslib.NodeConf{
  15. Name: "node" + util.GetNowTimeCustom(),
  16. MasterAddress: CloudConfig.Ros.MasterAddress,
  17. }); err != nil {
  18. c_log.GlobalLogger.Error("初始化RosNode - 进行中:", err)
  19. continue
  20. }
  21. c_log.GlobalLogger.Info("初始化RosNode - 成功:", CloudConfig.Ros.MasterAddress)
  22. break
  23. }
  24. }