CN110160560A - 磁编码器、机器人关节及磁编码器的标定方法 - Google Patents

磁编码器、机器人关节及磁编码器的标定方法 Download PDF

Info

Publication number
CN110160560A
CN110160560A CN201910539100.4A CN201910539100A CN110160560A CN 110160560 A CN110160560 A CN 110160560A CN 201910539100 A CN201910539100 A CN 201910539100A CN 110160560 A CN110160560 A CN 110160560A
Authority
CN
China
Prior art keywords
magnetic
magnetic field
field sensor
coder
ring
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
Application number
CN201910539100.4A
Other languages
English (en)
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.)
Shanghai Ling First Robot Polytron Technologies Inc
Original Assignee
Shanghai Ling First Robot Polytron Technologies Inc
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 Shanghai Ling First Robot Polytron Technologies Inc filed Critical Shanghai Ling First Robot Polytron Technologies Inc
Priority to CN201910539100.4A priority Critical patent/CN110160560A/zh
Publication of CN110160560A publication Critical patent/CN110160560A/zh
Pending legal-status Critical Current

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J17/00Joints
    • B25J17/02Wrist joints
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D18/00Testing or calibrating apparatus or arrangements provided for in groups G01D1/00 - G01D15/00
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01DMEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
    • G01D5/00Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable
    • G01D5/12Mechanical means for transferring the output of a sensing member; Means for converting the output of a sensing member to another variable where the form or nature of the sensing member does not constrain the means for converting; Transducers not specially adapted for a specific variable using electric or magnetic means

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Transmission And Conversion Of Sensor Element Output (AREA)
  • Manipulator (AREA)

Abstract

本发明提供了一种磁编码器、机器人关节及磁编码器的标定方法,所述磁编码器的设计方案中,将磁编码器设计为包括第一径向磁环和第二径向磁环,第一径向磁环包括一对磁极,第二径向磁环包括至少两对磁极,第二径向磁环与第一径向磁环共轴;在磁环固定部件相对磁场传感器固定部件旋转时,带动第一径向磁环和第二径向磁环相对第一磁场传感器和第二磁场传感器的旋转,第一磁场传感器和第二磁场传感器分别感测第一径向磁环和第二径向磁环的磁场数据。由于第二径向磁环具有至少两对磁极,使得第二径向磁环可产生与磁极对数个周期信号,从而提高第二磁场传感器的读数的分辨率,进而实现对磁编码器的分辨率提高。

Description

