From fa0864d3e5ed931d02b3fea958c103b2b17f7042 Mon Sep 17 00:00:00 2001 From: windows <2877519694@qq.com> Date: Fri, 19 Dec 2025 15:32:28 +0800 Subject: [PATCH 1/3] =?UTF-8?q?=E6=8F=90=E4=BA=A4=E9=80=89=E9=A2=98?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/simple_wheeled_vehicle/README.md | 49 ++++++++++++++++++++++++++++ 1 file changed, 49 insertions(+) create mode 100644 src/simple_wheeled_vehicle/README.md diff --git a/src/simple_wheeled_vehicle/README.md b/src/simple_wheeled_vehicle/README.md new file mode 100644 index 0000000000..d6a7ae411e --- /dev/null +++ b/src/simple_wheeled_vehicle/README.md @@ -0,0 +1,49 @@ +简易轮式小车 MuJoCo 模型 +README.md +markdown +# 简易轮式小车 MuJoCo 仿真模型 +一款轻量化的**2驱动轮+1万向轮**轮式小车 MuJoCo 模型,适用于移动机器人运动控制入门学习。 + +## 模型概述 +- **结构组成**:长方体底盘 + 2个后置驱动轮 + 1个前置万向轮 +- **关节类型**:驱动轮采用铰链关节(沿Y轴旋转),万向轮采用球关节(360°自由转向) +- **控制方式**:驱动轮速度控制,支持差速转向 +- **引擎兼容性**:MuJoCo 2.1 及以上版本 + +## 模型文件结构 +simple_wheeled_car/├── car_model.xml # 核心 MJCF 模型文件└── README.md # 模型说明文档 +plaintext + +## 核心组件说明 +| 组件 | 类型 | 功能 | +|-----------|------|----------| +| 底盘 | 长方体几何 | 小车主体,承载所有部件 | +| 左/右驱动轮 | 圆柱体几何 | 由速度执行器驱动,提供动力 | +| 万向轮 | 球体几何 | 支撑车身,实现自由转向 | +| 铰链关节 | 铰链类型 | 约束驱动轮沿固定轴旋转 | +| 球关节 | 球型类型 | 允许万向轮无驱动自由转向 | +| 速度执行器 | 速度类型 | 控制驱动轮旋转速度 | + +## 快速上手 +1. 将 `car_model.xml` 放入你的 MuJoCo 项目目录 +2. 在 MuJoCo 模拟器或自定义代码中加载该模型 +3. 通过为 `left_wheel_vel` 和 `right_wheel_vel` 执行器设置目标速度来控制小车 + +## 控制逻辑 +- **直线运动**:为左右驱动轮设置相同的目标速度(正数前进,负数后退) +- **差速转向**:为两个驱动轮设置不同的目标速度(速度差越大,转向半径越小) + +## 自定义优化技巧 +- 调整底盘几何的 `size` 参数,修改车身尺寸 +- 修改惯性参数的 `mass` 值,调整车身重量和动力学性能 +- 更改速度执行器的 `ctrlrange` 参数,限制驱动轮最大转速 +模型大纲(car_model.xml 结构) +编译器配置:设置角度单位为弧度,启用从几何形状计算惯性参数 +默认参数定义:配置全局几何颜色、关节转动惯量和阻尼系数 +世界体定义 +搭建光源和地面平面 +定义带长方体几何与惯性参数的底盘体 +定义带铰链关节与圆柱体几何的左右驱动轮体 +定义带球关节与球体几何的万向轮体 +执行器配置:为两个驱动轮关节添加速度执行器 +可选扩展:添加传感器(如关节速度传感器)用于数据采集 \ No newline at end of file From 197efeccfc4e5ac116108f5b8b2c8eab62336771 Mon Sep 17 00:00:00 2001 From: windows <2877519694@qq.com> Date: Fri, 19 Dec 2025 16:33:43 +0800 Subject: [PATCH 2/3] =?UTF-8?q?=E6=8F=90=E4=BA=A4=E9=80=89=E9=A2=98?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/simple_wheeled_vehicle/README.md | 3 --- 1 file changed, 3 deletions(-) diff --git a/src/simple_wheeled_vehicle/README.md b/src/simple_wheeled_vehicle/README.md index d6a7ae411e..77edb8d4f7 100644 --- a/src/simple_wheeled_vehicle/README.md +++ b/src/simple_wheeled_vehicle/README.md @@ -1,6 +1,3 @@ -简易轮式小车 MuJoCo 模型 -README.md -markdown # 简易轮式小车 MuJoCo 仿真模型 一款轻量化的**2驱动轮+1万向轮**轮式小车 MuJoCo 模型,适用于移动机器人运动控制入门学习。 From 9bb7d1f364da935fc8653221536796dccced043b Mon Sep 17 00:00:00 2001 From: windows <2877519694@qq.com> Date: Fri, 19 Dec 2025 17:42:07 +0800 Subject: [PATCH 3/3] =?UTF-8?q?=E6=8F=90=E4=BA=A4=E9=80=89=E9=A2=98?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- src/simple_wheeled_vehicle/README.md | 175 ++++++++++++++++++++------- 1 file changed, 129 insertions(+), 46 deletions(-) diff --git a/src/simple_wheeled_vehicle/README.md b/src/simple_wheeled_vehicle/README.md index 77edb8d4f7..d38afd39ea 100644 --- a/src/simple_wheeled_vehicle/README.md +++ b/src/simple_wheeled_vehicle/README.md @@ -1,46 +1,129 @@ -# 简易轮式小车 MuJoCo 仿真模型 -一款轻量化的**2驱动轮+1万向轮**轮式小车 MuJoCo 模型,适用于移动机器人运动控制入门学习。 - -## 模型概述 -- **结构组成**:长方体底盘 + 2个后置驱动轮 + 1个前置万向轮 -- **关节类型**:驱动轮采用铰链关节(沿Y轴旋转),万向轮采用球关节(360°自由转向) -- **控制方式**:驱动轮速度控制,支持差速转向 -- **引擎兼容性**:MuJoCo 2.1 及以上版本 - -## 模型文件结构 -simple_wheeled_car/├── car_model.xml # 核心 MJCF 模型文件└── README.md # 模型说明文档 -plaintext - -## 核心组件说明 -| 组件 | 类型 | 功能 | -|-----------|------|----------| -| 底盘 | 长方体几何 | 小车主体,承载所有部件 | -| 左/右驱动轮 | 圆柱体几何 | 由速度执行器驱动,提供动力 | -| 万向轮 | 球体几何 | 支撑车身,实现自由转向 | -| 铰链关节 | 铰链类型 | 约束驱动轮沿固定轴旋转 | -| 球关节 | 球型类型 | 允许万向轮无驱动自由转向 | -| 速度执行器 | 速度类型 | 控制驱动轮旋转速度 | - -## 快速上手 -1. 将 `car_model.xml` 放入你的 MuJoCo 项目目录 -2. 在 MuJoCo 模拟器或自定义代码中加载该模型 -3. 通过为 `left_wheel_vel` 和 `right_wheel_vel` 执行器设置目标速度来控制小车 - -## 控制逻辑 -- **直线运动**:为左右驱动轮设置相同的目标速度(正数前进,负数后退) -- **差速转向**:为两个驱动轮设置不同的目标速度(速度差越大,转向半径越小) - -## 自定义优化技巧 -- 调整底盘几何的 `size` 参数,修改车身尺寸 -- 修改惯性参数的 `mass` 值,调整车身重量和动力学性能 -- 更改速度执行器的 `ctrlrange` 参数,限制驱动轮最大转速 -模型大纲(car_model.xml 结构) -编译器配置:设置角度单位为弧度,启用从几何形状计算惯性参数 -默认参数定义:配置全局几何颜色、关节转动惯量和阻尼系数 -世界体定义 -搭建光源和地面平面 -定义带长方体几何与惯性参数的底盘体 -定义带铰链关节与圆柱体几何的左右驱动轮体 -定义带球关节与球体几何的万向轮体 -执行器配置:为两个驱动轮关节添加速度执行器 -可选扩展:添加传感器(如关节速度传感器)用于数据采集 \ No newline at end of file +# 简易轮式小车智能代理 + +## 项目简介 +一个基于PyTorch神经网络与ROS的**简易轮式小车智能代理**,主要面向Carla自动驾驶模拟器。项目实现了从感知到控制的基本自动驾驶流程,模块化设计清晰,便于学习、扩展与二次开发。 + +## 功能特性 +- **环境感知**:处理相机图像,识别车道线、可行驶区域及动态障碍物。 +- **决策规划**:基于感知结果进行局部路径规划与动态避障决策。 +- **运动控制**:输出转向、油门及刹车指令,控制小车沿规划路径行驶。 +- **训练接口**:提供数据采集与模型训练接口,支持强化学习与模仿学习。 +- **ROS集成**:通过ROS节点进行模块间通信,支持传感器数据发布与控制指令订阅。 + +## 环境要求 +- **操作系统**:Ubuntu 20.04/22.04(推荐)或 Windows 10/11(WSL2) +- **Python**:3.7 - 3.12 +- **核心框架**:PyTorch >= 1.9.0(CPU/GPU版本均可) +- **模拟器**:Carla 0.9.14+ +- **可选依赖**:ROS Noetic 或 ROS2 Foxy(用于ROS通信) +- **基础包**:numpy, opencv-python, matplotlib + +## 项目结构 +``` +src/simple_wheeled_agent/ +├── main.py # 模块主入口 (非ROS启动) +├── main.launch # ROS启动配置文件 +├── requirements.txt +├── config/ +│ └── default.yaml # 配置文件 +├── docs/ # 模块文档 +├── models/ # 预训练模型存放处 +├── scripts/ # 工具脚本 +├── src/ # 核心源代码 +│ ├── perception/ +│ │ ├── __init__.py +│ │ ├── image_processor.py # 图像处理与神经网络推理 +│ │ └── data_collector.py # 训练数据采集 +│ ├── planning/ +│ │ ├── __init__.py +│ │ └── local_planner.py # 局部路径规划器 +│ ├── control/ +│ │ ├── __init__.py +│ │ └── pid_controller.py # 运动控制器 +│ └── utils/ # 通用工具函数 +└── tests/ # 单元测试 +``` + +## 快速开始 +1. **安装依赖**: + ```bash + cd src/simple_wheeled_agent + pip install -r requirements.txt -i https://mirrors.aliyun.com/pypi/simple/ + ``` + +2. **启动Carla服务端** (在另一个终端): + ```bash + ./CarlaUE4.sh -quality-level=Low # 可根据硬件调整画质 + ``` + +3. **运行代理**: + ```bash + python main.py --config config/default.yaml + ``` + 程序将连接Carla,生成车辆,并开始自主驾驶。 + +4. **(可选) ROS模式**: + ```bash + roslaunch simple_wheeled_agent main.launch + ``` + +## 主要类和方法 +- **`PerceptionAgent` (感知模块)**: + - `process_image(raw_image)`: 处理原始图像,输出车道与障碍物信息。 + - `collect_training_data()`: 采集带标签的训练数据。 + +- **`LocalPlanner` (规划模块)**: + - `compute_path(perception_result, goal)`: 根据感知结果和全局目标计算局部路径。 + - `dynamic_obstacle_avoidance()`: 动态避障算法。 + +- **`VehicleController` (控制模块)**: + - `update_control(target_path, current_state)`: 根据目标路径和车辆状态计算控制量。 + - `get_control()`: 返回当前的控制指令(转向、油门、刹车)。 + +## 配置参数 +关键参数可在 `config/default.yaml` 中调整: +```yaml +carla: + host: localhost + port: 2000 + timeout: 10.0 +vehicle: + target_speed: 30.0 # 目标速度 (km/h) + max_steer_angle: 70.0 # 最大转向角 (度) +perception: + model_path: models/perception_model.pth + image_width: 640 + image_height: 480 +``` + +## 数据输出 +运行过程中会生成以下数据: +1. **控制台输出**:车辆状态、控制指令、故障信息。 +2. **日志文件** (位于 `logs/`): 运行日志与性能统计。 +3. **数据记录** (训练模式下): 图像与对应控制指令,保存于 `data/train/`。 +4. **可视化窗口**:实时显示处理后的图像与规划路径。 + +## 扩展建议 +- **更换模拟器**:参考现有Carla接口,为AirSim或MuJoCo实现对应的环境包装器。 +- **改进感知模型**:替换 `perception` 模块中的网络结构(如使用ResNet、Transformer)。 +- **尝试新算法**:在 `planning` 模块中实现强化学习(PPO、SAC)或更先进的规划算法。 +- **增加传感器**:集成激光雷达(Lidar)或雷达(Radar)数据进行多传感器融合。 + +## 常见问题 +1. **Q: 无法连接到Carla服务器** + A: 请确认CarlaUE4正在运行,且端口未被占用。检查配置中的 `host` 和 `port`。 + +2. **Q: 运行时报错 “No module named ‘torch’”** + A: 请单独安装与你的Python及CUDA版本匹配的PyTorch。 + +3. **Q: 车辆控制不平稳,抖动严重** + A: 尝试调整 `config/default.yaml` 中的PID控制参数,或降低 `target_speed`。 + +4. **Q: 如何用自己的数据训练模型?** + A: 运行 `python main.py --mode collect` 采集数据,然后使用 `scripts/train_model.py` 进行训练。 + +5. **Q: ROS节点无法启动** + A: 确保ROS环境已正确配置 (`source /opt/ros//setup.bash`),且所有ROS依赖已安装。 + +--- +*更详细的API文档请使用 `mkdocs serve` 在本地构建和查看。* \ No newline at end of file