一种无编码器伺服电机控制器的制作方法

本发明涉及一种无编码器伺服电机控制器，属于电机控制技术领域。

背景技术：

关节组件是构成机器人尤其是机械臂的重要核心部件。在机器人关节组件主要依靠电机控制器控制电机运动来实现关节的运动。

目前，电机控制器通常使用编码器来检测电机转子的位置和转速。然而，编码器的机械加工和安装精度的要求很高，会导致机器人关节组件的集成化难度高，集成效率较低的问题。

技术实现要素：

本发明的目的在于提供一种无编码器伺服电机控制器。为达到上述目的，本发明提供如下技术方案：一种无编码器伺服电机控制器，用于驱动三相绕组的同步伺服电机，所述同步伺服电机与所述无编码器伺服电机控制器安装于智能机器人的集成化关节组件中；所述无编码器伺服电机控制器包括：

用于供电的电源模块、电源输入端与所述电源模块相连的第一处理器和第二处理器、输出端与所述第二处理器的输入端相连的信号处理模块、输出端与所述信号处理模块的第一输入端相连的电流检测模块、输出端与所述信号处理模块的第二输入端相连的反电势检测模块、第一反馈端与所述电流检测模块的输入端相连且第二反馈端与所述反电势检测模块的输入端相连的三相功率逆变器、输入端与所述第二处理器的输出端相连的驱动模块；

所述第二处理器的输出端与所述第一处理器的输入端相连；

所述驱动模块的输出端与所述三相功率逆变器的输入端相连；

所述三相功率逆变器的输出端与所述同步伺服电机相连。

可选地，所述信号处理模块，用于对所述反电势检测模块输出的三个反电势进行整形，得到三个反电势过零脉冲。

可选地，所述第二处理器，用于对所述信号处理模块输出的三个反电势过零脉冲两两之间进行内插值处理，得到两组2倍频的脉冲信号；根据所述两组2倍频的脉冲信号计算所述同步伺服电机的数字化转角信号。

可选地，所述第二处理器，还用于将所述电流检测模块检测到的电流值发送至所述第一处理器；

所述第一处理器，用于基于磁场定向控制foc算法使用所述同步伺服电机的电机速度、所述第二处理器输出的数字化转角信号和电流值计算得到三相脉冲宽度调制波形；将所述三相脉冲宽度调制波形输出至所述驱动模块；

所述驱动模块，用于根据所述三相脉冲宽度调制波形驱动所述三相功率逆变器；

所述三相功率逆变器，用于根据所述驱动模块的驱动向所述同步伺服电机输入具有所述三相脉冲宽度调制波形的电流。

可选地，所述第一处理器与所述第二处理器为arm处理器。

可选地，所述驱动模块为绝缘栅双极型晶体管igbt驱动电路。

本发明的有益效果在于：通过在智能机器人的集成化关节组件中设置无编码器伺服电机控制器来驱动同步伺服电机，在该无编码器伺服电机控制器中设置用于供电的电源模块、第一处理器、第二处理器、信号处理模块、电流检测模块、反电势检测模块、三相功率逆变器和驱动模块；可以解决使用具有编码器的电机控制器来驱动同步伺服电机时，使用编码器来检测转子的位置和转速，而编码器的机械加工和安装精度要求较高导致智能机器人集成关节组件的集成效率较低的问题；可以实现使用无编码器伺服电机控制器驱动智能机器人的集成化关节组件中的电机；可以提高关节组件的集成度和可靠性。

上述说明仅是本发明技术方案的概述，为了能够更清楚了解本发明的技术手段，并可依照说明书的内容予以实施，以下以本发明的较佳实施例并配合附图详细说明如后。

附图说明

图1是本申请一个实施例提供的无编码器伺服电机控制器的电路结构示意图；

图2是本申请一个实施例提供的无编码器伺服电机控制器的数字化转角信号计算原理示意图。

具体实施方式

下面结合附图和实施例，对本发明的具体实施方式作进一步详细描述。以下实施例用于说明本发明，但不用来限制本发明的范围。

首先，对本申请涉及的若干名词进行介绍。

反电动势：是指有反抗电流发生改变的趋势而产生电动势，其本质上属于感应电动势。反电动势一般出现在电磁线圈中，如继电器线圈、电磁阀、接触器线圈、电动机、电感等。

磁场定向控制(filedorientedcontrol，foc)：是采用数学方法实现三相马达的力矩与励磁的解耦控制。foc算法主要是对电机的控制电流进行矢量分解，变成励磁电流和交轴电流，励磁电流主要是产生励磁，控制的是磁场的强度，而交轴电流是用来控制力矩。

foc算法的输入为电机的位置信息(比如：为电机的数字化转角信号)、两相采样电流值和电机速度；输出为三相脉冲宽度调制(pulsewidthmodulation，pwm)波形。foc算法在本质上是一些线性代数中的矩阵变换。首先采样得到电机的ia，ib两相电流信息；基尔霍夫电流定律，同一个节点流入电流值与流出电流相等，因此可以根据ia和ib计算出ic；之后通过clark变换，可以将三相定子坐标系(三个轴互为120°，ia，ib，ic)转化为两相的定子直角坐标系(iα，iβ)；通过park变换将两相定子坐标系变换到两相转子坐标系(iq，id)。在变换过程中需要使用转子的位置信息，该位置信息为电机的数字化转角信号，其中id为励磁电流分量，iq为转矩电流分量，可以建立两个pi调节器分别对两个电流分量进行调节。通常情况下，励磁电流分量为0，而转矩电流分量为给定值或者是经过速度环输出值。速度环可以根据速度反馈来控制该电流的大小，之后转矩电流的pi调节器输出vq，励磁电流的pi调节器输出vd。之后通过反park变换再将其转化为两相定子坐标系(vα，vβ)，通过clark逆变换得到需要施加在三相定子上的电压值(va，vb，vc)然后通过pwm波调制技术得到三相脉冲宽度调制波形，将该三相脉冲宽度调制波形输出到三相功率逆变器。

