CN108943014A - 一种重型6自由度机械臂各关节传感器的现场标定方法 - Google Patents
一种重型6自由度机械臂各关节传感器的现场标定方法 Download PDFInfo
- Publication number
- CN108943014A CN108943014A CN201710354422.2A CN201710354422A CN108943014A CN 108943014 A CN108943014 A CN 108943014A CN 201710354422 A CN201710354422 A CN 201710354422A CN 108943014 A CN108943014 A CN 108943014A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- joint
- calibration
- joint sensors
- arm
- 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.)
- Pending
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
- B25J19/0095—Means or methods for testing manipulators
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Earth Drilling (AREA)
Abstract
一种重型6自由度机械臂各关节传感器的现场标定法针对凿岩台车钻臂自动定位控制***中的传感器标定问题，提出一种简便易用、不借助外部仪器，在台车的使用现场对机械臂各关节传感器进行标定的方法。这种方法考虑了机械臂干涉的可能性、操作的方便性、标定数值的唯一性和确定性等条件，实现准确的传感器标定。
Description
技术领域
凿岩台车是隧道、地下工程钻爆施工法的一种工程装备；具有计算机自动控制功能的凿岩台车也称为凿岩机器人，是一种特种移动机器人；本发明适用于这种特种移动机器人的重型6自由度机械臂，在施工现场对各关节传感器进行标定的应用。
背景技术
钻爆法施工是目前隧道开挖的主要工艺方法，其中凿岩台车是钻爆法的重要工程装备。在我国，风钻凿岩台车由于作业环境恶劣、对操作工人的身体健康带来严重威胁而逐步退出历史舞台；全液压凿岩台车极大地改善了工人的劳动条件，成为各种隧道施工的主要装备。随着计算机及控制技术的发展，全电脑凿岩台车在改善工人的劳动强度、提高劳动生产率方面有着显著的优势，成为一种发展方向。全电脑凿岩台车的技术优势掌握在多山的北欧国家的公司手中，如挪威 AMV 公司，瑞典的 Atlas公司，瑞典的Sandvik公司等。这些公司在凿岩台车的计算机控制方面投入了巨大的研究力量，其产品介绍上的描述包括全自动移动钻臂、全自动凿岩、激光扫描断面进行车体定位等。这些研究成果并未见到有详细的技术描述的学术报道。另一方面，就国内引进的这些产品的实际应用来看，其自动化的实用性还远没有预期的效果。国内的生产企业基本上以液压凿岩台车为主打产品，高校、研究院所也投入了不少的研究力量，见诸文献的也有不少自称是实现了全自动的电脑控制，但实际工程应用上，尚未见到国产的自动控制的凿岩台车，在具有防爆要求的煤矿井下，更未见到国产产品。
电脑自动凿岩台车的一个主要任务是把安装在末端的液压凿岩机通过重型6自由度串联机械臂以预先设计的姿态运送到断面要求的位置，这一过程就是机械臂的自动定位。为了对机械臂进行自动定位，需要在机械臂各关节安装反映关节运动位置的传感器。但在将凿岩台车运输到工作现场时，往往需要对整个车体进行拆解，分开运输，到现场后再进行装配。例如要将台车运送到煤矿井下，因巷道及运输工具的限制，不能将整车一次运送下去，需要肢解后运输。
到现场重新装配的机械臂，其传感器必须重新进行标定，才能投入钻臂自动定位功能。但因现场的设备条件有限，没有专用的标定仪器。本发明就是针对这一问题，不需要专用仪器，适用于现场环境下对传感器进行标定。还没有发现文献上有类似的报道。
发明内容
本发明针对的凿岩台车的机械臂如图1为所示，有六个自由度，其中前5个关节为转动副，第六个关节为移动副。
该机械臂的运动机构图如图2所示。
各关节传感器类型：关节1-关节5安装有CAN总线的绝对式光电编码器，通过总线输出数字信号；关节6在油缸内部油缸长度传感器，模拟电压信号输出。
本发明涉及到机械臂在现场重新组装好后，各关节传感器的标定顺序和每个传感器标定时机械臂的操作方式及停放姿态。本发明考虑了机械臂干涉的可能性、操作的方便性、标定数值的唯一性和确定性等条件，按照本发明进行传感器标定，操作速度快、干涉的危险性小、标定的精度高。下面以右臂传感器标定为例进行说明，左臂采用相同的标定过程。
传感器的标定顺序：关节1，关节2，关节5，关节4，关节3，关节6。
关节1传感器标定：（1）操作手柄，调节右臂1号油缸伸长（大臂往里转）到极限位置，如图3所示。（2）将该极限角度位置通过CAN总线，写入1号传感器。
关节2传感器标定：（1）操作手柄，调节右臂2号油缸收缩（大臂往下降）到极限位置，如图4所示。（2）将该极限角度位置通过CAN总线，写入2号传感器。
关节5传感器标定：（1）操作手柄，调节右臂5号油缸收缩（滑架前端往里摆）到极限位置，如图5所示。（2）将该极限角度位置通过CAN总线，写入5号传感器。
关节4传感器标定：（1）操作手柄，调节右臂4号油缸伸长（滑架前端往上仰）到极限位置，如图6所示。（2）将该极限角度位置通过CAN总线，写入4号传感器。
关节3传感器标定：（1）操作手柄，调节3号关节，对齐机械臂上的刻度线，如图7所示。（2）此时3号关节为零度，通过CAN总线，将零值写入3号传感器。
关节6传感器标定：（1）操作手柄，调节6号关节，将滑架退回零位。（2）此时传感器电压值记录为6号传感器零值。
附图说明
本发明说明书附图含有7个图，从图1到图7连续编号，下面对附图进行说明。
图1是机械臂外形图，图中1.关节1，2.关节2，3.关节3，4.关节4，5.关节5，6.关节6，7.车体
图2是机械臂运动机构简图。
图3是右臂1号传感器标定时臂的位置示意图。
图4是右臂2号传感器标定时臂的位置示意图。
图5是右臂5号传感器标定时臂的位置示意图。
图6是右臂4号传感器标定时臂的位置示意图。
图7是右臂3号传感器标定时臂的位置示意图。
Claims (3)
1.一种重型6自由度机械臂各关节传感器的现场标定法，其特征在凿岩台车的使用现场，不需要使用外部仪器，实现对各个关节传感器的标定。
2.根据权利要求1，这种方法规定了传感器的标定顺序和对应机械臂的摆放姿态。
3.根据权利要求1，这种方法首先操作臂到达规定姿态，然后将数值写入传感器，实现标定。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710354422.2A CN108943014A (zh) | 2017-05-19 | 2017-05-19 | 一种重型6自由度机械臂各关节传感器的现场标定方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710354422.2A CN108943014A (zh) | 2017-05-19 | 2017-05-19 | 一种重型6自由度机械臂各关节传感器的现场标定方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN108943014A true CN108943014A (zh) | 2018-12-07 |
Family
ID=64462665
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710354422.2A Pending CN108943014A (zh) | 2017-05-19 | 2017-05-19 | 一种重型6自由度机械臂各关节传感器的现场标定方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN108943014A (zh) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109555474A (zh) * | 2018-12-28 | 2019-04-02 | 浙江理工大学 | 空间四自由度凿岩机钻臂机构综合方法及钻臂机构 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101451832A (zh) * | 2008-12-30 | 2009-06-10 | 三一重工股份有限公司 | 用于测量机械臂或机械手角度的传感器标定方法及装置 |
| US20150025683A1 (en) * | 2013-07-22 | 2015-01-22 | Canon Kabushiki Kaisha | Robot system and calibration method of the robot system |
| CN104727804A (zh) * | 2014-11-27 | 2015-06-24 | 三一重型装备有限公司 | 一种凿岩台车及其钻臂定位控制方法和装置 |
| CN106625594A (zh) * | 2016-12-16 | 2017-05-10 | 南京熊猫电子股份有限公司 | 一种基于电磁编码器的机器人零位标定方法 |
-
2017
- 2017-05-19 CN CN201710354422.2A patent/CN108943014A/zh active Pending
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101451832A (zh) * | 2008-12-30 | 2009-06-10 | 三一重工股份有限公司 | 用于测量机械臂或机械手角度的传感器标定方法及装置 |
| US20150025683A1 (en) * | 2013-07-22 | 2015-01-22 | Canon Kabushiki Kaisha | Robot system and calibration method of the robot system |
| CN104727804A (zh) * | 2014-11-27 | 2015-06-24 | 三一重型装备有限公司 | 一种凿岩台车及其钻臂定位控制方法和装置 |
| CN106625594A (zh) * | 2016-12-16 | 2017-05-10 | 南京熊猫电子股份有限公司 | 一种基于电磁编码器的机器人零位标定方法 |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109555474A (zh) * | 2018-12-28 | 2019-04-02 | 浙江理工大学 | 空间四自由度凿岩机钻臂机构综合方法及钻臂机构 |
| CN109555474B (zh) * | 2018-12-28 | 2023-10-24 | 浙江理工大学 | 空间四自由度凿岩机钻臂机构综合方法及钻臂机构 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN105298387A (zh) | 凿岩台车 | |
| CN111360832B (zh) | 提高破拆机器人末端工具远程对接精度的方法 | |
| CN204163619U (zh) | 一种钻车钻臂定位*** | |
| CN104833324A (zh) | 一种基于测量头的机器人标定方法 | |
| US20220170368A1 (en) | Apparatus and Method for Preparing a Blast Hole in a Rock Face During a Mining Operation | |
| CN107219084A (zh) | 动态指向式旋转导向钻井工具性能测试试验台 | |
| US20210108428A1 (en) | System comprising at least one first device movable in a controlled manner and at least one second device, which is arranged on said at least one first device, for applying material | |
| CN105257300B (zh) | 一种隧道超欠挖控制方法及钻孔检测杆 | |
| CN111485879A (zh) | 一种掘进机车体及其截割滚筒的定位方法及定位*** | |
| CN108943014A (zh) | 一种重型6自由度机械臂各关节传感器的现场标定方法 | |
| CN105239992A (zh) | 钻孔方法 | |
| KR101826343B1 (ko) | 다축센서를 이용한 거동 측정 및 유지보수 방법 | |
| CN103967474A (zh) | 地下采矿钻车自动定位*** | |
| Roman et al. | Development of Position System of a Roadheader on a Base of Active IR-sensor | |
| CN107143293A (zh) | 一种全液压煤矿井下钻孔辅助机械装置 | |
| CN108643914B (zh) | 一种智能化露天煤矿连采机*** | |
| CN212296219U (zh) | 一种综采工作面过断层智能钻孔*** | |
| CN113756711B (zh) | 一种煤矿井下钻探施工设备***及其施工参数优化方法 | |
| CN210798831U (zh) | 轨道及公路交通隧道智能打孔*** | |
| CN212254422U (zh) | 一种新型可溯源和状态监测的盾构管片 | |
| CN107966461B (zh) | 一种双全回转检测机头位姿自动补偿机构 | |
| Chen | Design and test of intelligent inspection and replacement system of TBM excavation tools | |
| CN108789402A (zh) | 一种特种移动机器人多臂运动的主动避碰方法 | |
| Li et al. | Four-point dynamic leveling method for drilling platform application | |
| Wada | Automatic segment erection system for shield tunnels |
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 | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20181207 |
|
| WD01 | Invention patent application deemed withdrawn after publication |