CN205014948U - 非接触式测量圆桶圆心坐标的装置 - Google Patents
非接触式测量圆桶圆心坐标的装置 Download PDFInfo
- Publication number
- CN205014948U CN205014948U CN201520714694.5U CN201520714694U CN205014948U CN 205014948 U CN205014948 U CN 205014948U CN 201520714694 U CN201520714694 U CN 201520714694U CN 205014948 U CN205014948 U CN 205014948U
- Authority
- CN
- China
- Prior art keywords
- circle
- coordinate
- robot
- range sensor
- central coordinate
- 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
Landscapes
- Length Measuring Devices By Optical Means (AREA)
Abstract
本实用新型提供一种非接触式测量圆桶圆心坐标的装置,包括设置在机器人末端法兰盘上的延长支架和设置在延长支架下端的安装板,所述安装板上设有距离传感器,且所述距离传感器的测量方向与所述延长支架的轴线垂直。本实用新型提供的非接触式测量圆桶圆心坐标的装置,具有结构简单、操作携带方便、测量精度高的优点。
Description
技术领域
本实用新型涉及一种非接触式测量圆桶圆心坐标的装置。
背景技术
在机器人装甑工艺中,机器人在甑桶内完成铺料都是以走圆的形式,这就需要机器人能很好的找到圆心点,才能保证铺料的均匀。目前,找圆心的方法非常粗犷,利用激光笔大致的找到一个圆心,然后再通过人工试校机器人,通过观察,逐步调整机器人,最终找到圆心的位置,这种方法找到的圆心其实是不准确的,在现场调试找圆心也特别耗时费力。
实用新型内容
本实用新型所要解决的技术问题是:为了克服现有技术中的不足,本实用新型提供一种非接触式测量圆桶圆心坐标的装置,解决了确定圆心不准确的技术问题。
本实用新型解决其技术问题所要采用的技术方案是:一种非接触式测量圆桶圆心坐标的装置,包括设置在机器人末端法兰盘上的延长支架和设置在延长支架下端的安装板,所述安装板上设有距离传感器,且所述距离传感器的测量方向与所述延长支架的轴线垂直。通过延长支架与距离传感器可以方便的测量出机器人末端到圆桶侧壁的距离,该套装置体积小便于携带,结构简单,测量精度高。
优选的,为了提高测量精度、保证测量的准确性,所述距离传感器为激光距离传感器。
进一步,为了实现自动采集和处理数据,还包括数据采集卡、机器人控制柜和电脑,所述激光距离传感器、数据采集卡、机器人控制柜和电脑依次线路连接。激光距离传感器采集的距离数据通过信号线传送至数据采集卡进行数据处理,数据处理的结果再由机器人控制柜通过网络发送至电脑,由电脑上的软件计算出圆心的坐标值。
进一步,为了数据传输方便以及采集操作方便,还包括信号线和网线,所述距离传感器通过所述信号线与所述数据采集卡连接,所述机器人控制柜通过所述网线与所述电脑连接。
一种利用上述装置的非接触式测量圆桶圆心坐标的方法,包括以下步骤:
(1)安装并调整距离传感器的初始位置,使机器人末端的零点位置与距离传感器的测量方向保持一致;
(2)将机器人末端的延长支架和距离传感器运动到圆桶内的任意旋转安全位置;
(3)调整机器人末端的位置P,确定一个起始测量位置,并从机器人上获取机器人末端的位置坐标P,然后得出距离传感器安装位置的基准点坐标T,并设起始测量方向上圆桶上的点为Q,通过距离传感器获取TQ距离d,根据公式计算出Q点的坐标值;
(4)使机器人末端连续旋转,旋转过程中使距离传感器采集距离传感器安装位置的基准点坐标T到圆桶同一圆周上至少不同的三个点的距离值以及旋转角度,并根据公式计算出对应点的坐标值;
(5)取不同的三个点的坐标,通过三个点的坐标计算出圆桶该深度的圆周的圆心坐标值。
优选的,为了减小测量误差,测量范围选择在整个圆周上均匀的取点,步骤(4)中的机器人末端连续旋转角度为360°。通过旋转延长支架360°可以测得一个圆周内的多个点的坐标,以准确确定圆心坐标,减小因取值范围小而增大测量误差。
进一步,为了计算方便,可以每间隔相同的角度采集一个点,步骤(4)中每间隔相同的角度α由距离传感器采集一次点到距离传感器安装位置的基准点的距离,同时记录该点与起始位置的夹角,连续旋转的角度应大于等于两倍的间隔采集角度α。由于不在同一直线上的三点确定一个圆,因此为了保证能够至少采集三个点,连续旋转角度应该大于等于间隔采集角度的两倍。
进一步,根据测量的参数不同以及选取的坐标系不同,步骤(3)和(4)中计算坐标的公式具体如下:
建立两个坐标系,一个是机器人基坐标系,另一个是工具坐标系,取机器人末端P为工具坐标系的原点,则机器人末端即工具坐标系原点在机器人坐标系中的坐标为P(Px,Py,Pz,PA),PA为机器人末端的旋转角度值,以X轴方向为基准,距离传感器安装位置的基准点在工具坐标系中的坐标T(Tx,Ty,Tz),距离传感器测量距离为d,最终需要求出所测点Q(Qx,Qy,Qz),机器人末端旋转轴为Z轴,利用Z轴旋转矩阵进行计算,由于激光发射朝向是X方向,则激光测量点Q在工具坐标系中坐标为(TQx=Tx+d,TQy=Ty,TQz=Tz),则
Qx=TQx*COS(PA)-TQy*SIN(PA)+Px;
Qy=TQx*SIN(PA)+TQy*COS(PA)+Py;
Qz=TQz+Pz。
由于设计或者安装时候的偏差,导致激光传感器的射出方向与安装的工具坐标系的X轴方向不再一致,则还可以通过先测量出实际的射出方向向量(Tx’,Ty’Tz’),根据下面公式计算出(TQx,TQy,TQZ)的值,然后根据计算结果将(TQx,TQy,TQZ)的值带入上述公式中,即可求得Q(Qx,Qy,Qz)的坐标值,计算公式如下:
TQx=Tx’/Sqrt(Tx’^2+Ty’^2+Tz’^2)*d+Tx;
TQy=Ty’/Sqrt(Tx’^2+Ty’^2+Tz’^2)*d+Ty;
TQz=Tz’/Sqrt(Tx’^2+Ty’^2+Tz’^2)*d+Tz。
进一步,为了提高圆心坐标的准确度,步骤(5)中圆心的坐标计算采用多次测量求平均值的方法,取至少两组点的坐标,每组包括三个点,任意两组间至少包括一个不同的点,计算公式如下:
设第一个圆心坐标为M1,第二个圆心坐标M2,第m个圆心坐标为Mm,则最终圆心坐标为:
M=(M1+M2+......+Mm)/m。
进一步,为了选取数据方便,将距离传感器采集的同一圆周上的所有点分成多个区间,每组的三个点取自不同区间内。
优选的,为了提高准确度和精度,所述区间为三个,相邻区间的夹角为120°。
进一步,还包括步骤(6),调整所述距离传感器在圆桶内的测量高度,计算出圆桶内不同高度的圆周的圆心坐标。通过计算不同高度的圆心坐标,可以确定圆桶的中心轴线的位置以及圆桶的垂直度。
本实用新型的有益效果是:本实用新型提供的一种非接触式测量圆桶圆心坐标的装置及其方法,具有以下优点:
(1)测试方便、节省时间,利用测试系统将机器人伸进甑桶的任意旋转安全的位置,将机器人末端旋转360°就可以准确的找到圆心坐标;
(2)安装简单,整个装置只要安装在机器人法兰盘上;
(3)测量精度高,如果传感器的精度够高,测试误差可以控制在1mm以内;
(4)该装置占用体积小,易于携带;
(5)该装置可以在圆桶内不同高度点测试,可以通过数据分析出圆桶的垂直度;
(6)在软件中可以很直观的看到测量点所绘制的圆。
附图说明
下面结合附图和实施例对本实用新型作进一步说明。
图1是本实用新型的非接触式测量圆桶圆心坐标的装置的结构示意图;
图2是非接触式测量圆桶圆心坐标的装置的应用系统图;
图3是采用两个坐标系时各点的位置关系示意图;
图4是采集软件中模拟采集点和圆心示意图。
图中:1、距离传感器,2、机器人,3、法兰盘,4、延长支架,5、螺钉,6、第一定向键,7、安装板,8、第二定向键,9、固定压板,10、圆桶。
具体实施方式
现在结合附图对本实用新型作详细的说明。此图为简化的示意图,仅以示意方式说明本实用新型的基本结构,因此其仅显示与本实用新型有关的构成。
如图1-4所示,本实用新型的一种非接触式测量圆桶圆心坐标的装置,包括激光距离传感器1、数据采集卡、机器人控制柜、电脑、信号线、网线以及设置在机器人2末端法兰盘3上的延长支架4。
法兰盘3通过螺钉5与机器人2末端连接,法兰盘3下端面上设有第一定向键6,延长支架4通过第一定向键6与法兰盘3固定连接,延长支架4的延伸方向与法兰盘3所在平面垂直,延长支架4下端设有安装板7,安装板7一端设有第二定向键8,安装板7通过第二定向键8套接在延长支架4的下端,第二定向键8下端设有固定压板9,通过内六角螺钉5将固定压板9固定在延长支架4的下端,从而将第二定向键8固定在延长支架4下端。
激光距离传感器1通过螺钉5固定在安装板7上,且激光距离传感器1的激光束发射方向与延长支架4的轴线垂直,激光距离传感器1、数据采集卡、机器人控制柜和电脑依次信号连接,其中,激光距离传感器1通过信号线与数据采集卡连接,机器人控制柜通过网线与电脑连接。
一种利用上述装置的非接触式测量圆桶圆心坐标的方法,包括以下步骤:
(1)安装并调整距离传感器1的初始位置,使机器人2末端的零点位置与激光距离传感器1的测量方向保持一致;
(2)将机器人2末端的延长支架4和距离传感器1运动到桶内的任意旋转安全位置;
(3)以X轴方向为基准,调整机器人2末端的位置P,确定一个起始测量位置,并从机器人2上获取机器人2末端的位置坐标P,然后得出距离传感器1安装位置的基准点坐标T,并设起始测量方向上圆桶10上的点为Q,通过距离传感器1获取TQ距离d,根据公式计算出Q点的坐标值;
(4)使机器人2末端连续旋转,旋转过程中使距离传感器1采集距离传感器1安装位置的基准点坐标T到圆桶10同一圆周上至少不同的三个点的距离值以及旋转角度,并根据公式计算出对应点的坐标值;
(5)取不同的三个点的坐标,通过三个点的坐标计算出圆桶10该深度的圆周的圆心坐标值。
优选的,为了减小测量误差,测量范围选择在圆桶10同一高度的整个圆周上均匀的取点,步骤4中的机器人2末端连续旋转角度为360°。通过延长支架4旋转360°可以测得一个圆周内的多个点的坐标,以准确确定圆心坐标,减小因取值范围小而增大测量误差。
进一步,为了计算方便,可以每间隔相同的角度采集一个点,步骤(4)中每间隔设定角度α由距离传感器1采集一次点到距离传感器1安装位置的基准点的距离,同时记录该点与起始位置的夹角,连续旋转的角度应大于等于两倍的设定间隔采集角度α。由于不在同一直线上的三点确定一个圆,因此为了保证能够至少采集三个点,连续旋转角度应该大于等于间隔采集角度的两倍。
根据测量的参数不同以及选取的坐标系不同,步骤(3)和(4)中计算坐标的公式具体如下:
如图3所示,建立两个坐标系,一个是机器人2基坐标系,另一个是工具坐标系,取机器人2末端P为工具坐标系的原点,则机器人2末端即工具坐标系原点在机器人2坐标系中的坐标为P(Px,Py,Pz,PA),PA为机器人2末端的旋转角度值,以X轴方向为基准,距离传感器1安装位置的基准点在工具坐标系中的坐标T(Tx,Ty,Tz),距离传感器1测量距离为d,最终需要求出所测点Q(Qx,Qy,Qz),机器人2末端旋转轴为Z轴,利用Z轴旋转矩阵进行计算,由于激光发射朝向是X方向,则激光测量点Q在工具坐标系中坐标为(TQx=Tx+d,TQy=Ty,TQz=Tz),则
Qx=TQx*COS(PA)-TQy*SIN(PA)+Px;
Qy=TQx*SIN(PA)+TQy*COS(PA)+Py;
Qz=TQz+Pz。
由于设计或者安装时候的偏差,导致激光距离传感器1的射出方向与安装的工具坐标系的X轴方向不再一致,则还可以通过先测量出实际的射出方向向量(Tx’,Ty’Tz’),根据下面公式计算出(TQx,TQy,TQZ)的值,然后根据计算结果将(TQx,TQy,TQZ)的值带入上述公式中,即可求得Q(Qx,Qy,Qz)的坐标值,计算公式如下:
TQx=Tx’/Sqrt(Tx’^2+Ty’^2+Tz’^2)*d+Tx;
TQy=Ty’/Sqrt(Tx’^2+Ty’^2+Tz’^2)*d+Ty;
TQz=Tz’/Sqrt(Tx’^2+Ty’^2+Tz’^2)*d+Tz。
进一步,为了提高圆心坐标的准确度,步骤(5)中圆心的坐标计算采用多次测量求平均值的方法,取至少两组点的坐标,每组包括三个点,任意两组间至少包括一个不同的点,计算公式如下:
设第一个圆心坐标为M1,第二个圆心坐标M2,第m个圆心坐标为Mm,则最终圆心坐标为:
M=(M1+M2+......+Mm)/m。
进一步,为了选取数据方便,将距离传感器1采集的同一圆周上的所有点分成多个区间,每组的三个点取自不同区间内。
优选的,为了提高准确度和精度,所述区间为三个,相邻区间的夹角为120°。
进一步,还包括步骤(6),调整所述距离传感器1在圆桶10内的测量高度,计算出圆桶10内不同高度的圆周的圆心坐标。通过计算不同高度的圆心坐标,可以确定圆桶10的中心轴线的位置以及圆桶10的垂直度。
具体操作时,为了计算方便,步骤3中的起始测量位置选取X轴方向与基准位置相同,可以把采集的所有点沿圆周分成三个区间,相邻区间的夹角为120°,每次在每个区间取各一个点,可以计算获得一个圆心坐标值,以此类推获得多个圆心坐标,然后再求平均值。采用该装置和方法还可以对圆桶10轴线的垂直度进行分析评价,同时,通过配套的采集软件可以方便的进行坐标值的读取以及圆心坐标的计算,如图4所示,在软件中可以很直观的看到测量点所绘制的圆。
以上述依据本实用新型的理想实施例为启示,通过上述的说明内容,相关的工作人员完全可以在不偏离本实用新型的范围内,进行多样的变更以及修改。本项实用新型的技术范围并不局限于说明书上的内容,必须要根据权利要求范围来确定其技术性范围。
Claims (4)
1.一种非接触式测量圆桶圆心坐标的装置,其特征在于:包括设置在机器人(2)末端法兰盘(3)上的延长支架(4)和设置在延长支架(4)下端的安装板(7),所述安装板(7)上设有距离传感器(1),且所述距离传感器(1)的测量方向与所述延长支架(4)的轴线垂直。
2.如权利要求1所述的非接触式测量圆桶圆心坐标的装置,其特征在于:所述距离传感器(1)为激光距离传感器。
3.如权利要求2所述的非接触式测量圆桶圆心坐标的装置,其特征在于:还包括数据采集卡、机器人控制柜和电脑,所述激光距离传感器、数据采集卡、机器人控制柜和电脑依次线路连接。
4.如权利要求3所述的非接触式测量圆桶圆心坐标的装置,其特征在于:还包括信号线和网线,所述距离传感器(1)通过所述信号线与所述数据采集卡连接,所述机器人控制柜通过所述网线与所述电脑连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201520714694.5U CN205014948U (zh) | 2015-09-15 | 2015-09-15 | 非接触式测量圆桶圆心坐标的装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201520714694.5U CN205014948U (zh) | 2015-09-15 | 2015-09-15 | 非接触式测量圆桶圆心坐标的装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN205014948U true CN205014948U (zh) | 2016-02-03 |
Family
ID=55213543
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201520714694.5U Active CN205014948U (zh) | 2015-09-15 | 2015-09-15 | 非接触式测量圆桶圆心坐标的装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN205014948U (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105136035A (zh) * | 2015-09-15 | 2015-12-09 | 常州铭赛机器人科技股份有限公司 | 非接触式测量圆桶圆心坐标的装置及其方法 |
CN106168468A (zh) * | 2016-08-31 | 2016-11-30 | 徐工集团工程机械有限公司 | 孔检测系统和方法 |
-
2015
- 2015-09-15 CN CN201520714694.5U patent/CN205014948U/zh active Active
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105136035A (zh) * | 2015-09-15 | 2015-12-09 | 常州铭赛机器人科技股份有限公司 | 非接触式测量圆桶圆心坐标的装置及其方法 |
CN105136035B (zh) * | 2015-09-15 | 2018-10-12 | 常州铭赛机器人科技股份有限公司 | 非接触式测量圆桶圆心坐标的装置及其方法 |
CN106168468A (zh) * | 2016-08-31 | 2016-11-30 | 徐工集团工程机械有限公司 | 孔检测系统和方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105136035A (zh) | 非接触式测量圆桶圆心坐标的装置及其方法 | |
CN106842229A (zh) | 一种激光云台智能空间定位系统及空间定位方法 | |
CN102331296B (zh) | 检测工程机械的臂架振动的方法、装置、系统及工程机械 | |
CN108311545B (zh) | 一种y型轧机连轧对中及孔型检测系统及方法 | |
CN110260809A (zh) | 面向风电塔筒形建筑物的倾斜形变检测方法 | |
CN206627632U (zh) | 一种激光云台智能空间定位系统 | |
CN108151766B (zh) | 磁钉的定位方法、磁钉定位导航误差修正方法及定位装置 | |
CN105739538B (zh) | 基于机械臂运动装置的定位方法、定位测试装置及方法 | |
CN108801141A (zh) | 基于激光测量技术的超高压隔离开关智能调试校准系统 | |
CN105737791A (zh) | 一种大倾角综采工作面液压支架位姿检测方法 | |
CN104359436A (zh) | 关节臂式三坐标测量机、多测量模型系统及工件测量方法 | |
CN202255414U (zh) | 一种可倾角校准装置 | |
CN109115147A (zh) | 全深度阵列式测斜仪及深部位移测量方法 | |
CN105222711A (zh) | 一种基于激光测距技术的合拢管现场测量装置及测量方法 | |
CN205014948U (zh) | 非接触式测量圆桶圆心坐标的装置 | |
CN108507769B (zh) | 喷杆仿形精度动态测试系统及测试方法 | |
CN105043381A (zh) | 一种基于磁钉的定位方法 | |
CN102353329A (zh) | 模拟试验场地非接触三维坐标测量方法及所用的装置 | |
CN108917711A (zh) | 一种隧道工程三维激光扫描分段测量方法及系统 | |
CN104535974A (zh) | 一种飞机雷达系统校靶装置及其使用方法 | |
CN206002067U (zh) | 孔检测系统 | |
CN203349785U (zh) | 一种用于可调桨叶片的激光测量装置及系统 | |
CN107388979B (zh) | 一种隧道表面形变监测系统及计算机 | |
CN104180791B (zh) | 一种飞机水平测量方法 | |
CN205066693U (zh) | 一种基于激光测距技术的合拢管现场测量装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
TR01 | Transfer of patent right | ||
TR01 | Transfer of patent right |
Effective date of registration: 20180211 Address after: Small banana Industrial Park in Fujian province 365017 Sanming City Meilie District Industrial Avenue No. 6 Building 1-8 Patentee after: Baxter (Fujian) Intelligent Equipment Technology Co. Ltd. Address before: Wujin District of Jiangsu city in Changzhou province 213164 Chang Wu Road No. 18, Changzhou science city Harbin mingseal science and Technology Building Patentee before: Changzhou Science and Technology Co., Ltd. of Ming Sai robot |