FrontVehicleFrequentBrake.go 2.2 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100
  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 "FrontVehicleFrequentBrake"
  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 countChanges(slice [][]float32) int {
  43. count := 0
  44. lable1:
  45. for i := 0; i < len(slice[3]); {
  46. xi := slice[0][i]
  47. yi := slice[1][i]
  48. speedi := slice[3][i]
  49. if math.Abs(float64(yi)) <= 1.5 && speedi >= 3 && xi >= 1.5 {
  50. for j := 0; j < len(slice[1])-i-1; j++ {
  51. xij := slice[0][1+i+j]
  52. yij := slice[1][1+i+j]
  53. speedij := slice[3][1+i+j]
  54. if math.Abs(float64(yij)) <= 1.5 && speedij <= 1 && xij >= 1.5 {
  55. count++
  56. //fmt.Println("here!!")
  57. i = i + j + 1
  58. continue lable1
  59. }
  60. }
  61. break lable1
  62. } else {
  63. i++
  64. }
  65. }
  66. return count
  67. }
  68. func FinalCallback(shareVars *sync.Map) {
  69. OutsideWorkshopFlag, ok := shareVars.Load("OutsideWorkshopFlag")
  70. ObjDicOfTpperception, ok1 := shareVars.Load("objDicOfTpperception")
  71. ObjDic := ObjDicOfTpperception.(map[uint32][][]float32)
  72. if ok && ok1 && OutsideWorkshopFlag.(bool) == true {
  73. for _, objValue := range ObjDic {
  74. Maxlenobj = max(Maxlenobj, int32(len(objValue[0])))
  75. if len(ObjDic[0]) <= 10 || countChanges(objValue) < 2 {
  76. continue
  77. }
  78. event_lable := "FrontVehicleFrequentBrake"
  79. fmt.Println(event_lable)
  80. ObjDicOfTpperception = make(map[uint32][][]float32)
  81. pjisuv_ticker.TickerChan <- pjisuv_ticker.TickInfo{FaultLabel: Label(), FaultHappenTime: pjisuv_ticker.GetNowTimeCustom()}
  82. }
  83. if Maxlenobj >= 100 {
  84. ObjDicOfTpperception = make(map[uint32][][]float32)
  85. shareVars.Store("ObjDicOfTpperception", ObjDicOfTpperception)
  86. Maxlenobj = 0
  87. }
  88. }
  89. }