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