CN106142082B - 机器人调整路径偏移的定位导航方法 - Google Patents
机器人调整路径偏移的定位导航方法 Download PDFInfo
- Publication number
- CN106142082B CN106142082B CN201610462650.7A CN201610462650A CN106142082B CN 106142082 B CN106142082 B CN 106142082B CN 201610462650 A CN201610462650 A CN 201610462650A CN 106142082 B CN106142082 B CN 106142082B
- Authority
- CN
- China
- Prior art keywords
- positioning strip
- translation
- sensor
- robot
- left sensor
- 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.)
- Active
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
一种机器人调整路径偏移的定位导航方法包括如下步骤:设置方向定位条和平移定位条;分别记录左侧传感器经过方向定位条的时间t2、右侧传感器经过方向定位条的时间t1及左侧传感器经过平移定位条的时间t2+T;计算得出实际行走方向与方向定位条的法线之间的夹角β;计算得出平移定位条与方向定位条的交点到左侧传感器实际经过平移定位条的t2+T时刻在方向定位条上的投影点之间的长度L;计算得出设计轨迹上的左侧传感器于t2+T时刻所处的定位点在方向定位条上的投影和交点之间的距离L1;分别比较L和L1、90°+β和γ,得到需要调整的平移位置差和偏转角。本发明根据几何关系计算实际路径相对于预定路径的偏移角度和偏移量,将机器人调整到正确的行走路径。
Description
技术领域
本发明涉及一种机器人调整路径偏移的定位导航方法,尤其是一种靶式控制且定点校正的机器人调整路径偏移的定位导航方法。
背景技术
目前在无轨室内定位导航的方案有视频图像识别、激光雷达、定点设置有源或无源标识等定位法。其定点设置有源和无源标识等定位法布置要求高,实施成本高。视频图像识别、激光雷达设备方案技术难度大、成本高。
发明内容
为了克服上述缺陷,本发明提供一种机器人调整路径偏移的定位导航方法,所述机器人调整路径偏移的定位导航方法能够在机器人需要行走的路径上转弯处和按照行走***的偏差量以及实际容许的最大偏差量决定设置校正点,从而能够确定机器人在室内行走过程中实际路径与预定路径的偏移,进而纠正机器人行走到正确的路径上。
本发明为了解决其技术问题所采用的技术方案是:一种机器人调整路径偏移的定位导航方法,包括如下步骤:
步骤1:在机器人需要行走的路径的转弯处和直行路径上设置方向定位条以及与方向定位条之间夹角为α的平移定位条,所述方向定位条和平移定位条为用户设定的校正点,校正点的密度由行走***的偏差量以及实际容许的最大偏差量决定;
步骤2:机器人沿实际行走方向以设定的速度v匀速行走,左侧传感器经过方向定位条的时间记录为t2,右侧传感器经过方向定位条的时间记录为t1,以及左侧传感器经过平移定位条的时间记录为t2+T;
步骤3:已知左侧传感器到右侧传感器的安装尺寸为d,实际行走方向与方向定位条的法线之间的夹角记为β,则计算得出β=tg-1(v*(t1-t2)/d);
步骤4:平移定位条与方向定位条的交点到左侧传感器实际经过平移定位条的t2+T时刻在方向定位条上的投影点之间的长度记为L,则计算得出L=((v*T)*cosβ)/(tgα);
步骤5:设计轨迹上的左侧传感器于t2+T时刻所处的定位点在方向定位条上的投影和交点之间的距离记为L1,则计算得出L1=L0-v*T*cosγ,其中L0和γ均已知,L0为设计轨迹上的左侧传感器于t2时刻所处的位置在方向定位条上的投影和交点之间的距离,γ为设计轨迹与方向定位条之间形成的大于0°小于90°的夹角;
步骤6:比较L和L1,即得到经过t2+T时间后,机器人按照实际行走方向与按照设计轨迹行走两种情况下在方向定位条方向上需要调整的投影平移位置差L’,即,L’=L-L1=((v*T)*cosβ)/(tgα)-(L0-v*T*cosγ);比较90°+β与γ,即得到经过t2+T时间后,机器人按照实际行走方向与按照设计轨迹行走两种情况下需要调整的偏转角θ,即,θ=90°+β-γ=90°+tg-1(v*(t1-t2)/d)-γ。
作为本发明的进一步改进,所述方向定位条和平移定位条的材质以及地面布设距离应与左侧传感器和右侧传感器的性能相匹配。
作为本发明的进一步改进,所述左侧传感器和右侧传感器分别由一个或一个以上的传感器构成。
本发明的有益效果是:本发明机器人调整路径偏移的定位导航方法,系根据几何关系以及匀速行走条件计算出实际路径相对于预定路径的偏移角度和偏移量,从而可以将机器人调整到正确的行走路径上。
附图说明
图1为本发明机器人调整路径偏移的定位导航方法的几何关系示意图。
对照以上附图,作如下补充说明:
1---传感器⑹在⑶和⑷上的运动轨迹
2---传感器⑺在⑶和⑷上的运动轨迹
3---平移定位条 4---方向定位条
6---左侧传感器 7---右侧传感器
8---实际行走方向 9---设计轨迹
11---机器人 15---定位点
34---交点
具体实施方式
本发明涉及一种机器人调整路径偏移的定位导航方法,其包括如下步骤:
步骤1:在机器人11需要行走的路径的转弯处和直行路径上设置方向定位条4以及与方向定位条4之间夹角为α的平移定位条3,所述方向定位条和平移定位条为用户设定的校正点,校正点的密度由行走***的偏差量以及实际容许的最大偏差量决定;
步骤2:机器人11沿实际行走方向8以设定的速度v匀速行走,左侧传感器6经过方向定位条4的时间记录为t2,右侧传感器7经过方向定位条4的时间记录为t1,以及左侧传感器6经过平移定位条3的时间记录为t2+T;
步骤3:已知左侧传感器6到右侧传感器7的安装尺寸为d,实际行走方向8与方向定位条4的法线之间的夹角记为β,则计算得出β=tg-1(v*(t1-t2)/d);
步骤4:平移定位条3与方向定位条4的交点34到左侧传感器6实际经过平移定位条3的t2+T时刻在方向定位条4上的投影点之间的长度记为L,则计算得出L=((v*T)*cosβ)/(tgα);
步骤5:设计轨迹9上的左侧传感器6于t2+T时刻所处的定位点15在方向定位条4上的投影和交点34之间的距离记为L1,则计算得出L1=L0-v*T*cosγ,其中L0和γ均已知,L0为设计轨迹9上的左侧传感器6于t2时刻所处的位置在方向定位条4上的投影和交点34之间的距离,γ为设计轨迹9与方向定位条4之间形成的大于0°小于90°的夹角;
步骤6:比较L和L1,即得到经过t2+T时间后,机器人11按照实际行走方向8与按照设计轨迹9行走两种情况下在方向定位条4方向上需要调整的投影平移位置差L’,即,L’=L-L1=((v*T)*cosβ)/(tgα)-(L0-v*T*cosγ);比较90°+β与γ,即得到经过t2+T时间后,机器人11按照实际行走方向8与按照设计轨迹9行走两种情况下需要调整的偏转角θ,即,θ=90°+β-γ=90°+tg-1((v*(t1-t2)/d)-γ。
因为方向定位条4和平移定位条3为用户设定的校正点,从而平移定位条3和方向定位条4之间的夹角α为已知。
实际行走方向8与设计轨迹9偏离。
机器人11为设定好的匀速行驶,速度v已知。
时间t2、t1、T都是根据传感器6、7经过方向定位条4、平移定位条3的时刻记录下来的,故,时间t2、t1、T已知。
在由左侧传感器6从t2到t2+T之间的实际运动轨迹、方向定位条4、左侧传感器6于t2+T时刻在平移定位条3上的位置点于方向定位条4上的投影6’所组成的第①个直角三角形以及由左侧传感器6从t2到t1之间的实际运动轨迹、方向定位条4、左侧传感器6到右侧传感器7的安装尺寸d之间所组成的第②个直角三角形中,实际行走方向8与方向定位条4的法线之间的夹角和左侧传感器6到右侧传感器7的安装尺寸与方向定位条4之间的夹角为同位角,均为β,故,在第②个直角三角形中,β所对的直角边长度v*(t1-t2)以及β相邻的直角边长度d均为已知,根据勾股定理,可以计算得出β=tg-1(v*(t1-t2)/d)。
在第①个直角三角形中,β角相邻的斜边长度为v*T,则与β角相邻的直角边长度为(v*T)*cosβ;在平移定位条3、方向定位条4以及左侧传感器6实际经过平移定位条3于t2+T时刻的位置点在方向定位条4上的投影6’组成的第③个直角三角形中,α及α所对的直角边长度(v*T)*cosβ均已知,根据勾股定理,可以计算得出另一个直角边L=((v*T)*cosβ)/(tgα)。
L0和机器人初始位置、速度v、设计轨迹9与方向定位条4之间的夹角γ有关,因为设计轨迹9是预先设计好的、已知的,因此,相当于L0就是一个可计算的确定值。
假设机器人11从初始位置以速度v行走,经时间t2刚好到达方向定位条4上的某位置,左侧传感器6在t2+T时刻到达定位点15,在由设计轨迹9、方向定位条4以及定位点15在方向定位条4上的投影15’所组成的第④个直角三角形中,γ角以及与γ角相邻的斜边长度v*T均已知,根据勾股定理,可以计算得出与γ角相邻的直角边长度为v*T*cosγ,则该定位点15在方向定位条4上的投影15’和交点34之间的距离L1=L0-v*T*cosγ。
机器人11从初始位置以速度v行走,经时间t2也可以没有到达方向定位条4,而是在方向定位条4上有投影时,该定位点15在方向定位条4上的投影和交点34之间的距离同样是L1=L0-v*T*cosγ。因为t2时刻是否刚好到达方向定位条4上的某位置,影响第④个直角三角形的位置变化,而大小无变化,即,第④个直角三角形中,γ角以及与γ角相邻的斜边长度v*T均已知且确定,故,定位点15在方向定位条4上的投影和交点34之间的距离依然是L1=L0-v*T*cosγ。
因为β是实际行走方向8与方向定位条4的法线的夹角,90°+β是实际行走方向8与方向定位条4的夹角,γ是设计轨迹9与方向定位条4的夹角。
所述方向定位条4和平移定位条3为用户设定的校正点,校正点的密度由行走***的偏差量(含环境干扰)以及实际容许的最大偏差量决定。
所述方向定位条4和平移定位条3的材质以及地面布设距离应与左侧传感器6和右侧传感器7的性能相匹配。
所述左侧传感器6和右侧传感器7分别由一个或一个以上的传感器构成。
本发明机器人调整路径偏移的定位导航方法,系根据几何关系以及匀速行走条件计算出实际路径相对于预定路径的偏移角度和偏移量,从而可以将机器人11调整到正确的行走路径上。
Claims (3)
1.一种机器人调整路径偏移的定位导航方法,其特征是:包括如下步骤:
步骤1:在机器人需要行走的路径的转弯处和直行路径上设置方向定位条以及与方向定位条之间夹角为α的平移定位条,所述方向定位条和平移定位条为用户设定的校正点,校正点的密度由行走***的偏差量以及实际容许的最大偏差量决定;
步骤2:机器人沿实际行走方向以设定的速度v匀速行走,左侧传感器经过方向定位条的时间记录为t2,右侧传感器经过方向定位条的时间记录为t1,以及左侧传感器经过平移定位条的时间记录为t2+T;
步骤3:已知左侧传感器到右侧传感器的安装尺寸为d,实际行走方向与方向定位条的法线之间的夹角记为β,则计算得出β=tg-1(v*(t1-t2)/d);
步骤4:平移定位条与方向定位条的交点到左侧传感器实际经过平移定位条的t2+T时刻在方向定位条上的投影点之间的长度记为L,则计算得出L=((v*T)*cosβ)/(tgα);
步骤5:设计轨迹上的左侧传感器于t2+T时刻所处的定位点在方向定位条上的投影和交点之间的距离记为L1,则计算得出L1=L0-v*T*cosγ,其中L0和γ均已知,L0为设计轨迹上的左侧传感器于t2时刻所处的位置在方向定位条上的投影和交点之间的距离,γ为设计轨迹与方向定位条之间形成的大于0°小于90°的夹角;
步骤6:比较L和L1,即得到经过t2+T时间后,机器人按照实际行走方向与按照设计轨迹行走两种情况下在方向定位条方向上需要调整的投影平移位置差L’,即,L’=L-L1=((v*T)*cosβ)/(tgα)-(L0-v*T*cosγ);比较90°+β与γ,即得到经过t2+T时间后,机器人按照实际行走方向与按照设计轨迹行走两种情况下需要调整的偏转角θ,即,θ=90°+β-γ=90°+tg-1(v*(t1-t2)/d)-γ。
2.根据权利要求1所述的机器人调整路径偏移的定位导航方法,其特征是:所述方向定位条和平移定位条的材质以及地面布设距离应与左侧传感器和右侧传感器的性能相匹配。
3.根据权利要求1所述的机器人调整路径偏移的定位导航方法,其特征是:所述左侧传感器和右侧传感器分别由一个或一个以上的传感器构成。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610462650.7A CN106142082B (zh) | 2016-06-23 | 2016-06-23 | 机器人调整路径偏移的定位导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610462650.7A CN106142082B (zh) | 2016-06-23 | 2016-06-23 | 机器人调整路径偏移的定位导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106142082A CN106142082A (zh) | 2016-11-23 |
CN106142082B true CN106142082B (zh) | 2018-07-10 |
Family
ID=57353772
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610462650.7A Active CN106142082B (zh) | 2016-06-23 | 2016-06-23 | 机器人调整路径偏移的定位导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106142082B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107515605B (zh) * | 2017-07-12 | 2020-12-18 | 台州智奥通信设备有限公司 | 一种基于超声波测距的agv小车导航方法及*** |
CN108296687B (zh) * | 2018-03-05 | 2019-08-27 | 北京华航唯实机器人科技股份有限公司 | 轨迹调整方法及装置 |
CN114690751A (zh) * | 2020-12-11 | 2022-07-01 | 珊口(深圳)智能科技有限公司 | 停泊控制方法、控制***、移动机器人及存储介质 |
CN113447040B (zh) * | 2021-08-27 | 2021-11-16 | 腾讯科技(深圳)有限公司 | 行驶轨迹确定方法、装置、设备以及存储介质 |
CN114159278B (zh) * | 2021-09-28 | 2024-03-15 | 杭州程天科技发展有限公司 | 适用于外骨骼吊架的自动校正控制方法和相关设备 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1033590A (zh) * | 1987-07-28 | 1989-07-05 | 布莱阿姆青年大学 | 机器人误差矫正装置和方法 |
CN1206880A (zh) * | 1997-07-11 | 1999-02-03 | 三星电子株式会社 | 用于控制机器人的最佳增益设定算法 |
CN104029203A (zh) * | 2014-06-18 | 2014-09-10 | 大连大学 | 实现空间机械臂避障的路径规划方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101234371B1 (ko) * | 2010-12-21 | 2013-02-18 | 고려대학교 산학협력단 | 이동 로봇의 최적 경로 생성 방법 및 이를 이용한 이동 로봇 |
JP5778311B1 (ja) * | 2014-05-08 | 2015-09-16 | 東芝機械株式会社 | ピッキング装置およびピッキング方法 |
-
2016
- 2016-06-23 CN CN201610462650.7A patent/CN106142082B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1033590A (zh) * | 1987-07-28 | 1989-07-05 | 布莱阿姆青年大学 | 机器人误差矫正装置和方法 |
CN1206880A (zh) * | 1997-07-11 | 1999-02-03 | 三星电子株式会社 | 用于控制机器人的最佳增益设定算法 |
CN104029203A (zh) * | 2014-06-18 | 2014-09-10 | 大连大学 | 实现空间机械臂避障的路径规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106142082A (zh) | 2016-11-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106142082B (zh) | 机器人调整路径偏移的定位导航方法 | |
US11340628B2 (en) | Marker-combined simultaneous localization and mapping navigation method, device and system | |
WO2021114764A1 (zh) | 基于局部地图的地图修正方法及*** | |
CN104520055B (zh) | 用于切割金属薄板胚料的方法 | |
CA2832956C (en) | System and method for controlling an unmanned aerial vehicle | |
RU2018138937A (ru) | Система отслеживания полосы для внедорожного транспортного средства | |
US9758239B2 (en) | System and method for controlling an unmanned air vehicle | |
US10508923B2 (en) | Vehicle position estimation device, vehicle position estimation method | |
MX2020002171A (es) | Metodo de correccion de posicion y dispositivo de correccion de error de posicion para vehiculo de conduccion asistida. | |
CN107179091B (zh) | 一种agv行走视觉定位误差修正方法 | |
CN105404842A (zh) | 基于地标二维码的agv定位定向及测速方法 | |
MX2017001247A (es) | Dispositivo y metodo de control de desplazamiento para vehiculo. | |
CN105783915A (zh) | 机器人基于图形标识和摄像头的全局空间定位方法 | |
CN102081404A (zh) | 一种通信约束下双无人机协同目标跟踪方法 | |
CN109189060B (zh) | 移动机器人的点镇定控制方法及装置 | |
CN104181926A (zh) | 机器人的导航控制方法 | |
CN110347160A (zh) | 一种基于双摄像头扫码的自动引导车及其导航方法 | |
DE502006001788D1 (de) | Verfahren zur flugführung mehrerer im verband fliegender flugzeuge | |
KR20180044354A (ko) | 차량 위치 추정 장치, 차량 위치 추정 방법 | |
US10586320B2 (en) | Method for correcting a predetermined cutting path for cutting a sheet metal blank | |
CN107544534A (zh) | 一种基于bds、ins的植保无人机自动精细作业及避障方法 | |
JP2017159879A (ja) | 車両位置認識システム | |
CN104965489A (zh) | 基于机器人的ccd自动对位组装***及方法 | |
CN205699105U (zh) | 一种脚步跟随式全向跑步机 | |
CN103472434B (zh) | 一种机器人声音定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
CB02 | Change of applicant information |
Address after: 215300 Kunshan City, Jiangsu province high tech Zone, Fung Road, No. 232, No. Applicant after: Suzhou pangolin robot Limited by Share Ltd Address before: 215300 Kunshan City, Jiangsu province high tech Zone, Fung Road, No. 232, No. Applicant before: KUNSHAN PANGOLIN ROBOTER CO., LTD. |
|
COR | Change of bibliographic data | ||
GR01 | Patent grant | ||
GR01 | Patent grant |