From 2fb482161a1dad8d10fd93cc9b6310cba1932628 Mon Sep 17 00:00:00 2001 From: 22268 <2226804607@qq.com> Date: Thu, 18 Dec 2025 23:41:09 +0800 Subject: [PATCH] =?UTF-8?q?=E5=B0=8F=E8=BD=A6=E5=BC=80=E5=A7=8B=E5=89=8D?= =?UTF-8?q?=E8=BF=9B=EF=BC=8C=E5=B9=B6=E4=B8=94=E8=83=BD=E6=8E=A7=E5=88=B6?= =?UTF-8?q?=E9=80=9F=E5=BA=A6?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/minicarsim/main.py | 7 ++ src/minicarsim/models/simple_car.xml | 102 +++++++++++++++++++++++++++ 2 files changed, 109 insertions(+) create mode 100644 src/minicarsim/models/simple_car.xml diff --git a/src/minicarsim/main.py b/src/minicarsim/main.py index 7a002bf72e..797db47ffb 100644 --- a/src/minicarsim/main.py +++ b/src/minicarsim/main.py @@ -201,6 +201,8 @@ def run_simulation(self): # 查找车辆的驱动关节 rear_left_idx = mujoco.mj_name2id(self.model, mujoco.mjtObj.mjOBJ_ACTUATOR, "rear_left_wheel_motor") rear_right_idx = mujoco.mj_name2id(self.model, mujoco.mjtObj.mjOBJ_ACTUATOR, "rear_right_wheel_motor") + front_left_steer_idx = mujoco.mj_name2id(self.model, mujoco.mjtObj.mjOBJ_ACTUATOR, "front_left_steering") + front_right_steer_idx = mujoco.mj_name2id(self.model, mujoco.mjtObj.mjOBJ_ACTUATOR, "front_right_steering") if rear_left_idx >= 0 and rear_right_idx >= 0: print("找到了车辆驱动关节") @@ -213,6 +215,11 @@ def run_simulation(self): self.data.ctrl[rear_left_idx] = 5.0 # 左后轮速度 if rear_right_idx >= 0: self.data.ctrl[rear_right_idx] = 5.0 # 右后轮速度 + # 设置前轮转向 + if front_left_steer_idx >= 0: + self.data.ctrl[front_left_steer_idx] = np.sin(i * 0.05) * 10 # 正弦变化转向 + if front_right_steer_idx >= 0: + self.data.ctrl[front_right_steer_idx] = np.sin(i * 0.05) * 10 # 正弦变化转向 # 执行仿真步长 mujoco.mj_step(self.model, self.data) diff --git a/src/minicarsim/models/simple_car.xml b/src/minicarsim/models/simple_car.xml new file mode 100644 index 0000000000..cb6aa99be0 --- /dev/null +++ b/src/minicarsim/models/simple_car.xml @@ -0,0 +1,102 @@ + + + + \ No newline at end of file