master_trigger_config.go 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517
  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/util"
  6. "cicv-data-closedloop/pjisuv_msgs"
  7. entity "cicv-data-closedloop/pjisuv_param"
  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, param entity.PjisuvParam) 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. //39
  136. TopicOfPjVehicleFdbPub = "/pj_vehicle_fdb_pub"
  137. RuleOfPjVehicleFdbPub []func(data *pjisuv_msgs.VehicleFdb, param *entity.PjisuvParam) string
  138. LabelMapTriggerId sync.Map
  139. )
  140. func InitTriggerConfig() {
  141. c_log.GlobalLogger.Info("主节点加载触发器插件 - 开始。")
  142. var triggerLocalPaths []string
  143. if config.CloudConfig.TriggersOnline { // 在线方案
  144. for _, trigger := range config.PlatformConfig.TaskTriggers {
  145. triggerLocalPath := config.CloudConfig.TriggersDir + trigger.TriggerScriptPath
  146. _ = util.CreateParentDir(triggerLocalPath)
  147. config.OssMutex.Lock()
  148. err := config.OssBucket.GetObjectToFile(trigger.TriggerScriptPath, triggerLocalPath)
  149. config.OssMutex.Unlock()
  150. if err != nil {
  151. c_log.GlobalLogger.Error("下载 oss 上的触发器插件失败:", err)
  152. continue
  153. }
  154. c_log.GlobalLogger.Info("下载触发器插件从 ", trigger.TriggerScriptPath, " 到 ", triggerLocalPath)
  155. triggerLocalPaths = append(triggerLocalPaths, triggerLocalPath)
  156. }
  157. } else { // 离线方案
  158. triggerLocalPaths = util.GetSoFilePaths(config.CloudConfig.TriggersDir)
  159. // 绑定 triggerId 和 triggerLabel
  160. for _, path := range triggerLocalPaths {
  161. name1 := util.GetFileNameWithoutExtension(path)
  162. for _, trigger := range config.PlatformConfig.TaskTriggers {
  163. name2 := util.GetFileNameWithoutExtension(config.CloudConfig.TriggersDir + trigger.TriggerScriptPath)
  164. if name1 == name2 {
  165. LabelMapTriggerId.Store(name1, strconv.Itoa(trigger.TriggerId))
  166. }
  167. }
  168. }
  169. }
  170. // 下载所有触发器的文件
  171. for _, triggerLocalPath := range triggerLocalPaths {
  172. // 载入插件到数组
  173. open, err := plugin.Open(triggerLocalPath)
  174. if err != nil {
  175. c_log.GlobalLogger.Error("加载本地插件", triggerLocalPath, "失败。", err)
  176. continue
  177. }
  178. topic0, err := open.Lookup("Topic")
  179. if err != nil {
  180. c_log.GlobalLogger.Error("加载本地插件", triggerLocalPath, "中的Topic方法失败。", err)
  181. continue
  182. }
  183. topic1, ok := topic0.(func() string)
  184. if ok != true {
  185. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func() string):", err)
  186. continue
  187. }
  188. topic2 := topic1()
  189. rule, err := open.Lookup("Rule")
  190. if err != nil {
  191. c_log.GlobalLogger.Error("加载本地插件", triggerLocalPath, "中的Rule方法失败。", err)
  192. continue
  193. }
  194. if TopicOfCicvExtend == topic2 { // 自定义扩展
  195. f, ok := rule.(func(param entity.PjisuvParam) string)
  196. if ok != true {
  197. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(param entity.ExtendParam):", err)
  198. continue
  199. }
  200. RuleOfCicvExtend = append(RuleOfCicvExtend, f)
  201. } else if TopicOfAmrPose == topic2 { //1
  202. f, ok := rule.(func(data *visualization_msgs.MarkerArray) string)
  203. if ok != true {
  204. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *visualization_msgs.MarkerArray) string):", err)
  205. continue
  206. }
  207. RuleOfAmrPose = append(RuleOfAmrPose, f)
  208. } else if TopicOfBoundingBoxesFast == topic2 { //2
  209. f, ok := rule.(func(data *pjisuv_msgs.BoundingBoxArray) string)
  210. if ok != true {
  211. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.BoundingBoxArray) string):", err)
  212. continue
  213. }
  214. RuleOfBoundingBoxesFast = append(RuleOfBoundingBoxesFast, f)
  215. } else if TopicOfCameraFault == topic2 { //3
  216. f, ok := rule.(func(data *pjisuv_msgs.FaultVec) string)
  217. if ok != true {
  218. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.FaultVec) string):", err)
  219. continue
  220. }
  221. RuleOfCameraFault = append(RuleOfCameraFault, f)
  222. } else if TopicOfCanData == topic2 { //4
  223. f, ok := rule.(func(data *pjisuv_msgs.Frame) string)
  224. if ok != true {
  225. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Frame) string):", err)
  226. continue
  227. }
  228. RuleOfCanData = append(RuleOfCanData, f)
  229. } else if TopicOfCh128x1LslidarPointCloud == topic2 { //5
  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. RuleOfCh128x1LslidarPointCloud = append(RuleOfCh128x1LslidarPointCloud, f)
  236. } else if TopicOfCh64wLLslidarPointCloud == topic2 { //6
  237. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  238. if ok != true {
  239. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  240. continue
  241. }
  242. RuleOfCh64wLLslidarPointCloud = append(RuleOfCh64wLLslidarPointCloud, f)
  243. } else if TopicOfCh64wLScan == topic2 { //7
  244. f, ok := rule.(func(data *sensor_msgs.LaserScan) string)
  245. if ok != true {
  246. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.LaserScan) string):", err)
  247. continue
  248. }
  249. RuleOfCh64wLScan = append(RuleOfCh64wLScan, f)
  250. } else if TopicOfCh64wRLslidarPointCloud == topic2 { //8
  251. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  252. if ok != true {
  253. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  254. continue
  255. }
  256. RuleOfCh64wRLslidarPointCloud = append(RuleOfCh64wRLslidarPointCloud, f)
  257. } else if TopicOfCh64wRScan == topic2 { //9
  258. f, ok := rule.(func(data *sensor_msgs.LaserScan) string)
  259. if ok != true {
  260. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.LaserScan) string):", err)
  261. continue
  262. }
  263. RuleOfCh64wRScan = append(RuleOfCh64wRScan, f)
  264. } else if TopicOfCicvLidarclusterMovingObjects == topic2 { //10
  265. f, ok := rule.(func(data *pjisuv_msgs.PerceptionCicvMovingObjects) string)
  266. if ok != true {
  267. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PerceptionCicvMovingObjects) string):", err)
  268. continue
  269. }
  270. RuleOfCicvLidarclusterMovingObjects = append(RuleOfCicvLidarclusterMovingObjects, f)
  271. } else if TopicOfCicvAmrTrajectory == topic2 { //11
  272. f, ok := rule.(func(data *pjisuv_msgs.Trajectory, param entity.PjisuvParam) string)
  273. if ok != true {
  274. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Trajectory,param entity.PjisuvParam) string):", err)
  275. continue
  276. }
  277. RuleOfCicvAmrTrajectory = append(RuleOfCicvAmrTrajectory, f)
  278. } else if TopicOfCicvLocation == topic2 { //12
  279. f, ok := rule.(func(data *pjisuv_msgs.PerceptionLocalization) string)
  280. if ok != true {
  281. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PerceptionLocalization) string):", err)
  282. continue
  283. }
  284. RuleOfCicvLocation = append(RuleOfCicvLocation, f)
  285. } else if TopicOfCloudClusters == topic2 { //13
  286. f, ok := rule.(func(data *pjisuv_msgs.AutowareCloudClusterArray) string)
  287. if ok != true {
  288. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.AutowareCloudClusterArray) string):", err)
  289. continue
  290. }
  291. RuleOfCloudClusters = append(RuleOfCloudClusters, f)
  292. } else if TopicOfHeartbeatInfo == topic2 { //14
  293. f, ok := rule.(func(data *pjisuv_msgs.HeartBeatInfo) string)
  294. if ok != true {
  295. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.HeartBeatInfo) string):", err)
  296. continue
  297. }
  298. RuleOfHeartbeatInfo = append(RuleOfHeartbeatInfo, f)
  299. } else if TopicOfLidarPretreatmentCost == topic2 { //15
  300. f, ok := rule.(func(data *geometry_msgs.Vector3Stamped) string)
  301. if ok != true {
  302. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *geometry_msgs.Vector3Stamped) string):", err)
  303. continue
  304. }
  305. RuleOfLidarPretreatmentCost = append(RuleOfLidarPretreatmentCost, f)
  306. } else if TopicOfLidarPretreatmentOdometry == topic2 { //16
  307. f, ok := rule.(func(data *nav_msgs.Odometry) string)
  308. if ok != true {
  309. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Odometry) string):", err)
  310. continue
  311. }
  312. RuleOfLidarPretreatmentOdometry = append(RuleOfLidarPretreatmentOdometry, f)
  313. } else if TopicOfLidarRoi == topic2 { //17
  314. f, ok := rule.(func(data *geometry_msgs.PolygonStamped) string)
  315. if ok != true {
  316. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *geometry_msgs.PolygonStamped) string):", err)
  317. continue
  318. }
  319. RuleOfLidarRoi = append(RuleOfLidarRoi, f)
  320. } else if TopicOfLine1 == topic2 { //18
  321. f, ok := rule.(func(data *nav_msgs.Path) string)
  322. if ok != true {
  323. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  324. continue
  325. }
  326. RuleOfLine1 = append(RuleOfLine1, f)
  327. } else if TopicOfLine2 == topic2 { //19
  328. f, ok := rule.(func(data *nav_msgs.Path) string)
  329. if ok != true {
  330. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  331. continue
  332. }
  333. RuleOfLine2 = append(RuleOfLine2, f)
  334. } else if TopicOfMapPolygon == topic2 { //20
  335. f, ok := rule.(func(data *pjisuv_msgs.PolygonStamped) string)
  336. if ok != true {
  337. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PolygonStamped) string):", err)
  338. continue
  339. }
  340. RuleOfMapPolygon = append(RuleOfMapPolygon, f)
  341. } else if TopicOfObstacleDisplay == topic2 { //21
  342. f, ok := rule.(func(data *visualization_msgs.MarkerArray) string)
  343. if ok != true {
  344. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *visualization_msgs.MarkerArray) string):", err)
  345. continue
  346. }
  347. RuleOfObstacleDisplay = append(RuleOfObstacleDisplay, f)
  348. } else if TopicOfPjControlPub == topic2 { //22
  349. f, ok := rule.(func(data *pjisuv_msgs.CommonVehicleCmd) string)
  350. if ok != true {
  351. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.CommonVehicleCmd) string):", err)
  352. continue
  353. }
  354. RuleOfPjControlPub = append(RuleOfPjControlPub, f)
  355. } else if TopicOfPointsCluster == topic2 { //23
  356. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  357. if ok != true {
  358. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  359. continue
  360. }
  361. RuleOfPointsCluster = append(RuleOfPointsCluster, f)
  362. } else if TopicOfPointsConcat == topic2 { //24
  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. RuleOfPointsConcat = append(RuleOfPointsConcat, f)
  369. } else if TopicOfReferenceDisplay == topic2 { //25
  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. RuleOfReferenceDisplay = append(RuleOfReferenceDisplay, f)
  376. } else if TopicOfReferenceTrajectory == topic2 { //26
  377. f, ok := rule.(func(data *pjisuv_msgs.Trajectory) string)
  378. if ok != true {
  379. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Trajectory) string):", err)
  380. continue
  381. }
  382. RuleOfReferenceTrajectory = append(RuleOfReferenceTrajectory, f)
  383. } else if TopicOfRoiPoints == topic2 { //27
  384. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  385. if ok != true {
  386. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  387. continue
  388. }
  389. RuleOfRoiPoints = append(RuleOfRoiPoints, f)
  390. } else if TopicOfRoiPolygon == topic2 { //28
  391. f, ok := rule.(func(data *nav_msgs.Path) string)
  392. if ok != true {
  393. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  394. continue
  395. }
  396. RuleOfRoiPolygon = append(RuleOfRoiPolygon, f)
  397. } else if TopicOfTf == topic2 { //29
  398. f, ok := rule.(func(data *tf2_msgs.TFMessage) string)
  399. if ok != true {
  400. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *tf2_msgs.TFMessage) string):", err)
  401. continue
  402. }
  403. RuleOfTf = append(RuleOfTf, f)
  404. } else if TopicOfTpperception == topic2 { //30
  405. f, ok := rule.(func(data *pjisuv_msgs.PerceptionObjects, param entity.PjisuvParam) string)
  406. if ok != true {
  407. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.PerceptionObjects, param entity.ExtendParam) string):", err)
  408. continue
  409. }
  410. RuleOfTpperception = append(RuleOfTpperception, f)
  411. } else if TopicOfTpperceptionVis == topic2 { //31
  412. f, ok := rule.(func(data *visualization_msgs.MarkerArray) string)
  413. if ok != true {
  414. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *visualization_msgs.MarkerArray) string):", err)
  415. continue
  416. }
  417. RuleOfTpperceptionVis = append(RuleOfTpperceptionVis, f)
  418. } else if TopicOfTprouteplan == topic2 { //32
  419. f, ok := rule.(func(data *pjisuv_msgs.RoutePlan) string)
  420. if ok != true {
  421. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.RoutePlan) string):", err)
  422. continue
  423. }
  424. RuleOfTprouteplan = append(RuleOfTprouteplan, f)
  425. } else if TopicOfTrajectoryDisplay == topic2 { //33
  426. f, ok := rule.(func(data *nav_msgs.Path) string)
  427. if ok != true {
  428. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *nav_msgs.Path) string):", err)
  429. continue
  430. }
  431. RuleOfTrajectoryDisplay = append(RuleOfTrajectoryDisplay, f)
  432. } else if TopicOfUngroundCloudpoints == topic2 { //34
  433. f, ok := rule.(func(data *sensor_msgs.PointCloud2) string)
  434. if ok != true {
  435. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.PointCloud2) string):", err)
  436. continue
  437. }
  438. RuleOfUngroundCloudpoints = append(RuleOfUngroundCloudpoints, f)
  439. } else if TopicOfCameraImage == topic2 { //35
  440. f, ok := rule.(func(data *sensor_msgs.Image) string)
  441. if ok != true {
  442. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *sensor_msgs.Image) string):", err)
  443. continue
  444. }
  445. RuleOfCameraImage = append(RuleOfCameraImage, f)
  446. } else if TopicOfDataRead == topic2 { //36
  447. f, ok := rule.(func(data *pjisuv_msgs.Retrieval) string)
  448. if ok != true {
  449. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.Retrieval) string):", err)
  450. continue
  451. }
  452. RuleOfDataRead = append(RuleOfDataRead, f)
  453. } else if TopicOfPjVehicleFdbPub == topic2 { //39
  454. f, ok := rule.(func(data *pjisuv_msgs.VehicleFdb, param *entity.PjisuvParam) string)
  455. if ok != true {
  456. c_log.GlobalLogger.Error("插件", triggerLocalPath, "中的Topic方法必须是(func(data *pjisuv_msgs.VehicleFdb) string):", err)
  457. continue
  458. }
  459. RuleOfPjVehicleFdbPub = append(RuleOfPjVehicleFdbPub, f)
  460. } else {
  461. c_log.GlobalLogger.Error("未知的topic:", topic2)
  462. continue
  463. }
  464. _, err = open.Lookup("Label")
  465. if err != nil {
  466. c_log.GlobalLogger.Error("加载本地插件 ", triggerLocalPath, " 中的 Label 方法失败。", err)
  467. continue
  468. }
  469. }
  470. c_log.GlobalLogger.Info("一共有", len(config.PlatformConfig.TaskTriggers), "个触发器。")
  471. }