CN114229519B - 一种大型物料桶定位装置及定位方法 - Google Patents

一种大型物料桶定位装置及定位方法 Download PDF

Info

Publication number
CN114229519B
CN114229519B CN202111647009.8A CN202111647009A CN114229519B CN 114229519 B CN114229519 B CN 114229519B CN 202111647009 A CN202111647009 A CN 202111647009A CN 114229519 B CN114229519 B CN 114229519B
Authority
CN
China
Prior art keywords
ranging sensor
material barrel
laser ranging
point
positioning
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
Application number
CN202111647009.8A
Other languages
English (en)
Other versions
CN114229519A (zh
Inventor
王绪晨
陶贤水
李龙
范鹏飞
曹雏清
赵杰
李瑞峰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Wuhu Hit Robot Technology Research Institute Co Ltd
Original Assignee
Wuhu Hit Robot Technology Research Institute Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Wuhu Hit Robot Technology Research Institute Co Ltd filed Critical Wuhu Hit Robot Technology Research Institute Co Ltd
Priority to CN202111647009.8A priority Critical patent/CN114229519B/zh
Publication of CN114229519A publication Critical patent/CN114229519A/zh
Application granted granted Critical
Publication of CN114229519B publication Critical patent/CN114229519B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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 (5)

1.一种大型物料桶定位装置，其特征在于：包括卸货平台(1)、滚筒线(2)、定位机构(3)和测距传感器(4)，所述滚筒线(2)安装在卸货平台(1)上，货车与滚筒线(2)对接，定位机构(3)安装在卸货平台(1)上位于滚筒线(2)的一端，测距传感器(4)在卸货平台(1)上位于滚筒线(2)的两侧；所述卸货平台(1)上滚筒线(2)的一端设有定位板(11)，卸货平台(1)上滚筒线(2)的两侧分别设有挡板Ⅰ(12)和挡板Ⅱ(13)，定位机构(3)安装在定位板(11)上，测距传感器(4)安装在挡板Ⅰ(12)和挡板Ⅱ(13)上；所述测距传感器(4)包括一号位激光测距传感器Ⅰ(41)、一号位激光测距传感器Ⅱ(42)、二号位激光测距传感器Ⅰ(43)和二号位激光测距传感器Ⅱ(44)；所述定位板(11)上并排设有两个定位机构(3)分别为一号定位装置(031)和二号定位装置(032)，一号定位装置(031)与一号位激光测距传感器Ⅰ(41)、一号位激光测距传感器Ⅱ(42)相对应，二号定位装置(032)与二号位激光测距传感器Ⅰ(43)、二号位激光测距传感器Ⅱ(44)相对应；所述定位机构(3)包括行程开关(31)、横档条(32)和弹簧片(33)，行程开关(31)和弹簧片(33)安装在定位板(11)上，在弹簧片(33)的另一端安装横档条(32)，物料桶(5)在滚筒线(2)上运动，物料桶(5)挤压横档条(32)，弹簧片(33)收缩，横档条(32)与行程开关(31)接触触发行程开关(31)；所述一号位激光测距传感器Ⅰ(41)和一号位激光测距传感器Ⅱ(42)并排安装在挡板Ⅰ(12)上，一号位激光测距传感器Ⅰ(41)与一号位激光测距传感器Ⅱ(42)之间设有间距，一号位激光测距传感器Ⅰ(41)与一号位激光测距传感器Ⅱ(42)将测量的物料桶(5)的位置信息传递给控制器的数据处理单元进行处理；所述二号位激光测距传感器Ⅰ(43)和二号位激光测距传感器Ⅱ(44)并排安装在挡板Ⅱ(13)上，二号位激光测距传感器Ⅰ(43)与二号位激光测距传感器Ⅱ(44)之间设有间距，二号位激光测距传感器Ⅰ(43)与二号位激光测距传感器Ⅱ(44)将测量的物料桶(5)的位置信息传递给控制器的数据处理单元进行处理。
2.如权利要求1所述的一种大型物料桶定位装置，其特征在于：所述定位装置还包括控制器和桁架机器人，定位机构(3)的行程开关(31)与控制器电连接，控制器与桁架机器人电连接，控制器内设有数据处理单元，测距传感器(4)与数据处理单元电连接，数据处理单元对测距传感器(4)采集的数据进行处理后得出物料桶(5)的偏转角度和中心点坐标并传递给桁架机器人，桁架机器人运行到物料桶中心的上方。
3.一种大型物料桶定位方法，其特征在于：基于权利要求1或2所述的一种大型物料桶定位装置，所述定位方法为：
步骤一：物料桶转移到卸货平台上在滚筒线(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点进行抓取物料桶。
4.如权利要求3所述的一种大型物料桶定位方法，其特征在于：所述物料桶旋转角度值θ计算方法为：Δy＝Y2-Y1；Δx＝X2-X1；tanθ＝Δy/Δx，θ＝acrtan(Δy/Δx)；将物料桶旋转角度值θ计算公式植入控制器中的数据处理单元，X1、X2、Y1和Y2为测量已知值，将X1、X2、Y1和Y2的数值传送给数据处理单元，数据处理单元便可计算出物料桶的旋转角度θ。
5.如权利要求4所述的一种大型物料桶定位方法，其特征在于：所述物料桶(5)中心E点坐标(Xe，Ye)计算方法为：要得到E点坐标(Xe，Ye)需先求出A(Xa，Ya)、B(Xb，Yb)、C(Xc，Yc)的坐标值；
1)B(Xb，Yb)点坐标计算方法为：
A点在X轴上，定位装置触发位置线作为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轴上，定位装置触发位置线作为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)。
CN202111647009.8A 2021-12-30 2021-12-30 一种大型物料桶定位装置及定位方法 Active CN114229519B (zh)

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 CN114229519A (zh) 2022-03-25
CN114229519B true 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)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115009554B (zh) * 2022-07-19 2023-08-08 宁波格劳博智能工业有限公司 锂电池锂盐全自动灌装设备