磁编码器、机器人关节及磁编码器的标定方法
技术领域
本发明涉及机器人技术领域,特别涉及一种磁编码器、机器人关节及磁编码器的标定方法。
背景技术
机器人及自动化装备有着广阔的应用市场,以机器人为例,机器人技术作为先进制造技术的典型代表,是集机械、电子、控制、计算机、传感器、人工智能等多学科先进技术于一体的重要的现代制造业自动化装备。其中,机器人一般都具有旋转底座,旋转底座的作用是带动机器人的机械手进行轴向圆周运动。其中,旋转底座外一般连接有导线,而当旋转底座进行轴向圆周运动时容易因为缠绕导线而影响机械手进行轴向圆周运动,那么就需要设置旋转编码器来控制轴向圆周运动只能够在一定旋转角度范围内转动,从而实现防缠线。
现有的旋转编码器主要分为光电式编码器、电容式编码器以及磁编码器等。其中,磁编码器由于其体积小、工作稳定等优点,在对体积要求较高的机器人等行业应用越来越广泛。然而磁编码器由于其工作原理限制,其分辨率通常只有单圈14-15位,难以满足高精度的需求。
针对现有技术中磁编码器存在的不足,本领域技术人员一直在寻找解决的方法。
发明内容
本发明的目的在于提供一种磁编码器、机器人关节及磁编码器的标定方法,以解决使用现有技术中磁编码器分辨率不高的问题。
为解决上述技术问题,本发明提供一种磁编码器,所述磁编码器包括:磁环固定部件、固定于所述磁环固定部件上的第一径向磁环和第二径向磁环、磁场传感器固定部件、以及固定于所述磁场传感器固定部件上的第一磁场传感器和第二磁场传感器;其中,所述第一径向磁环包括一对磁极,所述第二径向磁环包括至少两对磁极,所述第二径向磁环与所述第一径向磁环共轴;所述第一磁场传感器和所述第二磁场传感器分别对应朝向所述第一径向磁环和所述第二径向磁环;所述磁环固定部件相对所述磁场传感器固定部件旋转时,所述第一磁场传感器和所述第二磁场传感器分别感测所述第一径向磁环和所述第二径向磁环的磁场数据。
可选的,在所述的磁编码器中,所述第一径向磁环相对所述第一磁场传感器转动一个周期,所述第一磁场传感器的读数变化范围是0~(215-1)。
可选的,在所述的磁编码器中,所述第二径向磁环相对所述第二磁场传感器转动一个周期,所述第二磁场传感器的读数变化范围是0~(215+N-1-1),其中,N为所述第二径向磁环中的磁极对数,N≥2。
可选的,在所述的磁编码器中,还包括:单片机,所述单片机分别与所述第一磁场传感器和所述第二磁场传感器连接,以读取所述第一磁场传感器和所述第二磁场传感器读取的数据,并存储磁编码器的标定数值。
可选的,在所述的磁编码器中,所述第一磁场传感器和所述第二磁场传感器均包括两个由巨磁电阻组成的全桥电路,且两个全桥电路互相垂直。
可选的,在所述的磁编码器中,所述第一磁场传感器和所述第二磁场传感器均采用英飞凌TLE5012芯片。
本发明还提供一种机器人关节,所述机器人关节包括如上所述的磁编码器、以及与所述磁编码器连接的电机编码器。
本发明还提供一种磁编码器的标定方法,所述磁编码器的标定方法包括如下步骤:
S1:记录磁环固定部件相对磁场传感器固定部件旋转一个周期过程中,第一磁场传感器产生的一个周期信号的数据、第二磁场传感器产生的N个周期信号的数据、以及在第二磁场传感器产生的周期信号跳变时第一磁场传感器的所有读取数据,其中,N为第二径向磁环中的磁极对数;
S2:将第一磁场传感器产生的一个周期信号的数据、第二磁场传感器产生的N个周期信号的数据以及所述所有读取数据进行数据融合,以获得新的编码器地址值;
S3:读取与磁编码器连接的电机编码器的数据,对所述电机编码器的数据进行比例缩放,以获得第一缩放数值;
S4:选择基地址,在所述基地址的基础上,以新的编码器地址值为偏移地址保存所述第一缩放数值;
S5:判断磁编码器的每个地址是否都存储有对应的第一缩放数值,若无,则执行S2;反之,执行S6;
S6:磁编码器标定完成。
可选的,在所述的磁编码器的标定方法中,在S2中,包括如下步骤:
S21:根据所述在第二磁场传感器产生的周期信号跳变时第一磁场传感器的所有读取数据查找当前时刻第一磁场传感器的扇区;
S22:将所述第一磁场传感器产生的一个周期信号的数据和所述第二磁场传感器产生的N个周期信号的数据进行数据融合,以获得初始的新的编码器数值;
S23:舍去所述初始的新的编码器数值的跳动位数,作为最终的新的编码器数值。
可选的,在所述的磁编码器的标定方法中,在S22中,获得初始的新的编码器数值采用的计算公式如下:
M=J*2152
其中,M为初始的新的编码器数值,M∈[0,215*N);J为当前时刻第一磁场传感器的扇区,J∈[0,N-1];α2为第二磁场传感器产生的N个周期信号的数据。
可选的,在所述的磁编码器的标定方法中,所述最终的新的编码器地址值采用的计算公式如下:
Add=(215*J+α2)>>T;
其中,Add为最终的新的编码器地址值;J为当前时刻第一磁场传感器的扇区;>>T表示在二进制中左移T位,T为跳动位数。
可选的,在所述的磁编码器的标定方法中,在S3中,对所述电机编码器的数据进行比例缩放采用的计算公式如下:
其中,θ为电机端编码器的角度数值,θ∈[0,2πk],k为谐波减速器的速比;H为由电机端编码器的读数、第一磁场传感器产生的一个周期信号的数据(α1)和所述第二磁场传感器产生的N个周期信号的数据构建的数组长度。
在本发明所提供的磁编码器、机器人关节及磁编码器的标定方法中,通过将磁编码器设计为包括第一径向磁环和第二径向磁环,第一径向磁环包括一对磁极,第二径向磁环包括至少两对磁极,第二径向磁环与第一径向磁环共轴;第一磁场传感器和第二磁场传感器分别对应朝向第一径向磁环和第二径向磁环;在磁环固定部件相对磁场传感器固定部件旋转时,带动第一径向磁环和第二径向磁环相对第一磁场传感器和第二磁场传感器的旋转,第一磁场传感器和第二磁场传感器分别感测第一径向磁环和第二径向磁环的磁场数据。由于第二径向磁环具有至少两对磁极,使得第二径向磁环可产生与磁极对数个周期信号,从而提高第二磁场传感器的读数的分辨率,进而实现对磁编码器的分辨率提高。
附图说明
图1是本发明一实施例中磁编码器的结构示意图;
图2是本发明一实施例中机器人关节的结构示意图;
图3是本发明一实施例中磁编码器的标定方法的流程图。
图中:
磁编码器-3;磁环固定部件-30;第一径向磁环-31;第二径向磁环-32;磁场传感器固定部件-36;第一磁场传感器-33;第二磁场传感器-34;单片机-35;旋转轴-7;电机定子-11;电机转子-12;第一电机定子固定件-131;第二电机定子固定件132;第一电机转子固定件-141;第二电机转子固定件142;机端磁铁-15;第一电机轴承-16;电机编码器-17;第二电机轴承-19;谐波减速器-20;刚轮-21;波发生器-22;柔轮-23;关节输出法兰-24;第一轴承-25;第二轴承-26;编码器固定连接板-37;
具体实施方式
以下结合附图和具体实施例对本发明提出的磁编码器、机器人关节及磁编码器的标定方法作进一步详细说明。根据下面说明和权利要求书,本发明的优点和特征将更清楚。需说明的是,附图均采用非常简化的形式且均使用非精准的比例,仅用以方便、明晰地辅助说明本发明实施例的目的。
为使本发明的目的、特征更明显易懂,下面结合附图对本发明的具体实施方式作进一步的说明,然而,本发明可以用不同的形式实现,不应认为只是局限在的实施例。
请参考图1,其为本发明的磁编码器的结构示意图。如图1所示,所述磁编码器3包括:磁环固定部件30、固定于所述磁环固定部件30上的第一径向磁环31和第二径向磁环32、磁场传感器固定部件36、以及固定于所述磁场传感器固定部件36上的第一磁场传感器33和第二磁场传感器34;其中,所述第一径向磁环31包括一对磁极,所述第二径向磁环32包括至少两对磁极,所述第二径向磁环32与所述第一径向磁环31共轴;所述第一磁场传感器33和所述第二磁场传感器34分别对应朝向所述第一径向磁环31和所述第二径向磁环32;所述磁环固定部件30相对所述磁场传感器固定部件36旋转时,所述第一磁场传感器33和所述第二磁场传感器34分别感测所述第一径向磁环31和所述第二径向磁环32的磁场数据。优选的,可选择将磁环固定部件30和磁场传感器固定部件36共轴设置。
具体的,请继续参考图1,所述磁环固定部件30相对所述磁场传感器固定部件36旋转时,所述磁环固定部件30绕旋转轴7沿顺时针或逆时针方向旋转,此时,所述第一径向磁环31和所述第二径向磁环32在所述磁环固定部件30的带动下相对所述第一磁场传感器33和所述第二磁场传感器34旋转,从而使得第一磁场传感器33和所述第二磁场传感器34感测过程中产生的磁场数据。
其中,所述第一径向磁环31相对所述第一磁场传感器33转动一个周期,所述第一磁场传感器33的读数变化范围是0~(215-1),第一磁场传感器33的输出分辨率为15位;所述第二径向磁环32相对所述第二磁场传感器34转动一个周期,所述第二磁场传感器34的读数变化范围是0~(215+N-1-1),其中,N为所述第二径向磁环32中的磁极对数,N≥2,第二磁场传感器34的输出分辨率提高到了(15+N-1)位(在不做最后几位数据舍弃的情况下);文中涉及的读数,为传感器(第一磁场传感器33和/或第二磁场传感器34)返回的数值,可以理解为刻度,在应用中,一个刻度对应的值是360°/215,单位为inc(increasement的缩写,即一个增量值)。由此可见,第二径向磁环32中的磁极对数增加会直接提高第二磁场传感器34的读数的分辨率,进而使得磁编码器3的分辨率提高。因此,可以通过增减第二径向磁环32中磁极对数,来实现对磁编码器3的分辨率调整。
具体的,所述第一磁场传感器33和所述第二磁场传感器34均包括两个由巨磁电阻组成的全桥电路,且两个全桥电路互相垂直,以测量磁场与磁场传感器(第一磁场传感器33或第二磁场传感器34)的方向。
优选的,所述第一磁场传感器33和所述第二磁场传感器34均采用英飞凌TLE5012芯片,当然还可以选用其他同类型芯片代替,只要符合磁场感测性能需求即可。即当磁环(具有一对磁极的情形)相对于磁场传感器转动一个完整的磁性周期时,磁场传感器能够输出0-360°绝对值信号,分辨率为15位。
进一步地,所述磁编码器3还包括单片机35,所述单片机35分别与所述第一磁场传感器33和所述第二磁场传感器34连接,以读取所述第一磁场传感器33和所述第二磁场传感器34读取的数据,并存储磁编码器3的标定数值。具体的,所述第一磁场传感器33和所述第二磁场传感器34固定在磁场传感器固定部件36的一侧,所述单片机35安装固定于所述磁场传感器固定部件36的另一侧。
请参考图2,其为本发明另一实施例中提供的机器人关节的结构示意图。如图2所示,所述机器人关节包括如上所述的磁编码器3、以及与所述磁编码器3连接的电机编码器17。其中,所述电机编码器17用于电机控制,可选用相对值编码器,也选用绝对值编码器。
此外,所述机器人关节还包括电机、谐波减速器20,其中,所述电机包括电机定子11和电机转子12;所述包括柔轮23、刚轮21及波发生器22。由于本发明的核心在于设计了一种新型的磁编码器3替换机器人关节原有的磁编码器,因此,对于机器人关节其他部件的位置关系可以参考现有公开结构及分布位置,这里仅对重要部件做详细阐述。
请继续参考图2,机器人关节中固定部分为:电机定子11、第一电机定子固定件131、第二电机定子固定件132、编码器固定连接板37、磁场传感器固定部件36、第一磁场传感器33、第二磁场传感器34、单片机35、电机编码器17、第一电机轴承16、第二电机轴承19、第一轴承25、第二轴承26;机器人关节中高速转动部分为:电机转子12、第一电机转子固定件141、第二电机转子固定件142、谐波减速器20的波发生器22、电机端磁铁15、第一电机轴承16、第二电机轴承19;机器人关节中低速转动部分为:谐波减速器20的柔轮23、关节输出法兰24、第一轴承25、第二轴承26、第一径向磁环31和第二径向磁环32。
具体的,电机定子11与第一电机定子固定件31、第二电机定子固定件32固定,电机转子12与第一电机转子固定件141、第二电机转子固定件142固定;电机转子12绕旋转轴7与电机定子11保持相对转动;电机定子11与电机转子12通过第一电机轴承16和第二电机轴承19连接;第二电机定子固定件32与谐波减速器20的刚轮21通过螺栓固定,第二电机转子固定件142与谐波减速器20的波发生器22通过螺栓固定,电机转子12带动波发生器22转动,在电机转子12转动时,谐波减速器20的柔轮23以低速转动,(谐波减速器20原理不做阐述),关节输出法兰24与谐波减速器20的柔轮23通过螺栓连接;第一径向磁环31和第二径向磁环32固定在关节输出法兰24上(这里机器人关节中的关节输出法兰24充当磁编码器3中的磁环固定部件30),随着谐波减速器20的柔轮23一起绕旋转轴7做旋转运动;第一电机转子固定件141上安装有电机端磁铁15,随着电机转子12绕旋转轴7做旋转运动;编码器固定连接板37与第一电机定子固定件31通过螺栓连接,编码器固定连接板37上有电机编码器17;磁场传感器固定部件36通过螺栓与编码器固定连接板37固定,该零件上安装有第一磁场传感器33、第二磁场传感器34、单片机35;第一轴承25和第二轴承26安装在关节输出法兰24和磁场传感器固定部件36之间(可选,用于保证同心度)。
相应的,本实施例还提供了一种磁编码器的标定方法。下面参考图2及图3详细说明本实施例所述磁编码器的标定方法。
首先,执行步骤S1,记录磁环固定部件30相对磁场传感器固定部件36旋转一个周期过程中(对应为机器人关节低速端转动一圈,电机转过的角度为2kπ,k为谐波减速器20的速比记),数值从0到32767(15位分辨率);第一磁场传感器33产生的一个周期信号的数据、第二磁场传感器34产生的N个周期信号的数据、以及在第二磁场传感器34产生的周期信号跳变(从0跳变到32767或者从32767跳变到0)时第一磁场传感器33的所有读取数据,记为Index=[I0,I1,...,IN-1],Index中数值按照从小到大升序排列;其中,N为第二径向磁环32中的磁极对数;
为了便于理解,S1换言之想表达的意思如下:
控制电机使得电机转子朝某一方向转动,使机器人关节低速端转动一圈,电机转过的角度为2kπ。在一个周期中,第一磁场传感器33读取到一个完整的周期,此时,第二磁场传感器34读取到N个完整的周期。通常由于安装误差、磁铁充磁不均匀等各种因素,第一磁场传感器33/第二磁场传感器34读取到的角度变化与实际机器人关节转动的角度变化呈非线性关系(但在同一个周期内呈单调变化)。
接着,执行步骤S2,将第一磁场传感器33产生的一个周期信号的数据α1、第二磁场传感器34产生的N个周期信号的数据α2以及所述所有读取数据Index进行数据融合,以获得新的编码器地址值Add;
所述S2具体包括如下步骤:
S21:根据所述在第二磁场传感器34产生的周期信号跳变时第一磁场传感器33的所有读取数据Index查找当前时刻第一磁场传感器33的扇区J;
其中,IJ<α1<IJ+1
S22:将所述第一磁场传感器33产生的一个周期信号的数据α1和所述第二磁场传感器34产生的N个周期信号的数据α2进行数据融合,以获得初始的新的编码器数值;其中,获得初始的新的编码器数值M采用的计算公式如下:
M=J*2152
其中,M为初始的新的编码器数值,M∈[0,215*N];J为当前时刻第一磁场传感器33的扇区,J∈[0,N-1];α2为第二磁场传感器34产生的N个周期信号的数据。
为了提高磁编码器的稳定性,考虑由于环境因素变化、第一磁场传感器33/第二磁场传感器34本身不稳定等原因,第二磁场传感器34读取到数据的最后几位可能发生跳动,在执行完S22之后,还可执行S23,具体如下:
S23:舍去所述初始的新的编码器数值的跳动位数T,作为最终的新的编码器数值Add。
进一步地,所述最终的新的编码器地址值Add采用的计算公式如下:
Add=(215*J+α2)>>T;
其中,Add为最终的新的编码器地址值;J为当前时刻第一磁场传感器33的扇区;>>T表示在二进制中左移T位,T为跳动位数。
接着,执行步骤S3,读取与磁编码器3连接的电机编码器17的数据,对所述电机编码器17的数据进行比例缩放,以获得第一缩放数值δ;
较佳的,对所述电机编码器17的数据进行比例缩放采用的计算公式如下:
其中,θ为电机端编码器的角度数值,θ∈[0,2πk],k为谐波减速器20的速比;H为由电机端编码器的读数、第一磁场传感器33产生的一个周期信号的数据α1和所述第二磁场传感器34产生的N个周期信号的数据α2构建的数组长度,经过缩放以使得δ和数组长度H变化范围保持一致,在数值上一一对应。
接着,执行步骤S4,选择基地址Abase,在所述基地址Abase的基础上,以新的编码器地址值Add为偏移地址保存所述第一缩放数值δ(即保存第一缩放数值δ的地址是Abase+Add)。
具体的,第一缩放数值δ保存在单片机35的FLASH中(也可以是其它存储设备)。
在使用时,直接读取单片机35的FLASH中地址为Abase+Add的数值,该数值即为最终的传感器数值。
接着,执行步骤S5,判断磁编码器3的每个地址是否都存储有对应的第一缩放数值,若无,则执行S2;反之,执行S6;
接着,执行步骤S6,磁编码器3标定完成。
在完成标定后,机器人关节中除了电机外均需保持固定,否则需要重新进行标定,标定过程可以全部自动完成,无需人为干预。
综上,在本发明所提供的磁编码器、机器人关节及磁编码器的标定方法中,通过将磁编码器设计为包括第一径向磁环和第二径向磁环,第一径向磁环包括一对磁极,第二径向磁环包括至少两对磁极,第二径向磁环与第一径向磁环共轴;第一磁场传感器和第二磁场传感器分别对应朝向第一径向磁环和第二径向磁环;在磁环固定部件相对磁场传感器固定部件旋转时,带动第一径向磁环和第二径向磁环相对第一磁场传感器和第二磁场传感器的旋转,第一磁场传感器和第二磁场传感器分别感测第一径向磁环和第二径向磁环的磁场数据。由于第二径向磁环具有至少两对磁极,使得第二径向磁环可产生与磁极对数个周期信号,从而提高第二磁场传感器的读数的分辨率,进而实现对磁编码器的分辨率提高。
上述描述仅是对本发明较佳实施例的描述,并非对本发明范围的任何限定,本发明领域的普通技术人员根据上述揭示内容做的任何变更、修饰,均属于权利要求书的保护范围。

