BlCanBusPerception.cs 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149
  1. using ProjectBase.Data.Logs;
  2. using SIASUN.Autopilot.Device;
  3. using SIASUN.Autopilot.Device.Command;
  4. using SIASUN.Autopilot.Device.Message;
  5. using System;
  6. using System.Collections.Generic;
  7. using System.Linq;
  8. using System.Text;
  9. using System.Threading.Tasks;
  10. namespace SIASUN.Autopilot.BLL
  11. {
  12. public class BlCanBusPerception
  13. {
  14. public static BlCanBusPerception Instance { get; private set; }
  15. /// <summary>
  16. /// 车辆状态1事件
  17. /// </summary>
  18. private VehicleStatus1 comVehicleStatus1;
  19. /// <summary>
  20. /// 车辆状态2事件
  21. /// </summary>
  22. private VehicleStatus2 comVehicleStatus2;
  23. /// <summary>
  24. /// 车辆状态3事件
  25. /// </summary>
  26. private VehicleStatus3 comVehicleStatus3;
  27. // 实际车速
  28. private long realSpeed = 0;
  29. // 获取当前实际速度
  30. public long GetRealSpeed
  31. {
  32. get { return realSpeed; }
  33. }
  34. // 实际角度
  35. private long realAng = 0;
  36. // 获取当前实际角度
  37. public long GetRealAng
  38. {
  39. get { return realAng; }
  40. }
  41. static BlCanBusPerception()
  42. {
  43. if (Instance != null)
  44. return;
  45. Instance = new BlCanBusPerception();
  46. CanFactory.Instance.Initialize();
  47. }
  48. public void Init()
  49. {
  50. comVehicleStatus1 = new VehicleStatus1();
  51. comVehicleStatus1.ReceiveMessage += ComVehicleStatus1_ReceiveMessage;
  52. comVehicleStatus1.Subscribe();
  53. comVehicleStatus2 = new VehicleStatus2();
  54. comVehicleStatus2.ReceiveMessage += ComVehicleStatus2_ReceiveMessage;
  55. comVehicleStatus2.Subscribe();
  56. comVehicleStatus3 = new VehicleStatus3();
  57. comVehicleStatus3.ReceiveMessage += ComVehicleStatus3_ReceiveMessage;
  58. comVehicleStatus3.Subscribe();
  59. }
  60. /// <summary>
  61. /// 车辆状态1响应函数
  62. /// </summary>
  63. /// <param name="e"></param>
  64. private void ComVehicleStatus1_ReceiveMessage(ReceiveMessageEventArgs e)
  65. {
  66. try
  67. {
  68. var m = e.Message as 车辆状态1;
  69. }
  70. catch (Exception ex)
  71. {
  72. LogHelper.log.Error("接收到车辆状态1的数据感知层出现错误",ex);
  73. }
  74. }
  75. /// <summary>
  76. /// 车辆状态2响应函数
  77. /// </summary>
  78. /// <param name="e"></param>
  79. private void ComVehicleStatus2_ReceiveMessage(ReceiveMessageEventArgs e)
  80. {
  81. try
  82. {
  83. var m = e.Message as 车辆状态2;
  84. realSpeed = Convert.ToInt64(m.实际车速);
  85. realAng = Convert.ToInt64(m.实际方向盘转角);
  86. }
  87. catch (Exception ex)
  88. {
  89. LogHelper.log.Error("接收到车辆状态2的数据感知层出现错误", ex);
  90. }
  91. }
  92. /// <summary>
  93. /// 车辆状态3响应函数
  94. /// </summary>
  95. /// <param name="e"></param>
  96. private void ComVehicleStatus3_ReceiveMessage(ReceiveMessageEventArgs e)
  97. {
  98. try
  99. {
  100. var m = e.Message as 车辆状态3;
  101. }
  102. catch (Exception ex)
  103. {
  104. LogHelper.log.Error("接收到车辆状态3的数据感知层出现错误", ex);
  105. }
  106. }
  107. /// <summary>
  108. /// 输入加速度,调用加速度接口
  109. /// </summary>
  110. /// <param name="accelerate">计算的加速度</param>
  111. public void SetAccelerate(double accelerate)
  112. {
  113. }
  114. /// <summary>
  115. ///
  116. /// </summary>
  117. /// <param name="angle"></param>
  118. public void Angle(double angle)
  119. {
  120. }
  121. // 制动
  122. public void Brake(double brake)
  123. {
  124. }
  125. }
  126. }