Citations (9)

* Cited by examiner, † Cited by third party
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 江苏科技大学 一种泡沫条的码放装置

Patent Citations (9)

* Cited by examiner, † Cited by third party
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 江苏科技大学 一种泡沫条的码放装置

Also Published As

Publication number Publication date
CN114229519A (zh) 2022-03-25

Similar Documents

Publication Publication Date Title
US10266351B2 (en) Automated truck unloader for unloading/unpacking product from trailers and containers
CN106276325B (zh) 厢式车自动化装车***
US20180257878A1 (en) Carton unloader with self-aligning interface
JP2022540107A (ja) 自動ガイドフォークリフト
WO2018167366A1 (en) Monitoring container transfer device on lowering container onto transport platform or lifting away from transport platform
CN109895825B (zh) 自动运输装置
CN114229519B (zh) 一种大型物料桶定位装置及定位方法
CN106564761A (zh) 码垛机器人***
CN110540137B (zh) 一种基于多传感器融合的起重机作业***
US20140277716A1 (en) Robot system and robot working method
CN111498525A (zh) 一种自动装车定位***和方法
CN112173518A (zh) 控制方法和自动引导车
CN202869460U (zh) 微控承载鞍全尺寸检测
CN112278891B (zh) 一种车厢内部姿态检测方法
CN112173519A (zh) 控制方法和自动引导车
US20220390564A1 (en) Portable sensor system
CN212391421U (zh) 货物检测***
CN210763109U (zh) 一种双头取放料平台
CN113463720B (zh) 装载机铲斗接触物料的辨识***和方法
CN217024565U (zh) 自动货物装卸***
EP4227256A1 (en) Substrate conveying hand, substrate conveying apparatus, and substrate conveying method
CN216710969U (zh) 溜槽定位检测装置
CN220548291U (zh) 一种搬运机器人
US20230382637A1 (en) Apparatus and method for handling twistlocks
US20240210542A1 (en) Methods and apparatus for lidar alignment and calibration

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