CN106945049B - 一种仿人机器人关节零位校准的方法 - Google Patents

一种仿人机器人关节零位校准的方法 Download PDF

Info

Publication number
CN106945049B
CN106945049B CN201710334155.2A CN201710334155A CN106945049B CN 106945049 B CN106945049 B CN 106945049B CN 201710334155 A CN201710334155 A CN 201710334155A CN 106945049 B CN106945049 B CN 106945049B
Authority
CN
China
Prior art keywords
joint
robot
zero adjustment
calibrated
control centre
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
CN201710334155.2A
Other languages
English (en)
Other versions
CN106945049A (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.)
Shenzhen Intelligent Bosch Technology Co Ltd
Original Assignee
Shenzhen Intelligent Bosch Technology 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 Shenzhen Intelligent Bosch Technology Co Ltd filed Critical Shenzhen Intelligent Bosch Technology Co Ltd
Priority to CN201710334155.2A priority Critical patent/CN106945049B/zh
Publication of CN106945049A publication Critical patent/CN106945049A/zh
Application granted granted Critical
Publication of CN106945049B publication Critical patent/CN106945049B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • B25J9/1692—Calibration of manipulator

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Toys (AREA)

Abstract

本发明属于仿人机器人技术领域，具体涉及一种仿人机器人关节零位校准的方法。用PC上位机软件、手机APP，通过有线连接或是无线连接连接到仿人机器人，或者通过语音控制方式，向仿人机器人发出关节零位校准指令，仿人机器人控制中心会进入零位校准模式，开始对每个关节进行校准；零位校准时，仿人机器人控制中心向待校准关节发送转动指令；机器人控制中心间隔一段时间查询一次待校准关节的角度，当待校准关节无法转动时，即认为待校准关节已经转动到关节限位面，机器人控制中心计算出零位位置误差值，并保存起来，开始校准下一个关节零位位置。本发明节省了开发成本和装置成本，不需要额外单独开发零位校准装置。

Description

