一种面向无人自行车的人工势场路径规划法
基本信息
申请号 | CN201710210981.6 | 申请日 | - |
公开(公告)号 | CN106843235B | 公开(公告)日 | 2019-04-12 |
申请公布号 | CN106843235B | 申请公布日 | 2019-04-12 |
分类号 | G05D1/02(2006.01)I | 分类 | 控制;调节; |
发明人 | 不公告发明人 | 申请(专利权)人 | 深圳市靖洲科技有限公司 |
代理机构 | - | 代理人 | - |
地址 | 518000 广东省深圳市南山区西丽街道留仙大道2012号新围大厦103B-1号 | ||
法律状态 | - |
摘要
摘要 | 本发明提供了一种面向无人自行车的人工势场局部路径规划法,包括:(1)初始化环境信息,确定无人自行车的初始位置、目标点位置和障碍物信息;(2)获取周围障碍物的信息,计算障碍物对无人自行车的影响距离及障碍物与目标位置的距离;(3)计算无人自行车在当前位置所受的引力与斥力,改进斥力势场函数和斥力函数后,计算合力的大小与方向;(4)引导无人自行车行进到下一个地点;(5)判断是否陷入局部最小点,如是则转入步骤(6),否则转入步骤(7);(6)加入虚拟障碍物,斥力场为Ja,转入步骤(2);(7)若有虚拟障碍物,将其删除,判断无人自行车是否到达目标位置或行走完规定距离,若是则结束,否则转到步骤(2)。 |
