一种基于五阶贝塞尔曲线的机器人路径平滑方法及系统
基本信息
申请号 | CN202110213716.X | 申请日 | - |
公开(公告)号 | CN113031592A | 公开(公告)日 | 2021-06-25 |
申请公布号 | CN113031592A | 申请公布日 | 2021-06-25 |
分类号 | G05D1/02 | 分类 | 控制;调节; |
发明人 | 周洋;靳兴来;冯艳晓;朱世强;裴翔;王国成 | 申请(专利权)人 | 杭州国辰机器人科技有限公司 |
代理机构 | 苏州中合知识产权代理事务所(普通合伙) | 代理人 | 阮梅 |
地址 | 311215 浙江省杭州市萧山经济技术开发区建设二路957号 | ||
法律状态 | - |
摘要
摘要 | 本发明公开一种基于五阶贝塞尔曲线的机器人路径平滑方法及系统。一种基于五阶贝塞尔曲线的机器人路径平滑方法,包括如下步骤:获取栅格地图信息以及连接起始点和目标点的折线路径;根据折线路径设定多段五阶贝塞尔曲线,每段五阶贝塞尔曲线为五次多项式,以每段五阶贝塞尔曲线的六个控制点作为优化变量,多段五阶贝塞尔曲线的平滑性作为优化目标,建立线性等式约束条件和线性不等式约束条件;采用二次规划算法进行求解,获得连接起始点和目标点的最优平滑路径。本发明在折线路径的基础上,建立基于五阶贝塞尔曲线的凸优化模型,设计二次规划算法快速优化得到平滑路径,整个过程计算量小、精确度高,确保了机器人运动的平稳性。 |
