H型精密运动平台自适应滑模补偿同步控制系统与方法

文档序号:10569282阅读:389来源:国知局
H型精密运动平台自适应滑模补偿同步控制系统与方法
【专利摘要】本发明是针对H型精密运动平台的同步控制问题,提出了一种RBF网络自适应滑模补偿装置。该装置以双边直线电机的同步误差为输入,利用其强大的自学习能力使H型精密运动平台两边平行电机之间的位置误差趋近于零,从而减小系统的同步误差,达到同步控制的目的。该控制系统硬件包括主电路、控制电路和控制对象三部分;控制电路包括DSP处理器、电流采样电路、动子位置采样电路、IPM隔离驱动电路和IPM保护电路。
【专利说明】H型精密运动平台自适应滑模补偿同步控制系统与方法
[0001 ]技术领域:本发明属于数控技术领域,特别涉及一种RBF网络自适应滑模补偿控制 器的H型精密运动平台的同步控制方法。
【背景技术】 [0002] :直线伺服系统作为超精密运动平台的核心组成,其良好的动、静态性能 直接影响着平台的速度、加速度、定位精度等参数,但传统的精密运动平台大多使用旋转电 机带动丝杜螺母副,将旋转运动转化为运动平台的直线运动。这种驱动方式存在传动链长、 系统结构复杂、附加的惯量大、系统刚度低、摩擦影响大等缺点。不能满足高速度和高精度 加工的要求,导致运动速度和精度受到严重限制。为了解决以上这些严重影响运动平台精 度的因素,我们采用直线电机直接驱动方式代替传统旋转电机和滚珠丝杠的驱动方式,去 除了电动机到运动平台的传动环节,将传动链缩短为零;此外,新型的H型精密运动平台使 用气浮轴承导向和支承,基本消除摩擦的影响,还为系统提供了较大的刚度,更易实现高速 度和高加速度的运动,可以达到亚微米乃至纳米级的定位精度。
[0003] H型精密运动平台控制系统采用双直线电机共同驱动的平行系统,满足高加速、高 推力和高刚性的要求,是具有机械耦合的双线性伺服系统。虽然这种结构可以避免单轴驱 动带来的运动滞后和机械振荡,但尽管两边采用同样的直线电机和相同的控制方法,也会 由于两个回路之间的耦合以及诸多不确定性致使两电机不可能达到完全绝对的同步,这就 会引起横梁的扭转,对工作台的定位造成很大的误差,严重时会导致运动平台卡死甚至损 坏驱动元件。因此确保双直线电机的同步运动相当重要。

【发明内容】

