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 @@
-
+
@@ -7,22 +7,25 @@
+
+
+
+
-
-
-
+
@@ -32,6 +35,41 @@
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
+
@@ -39,7 +77,7 @@
-
+
@@ -52,7 +90,7 @@
-
+
From 2a71069532229aaf6ecb7231621a6284103382be Mon Sep 17 00:00:00 2001
From: windows <2877519694@qq.com>
Date: Mon, 22 Dec 2025 02:03:59 +0800
Subject: [PATCH 3/3] =?UTF-8?q?=E7=BB=99=E5=B0=8F=E8=BD=A6=E6=96=B0?=
=?UTF-8?q?=E5=A2=9E=E7=BC=93=E6=85=A2=E8=87=AA=E5=8A=A8=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/3.py | 6 ------
src/simple_wheeled_vehicle/wheeled_car.xml | 24 +++++++++++-----------
2 files changed, 12 insertions(+), 18 deletions(-)
diff --git a/src/simple_wheeled_vehicle/3.py b/src/simple_wheeled_vehicle/3.py
index 11ce5fde0d..e439deac00 100644
--- a/src/simple_wheeled_vehicle/3.py
+++ b/src/simple_wheeled_vehicle/3.py
@@ -1,9 +1,3 @@
-"""
-自动巡航小车
-- 恒定速度 0.0005 m/s
-- 转向回正(直走)
-- R 键仍可复位
-"""
import mujoco
import mujoco.viewer
import numpy as np
diff --git a/src/simple_wheeled_vehicle/wheeled_car.xml b/src/simple_wheeled_vehicle/wheeled_car.xml
index 90ddf5b11f..a0f375ecf0 100644
--- a/src/simple_wheeled_vehicle/wheeled_car.xml
+++ b/src/simple_wheeled_vehicle/wheeled_car.xml
@@ -1,4 +1,4 @@
-
+
@@ -7,7 +7,6 @@
-
@@ -25,7 +24,7 @@
-
+
@@ -35,8 +34,7 @@
-
-
+
@@ -49,8 +47,6 @@
-
-
@@ -60,8 +56,6 @@
-
-
@@ -69,7 +63,11 @@
-
+
+
+
+
+
@@ -119,8 +117,10 @@
-
-
+
+
+
+