|
|
|
|
@ -414,7 +414,6 @@ def main_develop(args=None):
|
|
|
|
|
analyzer.create_global_global(sysid, analyzer.mavlink_systems[sysid].components[compid])
|
|
|
|
|
analyzer.create_global_rel(sysid, analyzer.mavlink_systems[sysid].components[compid])
|
|
|
|
|
analyzer.create_global_vel(sysid, analyzer.mavlink_systems[sysid].components[compid])
|
|
|
|
|
analyzer.create_global_hdg(sysid, analyzer.mavlink_systems[sysid].components[compid])
|
|
|
|
|
analyzer.create_vfr_hud(sysid, analyzer.mavlink_systems[sysid].components[compid])
|
|
|
|
|
analyzer.create_battery(sysid, analyzer.mavlink_systems[sysid].components[compid])
|
|
|
|
|
end_time = time.time()
|
|
|
|
|
@ -424,7 +423,7 @@ def main_develop(args=None):
|
|
|
|
|
|
|
|
|
|
start_time = time.time()
|
|
|
|
|
show_time = time.time()
|
|
|
|
|
while time.time() - start_time < 20:
|
|
|
|
|
while time.time() - start_time < 2000:
|
|
|
|
|
try:
|
|
|
|
|
# rclpy.spin(analyzer)
|
|
|
|
|
analyzer.emit_info() # 這邊是測試 node 的運行
|
|
|
|
|
@ -435,7 +434,6 @@ def main_develop(args=None):
|
|
|
|
|
analyzer.destroy_node()
|
|
|
|
|
rclpy.shutdown()
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
# 結束程式 退出所有 thread
|
|
|
|
|
mavlink_object3.stop()
|
|
|
|
|
mavlink_object3.thread.join()
|
|
|
|
|
|