|
@@ -1,10 +1,10 @@
|
|
package svc
|
|
package svc
|
|
|
|
|
|
import (
|
|
import (
|
|
|
|
+ "cicv-data-closedloop/common/config/c_log"
|
|
"cicv-data-closedloop/pji/common/cfg"
|
|
"cicv-data-closedloop/pji/common/cfg"
|
|
commonEntity "cicv-data-closedloop/pji/common/ent"
|
|
commonEntity "cicv-data-closedloop/pji/common/ent"
|
|
"cicv-data-closedloop/pji/common/global"
|
|
"cicv-data-closedloop/pji/common/global"
|
|
- "cicv-data-closedloop/pji/common/log"
|
|
|
|
commonService "cicv-data-closedloop/pji/common/svc"
|
|
commonService "cicv-data-closedloop/pji/common/svc"
|
|
"cicv-data-closedloop/pji/common/util"
|
|
"cicv-data-closedloop/pji/common/util"
|
|
masterConfig "cicv-data-closedloop/pji/master/pkg/cfg"
|
|
masterConfig "cicv-data-closedloop/pji/master/pkg/cfg"
|
|
@@ -54,12 +54,12 @@ func PrepareTimeWindowProducerQueue() {
|
|
// log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfOdom, "发生故障:", err)
|
|
// log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfOdom, "发生故障:", err)
|
|
// os.Exit(-1)
|
|
// os.Exit(-1)
|
|
//}
|
|
//}
|
|
- log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfObstacleDetection)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfObstacleDetection)
|
|
subscriber1, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
subscriber1, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: cfg.RosNode,
|
|
Node: cfg.RosNode,
|
|
Topic: masterConfig.TopicOfObstacleDetection,
|
|
Topic: masterConfig.TopicOfObstacleDetection,
|
|
Callback: func(data *std_msgs.UInt8) {
|
|
Callback: func(data *std_msgs.UInt8) {
|
|
- //log.GlobalLogger.Info("话题", masterConfig.TopicOfObstacleDetection, "接收到数据", data)
|
|
|
|
|
|
+ //c_log.GlobalLogger.Info("话题", masterConfig.TopicOfObstacleDetection, "接收到数据", data)
|
|
subscriber1Mutex.Lock()
|
|
subscriber1Mutex.Lock()
|
|
{
|
|
{
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
@@ -77,15 +77,15 @@ func PrepareTimeWindowProducerQueue() {
|
|
},
|
|
},
|
|
})
|
|
})
|
|
if err != nil {
|
|
if err != nil {
|
|
- log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
os.Exit(-1)
|
|
os.Exit(-1)
|
|
}
|
|
}
|
|
- log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfSysInfo)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfSysInfo)
|
|
subscriber2, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
subscriber2, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: cfg.RosNode,
|
|
Node: cfg.RosNode,
|
|
Topic: masterConfig.TopicOfSysInfo,
|
|
Topic: masterConfig.TopicOfSysInfo,
|
|
Callback: func(data *pji_msgs.SysInfo) {
|
|
Callback: func(data *pji_msgs.SysInfo) {
|
|
- //log.GlobalLogger.Info("话题", masterConfig.TopicOfSysInfo, "接收到数据", data)
|
|
|
|
|
|
+ //c_log.GlobalLogger.Info("话题", masterConfig.TopicOfSysInfo, "接收到数据", data)
|
|
subscriber2Mutex.Lock()
|
|
subscriber2Mutex.Lock()
|
|
{
|
|
{
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
@@ -103,15 +103,15 @@ func PrepareTimeWindowProducerQueue() {
|
|
},
|
|
},
|
|
})
|
|
})
|
|
if err != nil {
|
|
if err != nil {
|
|
- log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
os.Exit(-1)
|
|
os.Exit(-1)
|
|
}
|
|
}
|
|
- log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfLocateInfo)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfLocateInfo)
|
|
subscriber3, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
subscriber3, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: cfg.RosNode,
|
|
Node: cfg.RosNode,
|
|
Topic: masterConfig.TopicOfLocateInfo,
|
|
Topic: masterConfig.TopicOfLocateInfo,
|
|
Callback: func(data *pji_msgs.LocateInfo) {
|
|
Callback: func(data *pji_msgs.LocateInfo) {
|
|
- //log.GlobalLogger.Info("话题", masterConfig.TopicOfLocateInfo, "接收到数据", data)
|
|
|
|
|
|
+ //c_log.GlobalLogger.Info("话题", masterConfig.TopicOfLocateInfo, "接收到数据", data)
|
|
subscriber3Mutex.Lock()
|
|
subscriber3Mutex.Lock()
|
|
{
|
|
{
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
@@ -129,15 +129,15 @@ func PrepareTimeWindowProducerQueue() {
|
|
},
|
|
},
|
|
})
|
|
})
|
|
if err != nil {
|
|
if err != nil {
|
|
- log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
os.Exit(-1)
|
|
os.Exit(-1)
|
|
}
|
|
}
|
|
- log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfImu)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfImu)
|
|
subscriber4, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
subscriber4, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: cfg.RosNode,
|
|
Node: cfg.RosNode,
|
|
Topic: masterConfig.TopicOfImu,
|
|
Topic: masterConfig.TopicOfImu,
|
|
Callback: func(data *sensor_msgs.Imu) {
|
|
Callback: func(data *sensor_msgs.Imu) {
|
|
- //log.GlobalLogger.Info("话题", masterConfig.TopicOfImu, "接收到数据", data)
|
|
|
|
|
|
+ //c_log.GlobalLogger.Info("话题", masterConfig.TopicOfImu, "接收到数据", data)
|
|
subscriber4Mutex.Lock()
|
|
subscriber4Mutex.Lock()
|
|
{
|
|
{
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
@@ -155,15 +155,15 @@ func PrepareTimeWindowProducerQueue() {
|
|
},
|
|
},
|
|
})
|
|
})
|
|
if err != nil {
|
|
if err != nil {
|
|
- log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
os.Exit(-1)
|
|
os.Exit(-1)
|
|
}
|
|
}
|
|
- log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfDiagnostics)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者订阅主题" + masterConfig.TopicOfDiagnostics)
|
|
subscriber5, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
subscriber5, err := goroslib.NewSubscriber(goroslib.SubscriberConf{
|
|
Node: cfg.RosNode,
|
|
Node: cfg.RosNode,
|
|
Topic: masterConfig.TopicOfDiagnostics,
|
|
Topic: masterConfig.TopicOfDiagnostics,
|
|
Callback: func(data *diagnostic_msgs.DiagnosticArray) {
|
|
Callback: func(data *diagnostic_msgs.DiagnosticArray) {
|
|
- //log.GlobalLogger.Info("话题", masterConfig.TopicOfDiagnostics, "接收到数据", data)
|
|
|
|
|
|
+ //c_log.GlobalLogger.Info("话题", masterConfig.TopicOfDiagnostics, "接收到数据", data)
|
|
subscriber5Mutex.Lock()
|
|
subscriber5Mutex.Lock()
|
|
{
|
|
{
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
faultHappenTime := util.GetNowTimeCustom() // 获取当前故障发生时间
|
|
@@ -181,7 +181,7 @@ func PrepareTimeWindowProducerQueue() {
|
|
},
|
|
},
|
|
})
|
|
})
|
|
if err != nil {
|
|
if err != nil {
|
|
- log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
|
|
|
|
+ c_log.GlobalLogger.Info("创建订阅者", masterConfig.TopicOfObstacleDetection, "发生故障:", err)
|
|
os.Exit(-1)
|
|
os.Exit(-1)
|
|
}
|
|
}
|
|
|
|
|
|
@@ -214,7 +214,7 @@ func saveTimeWindow(faultLabel string, faultHappenTime string, lastTimeWindow *c
|
|
MasterTopics: masterTopics,
|
|
MasterTopics: masterTopics,
|
|
SlaveTopics: slaveTopics,
|
|
SlaveTopics: slaveTopics,
|
|
}
|
|
}
|
|
- log.GlobalLogger.Infof("不在旧故障窗口内,向生产者队列添加一个新窗口,【Lable】=%v,【FaultTime】=%v,【Length】=%v", newTimeWindow.Labels, newTimeWindow.FaultTime, newTimeWindow.Length)
|
|
|
|
|
|
+ c_log.GlobalLogger.Infof("不在旧故障窗口内,向生产者队列添加一个新窗口,【Lable】=%v,【FaultTime】=%v,【Length】=%v", newTimeWindow.Labels, newTimeWindow.FaultTime, newTimeWindow.Length)
|
|
util.AddTimeWindowToTimeWindowProducerQueue(newTimeWindow)
|
|
util.AddTimeWindowToTimeWindowProducerQueue(newTimeWindow)
|
|
} else {
|
|
} else {
|
|
// 2-2 如果在旧故障窗口内
|
|
// 2-2 如果在旧故障窗口内
|
|
@@ -240,7 +240,7 @@ func saveTimeWindow(faultLabel string, faultHappenTime string, lastTimeWindow *c
|
|
lastTimeWindow.MasterTopics = util.MergeSlice(sourceMasterTopics, masterTopics)
|
|
lastTimeWindow.MasterTopics = util.MergeSlice(sourceMasterTopics, masterTopics)
|
|
sourceSlaveTopics := lastTimeWindow.SlaveTopics
|
|
sourceSlaveTopics := lastTimeWindow.SlaveTopics
|
|
lastTimeWindow.SlaveTopics = util.MergeSlice(sourceSlaveTopics, slaveTopics)
|
|
lastTimeWindow.SlaveTopics = util.MergeSlice(sourceSlaveTopics, slaveTopics)
|
|
- log.GlobalLogger.Infof("在旧故障窗口内,更新生产者队列最新的窗口,【Lable】=%v,【FaultTime】=%v,【Length】=%v", lastTimeWindow.Labels, lastTimeWindow.FaultTime, lastTimeWindow.Length)
|
|
|
|
|
|
+ c_log.GlobalLogger.Infof("在旧故障窗口内,更新生产者队列最新的窗口,【Lable】=%v,【FaultTime】=%v,【Length】=%v", lastTimeWindow.Labels, lastTimeWindow.FaultTime, lastTimeWindow.Length)
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
|