CN107765712A - 基于传感器数据融合的云台转角估计方法、控制器及系统 - Google Patents

基于传感器数据融合的云台转角估计方法、控制器及系统 Download PDF

Info

Publication number
CN107765712A
CN107765712A CN201710806218.XA CN201710806218A CN107765712A CN 107765712 A CN107765712 A CN 107765712A CN 201710806218 A CN201710806218 A CN 201710806218A CN 107765712 A CN107765712 A CN 107765712A
Authority
CN
China
Prior art keywords
data
output shaft
transmission mechanism
shaft angle
mechanism output
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.)
Granted
Application number
CN201710806218.XA
Other languages
English (en)
Other versions
CN107765712B (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.)
State Grid Intelligent Technology Co Ltd
Original Assignee
State Grid Corp of China SGCC
Electric Power Research Institute of State Grid Shandong Electric Power Co Ltd
Shandong Luneng Intelligence 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 State Grid Corp of China SGCC, Electric Power Research Institute of State Grid Shandong Electric Power Co Ltd, Shandong Luneng Intelligence Technology Co Ltd filed Critical State Grid Corp of China SGCC
Priority to CN201710806218.XA priority Critical patent/CN107765712B/zh
Publication of CN107765712A publication Critical patent/CN107765712A/zh
Application granted granted Critical
Publication of CN107765712B publication Critical patent/CN107765712B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction
    • G05D3/12—Control of position or direction using feedback

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position Or Direction (AREA)
  • Numerical Control (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Abstract

本发明公开了一种基于传感器数据融合的云台转角估计方法、控制器及系统。其中，该方包括利用云台的任一自由度上的角度传感器模块来实时采集云台电机轴角度数据和传动机构输出轴角度数据；利用云台电机轴角度数据的采集值来估计传动机构输出轴角度数据，得到传动机构输出轴角度数据的估计值；所述传动机构输出轴角度数据的估计值为云台电机轴角度数据的采集值与角度数据比例系数相乘后再依次与稳态偏差和系统误差的累加值；将传动机构输出轴角度数据的估计值与传动机构输出轴角度数据的采集值进行融合，得到传动机构输出轴角度的精确估计值。

Description

基于传感器数据融合的云台转角估计方法、控制器及系统
技术领域
本发明属于云台控制领域，尤其涉及一种基于传感器数据融合的云台转角估计方法、控制器及系统。
背景技术
云台是一种可以搭载摄像机且能够在水平和垂直方向转动的承载设备，在摄影、安防、机器人等领域应用广泛。目前常用的电控云台通常具备水平和垂直两个自由度，云台控制器依据各自由度上安装的角度传感器控制云台电机旋转，实现对云台姿态的控制，进而完成对特定区域图像、视频等信息的连续或定点采集。依据角度传感器安装位置不同，现有电控云台通常有以下两种类型：
(1)仅在云台电机轴或传动机构输入轴安装角度传感器的云台
这类云台通常可以实现对云台输出轴转角微小增量的精确控制，尤其是当角度传感器安装于电机轴时，可以进一步实现对云台电机转速的闭环控制，有效克服传动机构运动过程中摩擦阻力导致各自由度转速不均匀现象，然而该类云台也存在易受传动机构机械回差影响，导致云台重复定位精度较差的问题。
(2)仅在传动机构输出轴安装角度传感器的云台
这类云台由于角度传感器可精确反应云台各自由度输出轴转角，因此具有良好的重复定位精度，然而由于各自由度云台电机转动过程中其转速无法实现闭环控制，传动机构摩擦阻力的不均匀会导致云台转动过程中转速出现波动，同时也难以实现对云台输出轴转角微小增量的精确控制。
发明内容
为了解决现有技术的不足，本发明提供了一种基于传感器数据融合的云台转角估计方法，其通过对云台电机轴和传动机构输出轴安装的角度传感器数据进行融合处理，从而为云台姿态控制提供更加准确可靠的输出转角数据。
本发明实施例第一方面提供了一种基于传感器数据融合的云台转角估计方法，具体步骤包括：
步骤1：利用云台的任一自由度上的角度传感器模块来实时采集云台电机轴角度数据和传动机构输出轴角度数据；
步骤2：利用云台电机轴角度数据的采集值来估计传动机构输出轴角度数据，得到传动机构输出轴角度数据的估计值；所述传动机构输出轴角度数据的估计值为云台电机轴角度数据的采集值与角度数据比例系数相乘后再依次与稳态偏差和系统误差的累加值；
步骤3：将传动机构输出轴角度数据的估计值与传动机构输出轴角度数据的采集值进行融合，得到传动机构输出轴角度的精确估计值；所述传动机构输出轴角度的精确估计值等于传动机构输出轴角度数据的采集值与估计值两者之间偏差与数据融合系数相乘后再与传动机构输出轴角度数据的估计值的累加值。
结合本发明实施例的第一方面，本发明实施例的第一方面的第一种实施方式中，在所述步骤1中，角度传感器模块包括云台电机轴角度传感器和传动机构输出轴角度传感器，用来分别实时采集云台电机轴角度数据和传动机构输出轴角度数据。
本实施例利用云台电机轴角度传感器和传动机构输出轴角度传感器这两种角度传感器来分别实时采集云台电机轴角度数据和传动机构输出轴角度数据，能够同时异步工作，而且采集的数据互不干扰。
结合本发明实施例的第一方面，本发明实施例的第一方面的第二种实施方式中，在所述步骤2中，角度数据比例系数、稳态偏差和系统误差是通过对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定而获得的。
本发明的该实施例通过实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定，可以更加有效获取云台各自由度运动范围内传动机构摩擦阻力和机械回差对输出转角的影响程度，从而进一步保证云台姿态控制的精度。
结合本发明的本发明实施例的第一方面的第二种实施方式中，对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定的过程包括：
步骤2.1：在云台电机旋转的同时，连续同步采集m组云台电机轴角度数据和传动机构输出轴角度数据；
步骤2.2：将采集得到的数据，依据云台输出轴转动范围等间隔分为n段，同时保证每段中至少有三组数据，之后利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差；
步骤2.3：根据角度数据比例系数和稳态偏差及其对应的数据段，确定线性关系之间的偏差即可得到系统误差；其中，m和n均为大于或等于1的正整数。
在本实施例方式中，利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差可以保证标定结果与原始数据间的均方误差最小。
除了最小二乘算法之外，也可以采用其他现有的算法来求得每段数据的角度数据比例系数和稳态偏差。
结合本发明实施例的第一方面，本发明实施例的第一方面的第三种实施方式中，所述步骤3中的数据融合系数的分子为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加值；数据融合系数的分母为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加后，再与传动机构输出轴角度传感器量化误差方差相累加。
该实施方式中，充分利用云台电机轴和传动机构输出轴安装的角度器输出数据，通过对角度传感器的融合处理，实现云台输出转角的准确估计，从而为云台姿态控制提供更加准确的转角数据。
本发明实施例第二方面提供了一种基于传感器数据融合的云台转角估计控制器。
基于传感器数据融合的云台转角估计控制器，包括：
角度数据获取模块，其用于接收云台的任一自由度上的角度传感器模块实时采集的云台电机轴角度数据和传动机构输出轴角度数据；
传动机构输出轴角度数据估计模块，其用于利用云台电机轴角度数据的采集值来估计传动机构输出轴角度数据，得到传动机构输出轴角度数据的估计值；所述传动机构输出轴角度数据的估计值为云台电机轴角度数据的采集值与角度数据比例系数相乘后再依次与稳态偏差和系统误差的累加值；
数据融合模块，其用于将传动机构输出轴角度数据的估计值与传动机构输出轴角度数据的采集值进行融合，得到传动机构输出轴角度的精确估计值；所述传动机构输出轴角度的精确估计值等于传动机构输出轴角度数据的采集值与估计值两者之间偏差与数据融合系数相乘后再与传动机构输出轴角度数据的估计值的累加值；其中，传动机构输出轴角度传感器量化误差方差由误差传递关系得到。
结合本发明实施例的第二方面，本发明实施例的第二方面的第一种实施方式中，在所述传动机构输出轴角度数据估计模块中，角度数据比例系数、稳态偏差和系统误差是通过对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定而获得的。
本发明的该实施例通过实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定，可以更加有效获取云台各自由度运动范围内传动机构摩擦阻力和机械回差对输出转角的影响程度，从而进一步保证云台姿态控制的精度。
结合本发明实施例的第二方面，本发明实施例的第二方面的第二种实施方式中，所述传动机构输出轴角度数据估计模块，还包括：
连续同步采集数据接收模块，其用于在云台电机旋转的同时，接收连续同步采集的m组云台电机轴角度数据和传动机构输出轴角度数据；
数据分段模块，其用于将采集得到的数据，依据云台输出轴转动范围等间隔分为n段，同时保证每段中至少有三组数据，之后利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差；
系统误差求取模块，其用于根据角度数据比例系数和稳态偏差及其对应的数据段，确定线性关系之间的偏差即可得到系统误差；其中，m和n均为大于或等于1的正整数。
在本实施例方式中，利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差可以保证标定结果与原始数据间的均方误差最小。
除了最小二乘算法之外，也可以采用其他现有的算法来求得每段数据的角度数据比例系数和稳态偏差。
结合本发明实施例的第二方面的第二种实施方式中，所述数据融合模块中的数据融合系数的分子为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加值；数据融合系数的分母为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加后，再与传动机构输出轴角度传感器量化误差方差相累加；其中，传动机构输出轴角度传感器量化误差方差由误差传递关系得到。
该实施方式中，充分利用云台电机轴和传动机构输出轴安装的角度器输出数据，通过对角度传感器的融合处理，实现云台输出转角的准确估计，从而为云台姿态控制提供更加准确的转角数据。
本发明实施例第三方面提供了一种基于传感器数据融合的云台转角估计系统。
一种基于传感器数据融合的云台转角估计系统，包括上述所述的云台转角估计控制器。
与现有技术相比，本发明的有益效果是：
(1)本发明充分利用云台电机轴和传动机构输出轴安装的角度器输出数据，通过对角度传感器的融合处理，实现云台输出转角的准确估计，从而为云台姿态控制提供更加准确的转角数据。
(2)本发明通过实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定，可以更加有效获取云台各自由度运动范围内传动机构摩擦阻力和机械回差对输出转角的影响程度，从而进一步保证云台姿态控制的精度。
附图说明
构成本申请的一部分的说明书附图用来提供对本申请的进一步理解，本申请的示意性实施例及其说明用于解释本申请，并不构成对本申请的不当限定。
图1是本发明的基于传感器数据融合的云台转角估计方法原理图。
图2是本发明的分段标定的过程示意图。
图3是本发明实施例的基于传感器数据融合的云台转角估计控制器结构示意图。
图4是传动机构输出轴角度数据估计模块结构示意图。
具体实施方式
应该指出，以下详细说明都是例示性的，旨在对本申请提供进一步的说明。除非另有指明，本文使用的所有技术和科学术语具有与本申请所属技术领域的普通技术人员通常理解的相同含义。
需要注意的是，这里所使用的术语仅是为了描述具体实施方式，而非意图限制根据本申请的示例性实施方式。如在这里所使用的，除非上下文另外明确指出，否则单数形式也意图包括复数形式，此外，还应当理解的是，当在本说明书中使用术语“包含”和/或“包括”时，其指明存在特征、步骤、操作、器件、组件和/或它们的组合。
图1是本发明的基于传感器数据融合的云台转角估计方法原理图。
如图1所示，本发明实施例提供的一种基于传感器数据融合的云台转角估计方法，具体步骤包括：步骤1～步骤3。
步骤1：利用云台的任一自由度上的角度传感器模块来实时采集云台电机轴角度数据和传动机构输出轴角度数据；
在所述步骤1中，角度传感器模块包括云台电机轴角度传感器和传动机构输出轴角度传感器，用来分别实时采集云台电机轴角度数据和传动机构输出轴角度数据。
例如：云台控制系统同步采集当前时刻对应自由度所有角度传感器输出数据，假设k(k为等于或等于1的正整数)时刻采集的云台电机轴角度传感器输出数据为传动机构输出轴角度传感器输出数据为其中，云台电机轴角度传感器和传动机构输出轴角度传感器输出数据的小标i表示后续分段标定中的索引号。
本实施例利用云台电机轴角度传感器和传动机构输出轴角度传感器这两种角度传感器来分别实时采集云台电机轴角度数据和传动机构输出轴角度数据，能够同时异步工作，而且采集的数据互不干扰。
步骤2：利用云台电机轴角度数据的采集值来估计传动机构输出轴角度数据，得到传动机构输出轴角度数据的估计值；所述传动机构输出轴角度数据的估计值为云台电机轴角度数据的采集值与角度数据比例系数相乘后再依次与稳态偏差和系统误差的累加值。
在所述步骤2中，角度数据比例系数、稳态偏差和系统误差是通过对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定而获得的。
具体地，利用k时刻云台电机轴角度数据估计传动机构输出轴角度传感器输出两者之间的关系可由以下公式表示：
上式中：ai、bi和εi由预先执行的角度传感器分段标定过程得到，分别代表了角度数据比例系数、稳态偏差和系统误差；n表示标定分段数。
本发明的该实施例通过实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定，可以更加有效获取云台各自由度运动范围内传动机构摩擦阻力和机械回差对输出转角的影响程度，从而进一步保证云台姿态控制的精度。
其中，如图2所示，对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定的过程包括：
步骤2.1：在云台电机旋转的同时，连续同步采集m组云台电机轴角度数据和传动机构输出轴角度数据；如：(θ1,j,θ2,j)，j＝1,2,…m；
步骤2.2：将采集得到的数据，依据云台输出轴转动范围等间隔分为n段，同时保证每段中至少有三组数据，之后利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差；
步骤2.3：根据角度数据比例系数和稳态偏差及其对应的数据段，确定线性关系之间的偏差即可得到系统误差；其中，m和n均为大于或等于1的正整数。
在本实施例方式中，利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差可以保证标定结果与原始数据间的均方误差最小。
除了最小二乘算法之外，也可以采用其他现有的算法来求得每段数据的角度数据比例系数和稳态偏差。
步骤3：将传动机构输出轴角度数据的估计值与传动机构输出轴角度数据的采集值进行融合，得到传动机构输出轴角度的精确估计值；所述传动机构输出轴角度的精确估计值等于传动机构输出轴角度数据的采集值与估计值两者之间偏差与数据融合系数相乘后再与传动机构输出轴角度数据的估计值的累加值。
具体地，所述步骤3中的数据融合系数的分子为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加值；数据融合系数的分母为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加后，再与传动机构输出轴角度传感器量化误差方差相累加；其中，传动机构输出轴角度传感器量化误差方差由误差传递关系得到。
具体地，利用下述公式将估计得到的传动机构输出轴角度与实际采集到的角度传感器数据进行融合，即可得到传动机构输出轴角度的精确估计值具体为：
上式中，R为传动机构输出轴角度传感器量化误差方差，而Pk-1则为k-1时刻传动机构输出轴角度方差，利用误差传递关系可得k时刻传动机构输出轴角度估计值方差Pk为：
该实施方式中，充分利用云台电机轴和传动机构输出轴安装的角度器输出数据，通过对角度传感器的融合处理，实现云台输出转角的准确估计，从而为云台姿态控制提供更加准确的转角数据。
本发明充分利用云台电机轴和传动机构输出轴安装的角度器输出数据，通过对角度传感器的融合处理，实现云台输出转角的准确估计，从而为云台姿态控制提供更加准确的转角数据。
图3是本发明实施例的基于传感器数据融合的云台转角估计控制器结构示意图。
如图3所示，基于传感器数据融合的云台转角估计控制器，包括：
(1)角度数据获取模块，其用于接收云台的任一自由度上的角度传感器模块实时采集的云台电机轴角度数据和传动机构输出轴角度数据；
其中，角度传感器模块包括云台电机轴角度传感器和传动机构输出轴角度传感器，用来分别实时采集云台电机轴角度数据和传动机构输出轴角度数据。
例如：云台控制系统同步采集当前时刻对应自由度所有角度传感器输出数据，假设k(k为等于或等于1的正整数)时刻采集的云台电机轴角度传感器输出数据为传动机构输出轴角度传感器输出数据为其中，云台电机轴角度传感器和传动机构输出轴角度传感器输出数据的小标i表示后续分段标定中的索引号。
本实施例利用云台电机轴角度传感器和传动机构输出轴角度传感器这两种角度传感器来分别实时采集云台电机轴角度数据和传动机构输出轴角度数据，能够同时异步工作，而且采集的数据互不干扰。
(2)传动机构输出轴角度数据估计模块，其用于利用云台电机轴角度数据的采集值来估计传动机构输出轴角度数据，得到传动机构输出轴角度数据的估计值；所述传动机构输出轴角度数据的估计值为云台电机轴角度数据的采集值与角度数据比例系数相乘后再依次与稳态偏差和系统误差的累加值；
在所述传动机构输出轴角度数据估计模块中，角度数据比例系数、稳态偏差和系统误差是通过对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定而获得的。
具体地，利用k时刻云台电机轴角度数据估计传动机构输出轴角度传感器输出两者之间的关系可由以下公式表示：
上式中：ai、bi和εi由预先执行的角度传感器分段标定过程得到，分别代表了角度数据比例系数、稳态偏差和系统误差；n表示标定分段数。
本发明的该实施例通过实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定，可以更加有效获取云台各自由度运动范围内传动机构摩擦阻力和机械回差对输出转角的影响程度，从而进一步保证云台姿态控制的精度。
如图4所示，所述传动机构输出轴角度数据估计模块，还包括：
(2.1)连续同步采集数据接收模块，其用于在云台电机旋转的同时，接收连续同步采集的m组云台电机轴角度数据和传动机构输出轴角度数据；如：(θ1,j,θ2,j)，j＝1,2,…m；
(2.2)数据分段模块，其用于将采集得到的数据，依据云台输出轴转动范围等间隔分为n段，同时保证每段中至少有三组数据，之后利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差；
(2.3)系统误差求取模块，其用于根据角度数据比例系数和稳态偏差及其对应的数据段，确定线性关系之间的偏差即可得到系统误差；其中，m和n均为大于或等于1的正整数。
在本实施例方式中，利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差可以保证标定结果与原始数据间的均方误差最小。
除了最小二乘算法之外，也可以采用其他现有的算法来求得每段数据的角度数据比例系数和稳态偏差。
(3)数据融合模块，其用于将传动机构输出轴角度数据的估计值与传动机构输出轴角度数据的采集值进行融合，得到传动机构输出轴角度的精确估计值；所述传动机构输出轴角度的精确估计值等于传动机构输出轴角度数据的采集值与估计值两者之间偏差与数据融合系数相乘后再与传动机构输出轴角度数据的估计值的累加值。
其中，所述数据融合模块中的数据融合系数的分子为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加值；数据融合系数的分母为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加后，再与传动机构输出轴角度传感器量化误差方差相累加；其中，传动机构输出轴角度传感器量化误差方差由误差传递关系得到。
具体地，利用下述公式将估计得到的传动机构输出轴角度与实际采集到的角度传感器数据进行融合，即可得到传动机构输出轴角度的精确估计值具体为：
上式中，R为传动机构输出轴角度传感器量化误差方差，而Pk-1则为k-1时刻传动机构输出轴角度方差，利用误差传递关系可得k时刻传动机构输出轴角度估计值方差Pk为：
该实施方式中，充分利用云台电机轴和传动机构输出轴安装的角度器输出数据，通过对角度传感器的融合处理，实现云台输出转角的准确估计，从而为云台姿态控制提供更加准确的转角数据。
本发明实施例还提供了一种基于传感器数据融合的云台转角估计系统。
本发明的基于传感器数据融合的云台转角估计系统，包括如图3所示的云台转角估计控制器。
上述虽然结合附图对本发明的具体实施方式进行了描述，但并非对本发明保护范围的限制，所属领域技术人员应该明白，在本发明的技术方案的基础上，本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。

Claims (10)

1.一种基于传感器数据融合的云台转角估计方法，其特征在于，包括：
步骤1：利用云台的任一自由度上的角度传感器模块来实时采集云台电机轴角度数据和传动机构输出轴角度数据；
步骤2：利用云台电机轴角度数据的采集值来估计传动机构输出轴角度数据，得到传动机构输出轴角度数据的估计值；所述传动机构输出轴角度数据的估计值为云台电机轴角度数据的采集值与角度数据比例系数相乘后再依次与稳态偏差和系统误差的累加值；
步骤3：将传动机构输出轴角度数据的估计值与传动机构输出轴角度数据的采集值进行融合，得到传动机构输出轴角度的精确估计值；所述传动机构输出轴角度的精确估计值等于传动机构输出轴角度数据的采集值与估计值两者之间偏差与数据融合系数相乘后再与传动机构输出轴角度数据的估计值的累加值。
2.如权利要求1所述的一种基于传感器数据融合的云台转角估计方法，其特征在于，在所述步骤1中，角度传感器模块包括云台电机轴角度传感器和传动机构输出轴角度传感器，用来分别实时采集云台电机轴角度数据和传动机构输出轴角度数据。
3.如权利要求1所述的一种基于传感器数据融合的云台转角估计方法，其特征在于，在所述步骤2中，角度数据比例系数、稳态偏差和系统误差是通过对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定而获得的。
4.如权利要求3所述的一种基于传感器数据融合的云台转角估计方法，其特征在于，对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定的过程包括：
步骤2.1：在云台电机旋转的同时，连续同步采集m组云台电机轴角度数据和传动机构输出轴角度数据；
步骤2.2：将采集得到的数据，依据云台输出轴转动范围等间隔分为n段，同时保证每段中至少有三组数据，之后利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差；
步骤2.3：根据角度数据比例系数和稳态偏差及其对应的数据段，确定线性关系之间的偏差即可得到系统误差；其中，m和n均为大于或等于1的正整数。
5.如权利要求1所述的一种基于传感器数据融合的云台转角估计方法，其特征在于，所述步骤3中的数据融合系数的分子为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加值；数据融合系数的分母为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加后，再与传动机构输出轴角度传感器量化误差方差相累加；其中，传动机构输出轴角度传感器量化误差方差由误差传递关系得到。
6.一种基于传感器数据融合的云台转角估计控制器，其特征在于，包括：
角度数据获取模块，其用于接收云台的任一自由度上的角度传感器模块实时采集的云台电机轴角度数据和传动机构输出轴角度数据；
传动机构输出轴角度数据估计模块，其用于利用云台电机轴角度数据的采集值来估计传动机构输出轴角度数据，得到传动机构输出轴角度数据的估计值；所述传动机构输出轴角度数据的估计值为云台电机轴角度数据的采集值与角度数据比例系数相乘后再依次与稳态偏差和系统误差的累加值；
数据融合模块，其用于将传动机构输出轴角度数据的估计值与传动机构输出轴角度数据的采集值进行融合，得到传动机构输出轴角度的精确估计值；所述传动机构输出轴角度的精确估计值等于传动机构输出轴角度数据的采集值与估计值两者之间偏差与数据融合系数相乘后再与传动机构输出轴角度数据的估计值的累加值。
7.如权利要求6所述的一种基于传感器数据融合的云台转角估计控制器，其特征在于，在所述传动机构输出轴角度数据估计模块中，角度数据比例系数、稳态偏差和系统误差是通过对实时采集的云台电机轴角度数据和传动机构输出轴角度数据进行分段标定而获得的。
8.如权利要求7所述的一种基于传感器数据融合的云台转角估计控制器，其特征在于，所述传动机构输出轴角度数据估计模块，还包括：
连续同步采集数据接收模块，其用于在云台电机旋转的同时，接收连续同步采集的m组云台电机轴角度数据和传动机构输出轴角度数据；
数据分段模块，其用于将采集得到的数据，依据云台输出轴转动范围等间隔分为n段，同时保证每段中至少有三组数据，之后利用最小二乘算法即可求得每段数据的角度数据比例系数和稳态偏差；
系统误差求取模块，其用于根据角度数据比例系数和稳态偏差及其对应的数据段，确定线性关系之间的偏差即可得到系统误差；其中，m和n均为大于或等于1的正整数。
9.如权利要求6所述的一种基于传感器数据融合的云台转角估计控制器，其特征在于，所述数据融合模块中的数据融合系数的分子为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加值；数据融合系数的分母为角度数据比例系数的平方值与传动机构输出轴角度估计值方差相乘后与系统误差方差累加后，再与传动机构输出轴角度传感器量化误差方差相累加；其中，传动机构输出轴角度传感器量化误差方差由误差传递关系得到。
10.一种基于传感器数据融合的云台转角估计系统，其特征在于，包括如权利要求6-9中任一项所述的云台转角估计控制器。
CN201710806218.XA 2017-09-08 2017-09-08 基于传感器数据融合的云台转角估计方法、控制器及系统 Active CN107765712B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710806218.XA CN107765712B (zh) 2017-09-08 2017-09-08 基于传感器数据融合的云台转角估计方法、控制器及系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710806218.XA CN107765712B (zh) 2017-09-08 2017-09-08 基于传感器数据融合的云台转角估计方法、控制器及系统

Publications (2)

Publication Number Publication Date
CN107765712A true CN107765712A (zh) 2018-03-06
CN107765712B CN107765712B (zh) 2020-10-16

Family

ID=61265593

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710806218.XA Active CN107765712B (zh) 2017-09-08 2017-09-08 基于传感器数据融合的云台转角估计方法、控制器及系统

Country Status (1)

Country Link
CN (1) CN107765712B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110187721A (zh) * 2019-05-05 2019-08-30 湖北久之洋红外系统股份有限公司 一种千分度精密云台运动控制装置及方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009044812A (ja) * 2007-08-07 2009-02-26 Sumitomo Heavy Ind Ltd 位置又は速度制御装置
JP2012216145A (ja) * 2011-04-01 2012-11-08 Nsk Ltd アクチュエータ、モータ制御システム、及びモータ制御方法
CN105352535A (zh) * 2015-09-29 2016-02-24 河海大学 一种基于多传感器数据融合的测量方法
CN106953553A (zh) * 2017-03-12 2017-07-14 纳恩博（北京）科技有限公司 一种云台、及云台电机的控制方法和装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2009044812A (ja) * 2007-08-07 2009-02-26 Sumitomo Heavy Ind Ltd 位置又は速度制御装置
JP2012216145A (ja) * 2011-04-01 2012-11-08 Nsk Ltd アクチュエータ、モータ制御システム、及びモータ制御方法
CN105352535A (zh) * 2015-09-29 2016-02-24 河海大学 一种基于多传感器数据融合的测量方法
CN106953553A (zh) * 2017-03-12 2017-07-14 纳恩博（北京）科技有限公司 一种云台、及云台电机的控制方法和装置

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
袁古兴: "特种机电传动机构综合性能实验台测控系统设计", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110187721A (zh) * 2019-05-05 2019-08-30 湖北久之洋红外系统股份有限公司 一种千分度精密云台运动控制装置及方法

Also Published As

Publication number Publication date
CN107765712B (zh) 2020-10-16

Similar Documents

Publication Publication Date Title
US20190195631A1 (en) Positioning method, positioning device, and robot
CN107941217B (zh) 一种机器人定位方法、电子设备、存储介质、装置
CN110879400A (zh) 激光雷达与imu融合定位的方法、设备及存储介质
CN108733039A (zh) 一种机器人室内导航定位的方法与装置
CN110849387B (zh) 一种传感器参数标定方法和装置
CN109446892A (zh) 基于深度神经网络的人眼注意力定位方法及系统
CN112643665B (zh) 一种绝对位姿传感器安装误差的标定方法和装置
CN107179091A (zh) 一种agv行走视觉定位误差修正方法
CN106370178A (zh) 移动终端设备的姿态测量方法及装置
CN115060268B (zh) 一种机房融合定位方法、系统、设备及存储介质
CN110033492A (zh) 摄像机标定方法及终端
CN108307174A (zh) 一种深度图像传感器精度提升方法和系统
CN113910756B (zh) 基于丝印对位的补偿控制方法、装置、设备和介质
CN114413791B (zh) 一种舵轮式叉车舵轮零偏角的检测方法、系统及装置
CN107765712A (zh) 基于传感器数据融合的云台转角估计方法、控制器及系统
CN109866217A (zh) 机器人里程定位方法、装置、终端设备及计算机存储介质
WO2022237375A1 (zh) 用于定位装置和里程计的标定方法、程序产品和标定装置
CN115585805A (zh) 车辆定位方法、定位装置、定位系统以及车辆
CN111380562A (zh) 一种双轮差速机器人里程计参数的校准方法及装置
CN115560744A (zh) 机器人以及基于多传感器的三维建图方法、存储介质
CN111781931B (zh) 机器人轮长和轮距的自动标定方法、装置、设备和介质
CN113050622B (zh) 无人压路机路径跟踪控制方法及系统、服务器及介质
CN114911225B (zh) 一种双轮差速机器人打滑判定方法及装置
CN112394190B (zh) 角速度的确定方法及装置、存储介质、电子装置
WO2022193318A1 (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
CB02 Change of applicant information

Address after: Ji'nan City, Shandong Province Wang Yue Road 250003 No. 2000

Applicant after: Electric Power Research Institute of State Grid Shandong Electric Power Company

Applicant after: National Network Intelligent Technology Co., Ltd.

Applicant after: State Grid Corporation of China

Address before: Ji'nan City, Shandong Province Wang Yue Road 250003 No. 2000

Applicant before: Electric Power Research Institute of State Grid Shandong Electric Power Company

Applicant before: Shandong Luneng Intelligent Technology Co., Ltd.

Applicant before: State Grid Corporation of China

CB02 Change of applicant information
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20201030

Address after: 250101 Electric Power Intelligent Robot Production Project 101 in Jinan City, Shandong Province, South of Feiyue Avenue and East of No. 26 Road (ICT Industrial Park)

Patentee after: National Network Intelligent Technology Co.,Ltd.

Address before: Ji'nan City, Shandong Province Wang Yue Road 250003 No. 2000

Patentee before: ELECTRIC POWER RESEARCH INSTITUTE OF STATE GRID SHANDONG ELECTRIC POWER Co.

Patentee before: National Network Intelligent Technology Co.,Ltd.

Patentee before: STATE GRID CORPORATION OF CHINA

TR01 Transfer of patent right