CN108614569A - 一种用于跟踪控制受控运动物体的方法 - Google Patents
一种用于跟踪控制受控运动物体的方法 Download PDFInfo
- Publication number
- CN108614569A CN108614569A CN201810654724.6A CN201810654724A CN108614569A CN 108614569 A CN108614569 A CN 108614569A CN 201810654724 A CN201810654724 A CN 201810654724A CN 108614569 A CN108614569 A CN 108614569A
- Authority
- CN
- China
- Prior art keywords
- motion
- coordinate
- distance
- corresponding points
- currently practical
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000006073 displacement reaction Methods 0.000 claims abstract description 7
- 230000011218 segmentation Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 2
- HNPWTDUZIXAJSA-UHFFFAOYSA-N 5,5-dimethyl-2-(3-methylbutanoyl)cyclohexane-1,3-dione Chemical compound CC(C)CC(=O)C1C(=O)CC(C)(C)CC1=O HNPWTDUZIXAJSA-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000014509 gene expression Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0246—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种用于跟踪控制受控运动物体的方法,属于运动控制领域。寻找运动物体实际位置在预规划运动曲线上对应的点,以及与预规划运动曲线的最小距离。过程为,根据当前实际坐标与前次对应坐标的移动距离,获得预规划运动曲线上的对应点;以当前对应点与下一个控制点做直线,计算当前实际坐标到该直线的距离,并以其作为受控物体相对运动曲线的偏离距离。本发明减少了每个控制周期计算受控物体在预规划运动曲线上的对应位置的计算量,同时该方法适用于各种曲线,而无需针对每种曲线设计不同的最小距离方程。
Description
技术领域
本发明属于运动控制领域,具体涉及一种用于跟踪控制受控运动物体的方法。
背景技术
智能车辆属于移动机器人领域,现有的移动机器人跟踪控制方法大致可分为以下几类基于反馈线性化方法,基于滑模变结构方法的跟踪控制,基于后推思想的方法,基于智能控制方法的跟踪控制器以及鲁棒控制方法。
但是具体到实际应用中,有以下特性需要兼顾(1)尽可能缩短控制周期以提高实时性,(2)能够适用不同平台以提高控制器通用性,(3)减少控制器对于参数的依赖以提高控制鲁棒性(4)控制量变化尽量光滑同时使得闭环系统在原点平衡状态是全局一致渐进稳定的。
在智能车辆运动控制中,为了更好的控制,我们会用拟合曲线的方式将运动路径拟合为运动曲线,控制运动物体沿该曲线运动。但是由于存在误差,物体的实际位置很难恰好在运动曲线上,因此必须找到运动物体实际位置在运动曲线上所对应的点才能确定误差。如使用对距离函数求导的方式计算距离最小值,则针对每种曲线需要单独设计最小距离方程,无法通用,同时,对于复杂曲线,动态求解最小距离方程运算量会比较大,如果每个控制周期进行计算会非常消耗计算资源。
发明内容
针对现有技术存在的缺陷,本发明旨在提供一种用于跟踪控制受控运动物体的方法。
本发明提供了一种用于跟踪控制受控运动物体的方法,其特征在于:采用测量目标的位置、速度等特征量的测量部件,本方法具体步骤如下:
步骤101:预先将规划运动曲线分割等间距控制点坐标序列;
步骤102:获得上个控制周期中的对应序号以及对应坐标,命名为“前次对应序号”以及“前次对应坐标”;
步骤103:获得当前控制周期中的实际坐标,命名为“当前实际坐标”;
步骤104:计算当前实际坐标与前次对应坐标之间的距离作为估算移动距离;
步骤105:根据该估算移动距离获得预估的对应点;
步骤106:以该预估的对应点为中心,在控制点坐标序列中寻找距离当前实际坐标最小的控制点。步骤107:以当前对应点与下一个控制点做直线,计算当前实际坐标到该直线的距离,并以其作为受控物体相对运动曲线的偏离距离;
步骤108:将当前对应点记录为前次对应点,更新对应序号,进入下一个周期;
步骤109:在每个运动控制周期重复步骤103到步骤108。
所述测量部件为毫米波雷达或摄像头模块或激光雷达。
所述寻找距离当前实际坐标最小的控制点时,查找方向为先沿着运动方向,再逆着运动方向。
所述方法用于寻找运动物体实际位置在预规划运动曲线上对应的点,以及与预规划运动曲线的最小距离。
所述方法使用可编程逻辑控制器计算。
所述方法每个运动控制周期为1-10s。
一种自动驾驶汽车,采用上述方法用于跟踪控制受控运动物体。
附图说明
图1为规划的拟合运动曲线;
图2为等间距分割后的坐标序列,符号(Pc1,Pc2,Pc3,…,Pcn-2,Pcn-1,Pcn) 为控制点,其下标中c表示该点是运动曲线上的点,数字表示控制点的序号;
图3为运动过程中某一个控制周期中,计算对应点的示意图,符号Ddiv为控制点分割间距;Dend为最后一段控制点间距;Pck为前次对应坐标,下标中c表示曲线上的点,k为前次对应序号;Pcie为当前猜测对应点,下标c表示曲线上的点,ie表示控制点序号的猜测值;Pci为当前对应点,下标c表示曲线上的点,i 表示控制点序号的实际值;Prp为前次实际坐标,下标r表示实际坐标,p表示前一控制周期;Prc为当前实际坐标,下标r表示实际坐标,c表示当前控制周期;
图4为对应控制周期中,计算受控物体实际坐标与运动曲线偏离距离的示意图,符号De为当前实际坐标与运动曲线偏离距离,下标e表示误差;Pcie,Pci同图3;Pci+1表示Pci的下一个控制点,下标意义同Pci。
具体实施方式
为了能更清楚地理解本发明的技术方案,下面结合附图对本发明进一步说明。
步骤101:预先将图1中所规划的运动曲线分割为图2中间距为Ddiv的控制点坐标序列(Pc1,Pc2,Pc3,…,Pcn),最后一段间距Dend可以小于Ddiv。
步骤102:在前一个控制周期中,获得前次对应序号k,以及前次对应坐标 Pck,如图3。
步骤103:获得当前实际坐标Prc。
步骤104:计算当实际坐标Prc与前次对应坐标Pck之间的距离作为估算移动距离Dem=Distance(Prc,Pck)。
步骤105:根据该估算移动距离Dem获得对应点的估算序号ie=k+Dem/Ddiv。
步骤106:在控制点序列(Pc1~Pcn)中,在估算序号ie周围寻找距离当前实际坐标Prc最小的控制点,得到其序号i。查找方向为先沿着运动方向,再逆着运动方向。
步骤107:以对应点Pci和下一个控制点Pci+1做直线Li,计算当前实际坐标Prc到直线Li的距离,并以其作为受控物体相对运动曲线的偏离距离De,如图4。
步骤108:将当前对应点的下标i记录为前次对应点下标k。
步骤109:在每个运动控制周期重复步骤103到步骤108。
所述方法用于寻找运动物体实际位置在预规划运动曲线上对应的点,以及与预规划运动曲线的最小距离。
所述方法使用可编程逻辑控制器计算。
所述方法每个运动控制周期为1-10s。
一种自动驾驶汽车,采用上述方法用于跟踪控制受控运动物体。
本发明的有益效果是:减少每个控制周期计算受控物体在预规划运动曲线上的对应位置的计算量,同时该方法适用于各种曲线,而无需针对每种曲线设计不同的最小距离方程。
以上显示和描述了本发明的基本原理和主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (7)
1.一种用于跟踪控制受控运动物体的方法,其特征在于:采用测量目标的位置、速度等特征量的测量部件,本方法具体步骤如下:
步骤101:预先将规划运动曲线分割等间距控制点坐标序列;
步骤102:获得上个控制周期中的对应序号以及对应坐标,命名为“前次对应序号”以及“前次对应坐标”;
步骤103:获得当前控制周期中的实际坐标,命名为“当前实际坐标”;
步骤104:计算当前实际坐标与前次对应坐标之间的距离作为估算移动距离;
步骤105:根据该估算移动距离获得预估的对应点;
步骤106:以该预估的对应点为中心,在控制点坐标序列中寻找距离当前实际坐标最小的控制点;
步骤107:以当前对应点与下一个控制点做直线,计算当前实际坐标到该直线的距离,并以其作为受控物体相对运动曲线的偏离距离;
步骤108:将当前对应点记录为前次对应点,更新对应序号,进入下一个周期;
步骤109:在每个运动控制周期重复步骤103到步骤108。
2.根据权利要求1所述的一种用于跟踪控制受控运动物体的方法,其特征在于:所述测量部件为毫米波雷达或摄像头模块或激光雷达。
3.根据权利要求1所述的一种用于跟踪控制受控运动物体的方法,其特征在于:所述寻找距离当前实际坐标最小的控制点时,查找方向为先沿着运动方向,再逆着运动方向。
4.根据权利要求1所述的一种用于跟踪控制受控运动物体的方法,其特征在于:所述方法用于寻找运动物体实际位置在预规划运动曲线上对应的点,以及与预规划运动曲线的最小距离。
5.根据权利要求1所述的一种用于跟踪控制受控运动物体的方法,其特征在于:所述方法使用可编程逻辑控制器计算。
6.根据权利要求1所述的一种用于跟踪控制受控运动物体的方法,其特征在于:所述方法每个运动控制周期为1-10s。
7.一种自动驾驶汽车,其特征在于:采用权利要求1-6任意一项用于跟踪控制受控运动物体的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810654724.6A CN108614569B (zh) | 2018-06-22 | 2018-06-22 | 一种用于跟踪控制受控运动物体的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810654724.6A CN108614569B (zh) | 2018-06-22 | 2018-06-22 | 一种用于跟踪控制受控运动物体的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108614569A true CN108614569A (zh) | 2018-10-02 |
CN108614569B CN108614569B (zh) | 2021-01-15 |
Family
ID=63665491
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810654724.6A Active CN108614569B (zh) | 2018-06-22 | 2018-06-22 | 一种用于跟踪控制受控运动物体的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108614569B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1775601A (zh) * | 2005-11-18 | 2006-05-24 | 吉林大学 | 车辆行驶轨迹预估及车道偏离评价方法 |
US20090099717A1 (en) * | 2006-03-14 | 2009-04-16 | Hidenori Yabushita | Trajectory tracking control system and method for mobile unit |
CN102495631A (zh) * | 2011-12-09 | 2012-06-13 | 中国科学院合肥物质科学研究院 | 一种无人驾驶车辆跟踪预定轨迹的智能控制方法 |
CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
CN103869820A (zh) * | 2014-03-18 | 2014-06-18 | 北京控制工程研究所 | 一种巡视器地面导航规划控制方法 |
CN105667507A (zh) * | 2016-03-06 | 2016-06-15 | 张敏 | 自动导航式无人驾驶电动汽车 |
CN105773620A (zh) * | 2016-04-26 | 2016-07-20 | 南京工程学院 | 基于倍四元数的工业机器人自由曲线的轨迹规划控制方法 |
CN106598055A (zh) * | 2017-01-19 | 2017-04-26 | 北京智行者科技有限公司 | 一种智能车局部路径规划方法及其装置、车辆 |
CN107092266A (zh) * | 2017-06-26 | 2017-08-25 | 东北大学 | 一种移动车轨迹跟踪控制方法 |
CN107339998A (zh) * | 2016-05-03 | 2017-11-10 | 现代自动车株式会社 | 考虑车辆驾驶情况来计算路线的装置和方法 |
-
2018
- 2018-06-22 CN CN201810654724.6A patent/CN108614569B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1775601A (zh) * | 2005-11-18 | 2006-05-24 | 吉林大学 | 车辆行驶轨迹预估及车道偏离评价方法 |
US20090099717A1 (en) * | 2006-03-14 | 2009-04-16 | Hidenori Yabushita | Trajectory tracking control system and method for mobile unit |
CN102495631A (zh) * | 2011-12-09 | 2012-06-13 | 中国科学院合肥物质科学研究院 | 一种无人驾驶车辆跟踪预定轨迹的智能控制方法 |
CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
CN103869820A (zh) * | 2014-03-18 | 2014-06-18 | 北京控制工程研究所 | 一种巡视器地面导航规划控制方法 |
CN105667507A (zh) * | 2016-03-06 | 2016-06-15 | 张敏 | 自动导航式无人驾驶电动汽车 |
CN105773620A (zh) * | 2016-04-26 | 2016-07-20 | 南京工程学院 | 基于倍四元数的工业机器人自由曲线的轨迹规划控制方法 |
CN107339998A (zh) * | 2016-05-03 | 2017-11-10 | 现代自动车株式会社 | 考虑车辆驾驶情况来计算路线的装置和方法 |
CN106598055A (zh) * | 2017-01-19 | 2017-04-26 | 北京智行者科技有限公司 | 一种智能车局部路径规划方法及其装置、车辆 |
CN107092266A (zh) * | 2017-06-26 | 2017-08-25 | 东北大学 | 一种移动车轨迹跟踪控制方法 |
Non-Patent Citations (1)
Title |
---|
罗三定等: "四轮移动机器人智能预瞄轨迹跟踪控制", 《计算机工程与应用》 * |
Also Published As
Publication number | Publication date |
---|---|
CN108614569B (zh) | 2021-01-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103149937B (zh) | 一种基于曲率补偿的横侧向曲线航迹跟踪方法 | |
CN103645725A (zh) | 一种机器人示教轨迹规划方法和系统 | |
CN106826834B (zh) | 一种机器人焊接自动寻位方法 | |
CN102785129B (zh) | 复杂零件的曲面加工精度的在线检测方法 | |
CN111108457A (zh) | 用于运行机器人控制系统的方法、设备和计算机程序 | |
CN111039231B (zh) | 智能叉车转弯路径规划方法 | |
CN106799745A (zh) | 一种基于协同克里金的工业机械臂精度标定方法 | |
CN107443388A (zh) | 一种基于泛克里金的机械臂绝对定位误差估计方法 | |
CN107511824B (zh) | 一种机器人掉头的控制方法及芯片 | |
CN105676779A (zh) | 一种自由曲面加工局部干涉区域边界确定的追踪方法 | |
CN106958643B (zh) | 齿轮轮齿接触性能分析方法 | |
CN107436592A (zh) | 基于b样条的精密打磨轨迹生成方法 | |
CN107748540A (zh) | 一种基于牛顿法的多轴系统轮廓误差估计及迭代控制方法 | |
CN109991932A (zh) | 一种物流搬运设备s曲线加减速速度规划与控制方法 | |
CN104076743A (zh) | 一种自识别插补种类的插补控制方法 | |
CN105182906A (zh) | 基于高阶s型运动轨迹的位置与速度控制方法 | |
CN105978400A (zh) | 超声电机控制方法 | |
CN107717988A (zh) | 一种基于泛克里金的工业机械臂精度标定方法 | |
WO2022097169A1 (en) | System and method for navigating an autonomous entity through a navigation space in real time | |
CN116661469B (zh) | 机器人轨迹误差修正方法及系统 | |
CN108614569A (zh) | 一种用于跟踪控制受控运动物体的方法 | |
CN113910001A (zh) | 一种数控机床空间误差辨识方法 | |
CN104061888A (zh) | 机器人三维激光加工头tcp坐标修正方法及装置 | |
CN110370278B (zh) | 一种基于工业机器人抖动分析的路线调整系统及方法 | |
CN115488887A (zh) | 一种基于焊接变形预测的轨迹规划的方法、装置及设备 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230407 Address after: No. 2616, 26th Floor, Comprehensive Building, Furong Road Primary School, Yuhua District, Changsha City, Hunan Province, 410000, No. 589, Section 3, Furong Middle Road, Dongtang Street, Yuhua District, Changsha City Patentee after: Changsha Xunan Zhenzhuo Technology Co.,Ltd. Address before: No.cb101-024, ground floor, building 8, No.1 courtyard, Zhongguancun East Road, Haidian District, Beijing 100083 Patentee before: BEIJING MINJIE POWER TECHNOLOGY Co.,Ltd. |
|
TR01 | Transfer of patent right |