From ba41358428988a28880d35241ae8702f7698b4e9 Mon Sep 17 00:00:00 2001 From: ZKX34 <3442977470@qq.com> Date: Wed, 24 Dec 2025 21:43:10 +0800 Subject: [PATCH 1/2] =?UTF-8?q?=E5=BB=BA=E7=AB=8B=E6=97=A0=E4=BA=BA?= =?UTF-8?q?=E6=9C=BA=E6=A8=A1=E5=9E=8B?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/drone_simulation/main.py | 112 +++++++++++++++++++++ src/drone_simulation/mjmodel.xml | 52 ++++++++++ src/drone_simulation/model.xml | 164 +++++++++++++++++++++++++++++++ 3 files changed, 328 insertions(+) create mode 100644 src/drone_simulation/main.py create mode 100644 src/drone_simulation/mjmodel.xml create mode 100644 src/drone_simulation/model.xml diff --git a/src/drone_simulation/main.py b/src/drone_simulation/main.py new file mode 100644 index 0000000000..78f334b53d --- /dev/null +++ b/src/drone_simulation/main.py @@ -0,0 +1,112 @@ +# simple_visible_drone.py +import mujoco +import mujoco.viewer +import numpy as np +import time +import os +import glob + +# 定义日志文件路径(可根据实际情况修改) +LOG_FILE_PATHS = [ + "mujoco.log", + "drone_simulation.log", + "./logs/*.log" +] + + +def delete_log_files(): + """删除指定的日志文件(无控制台输出)""" + deleted_count = 0 + for path in LOG_FILE_PATHS: + if "*" in path: + for file in glob.glob(path): + try: + os.remove(file) + deleted_count += 1 + except (FileNotFoundError, PermissionError): + continue + else: + if os.path.exists(path): + try: + os.remove(path) + deleted_count += 1 + except (FileNotFoundError, PermissionError): + continue + + +# 最小化但可见的模型 +MJCF_MODEL = """ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + +""" + + +def main(): + # 删除日志文件(无输出) + delete_log_files() + + # 加载模型和数据 + model = mujoco.MjModel.from_xml_string(MJCF_MODEL) + data = mujoco.MjData(model) + + # 等待3秒(无提示) + time.sleep(3) + + with mujoco.viewer.launch_passive(model, data) as viewer: + # 设置相机视角 + viewer.cam.lookat[:] = [0, 0, 1] + viewer.cam.distance = 8.0 + viewer.cam.azimuth = 45 + viewer.cam.elevation = -30 + + t = 0 + while viewer.is_running() and t < 20: + # 简单的上下浮动 + force_z = 20 * np.sin(t * 2) + 50 + + # 应用力 + data.qfrc_applied[2] = force_z + + # 缓慢旋转 + data.qfrc_applied[5] = 5 * np.sin(t * 0.5) + + mujoco.mj_step(model, data) + viewer.sync() + + t += 0.01 + time.sleep(0.01) + + +if __name__ == "__main__": + main() diff --git a/src/drone_simulation/mjmodel.xml b/src/drone_simulation/mjmodel.xml new file mode 100644 index 0000000000..b86af68bb9 --- /dev/null +++ b/src/drone_simulation/mjmodel.xml @@ -0,0 +1,52 @@ + + + + \ No newline at end of file diff --git a/src/drone_simulation/model.xml b/src/drone_simulation/model.xml new file mode 100644 index 0000000000..717a287e45 --- /dev/null +++ b/src/drone_simulation/model.xml @@ -0,0 +1,164 @@ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + \ No newline at end of file From 7e4a5998809450db0af6ba687bd02ab9557a8ac4 Mon Sep 17 00:00:00 2001 From: ZKX34 <3442977470@qq.com> Date: Thu, 25 Dec 2025 21:12:49 +0800 Subject: [PATCH 2/2] =?UTF-8?q?=E6=9B=B4=E6=96=B0=E4=BB=A3=E7=A0=81?= =?UTF-8?q?=EF=BC=8C=E4=BD=BF=E6=97=A0=E4=BA=BA=E6=9C=BA=E6=A8=A1=E5=9E=8B?= =?UTF-8?q?=E6=9B=B4=E5=8A=A0=E7=B2=BE=E7=BB=86=E5=8C=96?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/drone_simulation/main.py | 242 +++++++++++++++++++++++------------ 1 file changed, 160 insertions(+), 82 deletions(-) diff --git a/src/drone_simulation/main.py b/src/drone_simulation/main.py index 78f334b53d..8f2f6f861d 100644 --- a/src/drone_simulation/main.py +++ b/src/drone_simulation/main.py @@ -1,112 +1,190 @@ -# simple_visible_drone.py import mujoco import mujoco.viewer import numpy as np import time -import os -import glob - -# 定义日志文件路径(可根据实际情况修改) -LOG_FILE_PATHS = [ - "mujoco.log", - "drone_simulation.log", - "./logs/*.log" -] - - -def delete_log_files(): - """删除指定的日志文件(无控制台输出)""" - deleted_count = 0 - for path in LOG_FILE_PATHS: - if "*" in path: - for file in glob.glob(path): - try: - os.remove(file) - deleted_count += 1 - except (FileNotFoundError, PermissionError): - continue - else: - if os.path.exists(path): - try: - os.remove(path) - deleted_count += 1 - except (FileNotFoundError, PermissionError): - continue - - -# 最小化但可见的模型 + +# 无人机模型(完全静止版本 - 修复关节范围错误) MJCF_MODEL = """ + """ def main(): - # 删除日志文件(无输出) - delete_log_files() - - # 加载模型和数据 - model = mujoco.MjModel.from_xml_string(MJCF_MODEL) - data = mujoco.MjData(model) - - # 等待3秒(无提示) - time.sleep(3) + print("=" * 50) + print(" 无人机完全静止展示") + print("=" * 50) + print("特性:") + print("1. 无人机保持绝对静止,无任何移动或旋转") + print("2. 旋翼完全固定,不会转动") + print("3. 所有零件尺寸放大,视觉效果佳") + print("4. 按ESC键退出展示窗口") + print("=" * 50) + + # 加载模型 + try: + model = mujoco.MjModel.from_xml_string(MJCF_MODEL) + data = mujoco.MjData(model) + except Exception as e: + print(f"加载模型失败: {e}") + input("按Enter键退出...") + return + + # 初始化viewer + try: + viewer = mujoco.viewer.launch_passive(model, data) + is_passive = True + except: + viewer = mujoco.viewer.launch(model, data) + is_passive = False + + try: + # 设置相机视角(固定视角) + viewer.cam.lookat[0] = 0.0 + viewer.cam.lookat[1] = 0.0 + viewer.cam.lookat[2] = 2.0 + viewer.cam.distance = 5.0 + viewer.cam.azimuth = 45.0 + viewer.cam.elevation = -20.0 + + # 强制无人机完全静止 + data.body('drone').xpos[:] = [0.0, 0.0, 2.0] # 固定位置 + data.body('drone').xquat[:] = [1.0, 0.0, 0.0, 0.0] # 固定姿态 + data.body('drone').cvel[:] = [0.0, 0.0, 0.0, 0.0, 0.0, 0.0] # 零速度 + + sim_duration = 0 + last_time = time.time() + last_print = 0 + + # 展示主循环 + while True: + if is_passive and not viewer.is_running(): + break + + # 控制帧率 + current_time = time.time() + dt = current_time - last_time + last_time = current_time + + # 运行仿真步(但保持所有物体静止) + mujoco.mj_step(model, data) - with mujoco.viewer.launch_passive(model, data) as viewer: - # 设置相机视角 - viewer.cam.lookat[:] = [0, 0, 1] - viewer.cam.distance = 8.0 - viewer.cam.azimuth = 45 - viewer.cam.elevation = -30 + # 每帧都强制重置位置和速度,确保绝对静止 + data.body('drone').xpos[:] = [0.0, 0.0, 2.0] + data.body('drone').xquat[:] = [1.0, 0.0, 0.0, 0.0] + data.body('drone').cvel[:] = [0.0, 0.0, 0.0, 0.0, 0.0, 0.0] - t = 0 - while viewer.is_running() and t < 20: - # 简单的上下浮动 - force_z = 20 * np.sin(t * 2) + 50 + # 更新视图 + if is_passive: + viewer.sync() - # 应用力 - data.qfrc_applied[2] = force_z + # 每5秒打印一次状态 + if sim_duration - last_print > 5.0: + print(f"\n📊 展示状态 (时间: {sim_duration:.1f}s)") + print( + f"📍 无人机位置: x={data.body('drone').xpos[0]:.3f}, y={data.body('drone').xpos[1]:.3f}, z={data.body('drone').xpos[2]:.3f}m") + print(f"🔄 无人机速度: {np.linalg.norm(data.body('drone').cvel):.3f} m/s") + print("✅ 无人机保持完全静止") + last_print = sim_duration - # 缓慢旋转 - data.qfrc_applied[5] = 5 * np.sin(t * 0.5) + sim_duration += dt + time.sleep(0.01) # 控制展示帧率 - mujoco.mj_step(model, data) - viewer.sync() + except KeyboardInterrupt: + print("\n\n展示被用户中断") + except Exception as e: + print(f"\n\n展示出错: {e}") + finally: + if viewer and is_passive: + viewer.close() - t += 0.01 - time.sleep(0.01) + print("\n展示结束!") + input("按Enter键退出...") if __name__ == "__main__": - main() + main() \ No newline at end of file