Claims (12)

1.一种磁编码器,其特征在于,包括:磁环固定部件、固定于所述磁环固定部件上的第一径向磁环和第二径向磁环、磁场传感器固定部件、以及固定于所述磁场传感器固定部件上的第一磁场传感器和第二磁场传感器;其中,所述第一径向磁环包括一对磁极,所述第二径向磁环包括至少两对磁极,所述第二径向磁环与所述第一径向磁环共轴;所述第一磁场传感器和所述第二磁场传感器分别对应朝向所述第一径向磁环和所述第二径向磁环;所述磁环固定部件相对所述磁场传感器固定部件旋转时,所述第一磁场传感器和所述第二磁场传感器分别感测所述第一径向磁环和所述第二径向磁环的磁场数据。
2.如权利要求1所述的磁编码器,其特征在于,所述第一径向磁环相对所述第一磁场传感器转动一个周期,所述第一磁场传感器的读数变化范围是0~(215-1)。
3.如权利要求2所述的磁编码器,其特征在于,所述第二径向磁环相对所述第二磁场传感器转动一个周期,所述第二磁场传感器的读数变化范围是0~(215+N-1-1),其中,N为所述第二径向磁环中的磁极对数,N≥2。
4.如权利要求1所述的磁编码器,其特征在于,还包括:单片机,所述单片机分别与所述第一磁场传感器和所述第二磁场传感器连接,以读取所述第一磁场传感器和所述第二磁场传感器读取的数据,并存储磁编码器的标定数值。
5.如权利要求1所述的磁编码器,其特征在于,所述第一磁场传感器和所述第二磁场传感器均包括两个由巨磁电阻组成的全桥电路,且两个全桥电路互相垂直。
6.如权利要求1所述的磁编码器,其特征在于,所述第一磁场传感器和所述第二磁场传感器均采用英飞凌TLE5012芯片。
7.一种机器人关节,其特征在于,包括如权利要求1~6中任一项所述的磁编码器、以及与所述磁编码器连接的电机编码器。
8.一种如权利要求1~6中任一项所述的磁编码器的标定方法,其特征在于,包括如下步骤:
S1:记录磁环固定部件相对磁场传感器固定部件旋转一个周期过程中,第一磁场传感器产生的一个周期信号的数据、第二磁场传感器产生的N个周期信号的数据、以及在第二磁场传感器产生的周期信号跳变时第一磁场传感器的所有读取数据(Index),其中,N为第二径向磁环中的磁极对数;
S2:将第一磁场传感器产生的一个周期信号的数据(α1)、第二磁场传感器产生的N个周期信号的数据(α2)以及所述所有读取数据(Index)进行数据融合,以获得新的编码器地址值(Add);
S3:读取与磁编码器连接的电机编码器的数据,对所述电机编码器的数据进行比例缩放,以获得第一缩放数值(δ);
S4:选择基地址,在所述基地址的基础上,以新的编码器地址值(Add)为偏移地址保存所述第一缩放数值(δ);
S5:判断磁编码器的每个地址是否都存储有对应的第一缩放数值,若无,则执行S2;反之,执行S6;
S6:磁编码器标定完成。
9.如权利要求8所述的磁编码器的标定方法,其特征在于,在S2中,包括如下步骤:
S21:根据所述在第二磁场传感器产生的周期信号跳变时第一磁场传感器的所有读取数据(Index)查找当前时刻第一磁场传感器的扇区(J);
S22:将所述第一磁场传感器产生的一个周期信号的数据(α1)和所述第二磁场传感器产生的N个周期信号的数据(α2)进行数据融合,以获得初始的新的编码器数值(M);
S23:舍去所述初始的新的编码器数值的跳动位数(T),作为最终的新的编码器数值(Add)。
10.如权利要求9所述的磁编码器的标定方法,其特征在于,在S22中,获得初始的新的编码器数值采用的计算公式如下:
M=J*2152
其中,M为初始的新的编码器数值,M∈[0,215*N);J为当前时刻第一磁场传感器的扇区,J∈[0,N-1];α2为第二磁场传感器产生的N个周期信号的数据。
11.如权利要求10所述的磁编码器的标定方法,其特征在于,所述最终的新的编码器地址值(Add)采用的计算公式如下:
Add=(215*J+α2)>>T;
其中,Add为最终的新的编码器地址值;J为当前时刻第一磁场传感器的扇区;>>T表示在二进制中左移T位,T为跳动位数。
12.如权利要求8所述的磁编码器的标定方法,其特征在于,在S3中,对所述电机编码器的数据进行比例缩放采用的计算公式如下:
其中,θ为电机端编码器的角度数值,θ∈[0,2πk],k为谐波减速器的速比;H为由电机端编码器的读数、第一磁场传感器产生的一个周期信号的数据(α1)和所述第二磁场传感器产生的N个周期信号的数据(α2)构建的数组长度。
CN201910539100.4A 2019-06-20 2019-06-20 磁编码器、机器人关节及磁编码器的标定方法 Pending CN110160560A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910539100.4A CN110160560A (zh) 2019-06-20 2019-06-20 磁编码器、机器人关节及磁编码器的标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910539100.4A CN110160560A (zh) 2019-06-20 2019-06-20 磁编码器、机器人关节及磁编码器的标定方法