绝缘栅双极型晶体管(insulatedgatebipolartransistor，igbt)是由双极型三极管(bipolarjunctiontransistor，bjt)和绝缘栅型场效应管(metaloxidesemiconductor，mos)组成的复合全控型电压驱动式功率半导体器件，兼有mosfet的高输入阻抗和gtr的低导通压降两方面的优点。gtr饱和压降低，载流密度大，但驱动电流较大；mosfet驱动功率很小，开关速度快，但导通压降大，载流密度小。igbt综合了以上两种器件的优点，驱动功率小而饱和压降低。非常适合应用于直流电压为600v及以上的变流系统如交流电机、变频器、开关电源、照明电路、牵引传动等领域。

通俗来讲：igbt是一种大功率的电力电子器件，是一个非通即断的开关，igbt没有放大电压的功能，导通时可以视为导线，断开时视为开路。三大特点就是高压、大电流、高速。

图1是本申请一个实施例提供的无编码器伺服电机控制器的电路结构示意图，如图1所示，用于驱动三相绕组的同步伺服电机，同步伺服电机与无编码器伺服电机控制器安装于智能机器人的集成化关节组件中。无编码器伺服电机控制器包括：用于供电的电源模块110、电源输入端与电源模块110相连的第一处理器120和第二处理器130、输出端与第二处理器130的输入端相连的信号处理模块140、输出端与信号处理模块140的第一输入端相连的电流检测模块150、输出端与信号处理模块140的第二输入端相连的反电势检测模块160、第一反馈端与电流检测模块150的输入端相连且第二反馈端与反电势检测模块160的输入端相连的三相功率逆变器170、输入端与第二处理器130的输出端相连的驱动模块180。第二处理器130的输出端与第一处理器120的输入端相连。驱动模块180的输出端与三相功率逆变器170的输入端相连。三相功率逆变器170的输出端与同步伺服电机相连。

可选地，第一处理器120与第二处理器130为arm处理器；驱动模块180为绝缘栅双极型晶体管igbt驱动电路。

可选地，三相功率逆变器170是由三个单相你变电路组合成的三相桥式逆变电路。在三相桥式逆变电路中，各管的导通次序同整流电路一样。各管的触发信号依次互差60°，在180°导通型的逆变电路中，任意瞬间都有三只管子导通，各管导通时间为180°，同一桥臂中上下两只管子轮流导通，称为互补管。在120°导通型逆变电路中，各管导通120°，任意瞬间只有不同相的两只管子导通，同一桥臂中的两只管子不是瞬时互补导通而是有60°的间隙时间，当某相中没有逆变管导通时，其感性电流经该相中的二极管流通。

其中，信号处理模块140，用于对反电势检测模块160输出的三个反电势进行整形，得到三个反电势过零脉冲。

第二处理器130，用于对信号处理模块140输出的三个反电势过零脉冲两两之间进行内插值处理，得到两组2倍频的脉冲信号；根据两组2倍频的脉冲信号计算同步伺服电机的数字化转角信号。

示意性地，假设信号处理模块140输出的a相反电势过零脉冲、b相反电势过零脉冲和c相反电势过零脉冲如图2所示，第二处理器130对a相反电势过零脉冲与b相反电势过零脉冲之间进行内插值处理，得到第一组2倍频的脉冲信号；对a相反电势过零脉冲与c相反电势过零脉冲之间进行内插值处理，得到第二组2倍频的脉冲信号；其中，a相反电势过零脉冲与b相反电势过零脉冲之间的相位差为θ0、插值处理得到的脉冲数为n0；a相反电势过零脉冲与c相反电势过零脉冲之间的相位差为θ1、插值处理得到的脉冲数为n1；则电机转子实际转过的角度θ＝θ1-θ0、实际转过的角度对应的脉冲数为n2；每个脉冲周期对应的脉冲数为n3；则同步伺服电机的数字化转角信号θ为：

第二处理器130，还用于将电流检测模块150检测到的电流值发送至第一处理器；第一处理器120，用于基于foc算法使用同步伺服电机的电机速度、第二处理器130输出的数字化转角信号和电流值计算得到三相脉冲宽度调制波形；将三相脉冲宽度调制波形输出至驱动模块180；驱动模块180，用于根据三相脉冲宽度调制波形驱动三相功率逆变器170；三相功率逆变器170，用于根据驱动模块的驱动向同步伺服电机输入具有三相脉冲宽度调制波形的电流。

综上所述，本实施例提供的无编码器伺服电机控制器，通过在智能机器人的集成化关节组件中设置无编码器伺服电机控制器来驱动同步伺服电机，在该无编码器伺服电机控制器中设置用于供电的电源模块、第一处理器、第二处理器、信号处理模块、电流检测模块、反电势检测模块、三相功率逆变器和驱动模块；可以解决使用具有编码器的电机控制器来驱动同步伺服电机时，使用编码器来检测转子的位置和转速，而编码器的机械加工和安装精度要求较高导致智能机器人集成关节组件的集成效率较低的问题；可以实现使用无编码器伺服电机控制器驱动智能机器人的集成化关节组件中的电机；可以提高关节组件的集成度和可靠性。

以上所述实施例的各技术特征可以进行任意的组合，为使描述简洁，未对上述实施例中的各个技术特征所有可能的组合都进行描述，然而，只要这些技术特征的组合不存在矛盾，都应当认为是本说明书记载的范围。

以上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。