![传统人工势场法程序_第1页](http://file3.renrendoc.com/fileroot_temp3/2022-1/13/6bf56369-f16c-4b7d-91e3-9b6f085bb4e1/6bf56369-f16c-4b7d-91e3-9b6f085bb4e11.gif)
![传统人工势场法程序_第2页](http://file3.renrendoc.com/fileroot_temp3/2022-1/13/6bf56369-f16c-4b7d-91e3-9b6f085bb4e1/6bf56369-f16c-4b7d-91e3-9b6f085bb4e12.gif)
版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
1、1 / 7 传统人工势场法程序 主程序: 起点位置 计算引力需要的增益系数 计算斥力的增益系数,都是自己设定的。 障碍影响距离,当障碍和车的距离大于这个距离时,斥力为, 即不受该障碍的影响。也是自 己设定。 障碍个数 步长 循环迭代次数 如果不能实现预期目标,可能也与初始的增益系数,设置的不合适有关。 给出障碍和目标信息 这个向量是()*维,其中是目标位置,剩下的都是障碍的位置。 循环初始,将车的起始坐标赋给 * 始化纟结束 开始主体循环 * 循环开始 ()()是保存车走过的每个点的坐标。刚开始先将起点放进该向量。 ()(); 调用计算角度模块 ()是计算出来的车和障碍,和目标之间的与轴之间的
2、夹角,统一规定角度为逆时针方向,用 这个模块可以计算出来。 调用计算引力模块 ()()是车和目标之间的角度,目标对车是引力。 ()为了后续计算斥力在引力方向的分量赋值给 ()计算出目标对车的引力在方向的两个分量值。 ()()计算斥力用的角度,是个向量,因为有个障碍,就有个角度。 调用计算斥力模块 ()计算出斥力在方向的分量数组。 计算合力和方向,这有问题,应该是数,每个循环的时候合力的大小应该是一个唯一的数, 不是数组。应该把斥力的所有分量相加,引力所有分量相加。 方向的合力 方向的合力 ()()合力与轴方向的夹角向量 计算车的下一步位置 )()()是应该完全相等的时候算作到达, 还是只是接近
3、就可以? 时候编程。 记录迭代到多少次,到达目标。 现在按完全相等的 ()()把路径向量的最后一个点赋值为目标 ()(); * * 画出障碍,起点 目标,路径点 画出路径 (); (); 路径向量是二维数组分别是数组的元素的集合,是两个一维数组。 障碍的坐标 ; 计算角度分程序: ()是引力,斥力与轴的角度向量是起点坐标,是目标和障碍的坐标向量 是障碍数目 ()() ()() (AA) () () 表示是目标 ,是()*矩阵 3 / 7 ()保存每个角度在向量里面,第一个元素是与目标的角度,后面都是与障碍的角度 计算引力分程序: ()输入参数为当前坐标,目标坐标,增益常数 ,分量和力的角度 把
4、路径上的临时点作为每个时刻的 ()()A()()A路径点和目标的距离平方 ()路径点和目标的距离 *(); *(); 计算斥力分程序: 斥力计算 ()输入参数为当前坐标,是目标和障碍的坐标向量,增益常数 ,障碍,目标方向的角度 ()()()A()()A路径点和障碍的距离平方 ()()路径点和障碍的距离保存在数组中 ()如果每个障碍和路径的距离大于障碍影响距离,斥力令为 () () ()*()A*()A)分解的向量 ()()*()()() ()()*() 判断距离是否在障碍影响范围内 ()叠加斥力的分量 () 改进势场法程序: 主程序: J 4 / 7 障碍和目标,起始位置都已知的路径规划 ,意
5、图实现从起点可以规划出一条避开障碍到达目 标的路径。 初始化车的参数 起点位置 计算引力需要的增益系数 初始化 计算斥力的增益系数,都是自己设定的。 障碍影响距离,当障碍和车的距离大于这个距离时,斥力为, 即不受该障碍的影响。也是自 己设定。 障碍个数 J 步长 循环迭代次数 如果不能实现预期目标,可能也与初始的增益系数,设置的不合适有关。 给出障碍和目标信息 这个向量是()*维,其中是目标位置,剩下的都是障碍的位置。 循环初始,将车的起始坐标赋给 * 始化纟结束 开始主体循环 * 循环开始 ()()是保存车走过的每个点的坐标。刚开始先将起点放进该向量。 ()(); 调用计算角度模块 ()是计
6、算出来的车和障碍,和目标之间的与轴之间的夹角,统一规定角度为逆时针方向, 用这个模块可以计算出来。 调用计算引力模块 ()()是车和目标之间的角度,目标对车是引力。 ()为了后续计算斥力在引力方向的分量赋值给 ()计算出目标对车的引力在方向的两个分量值。 ()()计算斥力用的角度,是个向量,因为有个障碍,就有个角度。 调用计算斥力模块 ()计算出斥力在方向的分量数组。 计算合力和方向,这有问题,应该是数,每个循环的时候合力的大小应该是一个唯一的数, 不是数组。应该把斥力的所有分量相加,引力所有分量相加。 方向的合力 方向的合力 ()()合力与轴方向的夹角向量 计算车的下一步位置 ()()*()
7、; ()()*(); 保存车的每一个位置在向量中 判断 5 / 7 ()()()()是应该完全相等的时候算作到达,还是只是接近就可以?现在按完全相 等的时候编程。 记录迭代到多少次,到达目标。 J 记录此时的值 如果不符合的条件,重新返回循环,继续执行。 大循环结束 ()()把路径向量的最后一个点赋值为目标 ()(); * 画出障碍,起点,目标,路径点 * 画出路径 (); (); 路径向量是二维数组分别是数组的元素的集合,是两个一维数组。 障碍的坐标 ; / II II II | 计算角度分程序: ()是引力,斥力与轴的角度向量是起点坐标,是目标和障碍的坐标向量 ,是()*矩阵 是障碍数目
8、()()(); ()()(); ()()A()A); () ()(); ()(); 表示是目标 ()保存每个角度在向量里面,第一个元素是与目标的角度,后面都是与障碍的角度 计算引力分程序: ()输入参数为当前坐标,目标坐标,增益常数 ,分量和力的角度 把路径上的临时点作为每个时刻的 ()()A()()A路径点和目标的距离平方 6 / 7 ()路径点和目标的距离 *()() *(); 计算斥力分程序: 斥力计算 ()输入参数为当前坐标,是目标和障碍的坐标向量,增益常数 ,障碍,目标方向的角 度 ()()A()()A路径点和目标的距离平方 ()路径点和目标的距离 ()()()A()()A路径点和障碍的距离平方 ()()路径点和障碍的距离保存在数组中 ()()A()()A; (); ()如果每个障碍和路径的距离大于障碍影响距离,斥力令为 (); (); (); (); () ()*()*()*(A)分解的向量 ()*()A)*(A)分解的向量 ()()*()()() ()*()*(
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 初中综合实践课程设计中的社区服务项目
- Unit 6 Bird watching Grammar 教学设计-2024-2025学年初中英语牛津译林版八年级上册
- 2024年二年级品社下册《路遇陌生人》教案 沪教版
- 《檀香及其香制品鉴别技术规程》(征求意见稿)
- 2023年广州市白云区大源街道办事处政府雇员招聘考试真题
- 2023年郴州汝城县鑫荣自来水有限公司招聘劳务人员考试真题
- 无锡城市职业技术学院招聘笔试真题2023
- 昆明市盘龙区引进银龄讲师笔试真题2023
- 北京平谷区公共文明引导员笔试真题2023
- 《儒林外史》专题复习课件(共70张课件)
- 高压电工作业培训通用PPT课件
- 俄罗斯餐桌礼仪ppt课件
- 道路工程施工组织设计方案(市政)
- 【课件】1 大青树下的小学
- 全面质量管理TQM培训课件
- 团队的力量(课堂PPT)课件
- 产品内分工理论和新兴古典贸易理论
- 工程项目第三方飞检迎检方案
- 矿床规模划分标准
- 华为IPD模式中跨部门团队成员的考核激励制度
- 吊篮斜屋面穿孔方式施工组织方案
评论
0/150
提交评论