Publications (1)

Publication Number Publication Date
CN110160560A true CN110160560A (zh) 2019-08-23

Family

ID=67626268

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910539100.4A Pending CN110160560A (zh) 2019-06-20 2019-06-20 磁编码器、机器人关节及磁编码器的标定方法

Country Status (1)

Country Link
CN (1) CN110160560A (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111156893A (zh) * 2019-12-27 2020-05-15 深圳市越疆科技有限公司 一种电机运行角度测量方法和系统、关节角度测量系统
CN112697175A (zh) * 2020-12-30 2021-04-23 武汉理工大学 一种侧轴式编码器系统及其标定方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009097896A (ja) * 2007-10-15 2009-05-07 Ntn Corp ドライブシャフトの軸トルク測定装置および測定方法
CN103640027A (zh) * 2013-05-20 2014-03-19 上海交通大学 空间承载型组件化机械臂关节及其组合
JP2015114209A (ja) * 2013-12-12 2015-06-22 セイコーエプソン株式会社 エンコーダー及び電気機械装置
CN106625594A (zh) * 2016-12-16 2017-05-10 南京熊猫电子股份有限公司 一种基于电磁编码器的机器人零位标定方法
CN109781150A (zh) * 2019-01-09 2019-05-21 福建睿能科技股份有限公司 一种磁编码器的控制方法、磁编码器及针织机器
CN209857924U (zh) * 2019-06-20 2019-12-27 上海岭先机器人科技股份有限公司 一种磁编码器及机器人关节

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009097896A (ja) * 2007-10-15 2009-05-07 Ntn Corp ドライブシャフトの軸トルク測定装置および測定方法
CN103640027A (zh) * 2013-05-20 2014-03-19 上海交通大学 空间承载型组件化机械臂关节及其组合
JP2015114209A (ja) * 2013-12-12 2015-06-22 セイコーエプソン株式会社 エンコーダー及び電気機械装置
CN106625594A (zh) * 2016-12-16 2017-05-10 南京熊猫电子股份有限公司 一种基于电磁编码器的机器人零位标定方法
CN109781150A (zh) * 2019-01-09 2019-05-21 福建睿能科技股份有限公司 一种磁编码器的控制方法、磁编码器及针织机器
CN209857924U (zh) * 2019-06-20 2019-12-27 上海岭先机器人科技股份有限公司 一种磁编码器及机器人关节

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111156893A (zh) * 2019-12-27 2020-05-15 深圳市越疆科技有限公司 一种电机运行角度测量方法和系统、关节角度测量系统
CN111156893B (zh) * 2019-12-27 2021-08-10 深圳市越疆科技有限公司 一种电机运行角度测量方法和系统、关节角度测量系统
CN112697175A (zh) * 2020-12-30 2021-04-23 武汉理工大学 一种侧轴式编码器系统及其标定方法

Similar Documents

Publication Publication Date Title
CN107404272B (zh) 永磁同步电机旋变零位初始角标定方法及标定系统
CN101924514B (zh) 一种旋转变压器初始位置信号自动校正方法
CN110160560A (zh) 磁编码器、机器人关节及磁编码器的标定方法
CN107650142B (zh) 一种应用于机械臂关节中的伺服驱动系统
CN101729002A (zh) 基于sopc的无位置传感器无刷直流电机远程监控系统
JPWO2013157279A1 (ja) 多回転エンコーダ
CN102185546A (zh) 大口径望远镜弧线电机驱动控制方法及其系统
CN108731707A (zh) 双增量式编码器测量绝对位置方法和装置
CN103326515A (zh) 双磁路多信号模式位置传感器及其检测方法
CN107797488B (zh) 一种位移控制系统及其控制方法、移动终端
CN104218728A (zh) 高度集成的机电作动器及其应用方法
CN207585910U (zh) 一种谐波减速机检测装置
CN110260894A (zh) 一种整体式机器人关节定位的绝对值编码器
CN210780430U (zh) 减速电机及包含其的机器人
CN102301570B (zh) 电气驱动装置
CN209857924U (zh) 一种磁编码器及机器人关节
CN207082973U (zh) 磁编码器、电机和电机系统
CN206611354U (zh) 一种磁性编码器及永磁电机
CN104494690A (zh) 一种汽车eps电机控制器
CN206211897U (zh) 交流伺服电机控制系统
CN106899240A (zh) 一种磁性编码器及永磁电机
Sang et al. The practical control technology design for AC servo motor based on STM32 micro-controller
CN207851254U (zh) 一种高效率伺服电机检测装置
CN105958864A (zh) 超声电机控制系统及其控制方法
CN104501791A (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