一种基于双旋变同轴设计的机器人一体化关节位置检测方法技术

本发明专利技术公开了一种基于双旋变同轴设计的机器人一体化关节位置检测方法。首先，确定两侧旋转变压器绝对零点之间的差值。然后，采用角度增量累计的方法，将电机侧旋转变压器测得角度θM和关节侧旋转变压器得到的角度θJ2在电机旋转过程中的增量累加，再相减得到差值，即为关节实际旋转的角度。同时，在计算角度增量时，需要在跨越零点的时刻进行特殊处理。即根据电机的最大转速和旋转变压器解算角度的时间差值，得到电机在下一时刻与上一时刻角度差值的最大可能值，作为判断的临界值。

【技术实现步骤摘要】

本专利技术涉及机器人
，特别涉及。
技术介绍
随着集成电路、电力电子技术和交流可变速驱动技术的发展，永磁交流伺服驱动技术有了突出的发展，永磁交流伺服电动机同直流伺服电动机比较，主要优点有无电刷和换向器，因此工作可靠，对维护和保养要求低，具有良好的速度控制特性，易于提高系统的·快速性。基于永磁交流伺服驱动技术的永磁同步电机可以应用于机器人的关节等部位。在基于永磁同步电机的机器人关节中，需要有相应的检测元件对永磁同步电机转子位置进行检测，以实现对电机的控制。目前，现有的基于永磁同步电机机器人关节的位置检测元件主要安装方式为采用一个位置检测元件并安装在电机侧，检测永磁同步电机转子的位置用于电机控制，并利用检测的位置结合减速机构的减速比η计算关节位置。这种方式的关节位置控制为开环，控制精度取决于减速机构的传动精度。在对现有技术进行研究后，专利技术人发现现有技术的永磁同步电机的机器人关节，在求解关节旋转角度时，通常采取的方式为将电机位置，除以减速器的减速比η，得到关节位置，此种求解关节位置的算法精度较低，可靠性差，且对于此种安装方式，当电机侧的检测元件损坏时，将使电机无法控制而导致机器人的关节失效。本专利技术中采用的算法基于的一体化关节的位置检测元件安装方式为将两个检测元件分别安装在电机侧及关节处，电机侧的检测元件采用旋转变压器检测永磁同步电机转子位置用于电机控制，关节侧的检测元件采用旋转变压器，其转子随电机转子同步转动，定子随关节输出端同步转动。此种一体化关节结构体积小，且可以通过算法解算出的关节位置用于伺服闭环控制。
技术实现思路
有鉴于现有技术的上述缺陷，本专利技术实施例提供，以解决现有技术的问题。本专利技术的技术效果通过以下技术方案得以实现。一种机器人关节的位置检测方法，所述关节包括电机外壳(I)、电机端旋转变压器定子(2)、电机侧旋转变压器转子(3)、永磁同步电机定子(4)、永磁同步电机转子(5)、关节输出侧外壳(6)、谐波减速器钢轮(7)、谐波减速器波发生器(8)、谐波减速器柔轮(9)、关节输出侧旋转变压器定子(10)和关节输出侧旋转变压器转子(11)、关节右侧档盖(12)、中空轴定位销(13)、电机轴承(14) (18)、轴承安装座(15) (17)和电机主轴(16)，其中，所述永磁同步电机转子(5)、电机侧旋转变压器转子(3)和关节输出侧旋转变压器转子(11)都安装在电机轴上，随电机轴一起转动；电机侧旋转变压器定子(2)固定，关节输出侧旋转变压器定子(10)安装在谐波减速器柔轮(9)上，关节输出侧旋转变压器定子(10)可以随关节一起转动，所述方法包括以下步骤首先，确定两侧旋转变压器由于安装时造成的绝对零点之间的差值，检测出电机侧旋转变压器位于绝对零点时，关节输出侧旋转变压器测得的位置量Θ。2，作为两个旋转变压器绝对零点初始差值；然后，将电机侧旋转变压器测得角度θ M和关节侧旋转变压器测得的角度θ12在电机旋转过程中的增量累加，再相减得到差值，即为关节实际旋转的角度。优选地，在计算角度增量时，需要在跨越零点的时刻进行判断。优选地，根据电机的最大转速和旋转变压器解算角度的时间差值，得到电机在下一时刻与上一时刻角度差值的最大可能值，作为对跨越零点的时刻的判断的临界值；其中，将根据电机的最大转速和旋转变压器解算角度的时间差值，得到电机在下一时刻与上一时刻角度差值的最大可能值记为9_;若1时刻电机侧的角度0Mi或关节侧的角度012i在下 一时刻与上一时刻的角度差值大于此最大可能值时，即电机的速度不可能使两个相邻时刻的差值出现以上情况，则判定角度过零点，计算出的差值减去或加上360°。附图说明图I是本专利技术中提供的一种基于永磁同步电机的机器人关节的结构示意图；图2是本专利技术中提供的机器人一体化关节的关节位置双余度检测方法流程图。具体实施例方式为使本专利技术的目的，技术方案和优点更加清楚，下面将结合附图对本专利技术实施方式作进一步地详细描述。图I为本专利技术提出的一种基于永磁同步电机的机器人关节，该关节的内部包括如下部件电机外壳I ;电机侧旋转变压器定子2 ;电机侧旋转变压器转子3 ;永磁同步电机定子4 ;永磁同步电机转子5 ;关节输出侧外壳6 ;谐波减速器钢轮7 ;谐波减速器波发生器8 ；谐波减速器柔轮9 ;关节输出侧旋转变压器定子10 ;关节输出侧旋转变压器转子11 ;关节右侧档盖12 ;中空轴定位销13 ;电机轴承14 ;轴承安装座15 ;电机主轴16 ;轴承安装座17 ；电机轴承18。其中，在永磁同步电机的机器人关节中安装一个电机侧旋转变压器和一个关节输出侧旋转变压器；所述关节输出侧的旋转变压器定子10安装在谐波检测器的柔轮9上，可以随关节同步转动；所述电机侧旋转变压器和所述关节输出侧旋转变压器与所述电机同轴，且永磁同步电机定子4、所述电机侧旋转变压器的转子2和关节输出侧旋转变压器的转子11都安装在电机轴上，随所述电机轴同步转动。所述电机侧旋转变压器的定子2固定不动，所述关节输出侧旋转变压器的定子10随关节输出端同步转动。利用所述电机侧旋转变压器和所述关节输出侧旋转变压器对所述关节输出端的关节位置进行检测；所述关节侧的旋转变压器检测到的所述关节输出端的从动关节转过的角度θτ，以及所述电机侧旋转变压器检测到的所述电机转子转过的角度ΘΜ。由于关节输出端的旋转方向与电机的旋转方向相反，所以可以得到以下关系式权利要求1.一种机器人关节的位置检测方法，所述关节包括电机外壳(I)、电机端旋转变压器定子(2)、电机侧旋转变压器转子(3)、永磁同步电机定子(4)、永磁同步电机转子(5)、关节输出侧外壳(6)、谐波减速器钢轮(7)、谐波减速器波发生器(8)、谐波减速器柔轮(9)、关节输出侧旋转变压器定子(10)和关节输出侧旋转变压器转子(11)、关节右侧档盖(12)、中空轴定位销(13)、电机轴承(14)和(18)、轴承安装座(15)和(17)和电机主轴(16)，其中，所述永磁同步电机转子(5)、电机侧旋转变压器转子(3)和关节输出侧旋转变压器转子(11)都安装在电机轴上，随电机轴一起转动；电机侧旋转变压器定子(2)固定，关节输出侧旋转变压器定子(10)安装在谐波减速器柔轮(9)上，关节输出侧旋转变压器定子(10)可以随关节一起转动，其特征在于，所述方法包括以下步骤 首先，确定两侧旋转变压器由于安装时造成的绝对零点之间的差值，检测出电机侧旋转变压器位于绝对零点时，关节输出侧旋转变压器测得的位置量Θ。2，作为两个旋转变压器绝对零点初始差值； 然后，将电机侧旋转变压器测得角度θ M和关节侧旋转变压器得到的角度Qj2在电机旋转过程中的增量累加，再相减得到差值，即为关节实际旋转的角度。2.根据权利要求I所述的方法，其特征在于，在计算角度增量时，需要在跨越零点的时刻进行判断。3.根据权利要求2所述的方法，其特征在于，根据电机的最大转速和旋转变压器解算角度的时间差值，得到电机在下一时刻与上一时刻角度差值的最大可能值，作为对跨越零点的时刻的判断的临界值；其中，将根据电机的最大转速和旋转变压器解算角度的时间差值，得到电机在下一时刻与上一时刻角度差值的最大可能值记为Qmax ;若i时刻电机侧的角度0Mi或关节侧的角度Θ 12i在下一时刻与上一时刻的角本文档来自技高网...

