diff --git a/src/humanoid_3d_animation/humanoid_simulation.py b/src/humanoid_3d_animation/humanoid_simulation.py new file mode 100644 index 0000000000..68cdeedf1b --- /dev/null +++ b/src/humanoid_3d_animation/humanoid_simulation.py @@ -0,0 +1,138 @@ +import mujoco +import mujoco.viewer as viewer +import os +import time + +def create_humanoid_xml(file_path): + """自动创建humanoid.xml文件并写入模型代码""" + xml_content = """ + + """ + with open(file_path, "w", encoding="utf-8") as f: + f.write(xml_content) + print(f"已自动在 {file_path} 创建humanoid.xml文件!") + +def run_humanoid_simulation(): + # 直接写死桌面路径(替换成你的实际用户名,这里保留你的用户名) + # 注意:路径中的反斜杠用双反斜杠,或单反斜杠加r前缀 + model_path = r"C:\Users\欧阳志威1\Desktop\humanoid.xml" # r前缀表示原始字符串,避免转义 + + # 打印路径 + print(f"===== 模型文件路径 =====") + print(f"模型文件完整路径:{model_path}") + print(f"========================") + + # 检查并创建文件 + if not os.path.exists(model_path): + create_humanoid_xml(model_path) + else: + print("humanoid.xml文件已存在,无需重新创建!") + + # 加载模型(新增:用Python内置的open函数测试是否能读取文件) + try: + # 先测试Python是否能读取该文件(排除系统权限问题) + with open(model_path, "r", encoding="utf-8") as f: + f.read() + print("Python内置函数已成功读取文件,权限正常!") + except Exception as e: + print(f"Python读取文件失败,权限/路径问题:{e}") + return + + # 加载MuJoCo模型 + try: + model = mujoco.MjModel.from_xml_path(model_path) + data = mujoco.MjData(model) + print("模型加载成功!开始启动仿真...") + except Exception as e: + print(f"MuJoCo加载模型失败:{e}") + # 备选方案:从字符串加载模型(绕过文件读取) + print("尝试从字符串直接加载模型...") + with open(model_path, "r", encoding="utf-8") as f: + xml_str = f.read() + model = mujoco.MjModel.from_xml_string(xml_str) + data = mujoco.MjData(model) + print("从字符串加载模型成功!开始启动仿真...") + + # 运行仿真 + with viewer.launch_passive(model, data) as v: + sim_steps = 10000 + step_interval = 0.01 + print("仿真开始,按窗口关闭按钮退出...") + for _ in range(sim_steps): + mujoco.mj_step(model, data) + v.sync() + time.sleep(step_interval) + print("仿真结束!") + +if __name__ == "__main__": + run_humanoid_simulation() \ No newline at end of file