master_trigger_config.go 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491
  1. package config
  2. import (
  3. "cicv-data-closedloop/aarch64/pjisuv/common/config"
  4. "cicv-data-closedloop/common/config/c_log"
  5. "cicv-data-closedloop/common/entity"
  6. "cicv-data-closedloop/common/util"
  7. "cicv-data-closedloop/pjisuv_msgs"
  8. "github.com/bluenviron/goroslib/v2/pkg/msgs/geometry_msgs"
  9. "github.com/bluenviron/goroslib/v2/pkg/msgs/nav_msgs"
  10. "github.com/bluenviron/goroslib/v2/pkg/msgs/sensor_msgs"
  11. "github.com/bluenviron/goroslib/v2/pkg/msgs/tf2_msgs"
  12. "github.com/bluenviron/goroslib/v2/pkg/msgs/visualization_msgs"
  13. "plugin"
  14. "strconv"
  15. "sync"
  16. )
  17. var (
  18. // 扩展
  19. TopicOfCicvExtend = "/cicv_extend"
  20. RuleOfCicvExtend []func(param entity.PjisuvParam) string
  21. //1
  22. TopicOfAmrPose = "/amr_pose"
  23. RuleOfAmrPose []func(data *visualization_msgs.MarkerArray) string
  24. //2
  25. TopicOfBoundingBoxesFast = "/bounding_boxes_fast"
  26. RuleOfBoundingBoxesFast []func(data *pjisuv_msgs.BoundingBoxArray) string
  27. //3
  28. TopicOfCameraFault = "/camera_fault"
  29. RuleOfCameraFault []func(data *pjisuv_msgs.FaultVec) string
  30. //4
  31. TopicOfCanData = "/can_data"
  32. RuleOfCanData []func(data *pjisuv_msgs.Frame) string
  33. //5
  34. TopicOfCh128x1LslidarPointCloud = "/ch128x1/lslidar_point_cloud"
  35. RuleOfCh128x1LslidarPointCloud []func(data *sensor_msgs.PointCloud2) string
  36. //6
  37. TopicOfCh64wLLslidarPointCloud = "/ch64w_l/lslidar_point_cloud"
  38. RuleOfCh64wLLslidarPointCloud []func(data *sensor_msgs.PointCloud2) string
  39. //7
  40. TopicOfCh64wLScan = "/ch64w_l/scan"
  41. RuleOfCh64wLScan []func(data *sensor_msgs.LaserScan) string
  42. //8
  43. TopicOfCh64wRLslidarPointCloud = "/ch64w_r/lslidar_point_cloud"
  44. RuleOfCh64wRLslidarPointCloud []func(data *sensor_msgs.PointCloud2) string
  45. //9
  46. TopicOfCh64wRScan = "/ch64w_r/scan"
  47. RuleOfCh64wRScan []func(data *sensor_msgs.LaserScan) string
  48. //10
  49. TopicOfCicvLidarclusterMovingObjects = "/cicv/lidarcluster_moving_objects"
  50. RuleOfCicvLidarclusterMovingObjects []func(data *pjisuv_msgs.PerceptionCicvMovingObjects) string
  51. //11
  52. TopicOfCicvAmrTrajectory = "/cicv_amr_trajectory"
  53. RuleOfCicvAmrTrajectory []func(data *pjisuv_msgs.Trajectory) string
  54. //12
  55. TopicOfCicvLocation = "/cicv_location"
  56. RuleOfCicvLocation []func(data *pjisuv_msgs.PerceptionLocalization) string
  57. //13
  58. TopicOfCloudClusters = "/cloud_clusters"
  59. RuleOfCloudClusters []func(data *pjisuv_msgs.AutowareCloudClusterArray) string
  60. //14
  61. TopicOfHeartbeatInfo = "/heartbeat_info"
  62. RuleOfHeartbeatInfo []func(data *pjisuv_msgs.HeartBeatInfo) string
  63. //15
  64. TopicOfLidarPretreatmentCost = "/lidarPretreatment_Cost"
  65. RuleOfLidarPretreatmentCost []func(data *geometry_msgs.Vector3Stamped) string
  66. //16
  67. TopicOfLidarPretreatmentOdometry = "/lidar_pretreatment/odometry"
  68. RuleOfLidarPretreatmentOdometry []func(data *nav_msgs.Odometry) string
  69. //17
  70. TopicOfLidarRoi = "/lidar_roi"
  71. RuleOfLidarRoi []func(data *geometry_msgs.PolygonStamped) string
  72. //18
  73. TopicOfLine1 = "/line_1"
  74. RuleOfLine1 []func(data *nav_msgs.Path) string
  75. //19
  76. TopicOfLine2 = "/line_2"
  77. RuleOfLine2 []func(data *nav_msgs.Path) string
  78. //20
  79. TopicOfMapPolygon = "/map_polygon"
  80. RuleOfMapPolygon []func(data *pjisuv_msgs.PolygonStamped) string
  81. //21
  82. TopicOfObstacleDisplay = "/obstacle_display"
  83. RuleOfObstacleDisplay []func(data *visualization_msgs.MarkerArray) string
  84. //22
  85. TopicOfPjControlPub = "/pj_control_pub"
  86. RuleOfPjControlPub []func(data *pjisuv_msgs.CommonVehicleCmd) string
  87. //23
  88. TopicOfPointsCluster = "/points_cluster"
  89. RuleOfPointsCluster []func(data *sensor_msgs.PointCloud2) string
  90. //24
  91. TopicOfPointsConcat = "/points_concat"
  92. RuleOfPointsConcat []func(data *sensor_msgs.PointCloud2) string
  93. //25
  94. TopicOfReferenceDisplay = "/reference_display"
  95. RuleOfReferenceDisplay []func(data *nav_msgs.Path) string
  96. //26
  97. TopicOfReferenceTrajectory = "/reference_trajectory"
  98. RuleOfReferenceTrajectory []func(data *pjisuv_msgs.Trajectory) string
  99. //27
  100. TopicOfRoiPoints = "/roi/points"
  101. RuleOfRoiPoints []func(data *sensor_msgs.PointCloud2) string
  102. //28
  103. TopicOfRoiPolygon = "/roi/polygon"
  104. RuleOfRoiPolygon []func(data *nav_msgs.Path) string
  105. //29
  106. TopicOfTf = "/tf"
  107. RuleOfTf []func(data *tf2_msgs.TFMessage) string
  108. //30
  109. TopicOfTpperception = "/tpperception"
  110. RuleOfTpperception []func(data *pjisuv_msgs.PerceptionObjects, extendParam entity.PjisuvParam) string
  111. //31
  112. TopicOfTpperceptionVis = "/tpperception/vis"
  113. RuleOfTpperceptionVis []func(data *visualization_msgs.MarkerArray) string
  114. //32
  115. TopicOfTprouteplan = "/tprouteplan"
  116. RuleOfTprouteplan []func(data *pjisuv_msgs.RoutePlan) string
  117. //33
  118. TopicOfTrajectoryDisplay = "/trajectory_display"
  119. RuleOfTrajectoryDisplay []func(data *nav_msgs.Path) string
  120. //34
  121. TopicOfUngroundCloudpoints = "/unground_cloudpoints"
  122. RuleOfUngroundCloudpoints []func(data *sensor_msgs.PointCloud2) string
  123. //35
  124. TopicOfCameraImage = "/camera_image"
  125. RuleOfCameraImage []func(data *sensor_msgs.Image) string
  126. //36
  127. TopicOfDataRead = "/data_read"
  128. RuleOfDataRead []func(data *pjisuv_msgs.Retrieval) string
  129. //37
  130. TopicOfPjiGps = "/pji_gps"
  131. RuleOfPjiGps []func(data *pjisuv_msgs.PerceptionLocalization) string
  132. //38
  133. TopicOfFaultInfo = "/fault_info"
  134. //RuleOfFaultInfo []func(data *pjisuv_msgs.FaultVec) string
  135. LabelMapTriggerId sync.Map
  136. )
  137. func InitTriggerConfig() {
  138. c_log.GlobalLogger.Info("主节点加载触发器插件 - 开始。")
  139. // 下载所有触发器的文件
  140. for _, trigger := range config.PlatformConfig.TaskTriggers {
  141. triggerLocalPath := config.CloudConfig.TriggersDir + trigger.TriggerScriptPath
  142. _ = util.CreateParentDir(triggerLocalPath)
  143. c_log.GlobalLogger.Info("下载触发器插件从 ", trigger.TriggerScriptPath, " 到 ", triggerLocalPath)
  144. config.OssMutex.Lock()
  145. err := config.OssBucket.GetObjectToFile(trigger.TriggerScriptPath, triggerLocalPath)
  146. config.OssMutex.Unlock()
  147. if err != nil {
  148. c_log.GlobalLogger.Error("下载 oss 上的触发器插件失败:", err)
  149. continue
  150. }
  151. // 载入插件到数组
  152. open, err := plugin.Open(triggerLocalPath)
  153. if err != nil {
  154. c_log.GlobalLogger.Error("加载本地插件", triggerLocalPath, "失败。", err)
  155. continue
  156. }
  157. topic0, err := open.Lookup("Topic")
  158. if err != nil {
  159. c_log.GlobalLogger.Error("加载本地插件", triggerLocalPath, "中的Topic方法失败。", err)
  160. continue
  161. }
  162. topic1, ok := topic0.(func() string)
  163. if ok != true {
  164. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func() string):", err)
  165. continue
  166. }
  167. topic2 := topic1()
  168. rule, err := open.Lookup("Rule")
  169. if err != nil {
  170. c_log.GlobalLogger.Error("加载本地插件", triggerLocalPath, "中的Rule方法失败。", err)
  171. continue
  172. }
  173. if TopicOfCicvExtend == topic2 { // 自定义扩展
  174. f, ok := rule.(func(param entity.PjisuvParam) string)
  175. if ok != true {
  176. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(param entity.ExtendParam):", err)
  177. continue
  178. }
  179. RuleOfCicvExtend = append(RuleOfCicvExtend, f)
  180. } else if TopicOfAmrPose == topic2 { //1
  181. f, ok := rule.(func(data *visualization_msgs.MarkerArray) string)
  182. if ok != true {
  183. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *visualization_msgs.MarkerArray) string):", err)
  184. continue
  185. }
  186. RuleOfAmrPose = append(RuleOfAmrPose, f)
  187. } else if TopicOfBoundingBoxesFast == topic2 { //2
  188. f, ok := rule.(func(data *pjisuv_msgs.BoundingBoxArray) string)
  189. if ok != true {
  190. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.BoundingBoxArray) string):", err)
  191. continue
  192. }
  193. RuleOfBoundingBoxesFast = append(RuleOfBoundingBoxesFast, f)
  194. } else if TopicOfCameraFault == topic2 { //3
  195. f, ok := rule.(func(data *pjisuv_msgs.FaultVec) string)
  196. if ok != true {
  197. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.FaultVec) string):", err)
  198. continue
  199. }
  200. RuleOfCameraFault = append(RuleOfCameraFault, f)
  201. } else if TopicOfCanData == topic2 { //4
  202. f, ok := rule.(func(data *pjisuv_msgs.Frame) string)
  203. if ok != true {
  204. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Frame) string):", err)
  205. continue
  206. }
  207. RuleOfCanData = append(RuleOfCanData, f)
  208. } else if TopicOfCh128x1LslidarPointCloud == topic2 { //5
  209. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  210. if ok != true {
  211. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  212. continue
  213. }
  214. RuleOfCh128x1LslidarPointCloud = append(RuleOfCh128x1LslidarPointCloud, f)
  215. } else if TopicOfCh64wLLslidarPointCloud == topic2 { //6
  216. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  217. if ok != true {
  218. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  219. continue
  220. }
  221. RuleOfCh64wLLslidarPointCloud = append(RuleOfCh64wLLslidarPointCloud, f)
  222. } else if TopicOfCh64wLScan == topic2 { //7
  223. f, ok := rule.(func(data *sensor_msgs.LaserScan) string)
  224. if ok != true {
  225. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.LaserScan) string):", err)
  226. continue
  227. }
  228. RuleOfCh64wLScan = append(RuleOfCh64wLScan, f)
  229. } else if TopicOfCh64wRLslidarPointCloud == topic2 { //8
  230. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  231. if ok != true {
  232. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  233. continue
  234. }
  235. RuleOfCh64wRLslidarPointCloud = append(RuleOfCh64wRLslidarPointCloud, f)
  236. } else if TopicOfCh64wRScan == topic2 { //9
  237. f, ok := rule.(func(data *sensor_msgs.LaserScan) string)
  238. if ok != true {
  239. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.LaserScan) string):", err)
  240. continue
  241. }
  242. RuleOfCh64wRScan = append(RuleOfCh64wRScan, f)
  243. } else if TopicOfCicvLidarclusterMovingObjects == topic2 { //10
  244. f, ok := rule.(func(data *pjisuv_msgs.PerceptionCicvMovingObjects) string)
  245. if ok != true {
  246. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PerceptionCicvMovingObjects) string):", err)
  247. continue
  248. }
  249. RuleOfCicvLidarclusterMovingObjects = append(RuleOfCicvLidarclusterMovingObjects, f)
  250. } else if TopicOfCicvAmrTrajectory == topic2 { //11
  251. f, ok := rule.(func(data *pjisuv_msgs.Trajectory) string)
  252. if ok != true {
  253. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Trajectory) string):", err)
  254. continue
  255. }
  256. RuleOfCicvAmrTrajectory = append(RuleOfCicvAmrTrajectory, f)
  257. } else if TopicOfCicvLocation == topic2 { //12
  258. f, ok := rule.(func(data *pjisuv_msgs.PerceptionLocalization) string)
  259. if ok != true {
  260. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PerceptionLocalization) string):", err)
  261. continue
  262. }
  263. RuleOfCicvLocation = append(RuleOfCicvLocation, f)
  264. } else if TopicOfCloudClusters == topic2 { //13
  265. f, ok := rule.(func(data *pjisuv_msgs.AutowareCloudClusterArray) string)
  266. if ok != true {
  267. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.AutowareCloudClusterArray) string):", err)
  268. continue
  269. }
  270. RuleOfCloudClusters = append(RuleOfCloudClusters, f)
  271. } else if TopicOfHeartbeatInfo == topic2 { //14
  272. f, ok := rule.(func(data *pjisuv_msgs.HeartBeatInfo) string)
  273. if ok != true {
  274. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.HeartBeatInfo) string):", err)
  275. continue
  276. }
  277. RuleOfHeartbeatInfo = append(RuleOfHeartbeatInfo, f)
  278. } else if TopicOfLidarPretreatmentCost == topic2 { //15
  279. f, ok := rule.(func(data *geometry_msgs.Vector3Stamped) string)
  280. if ok != true {
  281. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *geometry_msgs.Vector3Stamped) string):", err)
  282. continue
  283. }
  284. RuleOfLidarPretreatmentCost = append(RuleOfLidarPretreatmentCost, f)
  285. } else if TopicOfLidarPretreatmentOdometry == topic2 { //16
  286. f, ok := rule.(func(data *nav_msgs.Odometry) string)
  287. if ok != true {
  288. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Odometry) string):", err)
  289. continue
  290. }
  291. RuleOfLidarPretreatmentOdometry = append(RuleOfLidarPretreatmentOdometry, f)
  292. } else if TopicOfLidarRoi == topic2 { //17
  293. f, ok := rule.(func(data *geometry_msgs.PolygonStamped) string)
  294. if ok != true {
  295. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *geometry_msgs.PolygonStamped) string):", err)
  296. continue
  297. }
  298. RuleOfLidarRoi = append(RuleOfLidarRoi, f)
  299. } else if TopicOfLine1 == topic2 { //18
  300. f, ok := rule.(func(data *nav_msgs.Path) string)
  301. if ok != true {
  302. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  303. continue
  304. }
  305. RuleOfLine1 = append(RuleOfLine1, f)
  306. } else if TopicOfLine2 == topic2 { //19
  307. f, ok := rule.(func(data *nav_msgs.Path) string)
  308. if ok != true {
  309. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  310. continue
  311. }
  312. RuleOfLine2 = append(RuleOfLine2, f)
  313. } else if TopicOfMapPolygon == topic2 { //20
  314. f, ok := rule.(func(data *pjisuv_msgs.PolygonStamped) string)
  315. if ok != true {
  316. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PolygonStamped) string):", err)
  317. continue
  318. }
  319. RuleOfMapPolygon = append(RuleOfMapPolygon, f)
  320. } else if TopicOfObstacleDisplay == topic2 { //21
  321. f, ok := rule.(func(data *visualization_msgs.MarkerArray) string)
  322. if ok != true {
  323. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *visualization_msgs.MarkerArray) string):", err)
  324. continue
  325. }
  326. RuleOfObstacleDisplay = append(RuleOfObstacleDisplay, f)
  327. } else if TopicOfPjControlPub == topic2 { //22
  328. f, ok := rule.(func(data *pjisuv_msgs.CommonVehicleCmd) string)
  329. if ok != true {
  330. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.CommonVehicleCmd) string):", err)
  331. continue
  332. }
  333. RuleOfPjControlPub = append(RuleOfPjControlPub, f)
  334. } else if TopicOfPointsCluster == topic2 { //23
  335. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  336. if ok != true {
  337. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  338. continue
  339. }
  340. RuleOfPointsCluster = append(RuleOfPointsCluster, f)
  341. } else if TopicOfPointsConcat == topic2 { //24
  342. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  343. if ok != true {
  344. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  345. continue
  346. }
  347. RuleOfPointsConcat = append(RuleOfPointsConcat, f)
  348. } else if TopicOfReferenceDisplay == topic2 { //25
  349. f, ok := rule.(func(data *nav_msgs.Path) string)
  350. if ok != true {
  351. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  352. continue
  353. }
  354. RuleOfReferenceDisplay = append(RuleOfReferenceDisplay, f)
  355. } else if TopicOfReferenceTrajectory == topic2 { //26
  356. f, ok := rule.(func(data *pjisuv_msgs.Trajectory) string)
  357. if ok != true {
  358. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Trajectory) string):", err)
  359. continue
  360. }
  361. RuleOfReferenceTrajectory = append(RuleOfReferenceTrajectory, f)
  362. } else if TopicOfRoiPoints == topic2 { //27
  363. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  364. if ok != true {
  365. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  366. continue
  367. }
  368. RuleOfRoiPoints = append(RuleOfRoiPoints, f)
  369. } else if TopicOfRoiPolygon == topic2 { //28
  370. f, ok := rule.(func(data *nav_msgs.Path) string)
  371. if ok != true {
  372. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  373. continue
  374. }
  375. RuleOfRoiPolygon = append(RuleOfRoiPolygon, f)
  376. } else if TopicOfTf == topic2 { //29
  377. f, ok := rule.(func(data *tf2_msgs.TFMessage) string)
  378. if ok != true {
  379. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *tf2_msgs.TFMessage) string):", err)
  380. continue
  381. }
  382. RuleOfTf = append(RuleOfTf, f)
  383. } else if TopicOfTpperception == topic2 { //30
  384. f, ok := rule.(func(data *pjisuv_msgs.PerceptionObjects, param entity.PjisuvParam) string)
  385. if ok != true {
  386. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PerceptionObjects, param entity.ExtendParam) string):", err)
  387. continue
  388. }
  389. RuleOfTpperception = append(RuleOfTpperception, f)
  390. } else if TopicOfTpperceptionVis == topic2 { //31
  391. f, ok := rule.(func(data *visualization_msgs.MarkerArray) string)
  392. if ok != true {
  393. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *visualization_msgs.MarkerArray) string):", err)
  394. continue
  395. }
  396. RuleOfTpperceptionVis = append(RuleOfTpperceptionVis, f)
  397. } else if TopicOfTprouteplan == topic2 { //32
  398. f, ok := rule.(func(data *pjisuv_msgs.RoutePlan) string)
  399. if ok != true {
  400. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.RoutePlan) string):", err)
  401. continue
  402. }
  403. RuleOfTprouteplan = append(RuleOfTprouteplan, f)
  404. } else if TopicOfTrajectoryDisplay == topic2 { //33
  405. f, ok := rule.(func(data *nav_msgs.Path) string)
  406. if ok != true {
  407. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  408. continue
  409. }
  410. RuleOfTrajectoryDisplay = append(RuleOfTrajectoryDisplay, f)
  411. } else if TopicOfUngroundCloudpoints == topic2 { //34
  412. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  413. if ok != true {
  414. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  415. continue
  416. }
  417. RuleOfUngroundCloudpoints = append(RuleOfUngroundCloudpoints, f)
  418. } else if TopicOfCameraImage == topic2 { //35
  419. f, ok := rule.(func(data *sensor_msgs.Image) string)
  420. if ok != true {
  421. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.Image) string):", err)
  422. continue
  423. }
  424. RuleOfCameraImage = append(RuleOfCameraImage, f)
  425. } else if TopicOfDataRead == topic2 { //36
  426. f, ok := rule.(func(data *pjisuv_msgs.Retrieval) string)
  427. if ok != true {
  428. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Retrieval) string):", err)
  429. continue
  430. }
  431. RuleOfDataRead = append(RuleOfDataRead, f)
  432. } else {
  433. c_log.GlobalLogger.Error("未知的topic:", topic2)
  434. continue
  435. }
  436. label, err := open.Lookup("Label")
  437. if err != nil {
  438. c_log.GlobalLogger.Error("加载本地插件 ", triggerLocalPath, " 中的 Label 方法失败。", err)
  439. continue
  440. }
  441. labelFunc := label.(func() string)
  442. labelString := labelFunc()
  443. LabelMapTriggerId.Store(labelString, strconv.Itoa(trigger.TriggerId))
  444. c_log.GlobalLogger.Info("主节点加载触发器插件:【ros topic】=", topic2, ",【触发器label】=", labelString, "【触发器ID】=", trigger.TriggerId)
  445. }
  446. c_log.GlobalLogger.Info("一共有", len(config.PlatformConfig.TaskTriggers), "个触发器。")
  447. }