FrontVehicleBrake.go 2.0 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485
  1. package main
  2. import (
  3. "cicv-data-closedloop/pjisuv_ticker"
  4. "fmt"
  5. "math"
  6. "sync"
  7. "time"
  8. )
  9. var (
  10. Maxlenobj int32 = 0
  11. )
  12. // 定时任务触发器固定的
  13. func Topic() string {
  14. return pjisuv_ticker.TickerTopic
  15. }
  16. // ******* 禁止存在下划线_
  17. // 触发器标记
  18. func Label() string {
  19. return "FrontVehicleBrake"
  20. }
  21. func Rule(shareVars *sync.Map) {
  22. defer func() {
  23. if r := recover(); r != nil {
  24. fmt.Println("Recovered from panic:", r)
  25. }
  26. }()
  27. // 1 使用goroutine
  28. go func(shareVars *sync.Map) {
  29. // 2 定义触发器的间隔时间
  30. ticker := time.NewTicker(time.Duration(2) * time.Second)
  31. defer ticker.Stop()
  32. // 3 运行一个无限循环
  33. for {
  34. select {
  35. // 定时器触发时执行的代码
  36. case <-ticker.C:
  37. FinalCallback(shareVars)
  38. }
  39. }
  40. }(shareVars)
  41. }
  42. func isBrake(ObjectList [][]float32) bool {
  43. for i, speed := range ObjectList[3] {
  44. if math.Abs(float64(ObjectList[1][i])) <= 1.3 && speed >= 3 && ObjectList[0][i] >= 1.3 {
  45. for j := 0; j < len(ObjectList[0])-i-1; j++ {
  46. if math.Abs(float64(ObjectList[1][1+i+j])) <= 1.3 && ObjectList[3][1+i+j] <= 1 {
  47. return true
  48. }
  49. }
  50. }
  51. }
  52. return false
  53. }
  54. func FinalCallback(shareVars *sync.Map) {
  55. OutsideWorkshopFlag, ok := shareVars.Load("OutsideWorkshopFlag")
  56. ObjDicOfTpperception, ok1 := shareVars.Load("objDicOfTpperception")
  57. ObjDic := ObjDicOfTpperception.(map[uint32][][]float32)
  58. if ok && ok1 && OutsideWorkshopFlag.(bool) == true {
  59. for _, objValue := range ObjDic {
  60. Maxlenobj = max(Maxlenobj, int32(len(objValue[0])))
  61. if len(ObjDic[0]) <= 10 || !isBrake(objValue) {
  62. continue
  63. }
  64. event_lable := "FrontVehicleBrake"
  65. fmt.Println(event_lable)
  66. ObjDicOfTpperception = make(map[uint32][][]float32)
  67. pjisuv_ticker.TickerChan <- pjisuv_ticker.TickInfo{FaultLabel: Label(), FaultHappenTime: pjisuv_ticker.GetNowTimeCustom()}
  68. }
  69. if Maxlenobj >= 100 {
  70. ObjDicOfTpperception = make(map[uint32][][]float32)
  71. shareVars.Store("ObjDicOfTpperception", ObjDicOfTpperception)
  72. Maxlenobj = 0
  73. }
  74. }
  75. }