Initial commit: 上传完整代码
This commit is contained in:
@@ -0,0 +1,76 @@
|
||||
from mqtt_client import MQTTClient
|
||||
from data_center import DataCenter
|
||||
from Manager.mwmotor_manager import MotorManager
|
||||
import sys
|
||||
import os
|
||||
import time
|
||||
import signal
|
||||
from PySide6.QtCore import *
|
||||
|
||||
class Application(QCoreApplication):
|
||||
def __init__(self, argv):
|
||||
super().__init__(argv)
|
||||
self.motor_manager = None
|
||||
self.mqtt_client = None
|
||||
self._signal_received = False
|
||||
|
||||
# 创建定时器检查信号
|
||||
self.timer = QTimer()
|
||||
self.timer.timeout.connect(self.check_signals)
|
||||
self.timer.start(100) # 每100ms检查一次
|
||||
|
||||
def check_signals(self):
|
||||
if self._signal_received:
|
||||
self.timer.stop()
|
||||
self.cleanup()
|
||||
|
||||
def cleanup(self):
|
||||
print("\n正在清理资源...")
|
||||
# 停止电机
|
||||
if self.motor_manager:
|
||||
self.motor_manager.emergency_stop(MotorManager.ID_MT1 | MotorManager.ID_MT2)
|
||||
time.sleep(0.2)
|
||||
self.motor_manager.destroy()
|
||||
time.sleep(0.2)
|
||||
# 断开MQTT连接
|
||||
if self.mqtt_client:
|
||||
self.mqtt_client.quit()
|
||||
print("资源清理完成,程序退出")
|
||||
self.quit()
|
||||
|
||||
def signal_handler(signum, frame):
|
||||
app._signal_received = True
|
||||
|
||||
def exec_cmd(cmd):
|
||||
print("exec:", cmd)
|
||||
out = os.popen(cmd)
|
||||
print(out.readlines())
|
||||
|
||||
if __name__ == "__main__":
|
||||
app = Application(sys.argv)
|
||||
|
||||
# 注册信号处理
|
||||
signal.signal(signal.SIGINT, signal_handler)
|
||||
signal.signal(signal.SIGTERM, signal_handler)
|
||||
|
||||
exec_cmd("sudo pinctrl set 17 op pn dl")
|
||||
|
||||
app.motor_manager = MotorManager()
|
||||
app.mqtt_client = MQTTClient()
|
||||
data_center = DataCenter()
|
||||
|
||||
app.motor_manager.mqtt_client = app.mqtt_client
|
||||
|
||||
app.motor_manager.update_online_status.connect(data_center.update_online_status)
|
||||
app.motor_manager.update_setting_velocity.connect(data_center.update_motor_setting_velocity)
|
||||
app.motor_manager.update_location.connect(data_center.update_motor_location)
|
||||
app.motor_manager.update_estimates.connect(data_center.update_motor_estimates)
|
||||
app.motor_manager.update_direction.connect(data_center.update_motor_direction)
|
||||
app.motor_manager.update_duration.connect(data_center.update_motor_duration)
|
||||
app.motor_manager.update_state.connect(data_center.update_motor_state)
|
||||
app.motor_manager.update_work_mode.connect(data_center.update_motor_sports_mode)
|
||||
data_center.dataReady.connect(app.mqtt_client.send_motor_status)
|
||||
app.mqtt_client.write_motor_data.connect(app.motor_manager.set_value)
|
||||
app.mqtt_client.write_motor_globaldev_data.connect(app.motor_manager.set_globaldev_value)
|
||||
|
||||
sys.exit(app.exec())
|
||||
Reference in New Issue
Block a user