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