【技术保护点】
一种机器人关节的位置检测方法，所述关节包括电机外壳(1)、电机端旋转变压器定子(2)、电机侧旋转变压器转子(3)、永磁同步电机定子(4)、永磁同步电机转子(5)、关节输出侧外壳(6)、谐波减速器钢轮(7)、谐波减速器波发生器(8)、谐波减速器柔轮(9)、关节输出侧旋转变压器定子(10)和关节输出侧旋转变压器转子(11)、关节右侧档盖(12)、中空轴定位销(13)、电机轴承(14)和(18)、轴承安装座(15)和(17)和电机主轴(16)，其中，所述永磁同步电机转子(5)、电机侧旋转变压器转子(3)和关节输出侧旋转变压器转子(11)都安装在电机轴上，随电机轴一起转动；电机侧旋转变压器定子(2)固定，关节输出侧旋转变压器定子(10)安装在谐波减速器柔轮(9)上，关节输出侧旋转变压器定子(10)可以随关节一起转动，其特征在于，所述方法包括以下步骤：首先，确定两侧旋转变压器由于安装时造成的绝对零点之间的差值，检测出电机侧旋转变压器位于绝对零点时，关节输出侧旋转变压器测得的位置量θoz，作为两个旋转变压器绝对零点初始差值；然后，将电机侧旋转变压器测得角度θM和关节侧旋转变压器得到的角度θJ2在电机旋转过程中的增量累加，再相减得到差值，即为关节实际旋转的角度。...

【技术特征摘要】

【专利技术属性】
技术研发人员：蒋志宏，黄强，李丹凤，李辉，
申请(专利权)人：北京理工大学，
类型：发明
国别省市：