CN108775882B - 爬行机器人在圆柱类物体表面运动位置的描述方法 - Google Patents
爬行机器人在圆柱类物体表面运动位置的描述方法 Download PDFInfo
- Publication number
- CN108775882B CN108775882B CN201810562701.2A CN201810562701A CN108775882B CN 108775882 B CN108775882 B CN 108775882B CN 201810562701 A CN201810562701 A CN 201810562701A CN 108775882 B CN108775882 B CN 108775882B
- Authority
- CN
- China
- Prior art keywords
- point
- axis
- vector
- cylindrical surface
- robot
- 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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Numerical Control (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种爬行机器人在圆柱类物体表面运动位置的描述方法,采用分步假设法,如下:在笛卡尔直角坐标系中,设一圆柱面的轴线m在平面zoy内,在m轴上任意选择一圆A,圆A上任选一点C作为机器人在圆柱面上的位置;经分步假设,齐次向量表示,矩阵平移或旋转变换解算,改变相应的坐标值就可以求得任意点的坐标值,即对机器人在圆柱面上沿轴线方向移动或绕轴线对转动到任意点的位置描述。不管机器人在圆柱面上的移动方向是向左、向右、向前、向后,在出现多个分支方向的情况下,所用到的方法都是一样的,只需要利用本发明方法提供的公式平移或旋转变换,改变相应的坐标值就可以求得任意点的坐标值。
Description
技术领域
本发明涉及机器人领域,尤其涉及机器人运动位置的描述方法。
背景技术
随着机器人技术的发展和在实践中的不断应用,机器人技术越来越成熟,应用领域也越来越广泛;尤其是一些比较危险的高空恶劣环境,我们更是迫切需要机器人能够代替人力工作;机器人代替人力,符合社会发展的需要,能够把人力从繁重危险的作业环境中解放出来,还能提高生产效率。
爬管、爬杆、爬树等圆柱类物体的外表面的机器人有着广阔的发展前景,具有比较大的研究价值,目前该类机器人的发展还处于起步阶段;其中,影响该类机器人研究和应用的一个重要问题就是机器人在复杂管路或分叉上运动过程中的精确位置如何进行描述确定。如果在三维空间中以笛卡尔直角坐标系中的坐标(x,y,z)来表示空间位置的话,其难点就是机器人可能沿着水平管运动,还可能沿着竖直管运动,还有可能沿着任意倾斜角度的斜管运动;在沿着各类管路的运动,不但包括沿管路轴线方向的平移,还包括绕着管路外表面任意角度的旋转动;尤其是机器人绕斜管旋转任意角度的位置描述用常规的方法不容易描述。
发明内容
本发明提供了一种机器人在爬圆柱类物体的外表面时的精确位置描述方法。该方法以地面为绝对参考系,符合物体宏观运动的轨迹研究和其他控制的需要。
一种爬行机器人在圆柱类物体表面运动位置的描述方法,采用分步假设法,如下:
步骤一、在笛卡尔直角坐标系中,设一圆柱面的轴线m在平面zoy内,圆柱的半径为r;轴线m与z轴的夹角为θ,与z轴的交点为E;E与平面xoy之间的距离为a;在轴线m上任意选择一点A,该点到E的距离为b;过点A做垂直于轴线m的平面,则平面与圆柱面的相交面为圆A;在圆A上,任选一点C,将C点坐标作为机器人在圆柱面上的位置;其中,C点在圆柱面上的运动可以是沿着轴线m方向的移动,也可以是绕着轴线m的转动;
步骤二、为了求机器人在圆柱面上的C点位置,现做如下分步假设:
1、让圆柱轴线m的初始位置与y轴重合;
2、让点C的起始点在坐标原点O,并记该点向量为C1;此时点向量C1用齐次向量表示为:
3、点C从原点O沿y轴平移到A1点,此时点向量记为C2,此时点向量C2可以根据平移矩阵得到,平移矩阵为:
式中x0—沿x轴方向平移距离;
y0—沿y轴方向平移距离;
z0—沿z轴方向平移距离;
则
4、点C从A1点沿z轴方向平移到B1点,此时点向量记为C3;C3向量可根据平移矩阵得到;
5、点C从B1点绕y轴旋转α,此时点向量记为C4;此时C4向量根据旋转矩阵得到,其中旋转矩阵为:
旋转之后的C4向量为:
6、水平圆柱面绕x轴旋转π/2-θ,此时点向量记为C5;C5向量根据旋转矩阵得到,其中旋转矩阵为:
则
7、圆柱面沿z轴方向平移a,此时点向量记为C6;C6向量再根据平移矩阵得到:
按照步骤一的设定,公式(6)中的y0=b,z0=a;这样公式(6)中的所有变量对于确定的管路都是已知的;步骤一中设定的的机器人的位置C的坐标为:
上述C的坐标就是对机器人在圆柱面上沿轴线m方向移动或绕轴线m对转动到任意点的位置描述。
本发明的积极效果在于,机器人在圆柱面上的移动方向不论是向左、向右、向前、向后,在出现多个分支方向的情况下,所用到的方法都是一样的,只需要根据上述公式平移或旋转变换,改变相应的坐标值就可以求得任意点的坐标值。
需要说明的是,如果在实际的控制程序或算法中需要用到相对坐标值,也要以绝对坐标值为基础,进行差值运算;也就是说无论在实际的控制***中用何种控制程序或算法,都能以该方法所确定的位置坐标作为基础。
附图说明
图1是在步骤第一步中为机器人在圆柱面上设定的笛卡尔直角坐标系;
图2是在步骤第一步中分步假设时让圆柱轴线m的初始位置与y轴重合的情况。
具体实施方式
一种爬行机器人在圆柱类物体表面运动位置的描述方法,采用分步假设法,如下:
步骤一、如图1,在笛卡尔直角坐标系中,设一圆柱面的轴线m在平面zoy内,圆柱的半径为r;轴线m与z轴的夹角为θ,与z轴的交点为E;E与平面xoy之间的距离为a;在轴线m上任意选择一点A,该点到E的距离为b;过点A做垂直于轴线m的平面,则平面与圆柱面的相交面为圆A;在圆A上,任选一点C,将C点坐标作为机器人在圆柱面上的位置;其中,C点在圆柱面上的运动可以是沿着轴线m方向的移动,也可以是绕着轴线m的转动;
步骤二、为了求机器人在圆柱面上的C点位置,现做如下分步假设:
1、让圆柱轴线m的初始位置与y轴重合,如图2所示;
2、让点C的起始点在坐标原点O,并记该点向量为C1;此时点向量C1用齐次向量表示为:
3、点C从原点O沿y轴平移到A1点,此时点向量记为C2,如图2所示;此时点向量C2可以根据平移矩阵得到,平移矩阵为:
式中x0—沿x轴方向平移距离;
y0—沿y轴方向平移距离;
z0—沿z轴方向平移距离;
则
4、点C从A1点沿z轴方向平移到B1点,如图2,此时点向量记为C3;C3向量可根据平移矩阵得到;
5、点C从B1点绕y轴旋转α,如图2,此时点向量记为C4;此时C4向量根据旋转矩阵得到,其中旋转矩阵为:
旋转之后的C4向量为:
6、水平圆柱面绕x轴旋转π/2-θ,如图1,此时点向量记为C5;C5向量根据旋转矩阵得到,其中旋转矩阵为:
则
7、圆柱面沿z轴方向平移a,如图1,此时点向量记为C6;C6向量再根据平移矩阵得到:
对照图1,公式(6)中的y0=b,z0=a;这样公式(6)中的所有变量对于确定的管路都是已知的;对应图1中的机器人的位置C的坐标为:
即
上述C的坐标就是对机器人在圆柱面上沿轴线m方向移动或绕轴线m对转动到任意点的位置描述。
Claims (1)
1.一种爬行机器人在圆柱类物体表面运动位置的描述方法,其特征在于,它采用分步假设法,具体如下
步骤一、在笛卡尔直角坐标系中,设一圆柱面的轴线m在平面zoy内,圆柱的半径为r;轴线m与z轴的夹角为θ,与z轴的交点为E;E与平面xoy之间的距离为a;在轴线m上任意选择一点A,该点到E的距离为b;过点A做垂直于轴线m的平面,则平面与圆柱面的相交面为圆A;在圆A上,任选一点C,将C点坐标作为机器人在圆柱面上的位置;其中,C点在圆柱面上的运动可以是沿着轴线m方向的移动,也可以是绕着轴线m的转动;
步骤二、求机器人在圆柱面上的C点位置,现做如下分步假设:
2.1、让圆柱轴线m的初始位置与y轴重合;
2.2、让点C的起始点在坐标原点O,并记该点向量为C1;此时点向量C1用齐次向量表示为:
2.3、点C从原点O沿y轴平移到A1点,此时点向量记为C2,此时点向量C2可以根据平移矩阵得到,平移矩阵为:
式中x0—沿x轴方向平移距离;
y0—沿y轴方向平移距离;
z0—沿z轴方向平移距离;
则
2.4、点C从A1点沿z轴方向平移到B1点,此时点向量记为C3;C3向量可根据平移矩阵得到;
2.5、点C从B1点绕y轴旋转α,此时点向量记为C4;此时C4向量根据旋转矩阵得到,其中旋转矩阵为:
旋转之后的C4向量为:
2.6、水平圆柱面绕x轴旋转π/2-θ,此时点向量记为C5;C5向量根据旋转矩阵得到,其中旋转矩阵为:
则
2.7、圆柱面沿z轴方向平移a,此时点向量记为C6;C6向量再根据平移矩阵得到:
按照步骤一的设定,公式(6)中的y0=b,z0=a;这样公式(6)中的所有变量对于确定的管路都是已知的;步骤一中设定的的机器人的位置C的坐标为:
上述C的坐标就是对机器人在圆柱面上沿轴线m方向移动或绕轴线m对转动到任意点的位置描述。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810562701.2A CN108775882B (zh) | 2018-06-01 | 2018-06-01 | 爬行机器人在圆柱类物体表面运动位置的描述方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810562701.2A CN108775882B (zh) | 2018-06-01 | 2018-06-01 | 爬行机器人在圆柱类物体表面运动位置的描述方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108775882A CN108775882A (zh) | 2018-11-09 |
CN108775882B true CN108775882B (zh) | 2019-06-14 |
Family
ID=64024486
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810562701.2A Active CN108775882B (zh) | 2018-06-01 | 2018-06-01 | 爬行机器人在圆柱类物体表面运动位置的描述方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108775882B (zh) |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4409478A (en) * | 1982-02-26 | 1983-10-11 | Automatix Incorporated | Method and apparatus for image acquisition utilizing a concave, cylindrical reflector |
US5475600A (en) * | 1992-01-06 | 1995-12-12 | Samsung Electronics Co., Ltd. | Mobile robot which utilizes inertial navigation to calculate shortest return distance |
CN1686056A (zh) * | 2005-04-28 | 2005-10-26 | 上海交通大学 | 基于手眼式机器人的股骨中心定位方法 |
CN102022989A (zh) * | 2010-09-29 | 2011-04-20 | 山东科技大学 | 一种基于指数积模型的机器人标定方法 |
TW201223724A (en) * | 2010-12-03 | 2012-06-16 | Ind Tech Res Inst | A position method and a calibrating method for the robot arm |
CN102700643A (zh) * | 2012-05-17 | 2012-10-03 | 山东科技大学 | 管外行走机器人机械结构及其工作方法 |
KR20140054927A (ko) * | 2012-10-30 | 2014-05-09 | 현대중공업 주식회사 | 로봇의 자동 캘리브레이션 방법 |
CN104443097A (zh) * | 2014-11-14 | 2015-03-25 | 山东科技大学 | 一种油气输送管道探伤在线作业机器人 |
CN104457645A (zh) * | 2014-11-27 | 2015-03-25 | 中南大学 | 一种利用二维测量功能平板的机器人工具中心点标定方法 |
JP2015126402A (ja) * | 2013-12-26 | 2015-07-06 | 日本放送協会 | ロボットカメラ制御装置、そのプログラム及び多視点ロボットカメラシステム |
CN104827479A (zh) * | 2015-05-15 | 2015-08-12 | 重庆邮电大学 | 一种面向激光加工机器人的管道插接相贯线轨迹规划方法 |
CN107422352A (zh) * | 2016-08-18 | 2017-12-01 | 山东科技大学 | 一种动物机器人自主导航***及方法 |
-
2018
- 2018-06-01 CN CN201810562701.2A patent/CN108775882B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4409478A (en) * | 1982-02-26 | 1983-10-11 | Automatix Incorporated | Method and apparatus for image acquisition utilizing a concave, cylindrical reflector |
US5475600A (en) * | 1992-01-06 | 1995-12-12 | Samsung Electronics Co., Ltd. | Mobile robot which utilizes inertial navigation to calculate shortest return distance |
CN1686056A (zh) * | 2005-04-28 | 2005-10-26 | 上海交通大学 | 基于手眼式机器人的股骨中心定位方法 |
CN102022989A (zh) * | 2010-09-29 | 2011-04-20 | 山东科技大学 | 一种基于指数积模型的机器人标定方法 |
TW201223724A (en) * | 2010-12-03 | 2012-06-16 | Ind Tech Res Inst | A position method and a calibrating method for the robot arm |
CN102700643A (zh) * | 2012-05-17 | 2012-10-03 | 山东科技大学 | 管外行走机器人机械结构及其工作方法 |
KR20140054927A (ko) * | 2012-10-30 | 2014-05-09 | 현대중공업 주식회사 | 로봇의 자동 캘리브레이션 방법 |
JP2015126402A (ja) * | 2013-12-26 | 2015-07-06 | 日本放送協会 | ロボットカメラ制御装置、そのプログラム及び多視点ロボットカメラシステム |
CN104443097A (zh) * | 2014-11-14 | 2015-03-25 | 山东科技大学 | 一种油气输送管道探伤在线作业机器人 |
CN104457645A (zh) * | 2014-11-27 | 2015-03-25 | 中南大学 | 一种利用二维测量功能平板的机器人工具中心点标定方法 |
CN104827479A (zh) * | 2015-05-15 | 2015-08-12 | 重庆邮电大学 | 一种面向激光加工机器人的管道插接相贯线轨迹规划方法 |
CN107422352A (zh) * | 2016-08-18 | 2017-12-01 | 山东科技大学 | 一种动物机器人自主导航***及方法 |
Non-Patent Citations (1)
Title |
---|
基于双目视觉的助老助残机器人定位***研究;樊炳辉等;《现代电子技术》;20170115;第40卷(第2期);第48-52页 |
Also Published As
Publication number | Publication date |
---|---|
CN108775882A (zh) | 2018-11-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108582071A (zh) | 一种工业机器人编程轨迹诊断及速度优化的方法 | |
Zhang et al. | Research on trajectory planning and autodig of hydraulic excavator | |
CN104385283A (zh) | 一种六自由度机械臂奇异位形的快速判断方法 | |
CN109676603A (zh) | 一种柔性超冗余度机器人控制方法 | |
CN110363801B (zh) | 工件实物与工件三维cad模型的对应点匹配方法 | |
CN106502090B (zh) | 一种三维空间中多智能体***的定位及环绕控制方法 | |
Wang et al. | A control method for hydraulic manipulators in automatic emulsion filling | |
CN108775882B (zh) | 爬行机器人在圆柱类物体表面运动位置的描述方法 | |
CN116330267A (zh) | 一种基于工业机器人腕部奇异点计算的控制方法 | |
CN114260625A (zh) | 圆管相贯线的焊接方法、焊接设备和存储介质 | |
CN114784701B (zh) | 配电网带电作业自主导航方法、***、设备及存储介质 | |
CN109366486A (zh) | 柔性机器人逆运动学求解方法、***、设备、存储介质 | |
CN116872212A (zh) | 一种基于A-Star算法和改进人工势场法的双机械臂避障规划方法 | |
Nazarzehi et al. | Decentralized three dimensional formation building algorithms for a team of nonholonomic mobile agents | |
Kang et al. | Coordinated workspace analysis and trajectory planning of redundant dual-arm robot | |
CN110948489B (zh) | 一种带电作业机器人安全工作空间限定方法及*** | |
Miao et al. | Gait fitting for snake robots with binary actuators | |
CN116141302A (zh) | 七自由度机械臂运动的控制方法、装置及电子设备 | |
Zhang et al. | Soft-ccd algorithm for inverse kinematics of soft continuum manipulators | |
Xutang et al. | Trajectory Planning for Digital Camouflage Spray Painting Robot Based on Projection Method | |
CN105180803A (zh) | 核电反应堆冷却剂回路波动管测量方法 | |
Jiang et al. | Research on obstacle avoidance path planning algorithm for six-axis robot | |
Ren et al. | Study on the stop position of the mobile manipulator for painting on big parts | |
Gu et al. | Experimental study of vision sensor based multiple robots active cooperative observation using multi-RFRs testbed | |
Wang et al. | Inverse kinematics of 6-DOF robot manipulator via analytic solution with conformal geometric algebra |
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 |