一种仿人机器人关节零位校准的方法
技术领域
本发明属于仿人机器人技术领域，具体涉及一种仿人机器人关节零位校准的方法。
背景技术
仿人机器人主要包含头部，手部各两条，腿部各两条。头部有1-3个关节，每只手有3个关节每条腿有3-6个关节，每个关节是一个自由度。关节因为存在位置传感器误差，关节输出齿轮与舵盘的安装位置误差等，造成不同关节零位位置存在的值不一样。位置传感器及其角度误差如图1所示。
关节输出齿轮齿数为N，每个齿的角度为360°/N，一般地，为了更方便地进行组装，允许舵盘与关节输出齿轮偏差2个齿数，即最大会产生2*360°/N度的误差。假设使用的关节齿轮齿数为25，所以每个齿的角度为14.4°。在安装时，舵盘与关节输出齿轮偏差1个齿数时，零位位置就会产生14.4°的误差。如图2所示。
现有仿人机器人零位校准方法有刻度对位校准方式，限位装置校准方式，CCD检测校准方式。
刻度对位校准方式：此方式在零位位置和活动关节增加对位的刻度，需要做零位校准时，手动将关节调整至刻度对应位置，将此位置设定为零位位置。这种方式需要人为判断零位位置，容易产生人为误差，效率较低。
限位装置校准方式：此方式规定每个关节零位位置，再根据对应的零位位置开发一套限位装置，需要做零位校准时，把机器人放入限位装置中，手动将关节调整至限位位置，再将此位置设定为零位位置。此种方式减少了人为判断造成的误差，但是机器人关节越多，操作越复杂，而且需要额外增加限位装置。
CCD检测校准方式：需要用到CCD检测平台，将机器人开机后，放置于检测平台，将CCD采集到机器人角度与预设零位角度进行对比，计算出角度误差后，再通知机器人修改相应的角度误差。这种方法需要专门为机器人零位校准开发一套视觉算法处理检测设备，设备开发技术复杂，成本较高，而且只适合在量产生产中使用，适用范围较窄。
发明内容
为克服现有技术所存在的缺陷，本发明提供一种仿人机器人关节零位校准的方法，以关节位置传感器的中位位置为参考零位位置，结合机器人本体结构限位，调整中位位置来确定参考机器人各关节的零位位置。
本发明要解决其技术问题所采用的技术方案是：设计一种仿人机器人关节零位校准的方法，按照下述步骤依次进行：
步骤一：使用PC上位机软件、手机APP，通过有线连接或是无线连接连接到仿人机器人，或者通过语音控制方式，向仿人机器人发出关节零位校准指令，仿人机器人控制中心会进入零位校准模式，开始对每个关节进行校准；
步骤二：零位校准时，仿人机器人控制中心向待校准关节发送转动指令；机器人控制中心间隔一段时间查询一次待校准关节的角度，当待校准关节无法转动时，即认为待校准关节已经转动到关节限位面，机器人控制中心计算出零位位置误差值，并保存起来，开始校准下一个关节零位位置。
优选的，步骤一中所述的无线连接包括蓝牙、Wi-Fi通信。
优选的，步骤二中所述的关节零位位置是以关节位置传感器的中位位置为参考零位位置，结合机器人本体结构限位，调整中位位置来确定参考机器人各关节的零位位置。
优选的，所述的关节位置传感器角度范围为0-330°，实际使用角度范围为0-240°，即截取中位位置左右各120°作为实际使用角度，预留90°作为校准角度。
本发明所具有的有益效果是：
本发明节省了开发成本和装置成本，不需要额外单独开发零位校准装置。降低开发技术难度，依托机器人本体结构就可以对机器人做零位校准。可以让机器人自动寻找零位位置，做零位校准，减少人为操作误差。
附图说明
图1为位置传感器及其角度误差；
图2为关节输出齿轮与舵盘及组装示意图；
图3为本发明的仿人机器人零位校准流程图；
图4是本发明的关节与位置传感器角度范围；
图5是本发明的仿人机器人各关节理想初始状态；
图6是本发明的仿人机器人各关节实际初始状态；
图7是本发明的关节限位说明示意图；
图8是本发明的关节转动与限位说明示意图；
图9是本发明的关节零位校准后示意图。
具体实施方式
本发明所述的一种仿人机器人关节零位校准的方法，按照下述步骤依次进行：
步骤一：使用PC上位机软件、手机APP，通过有线连接或是无线连接连接到仿人机器人，或者通过语音控制方式，向仿人机器人发出关节零位校准指令，仿人机器人控制中心会进入零位校准模式，开始对每个关节进行校准；
步骤二：零位校准时，仿人机器人控制中心向待校准关节发送转动指令；机器人控制中心间隔一段时间查询一次待校准关节的角度，当待校准关节无法转动时，即认为待校准关节已经转动到关节限位面，机器人控制中心计算出零位位置误差值，并保存起来，开始校准下一个关节零位位置。如图3所示。
步骤一中所述的无线连接包括蓝牙、Wi-Fi通信。
步骤二中所述的关节零位位置是以关节位置传感器的中位位置为参考零位位置，结合机器人本体结构限位，调整中位位置来确定参考机器人各关节的零位位置。
所述的关节位置传感器角度范围为0-330°，实际使用角度范围为0-240°，即截取中位位置左右各120°作为实际使用角度，预留90°作为校准角度。如图4所示。
图4中两边黑色箭头部分为预留的校准角度，校准角度范围左右各45°，此部分在关节使用时不可见，只在校准时才起作用。中间白色框代表关节实际使用角度范围0-240°，图中位置传感器中位位置对应关节的120°。
关节初始角度设定在中位位置，即120°。各关节理想的初始状态如图5所示。图5中每个关节都是120°。
但是因为不同关节之间存在角度误差，所以成整机后，机器人各关节实际初始状态与理想初始状态有一定的差异，如图6所示。
本发明在仿人机器人关节连接的地方，增加了外壳结构限位。如图7所示。
关节1作为关节2的零位校准基准点。利用关节1的外壳设置了关节2的角度限位。
关节1的限位面需要平整，不能因关节1和关节2角度差异而产生误差。
图8所示，关节限位面与关节初始状态形成的夹角角度值是固定的，可预知的角度值θ1。
实际装配的初始角度f与理想初始角度e存在误差θ2。θ2可以是正值，也可以是负值。
当关节2转动到关节限位面后，无法再转动，此时关节2的角度为关节限位角度，此时关节2转动的角度值为θ。
θ＝θ1+θ2
关节2转动的角度值θ可以通过关节位置传感器检测得知。从式1可以得知
θ2＝θ-θ1
即关节2实际转动的角度-关节限位面与关节初始状态形成的固定夹角，得到的就是关节实际初始角度值与理想初始角度值的误差θ2。如图9所示。
图9表示关节角度整体往位置传感器零位位置方向偏移θ2。当θ2为负值时，关节角度整体往位置传感器最大位置方向偏移θ2。
最后所应说明的是：以上实施例仅用以说明而非限制本发明的技术方案，尽管参照上述实施例对本发明进行了详细说明，本领域的普通技术人员应该理解：依然可以对本发明进行修改或者等同替换，而不脱离本发明的精神和范围的任何修改或局部替换，其均应涵盖在本发明的权利要求范围当中。