[0004] 发明目的:本发明提供了一种H型精密运动平台自适应滑模补偿同步控制系统与 方法,其目的在于解决现有技术中存在的两电机不能完全同步,引起横梁的扭转,对工作台 的定位造成很大的误差等问题。
[0005] 技术方案:
[0006] -种H型精密运动平台自适应滑模补偿同步控制系统,该系统包括主电路、控制电 路和控制对象三部分;
[0007] 所述控制电路包括DSP处理器、电流采样电路、动子位置采样电路、IPM隔离驱动电 路和IPM保护电路;
[0008] 所述主电路包括调压电路、整流滤波单元和IPM逆变单元;
[0009] 所述控制对象为三相永磁直线同步电机H型精密运动平台,机身装有光栅尺;
[0010] 所述电流采样电路、动子位置采样电路、IPM隔离驱动电路和IPM保护电路分别与 DSP处理器连接,所述DSP处理器通过电压调整电路连接至所述主电路中的调压电路;
[0011] 所述主电路中的调压电路通过整流滤波单元连接至IPM逆变单元;所述IPM逆变单 元与三相永磁直线同步电机连接;
[0012]所述IPM隔离驱动电路和IPM保护电路分别与IPM逆变单元连接;所述电流采样电 路通过霍尔传感器连接所述三相永磁直线同步电机H型精密运动平台;所述动子位置采样 电路连接光栅尺。
[0013]所述的H型精密运动平台自适应滑模补偿同步控制系统的控制方法,该方法运用 RBF网络自适应滑模补偿控制器,将滑模控制结合神经网络逼近应用到非线性系统的控制 中,该方法包括如下步骤:
[0014]步骤1系统初始化;
[0015] 步骤2允许TN1、TN2中断;
[0016] 步骤3启动T1下溢中断;
[0017]步骤4程序数据初始化;
[0018] 步骤5开总中断;
[0019] 步骤6中断等待;
[0020] 步骤7TN1中断处理子控制程序;
[0021]步骤8结束。
[0022]所述的H型精密运动平台自适应滑模补偿同步控制方法,所述的TN1中断处理子控 制程序包括如下步骤:
[0023] 步骤1TN1中断子控制程序;
[0024]步骤2保护现场;
[0025] 步骤3判断是否已初始定位;是进入步骤4,否则进入步骤10;
[0026] 步骤4电流采样,CLARK变换,PARK变换;
[0027] 步骤5判断是否需要位置调节;否则进入步骤7;
[0028] 步骤6位置调节中断处理子控制程序;
[0029] 步骤7dq轴电流调节;
[0030] 步骤8PARK逆变换;
[0031] 步骤9计算CMPPx及PWM输出;
[0032]步骤10位置采样;
[0033]步骤11初始定位程序;
[0034]步骤12恢复现场;
[0035] 步骤13中断返回。
[0036] 所述的H型精密运动平台自适应滑模补偿同步控制方法,所述的步骤6位置调节中 断处理子控制程序包括以下步骤:
[0037] 步骤1位置调节中断子控制程序;
[0038]步骤2读取编码器值;
[0039]步骤3判断角度;
[0040] 步骤4计算已走距离;
[0041 ]步骤5执行位置控制器;
[0042]步骤6执行自适应控制器;
[0043]步骤7计算电流命令并输出;
[0044] 步骤8中断返回。
[0045] 优点及效果:本发明采用可以逼近非线性系统的RBF网络自适应滑模控制器作为 补偿控制器,来补偿由于两电机控制特性的不匹配和周围环境的不确定性而产生的同步误 差,从而能够保证H型精密运动平台在运动过程中的双边同步误差趋近于零。
【附图说明】:
[0046] 图1为H型精密运动平台结构示意图;
[0047] 图2为H型精密运动平台RBF网络自适应滑模补偿控制器系统框图;
[0048]图3为本发明方法中主控制系统程序流程图及TN1中断处理子控制程序流程图;
[0049] 图4为本发明方法位置调节中断处理子控制程序流程图;
[0050] 图5为实现本发明所设计的永磁直线同步电机矢量控制系统硬件结构硬件框图; [0051]图6-9为实现本发明的硬件控制系统原理图,
[0052]其中:
[0053]图6为电流检测电路,
[0054]图7为位置检测电路,
[0055]图8为电源电路,
[0056] 图9为驱动电路。
【具体实施方式】:
[0057]下面结合附图对本发明做进一步的说明:
[0058]如图1所示,本发明提供一种H型精密运动平台的结构及其建模方法。
[0059]采用磁场定向的控制方法,简化电磁力为:
[0060] Fei=K/qi (1)
[0061] Kf i = 33inPiApMi/ (2ii) (2)
[0062] 其中Kfi是推力系数,g是推理电流命令;APMi永磁体磁链,nPi是初级磁极对数,Ti = 32mm,是极距。i = yi和y2代表双直线电机伺服系统的yi和y2轴。
[0063]用电磁力表达的永磁直线电机的动力学方程为:
[0064] Fei=Mivi + Divi+FLi+ft{v) (3)
[0065] 其中Vi是电机的线速度,Mi是电机动子质量,Di是粘滞摩擦和铁损系数,Fu是外部 扰动,fKv)是摩擦力。采用基于电机位置阶跃响应的曲线拟合技术来寻找电机驱动系统的 准确数学模型。
[0066] H型精密运动平台的RBF网络自适应滑模补偿器的同步控制系统采用将滑模控制 结合神经网络逼近用于非线性系统的控制中,采用神经网络实现模型未知部分的自适应逼 近,可有效地降低模糊增益。神经网络自适应律通过Lyapunov方法导出,通过自适应权重的 调节保证整个闭环系统的稳定性和收敛性。在保证单轴运动精度的基础上,通过控制器输 出的补偿信号来减小同步误差使其趋于零。
[0067] 图2为本发明提供的H型精密运动平台同步控制方法的结构图,在传统并联同步控 制的基础上引入同步误差补偿器,补偿器采用RBF网络自适应滑模的控制方法,RBF网络自 适应滑模作为同步误差补偿控制器,其输入分别为两直线电机的位移同步误差L和U,输出 U作为修正量,对两电机轴的速度参考指令进行修正。
[0068] 忽略不确定性和磁场导向,公式(1)和(3)改写入下:
[0070] 其中cU⑴是电机的位置,4,-荩/琢,4,:=及V風:>:〇池为控制效果,推理电流 命令。考虑参数变化及系统的不确定项的存在,H型精密运动平台的动态模型可以改写为如 下:
[0071] = +/MK(/) + (5,/ +^/K + +ACi\Fii +./,(1')| .(5.) =
[0072] 其中1/% A4., ABi和ACi分别表*Ani,Bni和Cni的不确定项,这种不确定是 由系统参数Mi和Di引起的。H定义为集中不确定项,定义如下:
[0073] 1!; = Midi{t) + /\B!ui +{Cni+ACli;tFl; +./;(y)] (6)
[0074]假设集中不确定项为有界值
[0075] |Hi| |^8i (7)
[0076] 其中&是一个正常数。
[0077] 在H型精密运动平台系统中,同时考虑单轴位置跟踪误差和两轴间的位置同步误 差。首先定义位置跟踪误差为
[0078] ei = yd-yi (8)
[0079] 式中,yd为位置输入给定,i = l,2。同步误差定义为
[0080] Ci = ei-e2,l,2 = e2-ei (9)
[0081] 式中,1和|2分别表示H型精密运动平台心和心轴的同步误差。如果式(9)中同步误 差为零,那么H型精密运动平台即为同步运行。将式(9)改为矩阵形式,即
[0082] W=TE (10) 「1. - r
[0083] 式中V = [li h]T,E=[ei e〗]1,'?1, 。 -丄_1
[0084] 为了确保跟踪误差和同步误差同时收敛到零,将两误差结合,定义为混合误差,表 示为
[0085] Eh = 01 +# ei _C,: =E + /^Y (11)
[0086] 式中,Eh=[ehl eh2]T,ehdPeh2分别表示H型精密运动平台的混合误差;0为两电机 的耦合系数。将式(1 〇)带入式(11)可得
[0087] Eh=(I+PT)E (12)
[0088] 式中,I为单位矩阵;(I+f3T)为正定矩阵。式(27)中,当且仅当E = 0,才有Eh = 0,也 就意味着W=〇。因此控制目标就是设计一个控制器,使跟踪误差和同步误差同时收敛到 零。
[0089] 为了满足控制要求,定义滑模函数为
[0090] 5, =ceif+4;5〇0 (13)
[0091] 贝 IJ i,. =cehl+ehi =ce&
[0092] =cehi+yd-AJi-Bniul-H i+fili (14) ^ ^i,: + Xj ~./ ('')- ~1 !: + Pii
[0093] 由式(14)可见,如果 s-0,则 ehi-〇 且'
[0094] 由于RBF网络具有万能逼近特性,采用RBF神经网络逼近f(y),网络算法为
(15)
[0096] f=ff*Th(x)+e (16)
[0097]其中,x为网络的输入;j为网络隐含层第j个节点;h=[h」]T为网络的高斯基函数输 出,为网络的理想权值;e为网络的逼近误差,e$eN。
[0098]网络的输入取X=[L |2]T,网络输出为 [0099] f[x) = Wih{x) (17)
[0100] 由于
[0101] f{x)-f(x) = IVv h(x) + a-~ W' h{x) = -IV! h(x) + a-
[0102] 定义Lyapunov函数为
[0110] 取n>|e|max,自适应律为
[0111] W = ph{x) (22)
[0112] 则尹二窃-?/卜|<0 〇
[0113] 当|^_〇时,s = 0,根据LaSalle不变集原理,闭环系统渐进稳定,时,s-0。由 于V彡0,#<〇 ,则当时,v有界,则步有界,但无法保证滲收敛于W。可见控制律中的鲁 棒项nsgn(s)的作用是克服神经网络的逼近误差,以保证系统稳定。
[0114] 图3为本发明方法中的控制系统流程图,如图所示,本发明方法最终由嵌入DPS处 理器中的控制程序实现,其中系统初始化程序包括关闭所有中断、DPS系统初始化、变量初 始化、事件管理器初始化、AD初始化和正交编码脉冲QEP初始化。中断服务子程序包括保护 中断子程序和T1下溢中断服务子程序。动子初始化定位、PID调节、矢量变换等都在定时器 T1下溢中断处理子程序中执行。
[0115] 其中T1中断处理子程序按以下步骤进行:
[0116] 步骤1TN1中断子控制程序;
[0117] 步骤2保护现场;
[0118] 步骤3判断是否已初始定位;是进入步骤4,否则进入步骤10;
[0119] 步骤4电流采样,CLARK变换,PARK变换;
[0120] 步骤5判断是否需要位置调节;否则进入步骤7;
[0121] 步骤6位置调节中断处理子控制程序;
[0122] 步骤7dq轴电流调节;
[0123] 步骤8PARK逆变换;
[0124] 步骤9计算CMPPx及P丽输出;
[0125] 步骤10位置采样;
[0126] 步骤11初始定位程序;
[0127] 步骤12恢复现场;
[0128] 步骤13中断返回。
[0129] 图4为本发明方法中的位置调节中断处理子控制程序流程图,如图所示,
[0130] 按照以下步骤进行
[0131] 步骤1位置调节中断子控制程序;
[0132] 步骤2读取编码器值;
[0133] 步骤3判断角度;
[0134] 步骤4计算已走距离;
[0135] 步骤5执行位置控制器;
[0136] 步骤6执行自适应控制器;
[0137] 步骤7计算电流命令并输出;
[0138] 步骤8中断返回
[0139] 图5为实现本发明所设计的永磁直线同步电机矢量控制系统硬件结构硬件图,包 括主电路、控制电路和控制对象三部分;控制电路包括DSP处理器、电流采样电路、动子位置 采样电路、IPM隔离驱动电路和IPM保护电路;主电路包括调压电路、整流滤波单元和IPM逆 变单元;控制对象为三相永磁直线同步电机H型平台,机身装有光栅尺;电流采样电路、动子 位置采样电路、IPM隔离驱动电路和IPM保护电路均与DSP处理器连接,DSP处理器还通过电 压调整电路连接至调压电路,调压电路通过整流滤波单元连接至IPM逆变单元,IPM逆变单 元连接三相永磁直线同步电机;IPM隔离驱动电路和IPM保护电路与IPM逆变单元连接,电流 采样电路通过霍尔传感器连接三相永磁直线同步电机H型平台,动子位置采样电路连接光 栅尺。
[0140]图6-9为所发明的控制系统的硬件原理图,大体可分为3部分即,第一块电路板为 功率电路板,包括AC-DC模块,主电路的过压欠压保护,IPM模块以及驱动电路,辅助电源电 路。第二块电路板为控制电路板,包括DSP(TMS320F28335),电流采样、编码器接口电路、 RS232通信、过流保护等电路。这块电路板是整个伺服控制器的核心部分。第三块电路板完 成显示与控制输入功能,包括数码管显示电路以及键盘输入。其主要功能是显示电机运行 时刻的状态,部分故障原因以及完成各种控制信号的输入。
[0141] 从图6可以看出,本系统是一个速度和电流反馈的闭环系统。DSP控制器负责转换 A/D转换、计算电机的转速和位置以及电流和速度的PI调节,最后得到电压空间矢量PWM的 控制信号,再经过光耦隔离电路后,驱动IPM功率开关器件。DSP,CPLD控制器负责整个系统 的的保护和监控,一旦系统出现过压、过电流、欠电压等故障,DSP将封锁PWM输出信号,以保 护IPM模块。
[0142] 图6为所发明的硬件控制系统的电流检测电路,根据整个系统的设计,控制系统中 有电流反馈环,因此需要采样电机的电流信号,在本设计中测量的是直线电机三相电流中 的两相。本系统中采用CsM025PTS系列霍尔电流传感器,它能采集的电流范围是-16A~+ 16A,输出的电压范围是0~5V。因为DSP芯片的AD模块采样的是电压信号,需要将电流信号 转化为电压信号。同DSP的AD模块输入电压范围是0~3V,而采样到得霍尔传感器的电压范 围是0~5V,需要做适当的变换,把采样的电压信号转化为合适的输入范围。16通道的AD模 块需要用到其中的三个,本设计中选用的是ADCIN08和ADCIN09两个通道,采样后的电压信 号重新转化为两相的电流信号存入相应的寄存器中,进行电流调节。经过霍尔传感器检测 到得电流成比例的转化为电压信号。霍尔传感器输出的电压信号不适合AD模块采集的电压 范围,需要经过放大器对电压信号进行缩放。
[0143] 图7为所发明的硬件控制系统的位置检测电路,直线电机的位置信号的检测是实 现直线电机精密控制的非常重要的因素且将其微分就是速度信号,本设计采用英国 RENI sHAW公司的RGH24X系列光栅尺,它的分辨率为lum,最高速度可达到5m/s。把 TMs320F28335事件管理器EVA的正交编码脉冲电路(QEP)和光栅尺进行连接,当事件管理器 的QEP被使能后,就能对相应的引脚输出脉冲进行计数,来确定电机运动的位置信息,根据 测量的位置信息相应的调整控制策略,控制电机运动。安装好的光栅尺在直线电机运动的 情况下,读数头输出与位置信息有关的6路方波信号,其中它们是三对反向的RS422A方波信 号,经过差分接收后,产生三路脉冲信号包括两路正交编码脉冲信号A和B,以及一路参考点 信号Z。正交编码脉冲信号A和B用来检测直线电机运动的位置信息,而Z信号用来做直线运 动过程中回零点位置的参考信号。由于光栅尺读数头输出的3路脉冲信号是5V的,而DSP的 I/O口电压是3.3V的,因此需要一个电平转换芯SN74LVC4245DW来实现5V到3.3V的电平转 换。同时使能DSP芯片事件管理器EVA的正交编码脉冲电路和捕获单元CAP3,QEP1和QEP2分 别接收A和B两路正交脉冲,CAP3捕获参考脉冲信号Z。
[0144] 光栅尺读数头输出的正交编码脉冲是两路频率可以变化相互正交的脉冲序列。当 直线电机运动时,光栅尺的读数头会产生正交编码脉冲信号,分别被QEP1和QEP2接口接收, 根据A和B脉冲信号的相位差是+90°还是-90°来确定直线电机的运动方向,同时可以确定通 用定时器的计数器的计数方向,如果QEP1接收的脉冲超前QEP2接收的脉冲,那么计数器是 递增计数,相反则递减计数。由于DSP的正交编码电路对输入正交脉冲上升沿和下降沿均进 行计数,因此经由QEP电路后输出脉冲的频率变为输入的四倍,并且事件管理器会将该时钟 提供给它的通用定时器作为通用定时器的时钟频率。在本设计中通用定时器TZ设置为定向 增/减计数,事件管理器EVA的正交编码脉冲电路既为它提供时钟频率又提供计数方向。光 栅尺的分辨率为lum,直线电机每移动lum则通用定时器对四倍频以后的脉冲进行一次计 数,通过前后两次计数器中不同的计数值可以确定直线电机运动的距离,同时有专门的寄 存器存储计数器的计数方向,也是直线电机的运动方向。在DSP的中断服务子程序中可以得 到直线电机的运动信息。
[0145] 图8为所发明的硬件控制系统的电源电路,本发明所设计的电源电路就是要得到 直流电压。首先通过一个整流桥将交流转化为直流,然后通过滤波得到较好的直流电存储 于大电容中,在将电容两端作为直流电源的输出口提供给功率模块。其中的加入一根保险 丝,为了防止电路电流过大,起到保护电路作用。继电器起到的是一个智能控制的作用,在 程序中当DSP初始化时,电容充电,初始化完成后,在程序中给K1端口发送一个高电平,继电 器发生一个开关动作使电容两端直接连接电源电压,这时候使电容两端的电压达到最大, 实验时最大可到320V,达到为电机供电要求。
[0146] 图9为所发明的硬件控制系统的驱动电路,直线电机驱动电路主要包括一个智能 功率模块,本发明选用的是IRAMS10UP60B,它适用于较大功率的电机中,它能驱动的电机功 率范围是400W~750W;主要由6个IGBT构成的三相桥式电路,控制板上DSP芯片产生的PWM控 制信号输入到功率模块,控制3个桥臂的关断,产生合适驱动电压,驱动直线电机运动图中 的HIN1和LIN1分别是第一相的上下桥臂的控制信号,它们都是低电平有效。IRAMS10UP60B 的工作电压VDD是15V,VSS为接地端,为了达到良好的去耦效果,在这两端加入两个并联的 去耦电容。由于输入的PWM波信号是数字信号,而IRAMS10UP60B不具备把数字信号和功率信 号隔离的功能,因此在IRAMS10UP60B的输入控制信号前需要加上光耦隔离,图中TLP113即 实现了将输入的PWM信号转化为模拟信号的功能,然后输入到对应桥臂的控制信号输入端。 在三相电压的输出端U,V,W分别加上一个2.2uF的自举电容。在Itrip端口为低电平时,芯片 正常工作,当桥臂的上部分输入的控制信号为低电平,下部分是高电平的时候该相有输出 电压;当上为高电平,下为低电平的时候输出电压为零;两个都为低电平的情况是不容许出 现的,那样会造成短路,烧毁芯片。当Itrip端口为高电平时,芯片不工作,没有电压输出,因 此在电路中加一个下拉电阻使Itrip端口为低电平,这样功率模块能正常工作。功率芯片自 身有过温和过流保护,当电路出现异常时能起到自我保护的作用。
[0147] 针对双边直线电机驱动的H型精密运动平台,提出了一个RBF网络自适应滑模补偿 控制器,解决以往运动控制中存在的问题,本发明的优点在于该控制器将滑模控制结合神 经网络逼近用于非线性系统的控制中,采用神经网络实现模型未知部分的自适应逼近,可 有效地降低模糊增益。神经网络自适应律通过Lyapunov方法导出,通过自适应权重的调节 保证整个闭环系统的稳定性和收敛性。在保证单轴运动精度的基础上,通过控制器输出偿 信号来减小同步误差使其趋于零。
【主权项】
1. 一种H型精密运动平台自适应滑模补偿同步控制系统,其特征在于:该系统包括主电 路、控制电路和控制对象三部分; 所述控制电路包括DSP处理器、电流采样电路、动子位置采样电路、IPM隔离驱动电路 和IPM保护电路; 所述主电路包括调压电路、整流滤波单元和IPM逆变单元; 所述控制对象为三相永磁直线同步电机H型精密运动平台,机身装有光栅尺; 所述电流采样电路、动子位置采样电路、IPM隔离驱动电路和IPM保护电路分别与DSP 处理器连接,所述DSP处理器通过电压调整电路连接至所述主电路中的调压电路; 所述主电路中的调压电路通过整流滤波单元连接至IPM逆变单元;所述IPM逆变单元 与三相永磁直线同步电机连接; 所述IPM隔离驱动电路和IPM保护电路分别与IPM逆变单元连接;所述电流采样电路 通过霍尔传感器连接所述三相永磁直线同步电机H型精密运动平台;所述动子位置采样电 路连接光栅尺。2. 如权利要求1所述的H型精密运动平台自适应滑模补偿同步控制系统的控制方法,其 特征在于:该方法运用RBF网络自适应滑模补偿控制器,将滑模控制结合神经网络逼近应用 到非线性系统的控制中,该方法包括如下步骤: 步骤1系统初始化; 步骤2允许TN1、TN2中断; 步骤3启动Tl下溢中断; 步骤4程序数据初始化; 步骤5开总中断; 步骤6中断等待; 步骤7 TNl中断处理子控制程序; 步骤8结束。3. 根据权利要求2所述的H型精密运动平台自适应滑模补偿同步控制方法,其特征在 于:所述的TNl中断处理子控制程序包括如下步骤: 步骤I TNl中断子控制程序; 步骤2保护现场; 步骤3判断是否已初始定位;是进入步骤4,否则进入步骤10 ; 步骤4电流采样,CLARK变换,PARK变换; 步骤5判断是否需要位置调节;否则进入步骤7 ; 步骤6位置调节中断处理子控制程序; 步骤7 dq轴电流调节; 步骤8 PARK逆变换; 步骤9计算CMPPx及PffM输出; 步骤10位置采样; 步骤11初始定位程序; 步骤12恢复现场; 步骤13中断返回。4.根据权利要求3所述的H型精密运动平台自适应滑模补偿同步控制方法,其特征在 于:所述的步骤6位置调节中断处理子控制程序包括以下步骤: 步骤1位置调节中断子控制程序; 步骤2读取编码器值; 步骤3判断角度; 步骤4计算已走距离; 步骤5执行位置控制器; 步骤6执行自适应控制器; 步骤7计算电流命令并输出; 步骤8中断返回。
【文档编号】G05B13/04GK105929693SQ201610340816
【公开日】2016年9月7日
【申请日】2016年5月19日
【发明人】王丽梅, 张宗雪, 孙宜标
【申请人】沈阳工业大学
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1