From 6a6fa8511a27bceca29186984ffdaade28152bde Mon Sep 17 00:00:00 2001 From: windows <2877519694@qq.com> Date: Sun, 21 Dec 2025 15:09:32 +0800 Subject: [PATCH 1/3] =?UTF-8?q?=E7=BB=99=E5=B0=8F=E8=BD=A6=E6=B7=BB?= =?UTF-8?q?=E5=8A=A0=E8=87=AA=E5=8A=A8=E7=BC=93=E6=85=A2=E5=B7=A1=E8=88=AA?= =?UTF-8?q?=E5=8A=9F=E8=83=BD?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/simple_wheeled_vehicle/2.py | 1 - src/simple_wheeled_vehicle/wheeled_car.xml | 1 - 2 files changed, 2 deletions(-) diff --git a/src/simple_wheeled_vehicle/2.py b/src/simple_wheeled_vehicle/2.py index 72e5a0d308..11ce5fde0d 100644 --- a/src/simple_wheeled_vehicle/2.py +++ b/src/simple_wheeled_vehicle/2.py @@ -16,7 +16,6 @@ def on_press(k): if k in KEYS: KEYS[k] = True def on_release(k): if k in KEYS: KEYS[k] = False - keyboard.Listener(on_press=on_press, on_release=on_release).start() # ---------------- 加载模型 -------------- diff --git a/src/simple_wheeled_vehicle/wheeled_car.xml b/src/simple_wheeled_vehicle/wheeled_car.xml index 3e91223e18..e80693af65 100644 --- a/src/simple_wheeled_vehicle/wheeled_car.xml +++ b/src/simple_wheeled_vehicle/wheeled_car.xml @@ -8,7 +8,6 @@ - Date: Sun, 21 Dec 2025 20:46:52 +0800 Subject: [PATCH 2/3] =?UTF-8?q?=E7=BB=99=E5=B0=8F=E8=BD=A6=E5=91=A8?= =?UTF-8?q?=E5=9B=B4=E6=B7=BB=E5=8A=A0=E9=9A=9C=E7=A2=8D=E7=89=A9?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/simple_wheeled_vehicle/3.py | 59 ++++++++++++++++++++++ src/simple_wheeled_vehicle/wheeled_car.xml | 50 +++++++++++++++--- 2 files changed, 103 insertions(+), 6 deletions(-) create mode 100644 src/simple_wheeled_vehicle/3.py diff --git a/src/simple_wheeled_vehicle/3.py b/src/simple_wheeled_vehicle/3.py new file mode 100644 index 0000000000..11ce5fde0d --- /dev/null +++ b/src/simple_wheeled_vehicle/3.py @@ -0,0 +1,59 @@ +""" +自动巡航小车 +- 恒定速度 0.0005 m/s +- 转向回正(直走) +- R 键仍可复位 +""" +import mujoco +import mujoco.viewer +import numpy as np +from pynput import keyboard + +# ---------------- 键盘 ------------------ +KEYS = {keyboard.KeyCode.from_char('r'): False} + +def on_press(k): + if k in KEYS: KEYS[k] = True +def on_release(k): + if k in KEYS: KEYS[k] = False +keyboard.Listener(on_press=on_press, on_release=on_release).start() + +# ---------------- 加载模型 -------------- +model = mujoco.MjModel.from_xml_path("wheeled_car.xml") +data = mujoco.MjData(model) + +# ---------------- 参数 ------------------ +CRUISE_SPEED = 0.0005 # ← 龟速恒定前进 +steer_target = 0.0 # 直走 + +# ---------------- 复位 ------------------ +def reset_car(): + mujoco.mj_resetData(model, data) + data.qpos[2] = 0.03 + print("\r>>> 已复位 <<<", end='', flush=True) + +# ---------------- 主循环 ---------------- +mujoco.mj_resetData(model, data) +with mujoco.viewer.launch_passive(model, data) as viewer: + viewer.cam.distance = 2.5 + viewer.cam.elevation = -25 + while viewer.is_running(): + if KEYS[keyboard.KeyCode.from_char('r')]: + reset_car() + KEYS[keyboard.KeyCode.from_char('r')] = False + + # ---- 自动巡航:恒定速度 + 直走 ---- + data.ctrl[0] = steer_target # 前左转向 = 0 + data.ctrl[1] = steer_target # 前右转向 = 0 + data.ctrl[2] = CRUISE_SPEED # 前左驱动 + data.ctrl[3] = CRUISE_SPEED # 前右驱动 + data.ctrl[4] = CRUISE_SPEED # 后左驱动 + data.ctrl[5] = CRUISE_SPEED # 后右驱动 + + # ---- 仿真 + HUD ---- + mujoco.mj_step(model, data) + vel = np.linalg.norm(data.qvel[:3]) + print(f"\rspeed: {vel:7.5f} m/s", end='', flush=True) + viewer.sync() + + print() \ No newline at end of file diff --git a/src/simple_wheeled_vehicle/wheeled_car.xml b/src/simple_wheeled_vehicle/wheeled_car.xml index e80693af65..90ddf5b11f 100644 --- a/src/simple_wheeled_vehicle/wheeled_car.xml +++ b/src/simple_wheeled_vehicle/wheeled_car.xml @@ -1,4 +1,4 @@ - +