Claims (4)

1.一种仿人机器人关节零位校准的方法，其特征在于：按照下述步骤依次进行：
步骤一：使用PC上位机软件、手机APP，通过有线连接或是无线连接连接到仿人机器人，或者通过语音控制方式，向仿人机器人发出关节零位校准指令，仿人机器人控制中心会进入零位校准模式，开始对每个关节进行校准；
步骤二：零位校准时，仿人机器人控制中心向待校准关节发送转动指令；机器人控制中心间隔一段时间查询一次待校准关节的角度，当待校准关节无法转动时，即认为待校准关节已经转动到关节限位面，机器人控制中心计算出零位位置误差值，并保存起来，开始校准下一个关节零位位置。
2.根据权利要求1所述的一种仿人机器人关节零位校准的方法，其特征在于：步骤一中所述的无线连接包括蓝牙、Wi-Fi通信。
3.根据权利要求1所述的一种仿人机器人关节零位校准的方法，其特征在于：步骤二中所述的关节零位位置是以关节位置传感器的中位位置为参考零位位置，结合仿人机器人本体结构限位，调整中位位置来确定参考机器人各关节的零位位置。
4.根据权利要求3所述的一种仿人机器人关节零位校准的方法，其特征在于：所述的关节位置传感器角度范围为0-330°，实际使用角度范围为0-240°，即截取中位位置左右各120°作为实际使用角度，预留90°作为校准角度。
CN201710334155.2A 2017-05-12 2017-05-12 一种仿人机器人关节零位校准的方法 Active CN106945049B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710334155.2A CN106945049B (zh) 2017-05-12 2017-05-12 一种仿人机器人关节零位校准的方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710334155.2A CN106945049B (zh) 2017-05-12 2017-05-12 一种仿人机器人关节零位校准的方法

Publications (2)

Publication Number Publication Date
CN106945049A CN106945049A (zh) 2017-07-14
CN106945049B true CN106945049B (zh) 2019-08-06

Family

ID=59478564

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710334155.2A Active CN106945049B (zh) 2017-05-12 2017-05-12 一种仿人机器人关节零位校准的方法

Country Status (1)

Country Link
CN (1) CN106945049B (zh)

