CN114229519A - 一种大型物料桶定位装置及定位方法 - Google Patents
一种大型物料桶定位装置及定位方法 Download PDFInfo
- Publication number
- CN114229519A CN114229519A CN202111647009.8A CN202111647009A CN114229519A CN 114229519 A CN114229519 A CN 114229519A CN 202111647009 A CN202111647009 A CN 202111647009A CN 114229519 A CN114229519 A CN 114229519A
- Authority
- CN
- China
- Prior art keywords
- material barrel
- point
- sensor
- distance measuring
- laser
- 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
- 239000000463 material Substances 0.000 title claims abstract description 162
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000007246 mechanism Effects 0.000 claims abstract description 25
- 210000001503 joint Anatomy 0.000 claims abstract description 3
- 238000012545 processing Methods 0.000 claims description 39
- 230000004888 barrier function Effects 0.000 claims description 15
- 238000005259 measurement Methods 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 12
- 230000009471 action Effects 0.000 claims description 6
- 230000001960 triggered effect Effects 0.000 claims description 4
- 238000009434 installation Methods 0.000 claims description 2
- 238000004148 unit process Methods 0.000 claims description 2
- 230000005540 biological transmission Effects 0.000 claims 1
- 238000005516 engineering process Methods 0.000 description 5
- 230000005611 electricity Effects 0.000 description 3
- 238000007599 discharging Methods 0.000 description 2
- 239000013072 incoming material Substances 0.000 description 2
- 230000001788 irregular Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- XAGFODPZIPBFFR-UHFFFAOYSA-N aluminium Chemical compound [Al] XAGFODPZIPBFFR-UHFFFAOYSA-N 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G67/00—Loading or unloading vehicles
- B65G67/02—Loading or unloading land vehicles
- B65G67/24—Unloading land vehicles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G1/00—Storing articles, individually or in orderly arrangement, in warehouses or magazines
- B65G1/02—Storage devices
- B65G1/04—Storage devices mechanical
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G13/00—Roller-ways
- B65G13/11—Roller frames
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
- B65G43/08—Control devices operated by article or material being fed, conveyed or discharged
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G47/00—Article or material-handling devices associated with conveyors; Methods employing such devices
- B65G47/22—Devices influencing the relative position or the attitude of articles during transit by conveyors
- B65G47/24—Devices influencing the relative position or the attitude of articles during transit by conveyors orientating the articles
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G69/00—Auxiliary measures taken, or devices used, in connection with loading or unloading
- B65G69/22—Horizontal loading or unloading platforms
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02E—REDUCTION OF GREENHOUSE GAS [GHG] EMISSIONS, RELATED TO ENERGY GENERATION, TRANSMISSION OR DISTRIBUTION
- Y02E30/00—Energy generation of nuclear origin
- Y02E30/30—Nuclear fission reactors
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种大型物料桶定位装置,包括卸货平台、滚筒线、定位机构和测距传感器,所述滚筒线安装在卸货平台上,货车与滚筒线对接,定位机构安装在卸货平台上位于滚筒线的一端,测距传感器在卸货平台上位于滚筒线的两侧。从箱式货车自动卸下的货物输送到卸货平台的滚筒线上,定位机构和测距传感器可以对大型物料在卸货平台上的位置进行定位,从而大型物料的自动化入库。本发明还公开了一种大型物料桶定位方法。
Description
技术领域
本发明属于大型物料装卸技术领域,具体涉及一种大型物料桶定位装置及定位方法。
背景技术
箱式货车运输大型的铝粉桶(700*700mm)以两个并排的方式从货车中往平台上输送。平台尺寸是长2.1米,宽1.2米。料桶因为在运输过程中存在抖动,不能保证卸货时候料桶的运输状态。因为物体较大和较高,无法使用相机进行整个平台范围的识别和抓取。要求实现的功能是桁架机器人能到达料桶附近进行粗定位,采用相机对料桶进行精确定位最终实现对料桶的自动抓取入库功能。
发明内容
针对现有技术中存在的不足,本发明的目的在于提供一种结构简单、使用方便的大型物料桶定位装置,该定位装置可以对物料桶在卸货平台上的位置进行定位,从而方便桁架机器人对物料桶进行精确定位最终实现对物料桶的自动抓取入库功能;本发明还提供了一种大型物料桶定位方法。
为实现上述目的,本发明的技术方案为:一种大型物料桶定位装置,包括卸货平台、滚筒线、定位机构和测距传感器,所述滚筒线安装在卸货平台上,货车与滚筒线对接,定位机构安装在卸货平台上位于滚筒线的一端,测距传感器在卸货平台上位于滚筒线的两侧。
进一步的,所述定位装置还包括控制器和桁架机器人,定位机构的行程开关与控制器电连接,控制器与桁架机器人电连接,控制器内设有数据处理单元,测距传感器与数据处理单元电连接,数据处理单元对测距传感器采集的数据进行处理后得出物料桶的偏转角度和中心点坐标并传递给桁架机器人,桁架机器人运行到物料桶中心的上方。
进一步的,所述卸货平台上滚筒线的一端设有定位板,卸货平台上滚筒线的两侧分别设有挡板Ⅰ和挡板Ⅱ,定位机构安装在定位板上,测距传感器安装在挡板Ⅰ和挡板Ⅱ上。
进一步的,所述定位机构包括行程开关、横档条和弹簧片,行程开关和弹簧片安装在定位板上,在弹簧片的另一端安装横档条,物料桶在滚筒线上运动,物料桶挤压横档条,弹簧片收缩横档条与行程开关接触触发行程开关。
进一步的,所述测距传感器包括一号位激光测距传感器Ⅰ和一号位激光测距传感器Ⅱ、一号位激光测距传感器Ⅰ和一号位激光测距传感器Ⅱ并排安装在挡板Ⅰ上,一号位激光测距传感器Ⅰ与一号位激光测距传感器Ⅱ之间设有间距,一号位激光测距传感器Ⅰ与一号位激光测距传感器Ⅱ将测量的物料桶的位置信息传递给控制器的数据处理单元进行处理。
进一步的,所述测距传感器还包括二号位激光测距传感器Ⅰ和二号位激光测距传感器Ⅱ,二号位激光测距传感器Ⅰ和二号位激光测距传感器Ⅱ并排安装在挡板Ⅱ上,二号位激光测距传感器Ⅰ与二号位激光测距传感器Ⅱ之间设有间距,二号位激光测距传感器Ⅰ与二号位激光测距传感器Ⅱ将测量的物料桶的位置信息传递给控制器的数据处理单元进行处理。
进一步的,所述定位板上并排设有两个定位机构分别为一号定位装置和二号定位装置,一号定位装置与一号位激光测距传感器Ⅰ、一号位激光测距传感器Ⅱ相对应,二号定位装置与二号位激光测距传感器Ⅰ、二号位激光测距传感器Ⅱ相对应。
本发明还涉及一种大型物料桶定位方法,基于上述一种大型物料桶定位装置,所述定位方法为:
步骤一:物料桶转移到卸货平台上在滚筒线作用下前进运动,当物料桶撞击到横挡条,横挡条压缩行程开关,行程开关被触发后筒线驱动电机停止工作,滚筒线停止运行,物料桶停止运动;
步骤二:在一号定位装置与一号位激光测距传感器Ⅰ、一号位激光测距传感器Ⅱ构成的定位系统中对物料桶进行测距;以物料桶触发行程开关的位置线作为X轴,以一号位激光测距传感器Ⅰ和一号位激光测距传感器Ⅱ所在位置线为Y轴;
步骤三:读出一号位激光测距传感器Ⅰ和一号位激光测距传感器Ⅱ的测量数值,得到一号位激光测距传感器Ⅰ到物料桶的距离X1和一号位激光测距传感器Ⅱ到物料桶的距离X2,一号位激光测距传感器Ⅰ和一号位激光测距传感器Ⅱ安装位置固定,用卡尺直接测量出一号位激光测距传感器ⅠY方向的值Y1,一号位激光测距传感器ⅡY方向的值Y2,由X1、X2、Y1和Y2计算出物料桶的旋转角度值θ;
步骤四:物料桶为方形桶,其边长为L,物料桶上靠近Y轴的三个顶点在XY平面的坐标分别为A(Xa,Ya)、B(Xb,Yb)、C(Xc,Yc),中心点E的坐标为(Xe,Ye),由几何关系可知,物料桶中心E的坐标为:Xe=(Xa+Xc)/2,Ye=(Ya+Yc)/2;
步骤五:将物料桶中心E点坐标(Xe,Ye)和物料桶偏转角度θ发送至桁架机器人,桁架机器人运动到E点进行抓取物料桶。
进一步的,所述物料桶旋转角度值θ计算方法为:Δy=Y2-Y1;Δx=X2-X1;tanθ=Δy/Δx,θ=acrtan(Δy/Δx);将物料桶旋转角度值θ计算公式植入控制器中的数据处理单元,X1、X2、Y1和Y2为测量已知值,将X1、X2、Y1和Y2的数值传送给数据处理单元,数据处理单元便可计算出物料桶的旋转角度θ。
进一步的,所述物料桶中心E点坐标(Xe,Ye)计算方法为:要得到E点坐标(Xe,Ye)需先求出A(Xa,Ya)、B(Xb,Yb)、C(Xc,Yc)的坐标值;
1)B(Xb,Yb)点坐标计算方法为:
A点在X轴上(定位装置触发位置线),因此通过θ值,求出B点坐标Yb的值Yb=L*sinθ;已知Y1和Yb,在直角三角形BHI中,求出BH长度,BH=Y1-Yb;
在三角形BHI中,已知BH长度和∠IBH=θ,求出IH长度,由tanθ=IH/BH=IH/(Y1-Yb)=IH/(Y1-L*sinθ)=Δy/Δx=(Y2-Y1)/(X2-X1);结合θ=acrtan(Δy/Δx);
IH=(Y2-Y1)/(X2-X1)*(Y1-L*sin(arctan((Y2-Y1)/(X2-X1))))
X1值通过测量得到,因此可以求出Xb的值;Xb=X1-IH,由此得到B点坐标(Xb,Yb);
2)C(Xc,Yc)点坐标计算方法为:
直角三角形AFB和直角三角形BDC为全等三角形,因此可得到C点Yc的值,Yc=FB+BD=L*sinθ+L*cosθ=L*(sinθ+cosθ);Xc=Xb+CD=Xb+L*sinθ,由此得到C点坐标(Xc,Yc);
3)A(Xa,Ya)点坐标计算方法为:
由于A点在X轴上(定位装置触发位置线),Ya=0,且已知B点坐标,可得Xa=L*cosθ+Xb=L*cosθ+X1-IH,由此得到A点坐标(Xa,0);
4)物料桶中心E点坐标计算方法为:
Xe=(Xa+Xc)/2;Ye=(Ya+Yc)/2=Yc/2;
并列方程式
Δy=Y2-Y1;Δx=X2-X1;θ=acrtan(Δy/Δx);Xa=L*cosθ+X1-IH;
IH=(Y2-Y1)/(X2-X1)*(Y1-L*sin(arctan((Y2-Y1)/(X2-X1))));
Xc=Xb+L*sinθ;Xb=X1-IH;Yc=L*(sinθ+cosθ);
将X1,X2,Y1,Y2值带入可求出物料桶中心E点坐标(Xe,Ye);
将物料桶中心E点坐标(Xe,Ye)计算方法植入控制器中的数据处理单元,将X1、X2、Y1、Y2和θ的数值传送给数据处理单元,数据处理单元便可计算出物料桶中心E点坐标(Xe,Ye)。
采用本发明技术方案的优点为:
1、本发明的定位装置和定位方法实现了对物料桶来料状态不确定时的料桶位置信息的自动识别,即自动识别物料桶位姿,并将识别出的信息传递给桁架,以方便桁架机器人的后续操作;采用横挡条加行程开关,保证物料桶在滚筒线上运行发生旋转时,始终是左右两个顶点触碰到行程开关开关停止;单边采用两个激光测距传感器,这样通过数值比较能计算出物料桶的旋转角度,同时激光测距传感器的数值可以用来进行货物装车保护。
2、本发明针对不规则来料料桶位姿采用激光测距传感器进行粗定位,获得料桶中心坐标值和旋转角度值,并与桁架机器人配合使用,采用视觉技术对料桶进行精确定位,实现料桶的自动抓取,进而实现物料的自动卸货入库和空桶装车功能。
附图说明
下面结合附图和具体实施方式对本发明作进一步详细的说明:
图1为本发明大型物料桶定位装置结构示意图;
图2为本发明定位机构结构示意图;
图3为本发明定位机构仰视示意图;
图4为物料桶在卸货平台上触发横档条位置示意图;
图5为物料桶在卸货平台上触发横档条位置俯视示意图;
图6为几何模型示意图。
上述图中的标记分别为:1、卸货平台;11、定位板;12、挡板Ⅰ;13、挡板Ⅱ;2、滚筒线;3、定位机构;031、一号定位装置;032、二号定位装置;31、行程开关;32、横档条;33、弹簧片;4、测距传感器;41、一号位激光测距传感器Ⅰ;42、一号位激光测距传感器Ⅱ;43、二号位激光测距传感器Ⅰ;44、二号位激光测距传感器Ⅱ;5、物料桶。
具体实施方式
在本发明中,需要理解的是,术语“长度”;“宽度”;“上”;“下”;“前”;“后”;“左”;“右”;“竖直”;“水平”;“顶”;“底”“内”;“外”;“顺时针”;“逆时针”;“轴向”;“平面方向”;“周向”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位;以特定的方位构造和操作,因此不能理解为对本发明的限制。
如图1至图6所示,一种大型物料桶定位装置,包括卸货平台1、滚筒线2、定位机构3和测距传感器4,所述滚筒线2安装在卸货平台1上,货车与滚筒线2对接,定位机构3安装在卸货平台1上位于滚筒线2的一端,测距传感器4在卸货平台1上位于滚筒线2的两侧。从箱式货车自动卸下的货物输送到卸货平台的滚筒线2上,定位机构3和测距传感器4可以对大型物料在卸货平台上的位置进行定位,从而大型物料的自动化入库。
定位装置还包括控制器和桁架机器人,定位机构3的行程开关31与控制器电连接,控制器与桁架机器人电连接,控制器内设有数据处理单元,测距传感器4与数据处理单元电连接,数据处理单元对测距传感器4采集的数据进行处理后得出物料桶5的偏转角度和中心点坐标并传递给桁架机器人,桁架机器人运行到物料桶中心的上方。
卸货平台1上滚筒线2的一端设有定位板11,卸货平台1上滚筒线2的两侧分别设有挡板Ⅰ12和挡板Ⅱ13,定位机构3安装在定位板11上,测距传感器4安装在挡板Ⅰ12和挡板Ⅱ13上。
定位机构3包括行程开关31、横档条32和弹簧片33,行程开关31和弹簧片33安装在定位板11上,在弹簧片33的另一端安装横档条32,物料桶5在滚筒线2上运动,物料桶5挤压横档条32,弹簧片33收缩横档条32与行程开关31接触触发行程开关31,行程开关31发出指令给控制器,控制器控制滚筒线驱动电机停止工作,滚筒线停止运行,物料桶5停止运动,此时物料桶5在卸货平台上的位置不动,控制器发出指令控制测距传感器4对物料桶5的位置进行测量;控制器的数据处理单元中设有用于计算物料桶5旋转角度和物料桶5中心E点坐标的计算模型,测距传感器4直接将测量的数值传送给控制器的数据处理单元,数据处理单元便可计算出物料桶5旋转角度和物料桶5中心E点坐标;然后控制器再将物料桶5旋转角度和物料桶5中心E点坐标值传送给桁架机器人,桁架机器人携带相机运动到E点进行拍照,拍照的数据上传至总控系统,总控系统根据得到的数据,发送对应指令给桁架机器人执行后续动作。
横挡条具有自复位功能被挤压之后触发行程开关,物料桶移走之后在弹簧片作用下复位;优选的,横挡条为半圆柱形包括圆弧面和平面,横挡条的平面与行程开关接触,横档条与行程开关接触面积大,进而提高触发精确度;横挡条的圆弧面与物料桶接触,可避免尖角触碰。
测距传感器4包括一号位激光测距传感器Ⅰ41和一号位激光测距传感器Ⅱ42、一号位激光测距传感器Ⅰ41和一号位激光测距传感器Ⅱ42并排安装在挡板Ⅰ12上,一号位激光测距传感器Ⅰ41与一号位激光测距传感器Ⅱ42之间设有间距,一号位激光测距传感器Ⅰ41与一号位激光测距传感器Ⅱ42将测量的物料桶5的位置信息传递给控制器的数据处理单元进行处理。测距传感器4还包括二号位激光测距传感器Ⅰ43和二号位激光测距传感器Ⅱ44,二号位激光测距传感器Ⅰ43和二号位激光测距传感器Ⅱ44并排安装在挡板Ⅱ13上,二号位激光测距传感器Ⅰ43与二号位激光测距传感器Ⅱ44之间设有间距,二号位激光测距传感器Ⅰ43与二号位激光测距传感器Ⅱ44将测量的物料桶5的位置信息传递给控制器的数据处理单元进行处理。
定位板11上并排设有两个定位机构3分别为一号定位装置031和二号定位装置032,一号定位装置031与一号位激光测距传感器Ⅰ41、一号位激光测距传感器Ⅱ42相对应,二号定位装置032与二号位激光测距传感器Ⅰ43、二号位激光测距传感器Ⅱ44相对应,当物料桶5触发一号定位装置031的行程开关时,一号位激光测距传感器Ⅰ41和一号位激光测距传感器Ⅱ42对物料桶5进行位置测量;当物料桶5触发二号定位装置032的行程开关时,二号位激光测距传感器Ⅰ43和二号位激光测距传感器Ⅱ44对物料桶5进行位置测量。
本发明主要实现启动卸货功能,箱式货车将物料从车内输送到卸货平台上。物料桶在卸货平台上向前运动,当物料桶撞击到横挡条,横挡条压缩行程开关,行程开关被触发并发出信号,总控系统收到信号后,发出停止指令,滚筒线停止运动,此时,物料桶完成定位。卸货平台一次最多只能允许两个物料桶同时被转移到卸货平台上,在卸货平台上左右两边各装两个激光测距传感器,通过激光测距传感器测得距离数值,结合物料桶的尺寸信息,得到物料桶中心E点Xe值,Ye值,以及物料桶偏转角度值θ,将物料桶的位置信息传送给桁架机器人,桁架机器人运行到物料桶中心E点,再利用视觉技术对物料桶进行精确定位,实现大型物料的自动化入库。
基于上述大型物料桶定位装置,本发明还涉及一种大型物料桶定位方法,以一号位为例,模型简化如图6所示,一号位激光测距传感器Ⅰ41、一号位激光测距传感器Ⅱ42、横档条触发位置如图6所示,并对图中几何关系进行标注,以物料桶5触发行程开关的位置线作为X轴,以一号位激光测距传感器Ⅰ41和一号位激光测距传感器Ⅱ42所在位置线为Y轴,图中物料桶5上靠近Y轴的三个顶点在XY平面的坐标分别为A(Xa,Ya)、B(Xb,Yb)、C(Xc,Yc),中心点E的坐标为(Xe,Ye),以B向X轴、Y轴做垂直辅助线与X轴、Y轴的交点分别为F点和G点;一号位激光测距传感器Ⅰ41发出测量射线打到物料桶5上的点为I点,且与BF延长线的交点为H点;以C向Y轴做垂直辅助线与BF延长线的交点为D点,一号位激光测距传感器Ⅱ42发出测量射线打到物料桶5上的点为J点。
所述定位方法为:
步骤一:物料桶转移到卸货平台上在滚筒线2作用下前进运动,当物料桶撞击到横挡条,横挡条压缩行程开关,行程开关被触发后筒线驱动电机停止工作,滚筒线停止运行,物料桶5停止运动;
步骤二:在一号定位装置031与一号位激光测距传感器Ⅰ41、一号位激光测距传感器Ⅱ42构成的定位系统中对物料桶5进行测距;以物料桶5触发行程开关的位置线作为X轴,以一号位激光测距传感器Ⅰ41和一号位激光测距传感器Ⅱ42所在位置线为Y轴;
步骤三:读出一号位激光测距传感器Ⅰ41和一号位激光测距传感器Ⅱ42的测量数值,得到一号位激光测距传感器Ⅰ41到物料桶5的距离X1和一号位激光测距传感器Ⅱ42到物料桶5的距离X2,一号位激光测距传感器Ⅰ41和一号位激光测距传感器Ⅱ42安装位置固定,用卡尺直接测量出一号位激光测距传感器Ⅰ41Y方向的值Y1,一号位激光测距传感器Ⅱ42Y方向的值Y2,由X1、X2、Y1和Y2计算出物料桶5的旋转角度值θ;
物料桶旋转角度值θ计算方法为:Δy=Y2-Y1;Δx=X2-X1;tanθ=Δy/Δx,θ=acrtan(Δy/Δx);将物料桶旋转角度值θ计算公式植入控制器中的数据处理单元,X1、X2、Y1和Y2为测量已知值,将X1、X2、Y1和Y2的数值传送给数据处理单元,数据处理单元便可计算出物料桶的旋转角度θ。
步骤四:物料桶5为方形桶,其边长为L,物料桶5上靠近Y轴的三个顶点在XY平面的坐标分别为A(Xa,Ya)、B(Xb,Yb)、C(Xc,Yc),中心点E的坐标为(Xe,Ye),由几何关系可知,物料桶(5)中心E的坐标为:Xe=(Xa+Xc)/2,Ye=(Ya+Yc)/2;
物料桶5中心E点坐标(Xe,Ye)计算方法为:要得到E点坐标(Xe,Ye)需先求出A(Xa,Ya)、B(Xb,Yb)、C(Xc,Yc)的坐标值;
1)B(Xb,Yb)点坐标计算方法为:
A点在X轴上(定位装置触发位置线),因此通过θ值,求出B点坐标Yb的值Yb=L*sinθ;已知Y1和Yb,在直角三角形BHI中,求出BH长度,BH=Y1-Yb;
在三角形BHI中,已知BH长度和∠IBH=θ,求出IH长度,由tanθ=IH/BH=IH/(Y1-Yb)=IH/(Y1-L*sinθ)=Δy/Δx=(Y2-Y1)/(X2-X1);结合θ=acrtan(Δy/Δx);
IH=(Y2-Y1)/(X2-X1)*(Y1-L*sin(arctan((Y2-Y1)/(X2-X1))))
X1值通过测量得到,因此可以求出Xb的值;Xb=X1-IH,由此得到B点坐标(Xb,Yb);
2)C(Xc,Yc)点坐标计算方法为:
直角三角形AFB和直角三角形BDC为全等三角形,因此可得到C点Yc的值,Yc=FB+BD=L*sinθ+L*cosθ=L*(sinθ+cosθ);Xc=Xb+CD=Xb+L*sinθ,由此得到C点坐标(Xc,Yc);
3)A(Xa,Ya)点坐标计算方法为:
由于A点在X轴上(定位装置触发位置线),Ya=0,且已知B点坐标,可得Xa=L*cosθ+Xb=L*cosθ+X1-IH,由此得到A点坐标(Xa,0);
4)物料桶中心E点坐标计算方法为:
Xe=(Xa+Xc)/2;Ye=(Ya+Yc)/2=Yc/2;
并列方程式
Δy=Y2-Y1;Δx=X2-X1;θ=acrtan(Δy/Δx);Xa=L*cosθ+X1-IH;
IH=(Y2-Y1)/(X2-X1)*(Y1-L*sin(arctan((Y2-Y1)/(X2-X1))));
Xc=Xb+L*sinθ;Xb=X1-IH;Yc=L*(sinθ+cosθ);
将X1,X2,Y1,Y2值带入可求出物料桶中心E点坐标(Xe,Ye);
将物料桶5中心E点坐标(Xe,Ye)计算方法植入控制器中的数据处理单元,将X1、X2、Y1、Y2和θ的数值传送给数据处理单元,数据处理单元便可计算出物料桶中心E点坐标(Xe,Ye)
步骤五:将物料桶5中心E点坐标(Xe,Ye)和物料桶5偏转角度θ发送至桁架机器人,桁架机器人运动到E点进行抓取物料桶。
通过物料桶的几何模型可以计算出物料桶中心E点坐标(Xe,Ye),以及料桶偏转角θ;最后将物料桶中心E点坐标(Xe,Ye)和偏转角θ,发送至桁架机器人,桁架机器人携带相机运动到E点进行拍照,拍照的数据上传至总控系统,总控系统根据得到的数据,发送对应指令给桁架机器人执行后续动作;显然通过本发明的设计方案也可实现对空物料桶的装车。
本发明的定位装置和定位方法实现了对物料桶来料状态不确定时的料桶位置信息的自动识别,即自动识别物料桶位姿,并将识别出的信息传递给桁架,以方便桁架机器人的后续操作;采用横挡条加行程开关,保证物料桶在滚筒线上运行发生旋转时,始终是左右两个顶点触碰到行程开关开关停止;单边采用两个激光测距传感器,这样通过数值比较能计算出物料桶的旋转角度,同时激光测距传感器的数值可以用来进行货物装车保护。
从箱式货车自动卸下的货物输送到卸货平台上,卸货平台空间较物料而言面积大,无法采用视觉技术对整个卸货平台时进行识别时候,采用本发明提供的定位装置及定位方法可以判断物料的在平台上的位置并进行粗定位,然后再利用桁架机器人视觉技术进行精确定位,实现大型物料的自动化入库。
本发明针对不规则来料料桶位姿采用激光测距传感器进行粗定位,获得料桶中心坐标值和旋转角度值,并与桁架机器人配合使用,采用视觉技术对料桶进行精确定位,实现料桶的自动抓取,进而实现物料的自动卸货入库和空桶装车功能。
以上结合附图对本发明进行了示例性描述,显然本发明具体实现并不受上述方式的限制,只要采用了本发明技术方案进行的各种非实质性的改进,或未经改进将本发明的构思和技术方案直接应用于其它场合的,均在本发明的保护范围之内。
Claims (10)
1.一种大型物料桶定位装置,其特征在于:包括卸货平台(1)、滚筒线(2)、定位机构(3)和测距传感器(4),所述滚筒线(2)安装在卸货平台(1)上,货车与滚筒线(2)对接,定位机构(3)安装在卸货平台(1)上位于滚筒线(2)的一端,测距传感器(4)在卸货平台(1)上位于滚筒线(2)的两侧。
2.如权利要求1所述的一种大型物料桶定位装置,其特征在于:所述定位装置还包括控制器和桁架机器人,定位机构(3)的行程开关(31)与控制器电连接,控制器与桁架机器人电连接,控制器内设有数据处理单元,测距传感器(4)与数据处理单元电连接,数据处理单元对测距传感器(4)采集的数据进行处理后得出物料桶(5)的偏转角度和中心点坐标并传递给桁架机器人,桁架机器人运行到物料桶中心的上方。
3.如权利要求2所述的一种大型物料桶定位装置,其特征在于:所述卸货平台(1)上滚筒线(2)的一端设有定位板(11),卸货平台(1)上滚筒线(2)的两侧分别设有挡板Ⅰ(12)和挡板Ⅱ(13),定位机构(3)安装在定位板(11)上,测距传感器(4)安装在挡板Ⅰ(12)和挡板Ⅱ(13)上。
4.如权利要求3所述的一种大型物料桶定位装置,其特征在于:所述定位机构(3)包括行程开关(31)、横档条(32)和弹簧片(33),行程开关(31)和弹簧片(33)安装在定位板(11)上,在弹簧片(33)的另一端安装横档条(32),物料桶(5)在滚筒线(2)上运动,物料桶(5)挤压横档条(32),弹簧片(33)收缩横档条(32)与行程开关(31)接触触发行程开关(31)。
5.如权利要求4所述的一种大型物料桶定位装置,其特征在于:所述测距传感器(4)包括一号位激光测距传感器Ⅰ(41)和一号位激光测距传感器Ⅱ(42)、一号位激光测距传感器Ⅰ(41)和一号位激光测距传感器Ⅱ(42)并排安装在挡板Ⅰ(12)上,一号位激光测距传感器Ⅰ(41)与一号位激光测距传感器Ⅱ(42)之间设有间距,一号位激光测距传感器Ⅰ(41)与一号位激光测距传感器Ⅱ(42)将测量的物料桶(5)的位置信息传递给控制器的数据处理单元进行处理。
6.如权利要求5所述的一种大型物料桶定位装置,其特征在于:所述测距传感器(4)还包括二号位激光测距传感器Ⅰ(43)和二号位激光测距传感器Ⅱ(44),二号位激光测距传感器Ⅰ(43)和二号位激光测距传感器Ⅱ(44)并排安装在挡板Ⅱ(13)上,二号位激光测距传感器Ⅰ(43)与二号位激光测距传感器Ⅱ(44)之间设有间距,二号位激光测距传感器Ⅰ(43)与二号位激光测距传感器Ⅱ(44)将测量的物料桶(5)的位置信息传递给控制器的数据处理单元进行处理。
7.如权利要求6所述的一种大型物料桶定位装置,其特征在于:所述定位板(11)上并排设有两个定位机构(3)分别为一号定位装置(031)和二号定位装置(032),一号定位装置(031)与一号位激光测距传感器Ⅰ(41)、一号位激光测距传感器Ⅱ(42)相对应,二号定位装置(032)与二号位激光测距传感器Ⅰ(43)、二号位激光测距传感器Ⅱ(44)相对应。
8.一种大型物料桶定位方法,其特征在于:基于权利要求1至7任意一项所述的一种大型物料桶定位装置,所述定位方法为:
步骤一:物料桶转移到卸货平台上在滚筒线(2)作用下前进运动,当物料桶撞击到横挡条,横挡条压缩行程开关,行程开关被触发后筒线驱动电机停止工作,滚筒线停止运行,物料桶(5)停止运动;
步骤二:在一号定位装置(031)与一号位激光测距传感器Ⅰ(41)、一号位激光测距传感器Ⅱ(42)构成的定位系统中对物料桶(5)进行测距;以物料桶(5)触发行程开关的位置线作为X轴,以一号位激光测距传感器Ⅰ(41)和一号位激光测距传感器Ⅱ(42)所在位置线为Y轴;
步骤三:读出一号位激光测距传感器Ⅰ(41)和一号位激光测距传感器Ⅱ(42)的测量数值,得到一号位激光测距传感器Ⅰ(41)到物料桶(5)的距离X1和一号位激光测距传感器Ⅱ(42)到物料桶(5)的距离X2,一号位激光测距传感器Ⅰ(41)和一号位激光测距传感器Ⅱ(42)安装位置固定,用卡尺直接测量出一号位激光测距传感器Ⅰ(41)Y方向的值Y1,一号位激光测距传感器Ⅱ(42)Y方向的值Y2,由X1、X2、Y1和Y2计算出物料桶(5)的旋转角度值θ;
步骤四:物料桶(5)为方形桶,其边长为L,物料桶(5)上靠近Y轴的三个顶点在XY平面的坐标分别为A(Xa,Ya)、B(Xb,Yb)、C(Xc,Yc),中心点E的坐标为(Xe,Ye),由几何关系可知,物料桶(5)中心E的坐标为:Xe=(Xa+Xc)/2,Ye=(Ya+Yc)/2;
步骤五:将物料桶(5)中心E点坐标(Xe,Ye)和物料桶(5)偏转角度θ发送至桁架机器人,桁架机器人运动到E点进行抓取物料桶。
9.如权利要求8所述的一种大型物料桶定位方法,其特征在于:所述物料桶旋转角度值θ计算方法为:Δy=Y2-Y1;Δx=X2-X1;tanθ=Δy/Δx,θ=acrtan(Δy/Δx);将物料桶旋转角度值θ计算公式植入控制器中的数据处理单元,X1、X2、Y1和Y2为测量已知值,将X1、X2、Y1和Y2的数值传送给数据处理单元,数据处理单元便可计算出物料桶的旋转角度θ。
10.如权利要求9所述的一种大型物料桶定位方法,其特征在于:所述物料桶(5)中心E点坐标(Xe,Ye)计算方法为:要得到E点坐标(Xe,Ye)需先求出A(Xa,Ya)、B(Xb,Yb)、C(Xc,Yc)的坐标值;
1)B(Xb,Yb)点坐标计算方法为:
A点在X轴上(定位装置触发位置线),因此通过θ值,求出B点坐标Yb的值Yb=L*sinθ;已知Y1和Yb,在直角三角形BHI中,求出BH长度,BH=Y1-Yb;
在三角形BHI中,已知BH长度和∠IBH=θ,求出IH长度,由tanθ=IH/BH=IH/(Y1-Yb)=IH/(Y1-L*sinθ)=Δy/Δx=(Y2-Y1)/(X2-X1);结合θ=acrtan(Δy/Δx);
IH=(Y2-Y1)/(X2-X1)*(Y1-L*sin(arctan((Y2-Y1)/(X2-X1))))
X1值通过测量得到,因此可以求出Xb的值;Xb=X1-IH,由此得到B点坐标(Xb,Yb);
2)C(Xc,Yc)点坐标计算方法为:
直角三角形AFB和直角三角形BDC为全等三角形,因此可得到C点Yc的值,Yc=FB+BD=L*sinθ+L*cosθ=L*(sinθ+cosθ);Xc=Xb+CD=Xb+L*sinθ,由此得到C点坐标(Xc,Yc);
3)A(Xa,Ya)点坐标计算方法为:
由于A点在X轴上(定位装置触发位置线),Ya=0,且已知B点坐标,可得Xa=L*cosθ+Xb=L*cosθ+X1-IH,由此得到A点坐标(Xa,0);
4)物料桶中心E点坐标计算方法为:
Xe=(Xa+Xc)/2;Ye=(Ya+Yc)/2=Yc/2;
并列方程式
Δy=Y2-Y1;Δx=X2-X1;θ=acrtan(Δy/Δx);Xa=L*cosθ+X1-IH;
IH=(Y2-Y1)/(X2-X1)*(Y1-L*sin(arctan((Y2-Y1)/(X2-X1))));
Xc=Xb+L*sinθ;Xb=X1-IH;Yc=L*(sinθ+cosθ);
将X1,X2,Y1,Y2值带入可求出物料桶中心E点坐标(Xe,Ye);
将物料桶(5)中心E点坐标(Xe,Ye)计算方法植入控制器中的数据处理单元,将X1、X2、Y1、Y2和θ的数值传送给数据处理单元,数据处理单元便可计算出物料桶中心E点坐标(Xe,Ye)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111647009.8A CN114229519B (zh) | 2021-12-30 | 2021-12-30 | 一种大型物料桶定位装置及定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111647009.8A CN114229519B (zh) | 2021-12-30 | 2021-12-30 | 一种大型物料桶定位装置及定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114229519A true CN114229519A (zh) | 2022-03-25 |
CN114229519B CN114229519B (zh) | 2023-12-08 |
Family
ID=80744564
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111647009.8A Active CN114229519B (zh) | 2021-12-30 | 2021-12-30 | 一种大型物料桶定位装置及定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114229519B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115009554A (zh) * | 2022-07-19 | 2022-09-06 | 宁波格劳博智能工业有限公司 | 锂电池锂盐全自动灌装设备 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0564125U (ja) * | 1992-01-30 | 1993-08-24 | 村田機械株式会社 | ローラコンベアの荷検出装置 |
JP2002274641A (ja) * | 2001-03-16 | 2002-09-25 | Mitsubishi Electric Engineering Co Ltd | 小物ワークの受渡し制御装置 |
CN107031898A (zh) * | 2017-04-11 | 2017-08-11 | 漳州建鑫机械有限公司 | 一种水果包装箱输送装置 |
CN206969490U (zh) * | 2017-07-10 | 2018-02-06 | 安阳豫德机械有限公司 | 一种钢型材抛丸后下料装置 |
CN109590952A (zh) * | 2018-12-17 | 2019-04-09 | 嘉兴运达智能设备有限公司 | 成套工艺装配板的智能检测方法和检测工作台 |
CN109709974A (zh) * | 2019-01-04 | 2019-05-03 | 南京航空航天大学 | 一种基于激光测距的二维空间引导定位方法 |
JP2019218216A (ja) * | 2019-10-02 | 2019-12-26 | 株式会社東芝 | 取出装置および方法 |
CN111498525A (zh) * | 2020-05-09 | 2020-08-07 | 安徽海螺水泥股份有限公司 | 一种自动装车定位系统和方法 |
CN113023348A (zh) * | 2021-03-12 | 2021-06-25 | 江苏科技大学 | 一种泡沫条的码放装置 |
-
2021
- 2021-12-30 CN CN202111647009.8A patent/CN114229519B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH0564125U (ja) * | 1992-01-30 | 1993-08-24 | 村田機械株式会社 | ローラコンベアの荷検出装置 |
JP2002274641A (ja) * | 2001-03-16 | 2002-09-25 | Mitsubishi Electric Engineering Co Ltd | 小物ワークの受渡し制御装置 |
CN107031898A (zh) * | 2017-04-11 | 2017-08-11 | 漳州建鑫机械有限公司 | 一种水果包装箱输送装置 |
CN206969490U (zh) * | 2017-07-10 | 2018-02-06 | 安阳豫德机械有限公司 | 一种钢型材抛丸后下料装置 |
CN109590952A (zh) * | 2018-12-17 | 2019-04-09 | 嘉兴运达智能设备有限公司 | 成套工艺装配板的智能检测方法和检测工作台 |
CN109709974A (zh) * | 2019-01-04 | 2019-05-03 | 南京航空航天大学 | 一种基于激光测距的二维空间引导定位方法 |
JP2019218216A (ja) * | 2019-10-02 | 2019-12-26 | 株式会社東芝 | 取出装置および方法 |
CN111498525A (zh) * | 2020-05-09 | 2020-08-07 | 安徽海螺水泥股份有限公司 | 一种自动装车定位系统和方法 |
CN113023348A (zh) * | 2021-03-12 | 2021-06-25 | 江苏科技大学 | 一种泡沫条的码放装置 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115009554A (zh) * | 2022-07-19 | 2022-09-06 | 宁波格劳博智能工业有限公司 | 锂电池锂盐全自动灌装设备 |
CN115009554B (zh) * | 2022-07-19 | 2023-08-08 | 宁波格劳博智能工业有限公司 | 锂电池锂盐全自动灌装设备 |
Also Published As
Publication number | Publication date |
---|---|
CN114229519B (zh) | 2023-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US8827623B2 (en) | Device for loading goods into and/or unloading goods from a loading space, particularly a container | |
EP2945894B1 (en) | Automated truck unloader for unloading/unpacking product from trailers and containers | |
CN103342240B (zh) | 袋装物料装车系统和方法 | |
CN110540137B (zh) | 一种基于多传感器融合的起重机作业系统 | |
WO2018167366A1 (en) | Monitoring container transfer device on lowering container onto transport platform or lifting away from transport platform | |
MX2013012317A (es) | Tecnicas para el posicionamiento de un vehiculo. | |
CN111498525A (zh) | 一种自动装车定位系统和方法 | |
CN215679136U (zh) | 导航系统和agv小车 | |
CN114229519A (zh) | 一种大型物料桶定位装置及定位方法 | |
KR101701108B1 (ko) | 부피 및 중량 자동 측정 시스템 | |
US20230202752A1 (en) | Refuse collection vehicle positioning | |
CN114572719B (zh) | 柔性自动装卸车机器人系统及方法 | |
CN108592801A (zh) | 车辆超限检测装置和检测方法 | |
CN114011661B (zh) | 涂胶控制方法及其系统 | |
CN113562094A (zh) | 一种带有转向调节的搬运机器人 | |
CN108793015A (zh) | 全自动无人堆垛车 | |
CN210260442U (zh) | 高度调节系统 | |
US20220390564A1 (en) | Portable sensor system | |
CN208292580U (zh) | 一种运用于小型箔卷的agv车 | |
CN108483349A (zh) | 具有行程检测功能的堆垛车 | |
CN108483353A (zh) | 具有防障碍物功能的堆垛车 | |
CN210763109U (zh) | 一种双头取放料平台 | |
CN209841071U (zh) | 无人值守堆取料机大车位置校验装置 | |
CN216710969U (zh) | 溜槽定位检测装置 | |
CN217024565U (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 |