MessageListener.py 6.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139
  1. from hub import methods, Global
  2. import threading
  3. import time
  4. import json
  5. import os
  6. # --- for linux
  7. # save_dir = f"/home/server/logs"
  8. # --- for windows
  9. # save_dir = r'C:\SRI-DINO.Server-py\logs' # sri内网测试环境
  10. save_dir = r'C:\logs' # sri内网测试环境
  11. # last_log_key = str()
  12. class MessageListener(object):
  13. """
  14. """
  15. last_log_key = str()
  16. @staticmethod
  17. def method_v001(client, userdata, message):
  18. """消息处理方法"""
  19. # --- log ---
  20. # print(f'MessageListener24: #message.payload: {message.payload}', flush=True)
  21. # methods.debug_log(f"MessageListener24", f"#message.payload: {message.payload}")
  22. # --- check ---
  23. # if not methods.is_dir(save_dir):
  24. # out = methods.run_command(f'mkdir -p {save_dir}', callback=True)
  25. # methods.debug_log('MessageListener46', f"#out: {out}")
  26. # --- save log ---
  27. file_name = methods.now_string('v001-%Y-%m-%d-%H.log')
  28. log_file_path = os.path.join(save_dir, file_name)
  29. log_dict = json.loads(message.payload)
  30. log_list = [
  31. f"timestamp: {methods.ts_to_string(int(log_dict.get('timestamp')) / 1000)}", # 时间
  32. f"userID: {log_dict.get('userID')}", # 用户id
  33. f"VehicleID: {log_dict.get('VehicleID')}", # 车id
  34. f"directSwitch: {log_dict.get('baseControl')[0].get('directSwitch')}", # 前后切换
  35. f"eStop: {log_dict.get('baseControl')[0].get('eStop')}", # 急停开关
  36. f"gearCaontrol: {log_dict.get('baseControl')[0].get('gearCaontrol')}", # 车辆档位控制
  37. f"hazardLight: {log_dict.get('baseControl')[0].get('hazardLight')}", # 双闪灯
  38. f"keyStatus: {log_dict.get('baseControl')[0].get('keyStatus')}", # 钥匙状态
  39. f"parkControl: {log_dict.get('baseControl')[0].get('parkControl')}", # 驻车控制
  40. f"silencedAlarm: {log_dict.get('baseControl')[0].get('silencedAlarm')}", # 消报警音按钮
  41. f"travelLight: {log_dict.get('baseControl')[0].get('travelLight')}", # 行驶灯光
  42. f"travelMode: {log_dict.get('baseControl')[0].get('travelMode')}", # 驾驶模式
  43. f"vehicleHorn: {log_dict.get('baseControl')[0].get('vehicleHorn')}", # 喇叭
  44. f"accPedalF: {log_dict.get('driveControl')[0].get('accPedal')[0].get('accPedalF')}", # 油门踏板.手油门
  45. f"accPedalH: {log_dict.get('driveControl')[0].get('accPedal')[0].get('accPedalH')}", # 油门踏板.脚油门
  46. f"accPedalH: {log_dict.get('driveControl')[0].get('brakePedal')}", # 刹车踏板
  47. f"steeringWheel: {log_dict.get('driveControl')[0].get('steeringWheel')}", # 方向盘转速
  48. f"turnMode: {log_dict.get('driveControl')[0].get('turnMode')}", # 转向模式
  49. f"turnSignal: {log_dict.get('driveControl')[0].get('turnSignal')}", # 转向灯
  50. f"errAccPedal: {log_dict.get('errCode')[0].get('errAccPedal')}", # 油门信号故障
  51. f"errBasOperation: {log_dict.get('errCode')[0].get('errBasOperation')}", # 基本操作故障
  52. f"errBrakePedal: {log_dict.get('errCode')[0].get('errBrakePedal')}", # 刹车信号故障
  53. f"errEndTool: {log_dict.get('errCode')[0].get('errEndTool')}", # 末端工具控制故障
  54. f"errHandle: {log_dict.get('errCode')[0].get('errHandle')}", # 手柄信号故障
  55. f"errOther: {log_dict.get('errCode')[0].get('errOther')}", # 其他故障
  56. f"errSteeringWheel: {log_dict.get('errCode')[0].get('errSteeringWheel')}", # 转向故障
  57. f"baseLegControl: {log_dict.get('taskControl')[0].get('baseLegControl')}", # 支腿动作控制
  58. f"baseLegSwitch: {log_dict.get('taskControl')[0].get('baseLegSwitch')}", # 支腿选择开关
  59. f"bypassSwitch: {log_dict.get('taskControl')[0].get('bypassSwitch')}", # 旁通开关
  60. f"cabLift: {log_dict.get('taskControl')[0].get('cabLift')}", # 驾驶室升降机构
  61. f"coopSignal: {log_dict.get('taskControl')[0].get('coopSignal')}", # 协同作业信号
  62. f"enableHydraulic: {log_dict.get('taskControl')[0].get('enableHydraulic')}", # 液压使能开关
  63. f"endJoint: {log_dict.get('taskControl')[0].get('endJoint')}", # 末端关节控制
  64. f"esCabLift: {log_dict.get('taskControl')[0].get('esCabLift')}", # 驾驶室应急下降开关
  65. f"suckerSelect: {log_dict.get('taskControl')[0].get('suckerSelect')}", # 吸盘选择开关
  66. f"taskJoint_1: {log_dict.get('taskControl')[0].get('taskJoint_1')}", # 第一个作业关节控制
  67. f"taskJoint_2: {log_dict.get('taskControl')[0].get('taskJoint_2')}", # 第二个作业关节控制
  68. f"taskJoint_3: {log_dict.get('taskControl')[0].get('taskJoint_3')}", # 第三个作业关节控制
  69. f"toolControl: {log_dict.get('taskControl')[0].get('toolControl')}", # 末端工具控制
  70. f"workLight: {log_dict.get('taskControl')[0].get('workLight')}", # 工作灯
  71. ]
  72. # --- check ---
  73. log_key = '-'.join(log_list[1:])
  74. if MessageListener.last_log_key and MessageListener.last_log_key == log_key:
  75. # methods.debug_log(f"MessageListener24", f"#86: {MessageListener.last_log_key == log_key}")
  76. return
  77. # --- update --
  78. MessageListener.last_log_key = log_key
  79. # --- save ---
  80. methods.debug_log(f"MessageListener24", f"#log_list: {log_list}")
  81. methods.write_text(log_file_path, ' | '.join(log_list) + '\n', 'a')
  82. @classmethod
  83. def subscribe_v001(cls):
  84. """"""
  85. Global.emqx.start_subscribe_loop(
  86. decorate_method=MessageListener.method_v001,
  87. subscribe_topic='Vehicle/ControlVehicle/Veh001'
  88. )
  89. @staticmethod
  90. def method_c001(client, userdata, message):
  91. """消息处理方法"""
  92. # --- log ---
  93. methods.debug_log(f"MessageListener|114", f"#message.payload: {message.payload}")
  94. def subscribe_c001(cls):
  95. """"""
  96. Global.emqx.start_subscribe_loop(
  97. decorate_method=MessageListener.method_c001,
  98. subscribe_topic='Cockpit/CanBus/CanId001/Cop001'
  99. )
  100. @classmethod
  101. def run(cls, background_is=True):
  102. thread_list = [
  103. threading.Thread(target=cls.subscribe_v001),
  104. ]
  105. for thread in thread_list:
  106. thread.setDaemon(True)
  107. thread.start()
  108. if background_is:
  109. return
  110. for thread in thread_list:
  111. thread.join()
  112. if __name__ == '__main__':
  113. # --- test ---
  114. MessageListener.run()