Families Citing this family (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6844462B2 (ja) * 2017-07-21 2021-03-17 株式会社デンソーウェーブ 角度検出器の偏心誤差補正方法、ロボットシステム
CN107932554A (zh) * 2017-10-26 2018-04-20 苏州乐轩科技有限公司 电动关节校准方法及校准装置
CN107813313A (zh) * 2017-12-11 2018-03-20 南京阿凡达机器人科技有限公司 机械臂运动的校正方法和装置
CN107953337A (zh) * 2017-12-29 2018-04-24 深圳市乐幻索尔科技有限公司 一种机器人动作偏差的调整和保存方法及系统
CN110405749B (zh) * 2018-04-27 2020-12-15 深圳市优必选科技有限公司 关节限位检测方法、装置、机器人及计算机可读存储介质
CN109262659B (zh) * 2018-12-20 2019-04-02 中国铁建重工集团有限公司 一种机械臂关节传感器的零位校准方法和设备
CN111376256A (zh) * 2018-12-29 2020-07-07 深圳市优必选科技有限公司 一种舵机角度校准方法、系统、机器人及存储介质
CN109732595B (zh) * 2018-12-29 2021-02-09 深圳市越疆科技有限公司 一种舵机的校准方法、装置及控制器
CN109927034B (zh) * 2019-04-08 2020-10-02 广州市威控机器人有限公司 校准装置及校准方法
CN110802593B (zh) * 2019-11-07 2020-11-27 北京理工大学 一种仿人机器人下肢关节零位标定方法
CN112549036B (zh) * 2020-12-25 2022-04-15 深圳市优必选科技股份有限公司 机器人关节校准方法、装置、机器人和存储介质
CN116172698A (zh) * 2021-11-29 2023-05-30 瑞龙诺赋(上海)医疗科技有限公司 机械零位校准方法、装置、设备及介质

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101574809A (zh) * 2009-06-16 2009-11-11 北京华凯汇信息科技有限公司 机器人关节零点定位系统、方法和装置
CN102744731A (zh) * 2012-07-19 2012-10-24 北京理工大学 一体化旋转关节和确定一体化旋转关节零位的方法
CN102837309A (zh) * 2011-06-22 2012-12-26 北京理工大学 机器人360度旋转关节的防绕线定位装置
CN103101054A (zh) * 2013-01-17 2013-05-15 上海交通大学 手机对机器人的编程和控制系统
CN103395073A (zh) * 2013-08-22 2013-11-20 中国船舶重工集团公司第七一六研究所 一种六轴工业机器人的零点标定方法
CN103968761A (zh) * 2014-05-28 2014-08-06 中科华赫（北京）科技有限责任公司 串联关节式机器人绝对定位误差校准方法及标定系统

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20150134099A1 (en) * 2013-11-08 2015-05-14 Startechno Co., Ltd. Workpiece machining device with calibration function and workpiece machining device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101574809A (zh) * 2009-06-16 2009-11-11 北京华凯汇信息科技有限公司 机器人关节零点定位系统、方法和装置
CN102837309A (zh) * 2011-06-22 2012-12-26 北京理工大学 机器人360度旋转关节的防绕线定位装置
CN102744731A (zh) * 2012-07-19 2012-10-24 北京理工大学 一体化旋转关节和确定一体化旋转关节零位的方法
CN103101054A (zh) * 2013-01-17 2013-05-15 上海交通大学 手机对机器人的编程和控制系统
CN103395073A (zh) * 2013-08-22 2013-11-20 中国船舶重工集团公司第七一六研究所 一种六轴工业机器人的零点标定方法
CN103968761A (zh) * 2014-05-28 2014-08-06 中科华赫（北京）科技有限责任公司 串联关节式机器人绝对定位误差校准方法及标定系统

Also Published As

Publication number Publication date
CN106945049A (zh) 2017-07-14

Similar Documents

Publication Publication Date Title
CN106945049B (zh) 一种仿人机器人关节零位校准的方法
US4172443A (en) Central receiver solar collector using analog coupling mirror control
CN106670763B (zh) 一种高精度自动组装机的计算方法
CN103237198A (zh) 一种摄像机协调处理方法、装置及摄像机
CN113359867B (zh) 一种无人机自稳云台及控制方法
CN104880215B (zh) 多传感器平台相机激光一体化检校的方法
CN105783896A (zh) 一种交互式无人机磁罗盘校准装置及校准方法
CN115437389A (zh) 一种基于海扁虫仿生的水下机器人以及抗干扰控制方法
US20220404844A1 (en) Method for correcting pointing errors of biaxial rotation system based on spherical cap function
CN110705002A (zh) 一种仿真试验的补偿系统及方法
CN111238558B (zh) 一种psd非线性误差的标校装置及方法
CN102566466A (zh) 三自由度球面并联机构姿态闭环控制方法
CN106773786A (zh) 一种rvdt信号仿真电路、方法及装置
CN105096782B (zh) 一种显示装置自动校正闪烁的防呆方法及其系统
CN207991574U (zh) 一种智能自动平衡仪器支架
CN107776436B (zh) 两轮自平衡设备的控制方法及装置
CN110802593B (zh) 一种仿人机器人下肢关节零位标定方法
KR102015791B1 (ko) 스마트 디바이스를 이용한 골프 코칭 시스템 및 그 방법
CN106612356A (zh) 终端重力传感器测试方法及系统
CN109297149A (zh) 人感运动装置的位置控制方法、装置、存储介质及空调
CN105690421A (zh) 自动记忆轨迹的通用机械臂
CN113043264B (zh) 一种一体化关节七轴机器人的零位标定方法
CN204671161U (zh) 前倾角测量器
CN104019832B (zh) 一种赤道仪之极轴校准机构及其校准方法
CN113445433B (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