diff --git a/src/drone_simulation/MUJOCO_LOG.TXT b/src/drone_simulation/MUJOCO_LOG.TXT new file mode 100644 index 0000000000..8d7def32c0 --- /dev/null +++ b/src/drone_simulation/MUJOCO_LOG.TXT @@ -0,0 +1,3 @@ +Mon Dec 22 14:33:32 2025 +WARNING: Nan, Inf or huge value in QACC at DOF 0. The simulation is unstable. Time = 0.0450. + diff --git a/src/drone_simulation/main.py b/src/drone_simulation/main.py new file mode 100644 index 0000000000..b6804d05bc --- /dev/null +++ b/src/drone_simulation/main.py @@ -0,0 +1,87 @@ +# simple_visible_drone.py +import mujoco +import mujoco.viewer +import numpy as np +import time + +# 最小化但可见的模型 +MJCF_MODEL = """ + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + + +""" + + +def main(): + print("正在启动无人机仿真...") + print("按ESC退出窗口") + print("等待3秒...") + + # 直接从字符串加载模型 + model = mujoco.MjModel.from_xml_string(MJCF_MODEL) + data = mujoco.MjData(model) + + # 等待3秒 + time.sleep(3) + + print("开始飞行演示...") + + 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: # 运行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) + + print("仿真结束!") + + +if __name__ == "__main__": + main() \ 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