master_trigger_config.go 21 KB

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