专利名称：一种直流伺服驱动控制系统的制作方法
技术领域：
本发明涉及一种基于自抗扰控制器的直流伺服驱动控制系统。
背景技术：
某些应用场合的直流伺服驱动系统要求控制系统具有动态响应速度快、稳定精度高和抗负载及参数扰动能力强等特点，例如风电机组电动变桨伺服驱动系统。在伺服驱动系统中，执行电动机电枢绕组的电阻值和电感值易受温度影响，不同生产厂家提供的电机参数也存有差异，这些因素的影响会降低常规PID闭环控制系统性能。常规PID控制器虽能够满足稳态精度高、动态响应快的要求，但在抗负载及电机参数扰动能力方面较差。现有技术的伺服驱动控制系统的结构如图2所示，由数据采集电路、DSP中央处理器和PWM功率输出电路组成，其DSP中央处理器中包括两个PI控制器，其中一个是转速环PI控制器，另一个是电流环PI控制器。这样的控制系统结构能满足稳态精度高、动态响应快的要求，但对于被控对象参数扰动、负载波动等因素造成的控制系统效果变差方面，缺乏一定的抗扰动能力。中国专利CN201039069Y、CN102811015A和CN101499769A，以及《基于自抗扰控制器的直流双闭环调速系统》(徐晗，徐宇，刘德君.[J].化工技术，2004，06 (12):42-44)的主要思路是将自抗扰控制器直接或简化改造后应用于控制系统，具有响应速度快、抗扰动能力强等特点，控制对象大多为交流电机或励磁装置等，少数几篇涉及直流电机的文章也只停留于仿真研究阶段，较少涉及高性能要求的直流伺服驱动控制系统的实际应用。
发明内容
本发明的目的在于克服上述现有常规PID控制技术的不足，结合自抗扰控制器的优点，提供一种基于自抗扰控制器的直流伺服驱动控制系统。本发明利用自抗扰控制器对直流伺服驱动控制系统总扰动量，即外部负载扰动和内部参数扰动，进行实时估计并通过反馈进行补偿控制，可以减少外部扰动和内部扰动对控制系统性能的影响，获得快速、无超调、高精度、强鲁棒性的良好控制效果。本发明的技术方案如下:—种基于自抗扰控制器的直流伺服驱动控制系统，其特征在于该系统主要由数据采集电路、DSP中央处理器和PWM功率输出电路组成。所述的DSP中央处理器的输入端接收上位机(如PLC或计算机)传送的速度给定值和由外部传感器反馈的直流伺服电动机速度反馈值、电流反馈值，经DSP中央处理器处理后，输出至PWM功率输出电路，PWM功率输出电路的输出端连接至所述直流伺服驱动控制系统的控制对象直流伺服电动机。所述的数据采集电路的输入端连接外部传感器，如光电编码器、电流传感器等，光电编码器、电流传感器等外部传感器采集直流伺服电动机的数据，送入所述的数据采集电路。数据采集电路的输出端连接DSP中央处理器的输入端，外部传感器采集的直流伺服电动机的数据经由数据采集电路送入DSP中央处理器处理后，传送至PWM功率输出电路，由PWM功率输出电路输出控制信号控制直流伺服电动机。所述的数据采集电路主要包括信号预处理电路和Α/D转换模块。信号预处理电路包括开关量预处理电路与模拟量预处理电路，开关量预处理电路采用常规光电隔离电路，通过光电隔离器件与来自接触器、继电器等器件的外部开关量信号耦合连接，将开关量信号转换成数字信号输入DSP中央处理器。模拟量预处理电路将包括直流伺服电动机的电流和电压两种基本模拟量在内的输入信号预处理成Α/D转换模块能够接收的电信号。模拟量预处理电路连接Α/D转换模块，将预处理完的模拟信号经由Α/D模块转换成数字信号传送至DSP中央处理器。所述的DSP中央处理器采用的是TI公司生产的TMS320F28335型号芯片，该芯片具有运行速度快、运行稳定的特点，可以大大提高控制系统的响应速度。所述的DSP中央处理器包括二阶自抗扰控制器和PI控制器，二阶自抗扰控制器完成直流伺服驱动控制系统转速环的运算，PI控制器完成直流伺服驱动控制系统电流环的运算。所述的PWM功率输出电路由信号驱动放大电路和IGBT整流电路构成。由DSP中央处理器输出的PWM控制信号经信号驱动放大电路进行功率放大，输出给IGBT整流电路中的IGBT单元，控制相应IGBT单元中的IGBT的通断，从而控制直流伺服电动机的电枢电压。所述的二阶自抗扰控制器是由跟踪-微分器(TD)、扩张状态观测器(ESO)和非线性误差反馈控制律(NLSEF)三个部分直接连接构成的一种非线性控制器。跟踪-微分器(TD)用于安排过渡过程，跟踪所述的直流伺服驱动控制系统输入端的给定信号及其微分量。扩张状态观测器(ESO)用于观测所述的直流伺服驱动控制系统输出端的输出信号及其微分量，并估计所述的直流伺服驱动控制系统的总扰动量。将跟踪-微分器(TD)输出的输入信号及其微分量与扩张状态观测器(ESO)反馈的输出信号及其微分量分别做差运算，在非线性误差反馈控制律(NLSEF)中对上述两次做差运算分别得到的结果进行非线性组合控制。对非线性误差反馈控制律的输出量与扩张状态观测器反馈回来的总扰动量进行做差运算，并将此做差运算结果除以自抗扰控制器参数整定值b0作补偿控制，补偿后的控制信号由二阶自抗扰控制器的输出端连接至PI控制器的输入端，经PI控制器运算后的结果输出至PWM功率输出电路的输入端。所述的PI控制器采用带抗积分饱和的常规PI控制器构成，具有响应速度快、输出量限幅的特点。所述的二阶自抗扰控制器在DSP中央处理器中实现方法如下述；本发明直流伺服驱动控制系统读入上位机(如PLC或计算机)通信传输的转速给定值和外部传感器传送的转速反馈值；然后分别由跟踪-微分器(TD)做运算来跟踪转速给定值及其微分信号，由扩张状态观测器(ESO)做运算来跟踪转速反馈值及其微分信号，并估计出直流伺服驱动控制系统的总扰动量；最后对转速给定值与转速反馈值做差运算得到的结果和转速给定值与转速反馈值这两个信号的微分信号做差运算得到的结果进行非线性控制运算，并对总扰动量进行补偿控制，输出最终的控制量信号。针对二阶自抗扰控制器中非线性函数不易在DSP中央处理器中实现的难点，所述的二阶自抗扰控制器采用数据链表查表方法，该方法具有容易实现、DSP占用率低、执行效率高的特点。非线性函数的表达式为:
falie^a.S) = ^ ^δ >0
\e\" -sign(e)\^>d式中，e表示误差值，δ和α为自抗扰控制器参数。在参数δ和α整定完成之后，可以建立一个给定与反馈信号误差值err和误差绝对值的指数值| err | α的数据链表，通过查表来实现非线性函数的功能。误差的绝对值大于I时，可以通过取倒数的方法将其限制在区间(0，I)内，然后逐点查表计算。在相邻两点之间采取线性插值来提高精度，插值
运算按常规线性插值方法/(χ) = 处理，式中(Xl，Y1)和(x2，y2)是相邻两点的坐标值，
χ表示横坐标值，y表示纵坐标值。本发明将二阶自抗扰控制器应用于DSP中央处理器中直流伺服驱动控制系统转速环。考虑快速性要求，直流伺服驱动控制系统电流环采用PI控制器。首先由数据采集电路完成信号和数据采集工作；在05 中央处理器中，由二阶自抗扰控制器根据转速给定值和转速反馈值进行控制，可以对直流伺服驱动控制系统的总扰动量，即外部负载扰动和内部参数扰动进行实时估计，并通过反馈进行补偿控制，能够获得快速、无超调、高精度、强鲁棒性的良好控制效果。直流伺服驱动控制系统转速环的输出值作为电流环的给定，与电流反馈值做差运算并进行PI控制，最后输出控制量并生成PWM控制信号；PWM控制信号经PWM功率输出电路完成IGBT整流电路中的IGBT单元的驱动控制，实现对电动机电枢电压的控制，最终实现对直流伺服电动机的灵活控制目标。本发明的优越性在于:1.将自抗扰控制器应用于直流伺服驱动控制系统转速环控制，具有转速输出无超调、响应速度快、控制精度高、抗电机参数及负载扰动能力强的优点；2.采用数据链表查表的方法实现自抗扰控制器中非线性函数，解决了非线性函数在DSP数字处理器中不易实现的问题，提高了程序的执行效率；3.采用高速浮点型DSP控制芯片TMS320F28335，运行速度快、运行稳定，可以大大提高控制系统的响应速度，满足自抗扰控制器运算量大的特点；4.直流伺服驱动控制系统核心算法在于自抗扰控制器的DSP软件实现，不需要改变原有直流 伺服驱动控制系统的硬件结构。
图1本发明基于自抗扰控制器的直流伺服驱动控制系统框图；图2现有技术直流伺服驱动控制系统框图；图3 二阶自抗扰控制器结构框图；图4本发明二阶自抗扰控制器DSP算法流程图；图5本发明二阶自抗扰控制器数据链表查表方法流程图。
具体实施例方式以下结合附图和具体实施方式
进一步说明本发明。图1为本发明基于自抗扰控制器的直流伺服驱动控制系统。该系统主要由数据采集电路、DSP中央处理器和PWM功率输出电路组成。所述的基于自抗扰控制器的直流伺服驱动控制系统的DSP中央处理器的输入端接收上位机(如PLC或计算机)速度给定值和外部传感器反馈回来的直流伺服电动机速度反馈值、电流反馈值，经DSP中央处理器处理后，输出至PWM功率输出电路，PWM功率输出电路的输出端连接至所述直流伺服驱动控制系统的控制对象直流伺服电动机。所述的数据采集电路的输入端连接外部传感器，如光电编码器、电流传感器等，光电编码器、电流传感器等外部传感器采集直流伺服电动机的数据，送入所述的数据采集电路。数据采集电路的输出端连接DSP中央处理器的输入端，外部传感器采集的直流伺服电动机的数据经DSP中央处理器处理后，传送至PWM功率输出电路，PWM功率输出电路输出控制信号控制直流伺服电动机。所述的数据采集电路主要包括信号预处理电路和Α/D转换模块。信号预处理电路包括开关量预处理电路与模拟量的预处理电路，开关量预处理电路采用常规光电隔离电路，通过光电隔离器件与来自接触器、继电器等器件的外部开关量信号耦合连接，将开关量信号转换成数字信号输入DSP中央处理器。模拟量预处理电路将包括直流伺服电动机的电流和电压两种基本模拟量在内的输入信号预处理成Α/D转换模块能够接收的电信号。模拟量预处理电路连接Α/D转换模块，将预处理完的模拟信号经由Α/D模块转换成数字信号传送至DSP中央处理器。所述的DSP中央处理器采用的是TI公司生产的TMS320F28335型号芯片，该芯片具有运行速度快、运行稳定的特点，可以大大提高控制系统的响应速度。所述的DSP中央处理器包括二阶自抗扰控制器和PI控制器，二阶自抗扰控制器完成直流伺服驱动控制系统转速环的运算，PI控制器完成直流伺服驱动控制系统电流环的运算。所述说的PWM功率输出电路是由信号驱动放大电路和IGBT整流电路构成。由DSP输出的PWM控制信号经信号驱动放大电路进行功率放大，输出给IGBT整流电路中的IGBT单元，控制相应IGBT单元中的IGBT的通断，从而控制直流伺服电动机的电枢电压。所述的二阶自抗扰控制器是由跟踪-微分器(TD)、扩张状态观测器(ESO)和非线性误差反馈控制律(NLSEF)三个部分按图3所示直接连接构成的一种非线性控制器。跟踪-微分器(TD)用于安排过渡过程，跟踪所述的直流伺服驱动控制系统输入端的给定信号及其微分量，跟踪结果分别为图中的Vl和v2 ;扩张状态观测器(ESO)用于观测所述的直流伺服驱动控制系统输出端的输出信号及其微分量，跟踪结果分别为图中的zl和z2，并估计所述的直流伺服驱动控制系统的总扰动量z3;将跟踪-微分器(TD)输出的输入信号及其微分量与扩张状态观测器(ESO)反馈的输出信号及其微分量分别做差运算，在非线性误差反馈控制律(NLSEF)中对两次做差运算分别得到的结果进行非线性组合控制；对非线性误差反馈控制律的输出量uO与扩张状态观测器反馈回来的总扰动量z3进行做差运算，并将此做差运算结果除以自抗扰控制器参数整定值b0作补偿控制，补偿后的控制信号由二阶自抗扰控制器的输出端连接至PI控制器的输入端，经PI控制器运算后的结果输出至PWM功率输出电路的输入端。所述的PI控制器采用带抗积分饱和的常规PI控制器构成，具有响应速度快、输出量限幅的特点。所述的二阶自抗扰控制器在DSP中央处理器中实现方法如图4所示:由直流伺服驱动控制系统读人上位机(如PLC或计算机)通信传输的转速给定值V*和外部传感器传送的转速反馈值V ;当DSP的采样时间到时，分别由跟踪-微分器(TD)和扩张状态观测器(ESO)计算跟踪转速给定值和转速反馈值及它们的微分信号，即图中vl、v2和zl、z2，其中vl、v2分别为转速给定值及其微分信号，zUz2分别为转速反馈值及其微分信号，并估计出总扰动量z3 ;然后做差计算转速给定值与转速反馈值的误差及它们的微分信号的误差，并对这两个分别计算的误差结果进行非线性控制运算，输出控制分量uO ;最后对总扰动量z3进行补偿控制，输出最终的控制量信号U。针对二阶自抗扰控制器中非线性函数不易在DSP中央处理器中实现的难点，所述的二阶自抗扰控制器采用数据链表查表方法，实现其非线性函数的功能，数据链表查表方法如图5示。该方法具有容易实现、DSP占用率低、执行效率高的特点。非线性函数的表达式为:
权利要求
1.一种直流伺服驱动控制系统，其特征在于所述的系统主要由数据采集电路、DSP中央处理器和PWM功率输出电路组成；所述的DSP中央处理器的输入端接收上位机传送的速度给定值和外部传感器反馈的直流伺服电动机速度反馈值、电流反馈值，经DSP中央处理器处理后，输出至PWM功率输出电路，PWM功率输出电路的输出端连接至所述直流伺服驱动控制系统的控制对象直流伺服电动机；所述的数据采集电路的输入端连接外部传感器，夕卜部传感器采集的直流伺服电动机的数据送入所述的数据采集电路；数据采集电路的输出端连接DSP中央处理器的输入端，外部传感器采集的直流伺服电动机的数据经由数据采集电路送入DSP中央处理器处理后，传送至PWM功率输出电路，由PWM功率输出电路输出控制信号控制直流伺服电动机。
2.如权利要求1所述的直流伺服驱动控制系统，其特征在于所述的数据采集电路主要包括信号预处理电路和Α/D转换模块；所述的信号预处理电路包括开关量预处理电路与模拟量预处理电路，开关量预处理电路通过光电隔离器件与来自接触器、继电器等器件的外部开关量信号耦合连接，将开关量信号转换成数字信号输入DSP中央处理器；模拟量预处理电路将包括直流伺服电动机的电流和电压两种基本模拟量在内的输入信号预处理成A/D转换模块能够接收的电信号；模拟量预处理电路连接Α/D转换模块，将预处理完的模拟信号经由Α/D模块转换成数字信号传送至DSP中央处理器。
3.如权利要求1所述的直流伺服驱动控制系统，其特征在于所述的DSP中央处理器包括二阶自抗扰控制器和PI控制器，二阶自抗扰控制器完成直流伺服驱动控制系统转速环的运算，PI控制器完成直流伺服驱动控制系统电流环的运算。
4.如权利要求3所述的直流伺服驱动控制系统，其特征在于所述的二阶自抗扰控制器是由跟踪-微分器(TD)、扩张状态观测器(ESO)和非线性误差反馈控制律(NLSEF)三个部分直接连接构成的一种非线性控制器；跟踪-微分器(TD)用于安排过渡过程，跟踪所述的直流伺服驱动控制系统输入端的给定信号及其微分量；扩张状态观测器(ESO)用于观测所述的直流伺服驱动控制系统输出端的输出信号及其微分量，并估计所述的直流伺服驱动控制系统的总扰动量；将跟踪-微分器(TD)输出的输入信号及其微分量与扩张状态观测器(ESO)反馈的输出信号及其微分量分别做差运算，在非线性误差反馈控制律(NLSEF)中对两次做差运算分别得到的结果进行非线性组合控制；对非线性误差反馈控制律的输出量与扩张状态观测器反馈的直流伺服驱动控制系统的总扰动量进行做差运算，并将此做差运算结果除以自抗扰控制器参数整定值b0作补偿控制，补偿后的控制信号由二阶自抗扰控制器的输出端连接至PI控制器的输入端，经PI控制器运算后的结果输出至PWM功率输出电路的输入端。
5.如权利要求3或4所述的直流伺服驱动控制系统，其特征在于所述的二阶自抗扰控制器采用数据链表查表的方法实现其非线性函数的功能；非线性函数的表达式为:
6.如权利要求1所述的直流伺服驱动控制系统，其特征在于所述的PWM功率输出电路由信号驱动放大电路和IGBT整流电路构成；由DSP中央处理器输出的PWM控制信号经信号驱动放大电路进行功率放大，输出给IGBT整流电路中的IGBT单元，控制相应IGBT单元中的IGBT的通断，从而控制直流伺服电动机的电枢电压。
全文摘要
一种直流伺服驱动控制系统，由数据采集电路、DSP中央处理器和PWM功率输出电路组成，其DSP中央处理器中包括二阶自抗扰控制器和PI控制器。所述的DSP中央处理器的输入端接收上位机传送的速度给定值和外部传感器反馈的直流伺服电动机速度反馈值、电流反馈值，经DSP中央处理器处理后，输出至PWM功率输出电路，PWM功率输出电路的输出端连接至所述直流伺服驱动控制系统的控制对象直流伺服电动机。所述的数据采集电路的输入端连接外部传感器，数据采集电路的输出端连接DSP中央处理器的输入端，外部传感器采集的直流伺服电动机的数据经由数据采集电路送入DSP中央处理器处理后，传送至PWM功率输出电路，由PWM功率输出电路输出控制信号控制直流伺服电动机。
文档编号H02P7/29GK103208958SQ20131009288
公开日2013年7月17日 申请日期2013年3月21日 优先权日2013年3月21日
发明者汪常明, 胡书举, 张雷, 夏安俊, 赵斌, 许洪华 申请人:中国科学院电工研究所