CN111604935B - 一种电磁驱动两自由度球型机器人手腕及其控制方法 - Google Patents
一种电磁驱动两自由度球型机器人手腕及其控制方法 Download PDFInfo
- Publication number
- CN111604935B CN111604935B CN202010484343.5A CN202010484343A CN111604935B CN 111604935 B CN111604935 B CN 111604935B CN 202010484343 A CN202010484343 A CN 202010484343A CN 111604935 B CN111604935 B CN 111604935B
- Authority
- CN
- China
- Prior art keywords
- universal joint
- wrist
- axis
- follow
- magnetic field
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J17/00—Joints
-
- 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/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
- B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
-
- 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/1612—Programme controls characterised by the hand, wrist, grip control
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Manipulator (AREA)
Abstract
本发明属于自动化工程技术领域,涉及一种电磁驱动两自由度球型机器人手腕及其控制方法,具体为一种通过相同转动中心的内、外部万向节两个输出端同轴连接所构成随动机构内置径向磁化永磁体在空间万向旋转磁场同轴随动磁矩直接驱动下实现侧摆、俯仰二自由度转动的机器人高集成主动球型手腕装置。本发明克服了复杂传动机械手腕的弊端,手腕传动系统结构简单轻便、传动效率高、系统静态及动态性能好、控制响应速度快。本发明可克服了现有球形电磁驱动关节三维复杂磁场的建模难题,实现球形电磁驱动关节磁场精确建模和电磁耦合和力学耦合的精准解耦,显著提高电磁驱动球形关节控制的响应灵敏度和定位精度。
Description
技术领域
本发明属于自动化工程技术领域,涉及一种电磁驱动两自由度球型机器人手腕及其控制方法,具体为一种通过相同转动中心的内、外部万向节两个输出端(从动叉)同轴连接所构成随动机构内置径向磁化永磁体在空间万向旋转磁场同轴随动磁矩直接驱动下实现侧摆、俯仰二自由度转动的机器人高集成主动球型手腕装置。
背景技术
应用于危险和极限环境下的机器人对腕部的性能指标要求苛刻,如空间机器人的显著特征是结构紧凑,集成化程度高,功重比大。空间机器人在航天器和空间站的维护等任务中发挥着越来越重要的作用,如飞船的控制与舱门的开启、空间舱段的组装、航天器的维修等,均可代替宇航员完成。腕部是联结臂与手的重要基础部件,其性能直接影响机器人末端执行器的定位精度、灵活性与作业功能。机器人腕部的功用是通过局部微小调整来改变末端执行器在空间的姿态,实现准确定位,腕部的自由度及姿态范围直接影响机器人的灵活性、稳定性与定位精度,机器人任意位置及姿态的控制需要六个自由度,手腕至少应有两个自由度,手腕位于臂部的前端,腕部的重量又构成小臂的附加载荷而增加能耗。腕部是在狭小的空间实现两轴回转,因此手腕的机构设计复杂、可变参数多,手腕的性能指标已经成为限制机器人在空间等极限环境下应用与扩展的主要瓶颈。
目前,机器人腕部尚不能完全满足空间作业要求,其多自由度运动的传递普遍采用齿轮传动,结构复杂、集成度低,存在运动耦合问题,使得末端执行器的灵活性、姿态调整能力和精确定位能力受限,尚不能通过腕部的调整完成飞船舱门开启等复杂性接触作业。
从结构方面,机器人手腕基本上可分为三类:1)球型手腕,它的三个关节轴线相交于一点,其位置和姿态是解耦的,逆运动学分析简单,结构紧凑,功重比大,所以空间机器人等特殊场合下使用的机器人大多采用球型手腕。由于受机械结构的限制,这种手腕设计难度大,结构复杂,重量难以降低,工作空间小;
2)非球型手腕,它的三个轴线不交于一点,克服了机械结构的局限性,每个关节的转动角度都能达到360°以上,但其缺点是结构不紧凑,体积庞大,限制了功重比指标的提高,运动不能解耦,控制精度低;3)并联结构手腕,此种结构的手腕实际上是一种小型化的并联机构。
The Martin Marietta和美国NASA的宇航飞行中心于1991年研制的一种用于空间站装配的遥控机器人腕部模块,其电机的布置采用俯仰、侧摆和自转分离方式,但其结构不紧凑,功重比小,三个关节的运动不解耦,控制精度低。
1991年Graco Robotics,Inc.研制了紧凑型双万向节万向腕,它的斜齿轮传动链由防倾斜的在齿轮滑轨内运动的凸轮机构导向来保证,克服了以往腕部功重比小和结构强度欠佳的缺点,俯仰和侧摆分别由两个相交的万向节转动轴传动,使结构更加紧凑,但该腕部的缺点仍然是结构复杂,加工难度大,但腕部斜齿轮在载荷的作用下有跳跃的不平稳现象。
NASA研制了新一代的腕部模块,传动系统采用三个并联的螺杆驱动实现侧摆、俯仰,简化了设计,降低了成本,由于其附加的灵活性适于非结构化环境, NASA喷气推力实验室已经将该万向腕成功的应用于处理危险的物品。但该腕部的缺点是要三个驱动实现侧摆、俯仰两个运动。
从操作方式方面,机器人作业可分为非接触与接触两大类:前者为机器人在自由空间中运动,不受外界环境约束,采用单纯位置控制即可,机器人位置控制只适合在结构化可建模环境内作业;后者受外界环境约束,如空间机器人开门、装配,旋转曲柄等任务。在未建模环境中的抓取、安装、定位等作业机器人具有明显接触作业特征,其腕部应该具有变刚度柔顺控制功能,以免接触作业时损坏机械臂。
对于接触作业,只采用位置控制已不能胜任,因为作业环境对机器人有接触力影响,其末端微小位置偏差可导致较大的接触力,极易损坏机械臂或作业目标,可见,未建模环境中目标抓取等作业绝非易事。目前,空间机械臂等手腕尚不完全具备非结构未建模环境中接触作业的能力。
迄今为止,柔顺控制主要分为两种:主动式和被动式。机器人通过处理力反馈信息并采用一定控制策略去主动控制作用力的方式称为主动柔顺控制。相反,机器人不通过力反馈而只是凭借机械等柔顺机构,使其自然顺从接触环境的方式称为被动柔顺控制。主动柔顺控制又分为主动阻抗控制和力/位置混合控制。力/位置混合控制方法对外界环境动力学依赖性强,需要详尽的任务描述。被动柔顺控制的研究主要是通过机械装置本身或特殊设计的被动柔顺机构来实现,如机器人手腕的RCC弹性附件,缺点是要增加额外的机械装置,使腕部机构变得复杂笨重,适应能力差。
韩国提出了一种球型两自由度主动驱动机器人腕部关节及主动柔顺控制方法。它的下半球运动通过齿轮传动实现,上半球通过内部万向节传递运动,两个偏置斜面复合成腕子的侧摆与俯仰两个运动,结构紧凑、简单,且实现了两个输入运动的解耦,并通过离合器的啮合程度控制传递力矩的大小,使腕部在一定力矩的作用下成为被动腕,起到了过载荷保护和避免机械干涉而损坏腕部关节的作用。
大连理工大学提出了一种三自由度等速解耦空间机器人主动球型腕与万向柔顺控制方法(专利号:ZL201310282753.1),是一种典型的主动柔顺控制方法,具体通过摩擦力补偿可实现主、被动腕功能,被动模态下球型腕处于完全柔顺状态,避免接触作业损坏机械臂。但机器人关节非线性摩擦力模型难以准确确定,摩擦力补偿精度会直接影响柔顺控制效果,手腕三轴转动控制过程复杂。
综上所述,由于机器人手腕机械系统结构复杂程度高,运动传动系统摩擦具有非线性特征,最终导致机械结构手腕动态性能差、控制精度低,机械效率低,可靠性差等问题。尤其是机械手腕复杂的传动结构与实现主动柔顺控制之间存在矛盾,导致柔顺控制难度大,响应速度低。由于传统机械式手腕减速器系统存在输出端反向传动自锁特性,接触作业时,必须施加主动控制力矩消除关节摩擦力,才能解除自锁,实现柔顺控制,但由于关节减速器系统的摩擦力表现为复杂的非线性,导致机械关节柔顺控制功能差而极易损坏机械臂。
为了克服上述机械传动手腕的弊端,使多自由度手腕传动系统结构简单轻便,并显著提高运动性能、传动效率、控制响应速度和定位精度,可采用电磁直接驱动多自由度电机代替复杂传动机械手腕。多自由度电机集成度高,传动链简单且无机械间隙,有效材料和控制系统元件的利用率高,特别是转动的自由度多,可显著简化机械系统结构,避免关节的非线性摩擦力,提高系统静态及动态性能。
球形电机是集现代电机设计理论、功率电子技术、自动控制理论于一体的高技术,球形电动机本身就是一种直接驱动的球形主动关节。按原理主要可分成以下几类:自整角机式、感应式、永磁式(含直流、步进、磁阻式、同步式) 等。克服了线圈式球形电机的许多缺点,永磁式球形电机占用空间小、系统效率高、磁能积高,在机器人、多向传动机构、制造业等多维空间伺服控制系统领域应用前景良好。
目前,电磁球形电机在本体结构设计、电磁和转矩分析与控制等方面普遍存在以下问题:1)磁场计算困难。球形电机磁场为三维磁场,异常复杂,目前球形电机磁场计算均基于理想化假设模型,还不能对磁场进行精确建模和计算。2)电磁耦合问题。球形电机各自由度间电磁耦合和力学耦合关系复杂,如何根据磁场模型,定量分析这些耦合关系,实现精准解耦,是球形电机设计与精确控制研究中急需解决的问题。3)新型球形电机的结构参数优化。必须以球形电机的精确建模为基础,以提高其输出转矩、减小尺寸、提高响应灵敏度和定位精度为目标,对球形电机本体结构参数进行优化设计。
为了解决上述难题,必须进行电磁驱动球形关节原理方面的创新。新球形电机必须便于建立准确的力学模型和运动模型,找出合适路径规划算法,提高电机的动态性能和稳定性,是对球形电机进行精密控制的基础,也是球形电机能够应用于精密工业领域的必然要求。
为了实现电磁驱动球型关节原理方面的创新,首先要突破空间万向旋转磁场技术。由于空间万向旋转磁场是三轴正交亥姆霍兹线圈产生的单一均匀旋转磁场,不存在磁场耦合问题,也不存在磁力耦合问题,磁极只受纯电磁驱动力矩作用,便于建立准确的力学模型和运动模型,因此,采用空间万向旋转磁场技术优势明显。但旋转磁场方位与旋转方向控制是关键。
为实现胶囊机器人在弯曲肠道环境中自由行走,国家发明专利“体内医疗微型机器人万向旋转磁场驱动控制方法”中(专利授权号:ZL 200810011110.2),提出了旋转轴线可调的空间万向旋转磁场控制方法,并给出适用于空间第一象限的旋转磁场基本电流叠加公式。
为了实现旋转磁场轴线的万向可调,将基本电流叠加公式扩展到空间另七个象限,国家发明专利“空间万向叠加旋转磁场旋转轴线方位与旋向的控制方法”中(专利授权号:ZL 201210039753.4)中,通过以空间某一固定轴线三个方向角为输入变量的基本电流叠加公式中三相正弦电流信号的反相位电流的组合驱动方式与三轴正交嵌套亥姆霍兹线圈装置内叠加的空间万向均匀旋转磁场的旋转轴方位和旋向的变化规律为基础,实现了空间万向旋转磁场旋转轴线方位与旋向在空间坐标系各个象限内的唯一性控制,在理论上解决通过数字化控制实现空间万向旋转磁矢量方位、旋向、强度、转速的任意调整的问题,为实现机器人的姿态调整与定向驱动行走奠定了基础。
为解决胶囊机器人在胃肠道中诊察时的姿态调整与行走两种运动方式相互分离的问题,国家发明专利“一种主被动双半球形胶囊机器人及其姿态调整与转弯驱动控制方法”(专利授权号:ZL 201510262778.4)中,利用球形结构的灵活性与万向性,避免了调姿时球形机器人发生滚动运动,结合空间万向旋转磁场的控制,可实现主、被动双半球结构胶囊机器人在体内自由进行姿态调整与转弯行走,研究表明,空间万向旋转磁场的方位与末端圆形轨迹误差直接影响机器人的控制精度。空间万向旋转磁场对双半球胶囊进行姿态调整与控制为两自由度球型机器人手腕研制奠定了基础。
为实现空间万向旋转磁场人机交互控制,国家发明专利“一种空间万向旋转磁场人机交互控制方法”(专利授权号:ZL 201610009285.4)中,提出经纬坐标系内以侧摆与俯仰角两个姿态角度为输入变量的电流形式的空间万向旋转磁场叠加公式,
其中其中θ、δ为机器人轴线侧摆角与俯仰角, I0为三轴亥姆霍兹线圈组中正弦电流的幅值,ω为施加正弦信号电流的角频率,施加正弦信号电流的频率为f=2π/ω。将空间万向旋转磁场的三维叠加问题转化为平面内的两维叠加问题,并通过两个操纵杆分别将侧摆与俯仰角度分离控制,实现低维度可分离变量交互式控制。三轴正交亥姆霍兹线圈的驱动是产生机器人轴线的侧摆角和俯仰角的方位可分离变量的空间万向旋转磁场控制模式,完全可以实现新型手腕侧摆角和俯仰角的控制。
为了实现电磁驱动球型关节原理方面的创新,还要解决均匀空间万向旋转磁场下更有效、快捷、准确的新型电磁驱动技术。在研究胶囊机器人姿态控制过程,发现在万向旋转磁场驱动下的径向磁化钕铁硼永磁体圆柱体轴线会发生旋转磁场同轴随动磁矩效应,即当钕铁硼圆柱体轴线与旋转磁场旋转轴线存在夹角时,旋转磁场的同轴随动磁矩将拉动钕铁硼圆柱体轴线向旋转磁场旋转轴线方向转动,直到重合为止。空间万向旋转磁场同轴随动磁矩可将永磁体轴线引导到空间任何方位,为球型关节姿态转换的电磁驱动奠定了基础。
为实现机器人运动关节的在线刚度调整功能,国内外科研人员进行多种结构设计,通过调查研究国内外变刚度柔性关节结构,变刚度柔性关节按结构原理分为杠杆机构、凸轮机构两类模型。德国宇航中心机器人及机电一体化协会,研制了一种基于凸轮机构的变刚度关节VS.Joint,利用关节旋转,带动凸轮滚子在底部凸轮盘内的位置变化,改变弹簧的压缩量,达到关节变刚度柔性输出;其第二代变刚度柔性关节(Floating spring joint,FSJ)并应用于新型DLR手臂系统中,该机构每个凹槽处由原来的一个凸轮滚子增加为两个,从而实现了低摩擦、低耗能,增大了承受负载的能力。意大利理工学院TSAGARAKIS等研制的变刚度驱动器CompAct—VSA,该机构利用齿轮齿条传动改变凸轮形状杠杆臂的旋转轴心所在的位置,凸轮通过滚子与弹簧作用,从而改变机构的输出刚度。总之,机械式变刚度调整机构体积较大,结构复杂,实际应用效果较差,如果能够摆脱复杂的机械结构,采用关节电磁驱动直接实现变刚度的线性化控制,则关节的柔顺控制动态性能将显著提高。
对上述机械式手腕所存在的机械结构复杂,机械摩擦力、变刚度控制、柔顺控制困难等局限性,结合旋转磁场同轴随动磁矩效应驱动原理,本发明提出一种通过同心内、外部万向节两个输出端(从动叉)同轴连接所构成随动机构内置径向磁化钕铁硼永磁体在空间万向旋转磁场同轴随动磁矩引导下实现随动机构输出端侧摆、俯仰的二自由度机器人高集成主动球型手腕机构及变刚度控制方法。在控制方面,是一种通过电磁驱动的前馈补偿途径实现该球型腕在接触作业条件下的变刚度及柔顺控制方法。通过电磁驱动的前馈补偿途径可实现主、被动腕功能,当通过侧摆、俯仰主动控制实现执行器末端定位后并拉住舱门;由于拉开舱门时,会出现机器人末端执行器运动轨迹与舱门转动圆轨迹的干涉,由于干涉时舱门对腕部的作用力方向已知,根据预知方向施加万向旋转磁场,施加力矩补偿,使腕子末端执行器的运动轨迹在过腕部末端执行器作用力方向的平面内,使腕子变成松弛的被动腕,避开干涉,顺利实现舱门的开启等复杂作业。
据掌握的资料和立项查新显示,目前,国内外还没有采用空间万向旋转磁场同轴随动磁矩效应的新型电磁驱动球型手腕的相关资料报道,也没有通过电磁力矩控制实现主、被动腕工作模式的报道,因此,本发明具有较为突出的原创性。
发明内容
为解决上述为问题,本发明提供一种通过同心内、外部万向节两个输出端 (从动叉)同轴连接所构成随动机构的内置径向磁化永磁体驱动器在空间万向旋转磁场同轴随动磁矩直接引导驱动下,实现输出端侧摆、俯仰二自由度主动球型手腕装置,还提供一种通过电磁直接驱动的前馈控制途径实现该球型腕在接触作业条件下的变刚度及柔顺控制方法。
本发明的技术方案是:
一种电磁驱动两自由度球型机器人手腕,包括三轴亥姆霍兹线圈组a和转子随动部分b;其中,三轴正交的亥姆霍兹线圈组a提供空间万向旋转磁场,转子随动部分b提供旋转磁场同轴随动磁矩驱动下侧摆和俯仰两个自由度转动;电磁驱动两自由度球型机器人手腕的具体结构如下:
所述的转子随动部分b包括内部十字万向节d、外部十字万向节c以及固定端e;固定端e的顶部为固定端支承座5,固定端支承座5分为四个位于同一轴线的竖直支撑架,支撑架的上设有水平的通孔,中间两个竖直支撑架用于安装内部十字万向节d,外端两个竖直支撑架用于安装外部十字万向节c;
所述的内部十字万向节d包括固定端支承座5中间两个竖直支撑架(主动叉),内部万向节内环14和柱形壳体2,其中,内部万向节内环14作为十字轴支架,柱形壳体2作为从动叉;内部万向节内环14的两侧分别通过深沟球轴承 a15和深沟球轴承b16安装在与固定端支承座5上中间的两个竖直支撑架的通孔中,固定端支承座5和内部万向节内环14实现相对转动,形成俯仰转角转轴;柱形壳体2位于内部万向节内环14内,连接轴d23和连接轴e26的一端分别对称固定在柱形壳体2的两侧,另一端分别通过深沟球轴承c24和深沟球轴承d25安装在内部万向节内环14内侧,实现柱形壳体2和内部万向节内环14相对转动,形成侧摆角转轴;径向磁化永磁体1通过轴承31安装于柱形壳体2内;
所述的外部十字万向节c包括固定端支承座5外端两个竖直支撑架(主动叉),外部万向节内环3和外部万向节外环17,其中,外部万向节内环3作为十字轴支架,外部万向节内环3上对称设有四个水平的同轴通孔(十字轴孔),外部万向节外环17作为从动叉;连接轴a7通过法兰轴承a8安装在固定端支承座5外端的一个竖直支撑架的通孔中,连接轴b9通过法兰轴承b10安装在固定端支承座5外端另一个竖直支撑架的通孔中;外部万向节内环3的两侧同轴通孔中的其中一个通孔通过平键a6与连接轴a7固定连接,外部万向节内环3的两侧同轴通孔中的另外一个通孔通过平键b11与连接轴b9固定连接,固定端支承座5和外部万向节内环3实现相对转动,形成俯仰转角转轴;连接轴a7外端与编码器a4连接,连接轴b9一端与阻尼器a12连接,另一端与制动器a13连接,且编码器a4、阻尼器a12和制动器a13均固定在固定端支承座5上;连接轴c21 通过法兰轴承c22安装在外部万向节内环3另外两侧的同轴通孔中的其中一个通孔中,连接轴f28通过法兰轴承d27安装在外部万向节内环3另外两侧的同轴通孔中的另外一个通孔中;外部万向节外环17由两个半环形结构的支撑杆对称组成,两个支撑杆中的一个支撑杆的一端分别通过平键c20与连接轴c21固定连接,两个支撑杆中的另一个支撑杆的一端通过平键d29与连接轴f28固定连接,且支撑杆的端部位于外部万向节内环3外部,两个支撑杆的另一端分别固定在外部十字万向节c的输出端33的两侧;外部万向节外环17和外部万向节内环3 实现相对转动,形成侧摆角转轴;内部十字万向节d的连接杆32的一端固定在柱形壳体2的顶部,另一端与输出端33固定连接;连接轴c21的两端分别与编码器b18和制动器b19连接,连接轴f28的外端与阻尼器b30连接,且编码器b18、制动器b19和阻尼器b30均固定安装在外部万向节内环3外侧;
所述的三轴亥姆霍兹线圈组a包括大线圈组、小线圈组和中间线圈组,每组包括两个完全相同的线圈,对称布置;三组线圈的轴线相互垂直,且三组线圈相互固定,其中大线圈组的底部固定在固定端e上,且中间线圈组的轴线与固定端e的轴线重合;内部十字万向节d位于三组线圈中间的内部空间内,外部十字万向节c位于三组线圈外部;所述的外部十字万向节c、三轴亥姆霍兹线圈组a、内部十字万向节d在空间上形成三层嵌套结构。
本发明的效果和益处是:
本发明的一种新型电磁驱动两自由度球型机器人手腕的内、外部万向节两个输入端、输出端分别同轴并联,内、外部万向节具有同一转动中心,因此构成机器人手腕,实现了手腕两个自由度的运动解耦,侧摆、俯仰角度可单独测量与控制。内、外部万向节均采用空心结构,可显著增加内部可嵌套容纳空间,手腕多层嵌套结构紧凑。手腕输出端连接的末端执行器侧摆、俯仰角度可控,但自转角度始终不发生偏转,可方便的调整末端执行器的法方向,完成腕部定位。
本发明克服了复杂传动机械手腕的弊端,手腕传动系统结构简单轻便、传动效率高、系统静态及动态性能好、控制响应速度快。由于传动链简单且无机械间隙,因此定位精度高。由于没有复杂机械传动系统非线性摩擦力,可通过电磁直接驱动快捷的实现手腕关节的变刚度控制以及柔顺控制。
本发明克服了现有球形电磁驱动关节三维复杂磁场的建模难题,可实现磁场精确建模和计算,为定量分析电磁驱动关节各自由度间电磁耦合和力学耦合关系,实现精准解耦和结构参数优化,最终可望实现电磁驱动球形关节控制的响应灵敏度和定位精度。
附图说明
图1是本发明机器人手腕结构示意图。
图2是本发明机器人手腕转子随动部分示意图。
图3(A)是本发明机器人手腕俯仰传动机构截面示意图。
图3(B)是本发明机器人手腕俯仰传动机构截面示意图Ⅰ处局部放大图。
图3(C)是本发明机器人手腕俯仰传动机构截面示意图Ⅱ处局部放大图。
图3(D)是本发明机器人手腕侧摆传动机构截面示意图。
图3(E)是本发明机器人手腕侧摆传动机构截面示意图Ⅲ处局部放大图。
图3(F)是本发明机器人手腕侧摆传动机构截面示意图Ⅳ处局部放大图。
图3(G)是本发明机器人手腕侧摆传动机构截面示意图Ⅴ处局部放大图。
图3(H)是本发明机器人手腕侧摆传动机构截面示意图Ⅵ处局部放大图。
图4(A)是本发明机器人手腕轴线由固定坐标系到赖柴坐标系转换过程示意图。
图4(B)是本发明机器人手腕轴线向量和空间万向旋转磁场旋转轴线向量的空间位置示意图。
图4(C)是本发明机器人手腕同轴随动磁矩效应驱动模型示意图。
图4(D)是本发明机器人手腕同轴随动磁矩计算坐标系建立示意图。
图5是本发明机器人手腕主被动模式控制原理示意图。
图中:a三轴亥姆霍兹线圈组;b转子随动部分;c外部十字万向节;d内部十字万向节;e固定端;f末端执行器;g力传感器;h两自由度机器人手腕。
1径向磁化永磁体;2柱形壳体;3外部万向节内环;4编码器a;5固定端支承座;6平键a;7连接轴a;8法兰轴承a;9连接轴b;10法兰轴承b;11 平键b;12阻尼器a;13制动器a;14内部万向节内环;15深沟球轴承a;16 深沟球轴承b;17外部万向节外环;18编码器b;19制动器b;20平键c;21 连接轴c;22法兰轴承c;23连接轴d;24深沟球轴承c;25深沟球轴承d;26连接轴e;27法兰轴承d;28连接轴f;29平键d;30阻尼器b;31轴承;32 连接杆;33输出端。
具体实施方式
以下结合技术方案和附图详细叙述本发明的具体实施例。
如图1所示,本发明的两自由度球型机器人手腕h,包括三轴亥姆霍兹线圈组a和转子随动部分b。三轴正交的亥姆霍兹线圈组a提供空间万向旋转磁场,转子随动部分b提供旋转磁场同轴随动磁矩驱动下侧摆和俯仰两个自由度转动;工作原理采用空间万向旋转磁场同轴随动磁矩效应。
结合图2、3(A)~3(C)、3(D)~3(H)说明本发明的新型电磁驱动两自由度球型机器人手腕转子随动部分b的构成。
转子随动部分b包括内部十字万向节d(内安装有转子永磁体,即径向磁化永磁体1)、外部十字万向节c(安装有制动机构、阻尼机构、测量机构等)以及固定端e。内部十字万向节d和外部十字万向节c的转动中心相同,即手腕转动中心,构成球型腕,实现了两个自由度转动的解耦,可以实施侧摆角度和俯仰角度的单独测量与控制;内部十字万向节d和外部十字万向节c均采用空心结构,以增加内部可容纳空间。
内部十字万向节d和外部十字万向节c均采用固定端支承座5为输入端(主动叉),保证两个输入端同轴;外部十字万向节c输出端33(从动叉)和内部十字万向节d的输出端即连接杆32(从动叉)也同轴连接,则构成手腕转子随动部分b。
转子随动部分b轴线即为手腕转动轴线,手腕转子随动部分b轴线可实现侧摆、俯仰两自由度定点(手腕转动中心)旋转运动,径向磁化永磁体1安装在转子随动部分b内并可以随旋转磁场自由旋转,以外旋转磁场同轴随动磁矩为动力媒介驱动并实现手腕侧摆与俯仰转向运动。
外部十字万向节c包括:固定端支承座5外端两个竖直支撑架(主动叉),外部万向节内环3(十字轴支架)和外部万向节外环17(从动叉)。外部万向节内环3为整体的环形结构,圆周均匀分布四个孔(十字轴孔);外部万向节外环17由两个半环形结构支撑杆对称组成,两个半环形结构支撑杆顶端均匀分布两个同轴孔。
与外部十字万向节c输出端33连接的末端执行器f姿态是由转子随动部分 b轴线的侧摆与俯仰角度决定,由于外部十字万向节c输入端,即固定端支承座5不能旋转,末端执行器f姿态与转子随动部分b轴线保持一致,因此,末端执行器f自转角度也不发生偏转,可方便的调整机器人末端执行器f的法方向,完成腕部定位。末端执行器f上可以安装力传感器g。
见图3(A)~3(C),固定端支承座5(相当于主动叉)和外部万向节内环3可实现相对转动,俯仰转角转轴的装配过程是:外部万向节内环3通过平键a6与连接轴a7固连,固定端支承座5外端一个竖直支撑架通过法兰轴承a8与连接轴 a7连接;外部万向节内环3通过平键b11与连接轴b9固连,固定端支承座5外端另一个竖直支撑架通过法兰轴承b10与连接轴b9连接。
见图3(D)~3(H),外部万向节外环17(相当于从动叉)和外部万向节内环3 可实现相对转动,侧摆角转轴的装配过程是:外部万向节外环17通过平键c20 与连接轴c21固连,外部万向节内环3通过法兰轴承c22与连接轴c21连接;外部万向节外环17通过平键d29与连接轴f28固连,外部万向节内环3通过法兰轴承d27与连接轴f28连接。
内部十字万向节d包括:固定端支承座5中间两个竖直支撑架(主动叉),内部万向节内环14(十字轴)和柱形壳体2(从动叉)三部分;内部万向节内环14相当于十字轴支架。
见图3(A)~3(C),固定端支承座5中间两个竖直支撑架和内部万向节内环 14可实现相对转动,俯仰转角转轴的装配过程是:内部万向节内环14通过深沟球轴承a15、深沟球轴承b16与固定端支承座5中间两个竖直支撑架连接。
见图3(D)~3(H),柱形壳体2和内部万向节内环14可实现相对转动,侧摆角转轴的装配过程是:连接轴d23一端固结于柱形壳体2,另一端通过深沟球轴承c24与内部万向节内环14连接;连接轴e26一端固结于柱形壳体2,另一端通过深沟球轴承d25与内部万向节内环14连接。
转子随动部分b通过外部十字万向节c和内部十字万向节d构成的特征是:内、外部十字万向节的转动中心相同(即手腕转动中心),外部十字万向节c 和内部十字万向节d的输入端(主动叉)、输出端(从动叉)分别同轴固接,因此构成球型腕,实现了两个自由度转动的解耦,进而,可以实施侧摆角度和俯仰角度的单独测量与控制,外部十字万向节c和内部十字万向节d均采用空心结构,以增加内部可容纳空间;外部十字万向节c和内部十字万向节d的输入端(主动叉)均为固定端支承座5,相当于外部十字万向节c和内部十字万向节d的输入端同轴固定连接。外部十字万向节c和内部十字万向节d的输出端 (从动叉)采用同轴连接,即外部十字万向节外环17和柱形壳体2的同轴连接过程是:连接杆32两端分别与柱形壳体2和输出端33固结,输出端33与外部十字万向节外环17固结。径向磁化永磁体1通过轴承31安装于柱形壳体2内,径向磁化永磁体1可实现相对转子随动部分b的同轴自转。
所述的外部十字万向节c和内部十字万向节d均采用固定端支承座5作为输入端,外部十字万向节c的输入端和内部十字万向节d的输入端(主动叉) 同轴连接的前提下,外部十字万向节c的输出端和内部十字万向节d的输出端 (从动叉)通过同轴连接构成手腕的转子随动部分b,转子随动部分b轴线即为手腕转动轴线,可实现侧摆、俯仰两自由度定点(手腕转动中心)旋转运动,径向磁化永磁体1在空间万向旋转磁场的同轴随动磁矩驱动下,实现手腕侧摆、俯仰两自由度定点运动。
手腕姿态的检测与控制方法如下:
转子随动部分b只存在一个固定点(手腕转动中心),还需要对转子随动部分b转轴方位进行控制。具体通过对外部万向节d各部分相对运动的检测与控制实现手腕轴线方位的控制。外部十字万向节c由固定端支承座5外端两个竖直支撑架,外部万向节内环3和外部万向节外环17三部分相对运动实现手腕轴线的万向转动。由于外部万向节内环3为圆周均匀分布四个孔(十字轴孔) 的整体环形结构;外部万向节外环17由顶端均匀分布两个同轴孔的两个半环形结构支撑杆对称组成,因此,可以连接如下:
外部万向节内环3(十字轴支架)一组两个同轴孔和固定端支承座5外端两个竖直支撑架(主动叉)连接形成俯仰转角转轴(一个十字轴),外部万向节内环3可绕轴线旋转,在外部万向节内环3和固定端支承座5外端两个竖直支撑架转轴之间分别安装绝对编码器a4、制动器a13、阻尼器a12,则编码器a4 可测量外部万向节内环3和固定端支承座5外端两个竖直支撑架之间相对转角即为手腕俯仰角度;外部万向节内环3另一组两个同轴孔和外部万向节外环17 两个半环形结构支撑杆的两个孔同轴连接形成另一个侧摆角转轴(另一个十字轴),外部万向节外环17相对外部万向节内环3可绕轴线旋转,在外部万向节内环3和外部万向节外环17转轴之间分别安装绝对编码器b18、制动器b19、阻尼器b30,则编码器b18可测量外部万向节内环3和外部万向节外环17之间相对转角即为手腕侧摆角度。
安装于外部十字万向节c两组垂直旋转轴处的两个绝对编码器b18和绝对编码器a4,可实现对侧摆与俯仰转角的实时测量,并传输给控制系统,以实现对侧摆与俯仰角度动的准确控制。
制动器a13、制动器b19均为电磁制动器,实现对手腕俯仰与侧摆两个自由度的锁定,当手腕静止时,制动器a13、制动器b19实现对外部十字万向节d的锁定,以固定转子随动部分b方位,防止随意摆动发生意外事故;当手腕旋转时,制动器a13、制动器b19解除对外部十字万向节d的锁定,以实现转子随动部分b与万向旋转磁场的随动,即实现侧摆与俯仰转动的驱动。当只锁定外部万向节一个转轴时,手腕就变成单个自由度转动手腕,两个自由度运动相互独立,互不影响,可实现独立检测与控制,实现手腕侧摆与俯仰两种单自由度控制模态。
阻尼器a12和阻尼器b30安装于外部十字万向节d两十字旋转轴关节处(俯仰与侧摆转轴),为手腕的俯仰、侧摆转动提供阻尼,以便减缓侧摆与俯仰姿态调整时手腕的振动。
当腕子完成定位与抓紧后,通过旋转磁场同轴随动磁矩的主动驱动控制,可解除腕部俯仰和侧摆的约束,使腕部变成柔顺性被动腕,有效解除机械干涉,满足空间极限环境对机器人腕部的特殊需求,完成旋转安装、拉开舱门等复杂作业。
结合图3(A)~3(C)说明本发明的新型电磁驱动两自由度球型机器人手腕俯仰运动的检测与控制的实现。
俯仰转角运动测量的实现过程是:外部万向节内环3通过平键a6与连接轴 a7固连,固定端支承座5(外部十字万向节c的主动叉)通过法兰轴承a8与连接轴a7连接,实现了外部万向节内环3和固定端支承座5的相对转动;编码器 a4固结于固定端支承座5并与连接轴a7相连接,实现俯仰转角测量。
俯仰转角运动控制的实现过程是:外部万向节内环3通过平键b11与连接轴b9固连,固定端支承座5通过法兰轴承b10与连接轴b9连接,实现了外部万向节内环3和固定端支承座5的相对转动;阻尼器a12固结于固定端支承座5 并与连接轴b9相连,实现俯仰转角阻尼特性的改变,以减小振动现象;制动器 a13固结于固定端支承座5并与连接轴b9相连,实现俯仰转角锁定。此部分结构实现了俯仰运动制动、测量、改变阻尼特性的功能。
结合图3(D)~3(H)说明本发明的新型电磁驱动两自由度球型机器人手腕侧摆运动的检测与控制的实现。
侧摆转角运动测量的实现过程是:外部万向节外环17通过平键c20与连接轴c21固连,外部万向节内环3通过法兰轴承c22与连接轴c21连接,实现了外部万向节外环17和外部万向节内环3的相对转动;编码器b18固结于外部万向节内环3并与连接轴c21相连,实现侧摆转角测量。
侧摆转角运动控制的实现过程是:外部万向节外环17通过平键d29与连接轴f28固连,外部万向节内环3通过法兰轴承d27与连接轴f28连接,实现了外部万向节外环17和外部万向节内环3的相对转动;阻尼器b30固结于外部万向节内环3并与连接轴f28相连,实现侧摆转角阻尼特性的改变,以减小振动现象;制动器b19固结于外部万向节内环3并与连接轴c21相连,实现侧摆转角锁定。此部分结构实现了侧摆运动制动、测量、改变阻尼特性的功能。
结合图4(A)、4(B)、4(C)、4(D)说明本发明的新型电磁驱动两自由度球型机器人手腕的工作原理。
首先,结合图4(A)说明本发明机器人手腕轴线俯仰角与侧摆角可以分别独立测量的原因。图4(A)中建立坐标系如下:固定坐标系Oxyz与三轴亥姆霍兹线圈组a固结,手腕轴线初始位置垂直向上,其中Oz轴与外部十字万向节c连接编码器a4的俯仰角旋转轴重合,其中Ox轴与外部十字万向节c连接编码器b18 的侧摆角旋转轴重合。
赖柴坐标系Ox1y1z1由固定坐标系Oxyz经过两次旋转得到,固定坐标系 Oxyz首先绕Oz轴旋转俯仰角θ,得到中间坐标系Ox1y’z,则与外部十字万向节 c连接的编码器a4可测得俯仰角θ,Ox1轴始终与外部十字万向节c连接编码器 b18的侧摆角旋转轴重合,中间坐标系Ox1y’z绕Ox1轴再旋转侧摆角δ,得到赖柴坐标系Ox1y1z1,则与外部十字万向节c连接编码器b18可测得侧摆角δ,Oy1即为两次旋转后手腕轴线的新方位,可见,通过固定坐标系Oxyz到赖柴坐标系 Ox1y1z1的两个旋转过程,结合外部十字万向节c上引起的两个相互垂直的俯仰转角转轴和侧摆角转轴的结构解耦特性,证明了手腕轴线空间方位的俯仰角θ、侧摆角δ可由与外部十字万向节c连接的编码器a4和编码器b18分别直接测得。
下面结合图4(B)、4(C)、4(D)证明本发明机器人手腕的同轴随动磁矩效应驱动原理,并推导同轴随动磁矩公式。
采用图4(A)中赖柴坐标系Ox1y1z1变换过程所采用的俯仰角θ、侧摆角δ来描述手腕轴线和空间万向旋转磁场旋转轴线在固定坐标系Oxyz内的空间方位,略去电机结构,可得图4(B)中径向磁化永磁体1轴线方向向量n2(θ0,δ0)(手腕轴线向量)和空间万向旋转磁场旋转轴线向量n3(θ3,δ3)在固定坐标系的任意空间位置,Oa,Ob分别为向量n2和向量n3端点在平面Oxy的投影。向量n2和向量n3空间夹角为α。
图4(C)是手腕同轴随动磁矩效应驱动模型图。可由图4(B)中向量n2和向量 n3构成的平面截取获得,驱动模型是磁矩为m的径向磁化永磁体1(旋转轴为 n2)在旋转磁场B(旋转轴为n3)内同时以角速度ω旋转的相对运动关系,其中,通过三轴亥姆霍兹线圈组a产生空间万向旋转磁场旋转轴线向量n3(θ3,δ3) 固定,分别通过外部十字万向节c上的制动器a13和制动器b19实现俯仰转角θ0和侧摆转角δ0锁定,则径向磁化永磁体1轴线方向向量n2(θ0,δ0)也固定,径向磁化永磁体1只能随空间万向旋转磁场以速度ω自转,Ta为以速度ω自转空间万向旋转磁场对以速度ω旋转的径向磁化永磁体1产生的同轴随动磁矩,以下证明同轴随动磁矩作用方向是由磁铁磁矩矢量m旋转平面向磁矢量B旋转平面翻转,即同轴随动磁矩使磁矩为m的径向磁化永磁体1的旋转轴n2向磁矢量B旋转轴线向量n3方向转动,直到重合为止。
图4(D)是本发明机器人手腕同轴随动磁矩计算坐标系建立示意图,旋转磁场所在固定坐标系Ox3y3z3与磁矩旋转矢量m所在固定坐标系Ox2y2z2建立如下:分别以向量n2、n3为Oy2、Oy3轴,分别以磁场旋转平面与磁矩矢量m的旋转平面交线为Oz2、Oz3轴,O即为两个固定坐标系原点。
旋转磁场所在坐标系Ox3y3z3由磁矩旋转矢量m所在坐标系Ox2y2z2绕Oz2旋转-α角得到,则旋转磁场所在坐标系Ox3y3z3到磁矩旋转矢量m所在坐标系 Ox2y2z2之间的变换矩阵为
ob为单位旋转磁矢量在坐标系Ox3y3z3下坐标为(cos(ωt),0,-sin(ωt)), om1为单位磁矩矢量在坐标系Ox2y2z2坐标为(cos(ωt-δ1),0,-sin(ωt-δ1)),δ1为磁矩m相对旋转磁场B的转差角。
可得ob在坐标系Ox2y2z2下坐标为
根据矢量外积公式
转差角一般很小,令δ1=0时
式中m0,B0为磁矩矢量与磁矢量大小。
由上式可得Tx2,Ty2,Tz2均为周期函数,周期分别为
由于α为定值,因此单个周期内平均力矩为
由式(2)可知,同轴随动磁矩只沿着Oz2轴,沿着Ox2和Oy2的磁矩均为0,即同轴随动磁矩只作用于磁铁磁矩矢量m旋转轴n2和磁矢量B旋转轴n3构成的旋转平面内,并由磁铁磁矩矢量m旋转平面向磁矢量B旋转平面翻转,因此,同轴随动磁矩计算公式可简化为:
式中,α角为磁矩为m径向磁化永磁体1轴线与旋转磁场B旋转轴线之间的夹角,m0,B0为磁矩矢量与旋转磁矢量幅值。
当手腕驱动磁矩矢量由径向磁化永磁体1提供时,每个周期内相当于永磁体只受延Oz2轴负向的磁力矩,在此磁力矩作用下,磁铁磁矩矢量m旋转平面向磁矢量B旋转平面翻转,即永磁体轴线向旋转磁场轴线靠近,该磁矩矢量即为永磁体同轴随动磁矩,该现象称为旋转磁场同轴随动磁矩效应,空间万向旋转磁场同轴随动磁矩效应可将永磁体轴线引导到空间任何方位,如果分别通过外部十字万向节c制动器a13和制动器b19解除俯仰转角θ0和侧摆转角δ0锁定,则径向磁化永磁体1轴线方向向量n2(θ0,δ0)不仅能随空间万向旋转磁场以速度ω自转,还能带动转子随动部分b向空间万向旋转磁场旋转轴线向量n3(θ3,δ3)转动。完全可以将同轴随动磁矩用于球型关节的电磁驱动,这就是球型关节电磁驱动的理论依据。
下面结合图4(C)、图5说明实现新型电磁驱动两自由度球型机器人手腕如何实现手腕关节同轴随动磁矩控制的具体实施方式。
首先,假设在末端执行器f端部作用力矢量F与末端执行器f轴线所构成的平面内,其中,末端执行器f与外部十字万向节c的输出端33连接;F对手腕转动中心产生的力矩方向与同轴随动磁矩方向必然相反,此时,一种电磁驱动两自由度球型机器人手腕是一种直接电磁驱动的球形主动关节,电磁驱动原理是旋转磁场同轴随动磁矩效应,由于同轴随动磁矩只作用于磁铁磁矩矢量m旋转轴n2和磁矢量B旋转轴n3构成的旋转平面内,并由磁铁磁矩矢量m旋转平面和磁矢量B旋转平面翻转,显然,末端执行器f端部作用力矢量F也在旋转轴n2和旋转轴n3构成的旋转平面内,(3)式即为同轴随动磁矩计算公式。(3)式表明,手腕同轴随动磁矩即可以通过三轴亥姆霍兹线圈组中正弦电流的幅值I0控制,也可以通过夹角α进行控制,还可以同时控制来提高磁矩。
即当F较大时,夹角α变化很大,由于力矩调整范围较大,永磁体同轴随动磁矩大小可同时通过三轴亥姆霍兹线圈组中正弦电流的幅值I0和径向磁化永磁体轴线与旋转磁场轴线夹角α进行控制,以便增加力矩调整范围,使手腕变成柔顺腕。由于没有复杂机械传动系统摩擦力,可通过电磁直接驱动快捷实现力矩控制。
下面结合图4(C)、图5说明实现新型电磁驱动两自由度球型机器人手腕如何实现手腕关节变刚度控制的具体实施方式。
首先,在数学上推导同轴随动磁矩驱动关节的刚度计算公式,假设在图5 中末端执行器f端部作用力矢量F与末端执行器f轴线所构成的平面内,此时, F对手腕转动中心产生的力矩方向与同轴随动磁矩方向必然相反,则电磁驱动球型关节的刚度是:
式中,s为末端执行器f端部沿着作用力方向的变形,L为执行器末端端部作用力矢量F到电磁驱动球型关节中心的距离,则有,s=Lα,α为磁矩为m径向磁化永磁体1轴线与旋转磁场B轴线的夹角,假设α初始数值为零,如图4(C) 所示。
末端执行器f端部作用力矢量F产生的力矩应该等于旋转磁场同轴随动磁矩,即
将(5)代入(4)得
(6)式表明,新型电磁驱动球型关节的刚度,可以通过旋转磁矢量幅值B0进行线性控制,即可通过三轴亥姆霍兹线圈组中正弦电流的幅值I0进行控制,由于没有复杂机械传动系统摩擦力,避免了复杂的变刚度机械调整机构,可通过电磁直接驱动快捷、便利的实现关节变刚度控制,控制精度显著提高,显然,当夹角α变化很小时,(6)式才成立。即当F较小时,夹角α变化很小,可以按照(6)式直接控制手腕刚度,此时,可以只通过正弦电流的幅值I0进行控制,使手腕变成柔顺腕。
结合图1、2说明新型电磁驱动两自由度球型机器人手腕的工作过程。
新型电磁驱动手腕作业前姿态零点标定过程是:通过三轴亥姆霍兹线圈组a 产生旋转轴线垂直的空间万向旋转磁场,在同轴随动磁矩驱动下,转子随动部分b与固定端e的轴线重合,此时,俯仰转角的编码器a4和侧摆转角的编码器 b18相对转角为零,此时分别给编码器a4和编码器b18上电,边存储并记忆两自由度解耦手腕的零点位置;当两自由度手腕定位时,驱动侧摆与俯仰使两自由度手腕处于主动腕模式,根据公式(3)的同轴随动磁矩控制系统与编码器a4 和编码器b18构成转角位置闭环控制,通过实时感知与记忆两自由度手腕的侧摆、俯仰位置,提高控制精度。
新型电磁驱动手腕两自由度主动模态工作过程是:
第一步,通电前,制动器a13与制动器b19一直锁定外部十字万向节c,无法进行侧摆、俯仰运动。
第二步,根据目标空间方位,确定应该施加空间万向旋转磁场的旋转轴线方向,依据公式(1)向三轴亥姆霍兹线圈组a通入三组等频交流电,产生相应方位的空间旋转磁场。
第三步,径向磁化永磁体1在旋转磁场的作用开始进行自转,并依据公式(3) 产生同轴随动磁矩,但由于制动器a13与制动器b19对外部十字万向节c两自由度的锁定,转子随动部分b无法进行侧摆、俯仰运动。
第四步,制动器a13与制动器b19通电解除对外部十字万向节c的锁定,径向磁化永磁体1在旋转磁场的同轴随动磁矩作用下,转子随动部分b轴线追随旋转磁场轴线进行侧摆、俯仰运动,俯仰转角通过编码器a4测量,偏转角度通过编码器b18测量,运动过程由阻尼器a12与阻尼器b30提供阻尼,防止发生振动。
第五步,通过编码器4a与编码器b18实时反馈俯仰、侧摆角度信息;根据反馈的角度信息,依据公式(3)对同轴随动磁矩进行反馈控制,直到满足精度为止,手腕到达目标位置,实现两自由度运动的控制。
第六步,三轴亥姆霍兹线圈组a断电,制动器a13与制动器b19断电,再次对外部十字万向节c锁定,以固定机器人手腕方位。
当只锁定外部十字万向节c一个转轴时,手腕就变成单个自由度转动手腕,两个自由度运动相互独立,互不影响,可实现独立检测与控制,实现手腕侧摆与俯仰两种单自由度控制模态。单自由度模态稳定性好,控制变量少,用于位置精确控制。其它步骤相同,以上第四步、在第五步分别按照如下控制,可实现单自由度控制模态。
新型电磁驱动手腕单自由度主动模态工作过程是:
第四步,只对制动器a13通电解除外部十字万向节c的单轴锁定,径向磁化永磁体1在旋转磁场的同轴随动磁矩作用下,转子随动部分b轴线追随旋转磁场轴线进行侧摆运动,偏转角度通过编码器b18测量;或者只对制动器b19通电解除对外部十字万向节c的单轴锁定,径向磁化永磁体1在旋转磁场的同轴随动磁矩作用下,转子随动部分b轴线追随旋转磁场轴线进行侧摆运动,俯仰转角度通过编码器a4测量。
第五步,通过编码器a4实时反馈俯仰角度信息,或者通过编码器b18实时反馈侧摆角度信息;根据反馈的角度信息,依据公式(3)对同轴随动磁矩进行反馈控制,直到满足精度为止,手腕到达目标位置,分别实现单自由度运动的控制。
下面结合图5说明实现新型电磁驱动两自由度球型机器人手腕的主、被动模式变刚度与柔顺控制的具体实施方式。
两自由度机器人手腕h的转子随动部分b具有侧摆与俯仰驱动功能,可以实现腕部末端执行器f在固定端e轴线的任意平面内的俯仰摆动,考虑到拉开舱门时,能避开腕部末端执行器f轨迹与舱门运动轨迹发生干涉,在机器人腕部末端执行器f上安装一个力传感器g,同轴随动磁矩控制系统与力传感器g检测到的力F构成闭环控制,根据力F的大小,即当F很大时,夹角α变化很大,按照公式(3)通过同轴随动电磁驱动力矩控制,即使腕部输出端在检测力平面内沿受力方向直接减少正弦电流的幅值I0和通过空间万向旋转磁场方向改变夹角α并使其减少,保证腕部末端执行器f的运动轨迹在过末端执行器f轴线和力F 组成的平面内沿力F的方向摆动;当F很小时,夹角α变化很小,则可按照公式(6)直接减少正弦电流的幅值I0,就可以控制两自由度机器人手腕h的刚度减小,实现腕部末端执行器f在所受力F的平面内沿着所受力F的方向运动,同轴随动磁矩控制系统与力传感器g检测到的力F通过闭环控制并追随力F的方向摆动,当力传感器g的检测到的力F值小到0.1N以下,就能实现完全柔顺被动腕,提高腕部的灵活性,保护腕部拉开舱门时不受损坏。同理,当力F的方向改变时,但F很大时,夹角α变化很大,依据公式(3)控制同轴随动磁矩改变力矩方向与大小,即直接减少正弦电流的幅值I0并使腕部输出端在检测力平面内沿受力方向改变夹角α并使其减少;当F很小时,α角变化很小,公式(6)成立,则按照公式(6)直接减少正弦电流的幅值I0,实现变刚度控制,保护手腕。两自由度机器人手腕h采用被动腕模式作业时,侧摆、俯仰的位置依然可以绝对编码器a4与绝对编码器b18存储记忆,两自由度机器人手腕h作业完成恢复到主动腕时,可以恢复到零点标定位置。
通过两自由度机器人手腕h变刚度控制,可以解除腕部俯仰和侧摆的约束,使腕部变成被动腕模式,当停止电磁力矩驱动时,手腕变成柔顺的绳子,实现完全柔顺,有效的解除机械干涉,满足空间极限环境对机器人腕部的特殊需求,完成外星球采样时拔出石头和航天器舱门拉开等复杂作业。
Claims (2)
1.一种电磁驱动两自由度球型机器人手腕,其特征在于,所述的电磁驱动两自由度球型机器人手腕包括三轴亥姆霍兹线圈组(a)和转子随动部分(b);其中,三轴亥姆霍兹线圈组(a)提供空间万向旋转磁场,转子随动部分(b)提供旋转磁场同轴随动磁矩驱动下侧摆和俯仰两个自由度转动;电磁驱动两自由度球型机器人手腕的具体结构如下:
所述的转子随动部分(b)包括内部十字万向节(d)、外部十字万向节(c)以及固定端(e);固定端(e)的顶部为固定端支承座(5),固定端支承座(5)分为四个位于同一轴线的竖直支撑架,竖直支撑架上设有水平的通孔,中间两个竖直支撑架用于安装内部十字万向节(d),外端的两个竖直支撑架用于安装外部十字万向节(c);
所述的内部十字万向节(d)包括固定端支承座(5)的中间两个竖直支撑架、内部万向节内环(14)和柱形壳体(2),其中,内部万向节内环(14)作为十字轴支架,柱形壳体(2)作为从动叉;内部万向节内环(14)的两侧分别通过深沟球轴承a(15)和深沟球轴承b(16)安装在固定端支承座(5)的中间两个竖直支撑架的通孔中,固定端支承座(5)和内部万向节内环(14)实现相对转动,形成俯仰转角转轴;柱形壳体(2)位于内部万向节内环(14)内,连接轴d(23)的一端和连接轴e(26)的一端分别对称固定在柱形壳体(2)的两侧,连接轴d(23)的另一端通过深沟球轴承c(24)安装在内部万向节内环(14)内侧,连接轴e(26)的另一端通过深沟球轴承d(25)安装在内部万向节内环(14)内侧,实现柱形壳体(2)和内部万向节内环(14)相对转动,形成侧摆角转轴;径向磁化永磁体(1)通过轴承(31)安装于柱形壳体(2)内;
所述的外部十字万向节(c)包括固定端支承座(5)外端的两个竖直支撑架、外部万向节内环(3)和外部万向节外环(17),其中,外部万向节内环(3)作为十字轴支架,外部万向节内环(3)上对称设有四个水平的同轴通孔,外部万向节外环(17)作为从动叉;连接轴a(7)通过法兰轴承a(8)安装在固定端支承座(5)外端的一个竖直支撑架的通孔中,连接轴b(9)通过法兰轴承b(10)安装在固定端支承座(5)外端的另一个竖直支撑架的通孔中;外部万向节内环(3)的两侧同轴通孔中的其中一个通孔通过平键a(6)与连接轴a(7)固定连接,外部万向节内环(3)的两侧同轴通孔中的另外一个通孔通过平键b(11)与连接轴b(9)固定连接,固定端支承座(5)和外部万向节内环(3)实现相对转动,形成俯仰转角转轴;连接轴a(7)外端与编码器a(4)连接,连接轴b(9)一端与阻尼器a(12)连接,另一端与制动器a(13)连接,且编码器a(4)、阻尼器a(12)和制动器a(13)均固定在固定端支承座(5)上;连接轴c(21)通过法兰轴承c(22)安装在外部万向节内环(3)另外两侧的同轴通孔中的其中一个通孔中,连接轴f(28)通过法兰轴承d(27)安装在外部万向节内环(3)另外两侧的同轴通孔中的另外一个通孔中;外部万向节外环(17)由两个半环形结构的支撑杆对称组成,两个支撑杆中的一个支撑杆的一端通过平键c(20)与连接轴c(21)固定连接,两个支撑杆中的另一个支撑杆的一端通过平键d(29)与连接轴f(28)固定连接,且两个支撑杆的端部位于外部万向节内环(3)外部,两个支撑杆的另一端分别固定在外部十字万向节(c)的输出端(33)的两侧;外部万向节外环(17)和外部万向节内环(3)实现相对转动,形成侧摆角转轴;内部十字万向节(d)的连接杆(32)的一端固定在柱形壳体(2)的顶部,另一端与输出端(33)固定连接;连接轴c(21)的两端分别与编码器b(18)和制动器b(19)连接,连接轴f(28)的外端与阻尼器b(30)连接,且编码器b(18)、制动器b(19)和阻尼器b(30)均固定安装在外部万向节内环(3)外侧;
所述的外部十字万向节(c)和内部十字万向节(d)均采用固定端支承座(5)作为输入端,所述的外部十字万向节(c)的输入端和内部十字万向节(d)的输入端同轴连接的前提下,外部十字万向节(c)的输出端和内部十字万向节(d)的输出端通过同轴连接构成手腕的转子随动部分(b),外部十字万向节(c)和内部十字万向节(d)具有同一转动中心,构成机器人手腕,实现手腕两个自由度的运动解耦,侧摆角度、俯仰角度可单独测量与控制,即编码器a(4)、制动器a(13)、阻尼器a(12)分别实现了俯仰运动的测量、制动、改变阻尼特性的功能,转子随动部分(b)轴线即为手腕转动轴线,实现侧摆、俯仰两自由度定点旋转运动,径向磁化永磁体(1)在空间万向旋转磁场的同轴随动磁矩驱动下,实现手腕侧摆、俯仰两自由度定点运动;
所述的三轴亥姆霍兹线圈组(a)包括大线圈组、小线圈组和中间线圈组,大线圈组、小线圈组和中间线圈组均包括两个完全相同的线圈,且对称布置;大线圈组、小线圈组和中间线圈组的轴线相互垂直,且大线圈组、小线圈组和中间线圈组相互固定,其中大线圈组的底部固定在固定端(e)上,且中间线圈组的轴线与固定端(e)的轴线重合;内部十字万向节(d)位于大线圈组、小线圈组和中间线圈组中间的内部空间内,外部十字万向节(c)位于大线圈组、小线圈组和中间线圈组外部;所述的外部十字万向节(c)、三轴亥姆霍兹线圈组(a)、内部十字万向节(d)在空间上形成三层嵌套结构。
2.权利要求1所述的一种电磁驱动两自由度球型机器人手腕的控制方法,其特征在于,具体控制过程如下:
(1)作业前姿态零点标定过程
通过三轴亥姆霍兹线圈组(a)产生旋转轴线垂直的空间万向旋转磁场,在同轴随动磁矩驱动下,转子随动部分(b)与固定端(e)的轴线重合,此时,俯仰转角的编码器a(4)和侧摆转角的编码器b(18)相对转角为零,此时分别给编码器a(4)和编码器b(18)上电,边存储并记忆两自由度球型机器人手腕的零点位置;当机器人手腕定位时,驱动侧摆与俯仰使机器人手腕处于主动腕模式,根据公式(3)的同轴随动磁矩与编码器a(4)和编码器b(18)构成转角位置闭环控制;公式(3)如下:
式中,α角为磁矩为m的径向磁化永磁体(1)轴线与旋转磁场B旋转轴线之间的夹角,m0、B0分别为磁矩矢量与旋转磁矢量幅值;
(2)两自由度主动模态工作过程
第一步,通电前,制动器a(13)与制动器b(19)一直锁定外部十字万向节(c),无法进行侧摆、俯仰运动;
第二步,根据目标空间方位,确定应该施加空间万向旋转磁场的旋转轴线方向,向三轴亥姆霍兹线圈组(a)通入三组等频交流电,产生相应方位的空间万向旋转磁场;
第三步,径向磁化永磁体(1)在旋转磁场的作用下开始进行自转,产生同轴随动磁矩,但由于制动器a(13)与制动器b(19)对外部十字万向节(c)两自由度的锁定,转子随动部分(b)无法进行侧摆、俯仰运动;
第四步,制动器a(13)与制动器b(19)通电解除对外部十字万向节(c)的锁定,径向磁化永磁体(1)在旋转磁场的同轴随动磁矩作用下,转子随动部分(b)轴线追随旋转磁场轴线进行侧摆、俯仰运动,俯仰角度通过编码器a(4)测量,侧摆角度通过编码器b(18)测量,运动过程由阻尼器a(12)与阻尼器b(30)提供阻尼,防止发生振动;
第五步,通过编码器a(4)与编码器b(18)实时反馈俯仰、侧摆角度信息;根据反馈的角度信息,对同轴随动磁矩进行反馈控制,直到满足精度为止,手腕到达目标位置,实现两自由度运动的控制;
第六步,三轴亥姆霍兹线圈组(a)断电,制动器a(13)与制动器b(19)断电,再次对外部十字万向节(c)锁定,以固定机器人手腕方位;
(3)单自由度主动模态工作过程
第一步~第三步、第六步分别同两自由度主动模态工作过程中的第一步~第三步、第六步,其余过程如下;
第四步,只对制动器a(13)通电解除外部十字万向节(c)的单轴锁定,径向磁化永磁体(1)在旋转磁场的同轴随动磁矩作用下,转子随动部分(b)轴线追随旋转磁场轴线进行侧摆运动,侧摆角度通过编码器b(18)测量;或者只对制动器b(19)通电解除对外部十字万向节(c)的单轴锁定,径向磁化永磁体(1)在旋转磁场的同轴随动磁矩作用下,转子随动部分(b)轴线追随旋转磁场轴线进行俯仰运动,俯仰角度通过编码器a(4)测量;
第五步,通过编码器a(4)实时反馈俯仰角度信息,或者通过编码器b(18)实时反馈侧摆角度信息;根据反馈的角度信息,对同轴随动磁矩进行反馈控制,直到满足精度为止,手腕到达目标位置,分别实现单自由度运动的控制;
(4)被动模态下同轴随动磁矩控制
首先,假设在末端执行器(f)端部作用力矢量F与末端执行器(f)轴线所构成的平面内,其中,末端执行器(f)与外部十字万向节(c)的输出端(33)连接;F对手腕转动中心产生的力矩方向与同轴随动磁矩方向相反,此时,机器人手腕是一种直接电磁驱动球型关节,电磁驱动原理是旋转磁场同轴随动磁矩效应,同轴随动磁矩计算公式为:
式中,α角为磁矩为m的径向磁化永磁体(1)轴线与旋转磁场B旋转轴线之间的夹角,m0、B0分别为磁矩矢量与旋转磁矢量幅值;
式(3)表明,手腕同轴随动磁矩大小同时通过三轴亥姆霍兹线圈组中正弦电流的幅值I0和径向磁化永磁体(1)轴线与旋转磁场B旋转轴线之间的夹角α进行控制,使手腕变成柔顺腕;
(5)手腕关节变刚度控制
首先,假设在末端执行器(f)端部作用力矢量F与末端执行器(f)轴线所构成的平面内,F对手腕转动中心产生的力矩方向与同轴随动磁矩方向相反,此时,电磁驱动球型关节的刚度是:
式中,s为末端执行器(f)端部沿着作用力方向的变形,L为末端执行器端部作用力矢量F到电磁驱动球型关节中心的距离,则有,s=Lα;
末端执行器(f)端部作用力矢量F产生的力矩等于旋转磁场同轴随动磁矩,即
将(5)代入(4)得
式(6)表明,手腕刚度通过旋转磁矢量幅值B0进行线性控制,即通过三轴亥姆霍兹线圈组中正弦电流的幅值I0进行控制,使手腕变成柔顺腕。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010484343.5A CN111604935B (zh) | 2020-06-01 | 2020-06-01 | 一种电磁驱动两自由度球型机器人手腕及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010484343.5A CN111604935B (zh) | 2020-06-01 | 2020-06-01 | 一种电磁驱动两自由度球型机器人手腕及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111604935A CN111604935A (zh) | 2020-09-01 |
CN111604935B true CN111604935B (zh) | 2021-09-24 |
Family
ID=72197263
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010484343.5A Active CN111604935B (zh) | 2020-06-01 | 2020-06-01 | 一种电磁驱动两自由度球型机器人手腕及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111604935B (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN216167587U (zh) * | 2020-10-19 | 2022-04-05 | 江苏木偶医疗器械有限公司 | 基于球形万向节控制的微创手术器械柔性关节的驱动装置 |
CN112393080B (zh) * | 2020-12-01 | 2022-07-05 | 国电长源第一发电有限责任公司 | 一种智能预控系统用信息显示装置及其使用方法 |
CN114789464A (zh) * | 2021-01-26 | 2022-07-26 | 祖大飞 | 万向控制机械关节 |
IT202100005678A1 (it) | 2021-03-11 | 2022-09-11 | Techrail Srl | Sistema di contenimento e di calibrazione di dispositivi elettronici di un sistema diagnostico per pantografi |
CN113081275B (zh) * | 2021-03-29 | 2022-04-15 | 深圳高性能医疗器械国家研究院有限公司 | 一种力反馈装置及其应用 |
CN113300513B (zh) * | 2021-04-23 | 2022-05-13 | 华中科技大学 | 一种多自由度电机 |
CN113352349B (zh) * | 2021-06-03 | 2023-03-31 | 深圳忆海原识科技有限公司 | 二自由度正交腱传动关节模块 |
CN113440379B (zh) * | 2021-07-25 | 2023-12-15 | 上海市第三康复医院 | 手部康复训练系统及训练方法 |
CN113561162B (zh) * | 2021-08-30 | 2023-03-31 | 苏州极攀企业管理合伙企业(有限合伙) | 一种五自由度混联加工机器人 |
CN113752295B (zh) * | 2021-09-30 | 2022-10-14 | 北京交通大学 | 一种二自由度复合柔性仿生球窝关节 |
CN113895657B (zh) * | 2021-12-09 | 2022-04-12 | 沈阳中科新宇空间智能装备有限公司 | 一种正交双关节式电推力器指向机构 |
CN115107079A (zh) * | 2022-04-26 | 2022-09-27 | 腾讯科技(深圳)有限公司 | 机械腕关节、机械臂及机器人 |
CN115020065B (zh) * | 2022-06-29 | 2023-09-05 | 北京理工大学 | 一种用于微机器人的线上磁化系统及磁化方法 |
CN115316918B (zh) * | 2022-09-06 | 2024-04-26 | 大连理工大学 | 全方位观察欠驱动胶囊机器人及其轴线翻转磁控操作方法 |
CN115741646A (zh) * | 2022-12-10 | 2023-03-07 | 北京友名科技有限公司 | 具备360度转向基座的通用仿真装备六自由度运动平台 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4628765A (en) * | 1985-02-27 | 1986-12-16 | Rensselaer Polytechnic Institute | Spherical robotic wrist joint |
CN102621995B (zh) * | 2012-04-09 | 2014-07-09 | 华南农业大学 | 一种框架式三自由度云台控制系统的控制方法 |
CN103341865B (zh) * | 2013-07-05 | 2015-06-24 | 大连理工大学 | 一种三自由度等速解耦空间机器人主动球型腕与万向柔顺控制方法 |
CN104764586B (zh) * | 2015-04-03 | 2017-05-03 | 大连理工大学 | 一种螺旋胶囊机器人液体阻力矩的非接触在线测量方法 |
CN110271033B (zh) * | 2019-05-22 | 2022-12-27 | 太原理工大学 | 一种无奇异位形的液压直驱三自由度球型手腕 |
-
2020
- 2020-06-01 CN CN202010484343.5A patent/CN111604935B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN111604935A (zh) | 2020-09-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111604935B (zh) | 一种电磁驱动两自由度球型机器人手腕及其控制方法 | |
CN103341865B (zh) | 一种三自由度等速解耦空间机器人主动球型腕与万向柔顺控制方法 | |
WO2021243515A1 (zh) | 一种电磁驱动两自由度球型机器人手腕及其控制方法 | |
CN102029614B (zh) | 三自由度球型空间机器人手腕 | |
US5355743A (en) | Robot and robot actuator module therefor | |
CN109849016A (zh) | 一种具有行走和搬运功能的家用服务机器人 | |
CN101733749A (zh) | 空间机器人多领域统一建模与仿真系统 | |
US20100107795A1 (en) | Frame walker predicated on a parallel mechanism | |
CN111506119B (zh) | 一种非正交驱动三自由度内框的光电吊舱装置 | |
Van de Perre et al. | Investigating the potential of flexible links for increased payload to mass ratios for collaborative robotics | |
Gao et al. | Design and modeling of a dual-ball self-balancing robot | |
Klas et al. | A compact, lightweight and singularity-free wrist joint mechanism for humanoid robots | |
You et al. | Dynamic control of a 3-DOF cable-driven robot based on backstepping technique | |
Li et al. | Design of a 2 motor 2 degrees-of-freedom coupled tendon-driven joint module | |
Yiğit et al. | Kinematic Analysis and Design of a Novel (6+ 3)-DoF Parallel Robot with Fixed Actuators | |
CN209717730U (zh) | 一种具有行走和搬运功能的家用服务机器人 | |
Wang et al. | Type synthesis of 3T2R decoupled hybrid mechanisms with large bearing capacity | |
Chen et al. | Improved Design and Modeling of a Series-Parallel Hybrid Modular Joint for Humanoid Arms | |
Wu | Workspace, transmissibility and dynamics of a new 3T3R parallel pick-and-place robot with high rotational capability | |
CN115664151A (zh) | 一种电磁驱动高集成球型电机及其控制方法 | |
CN111843989A (zh) | 一种液压作动器驱动的机器人手腕单元 | |
Khatib et al. | The design of a high-performance force-controlled manipulator | |
Li et al. | Check for updates System Design, Localization, and Forced-Based Trajectory Evaluation of the Magnetic Adhesion Robot | |
Monti et al. | An experimental testbed to simulate space manipulators GNC | |
Liu et al. | Structure Design and Dynamic Simulation Analysis of Dual-arm Handling Robot |
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 |