电流和速度双闭环PI控制在机械手模型上的应用.pdf

《电流和速度双闭环PI控制在机械手模型上的应用.pdf》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、科技创新2015年第25期I科技创新与应用电流和速度双闭环PI控制在机械手模型上的应用王海龙(河北工业大学工程训练中心，天津300401)摘要：文章利用matlab对机械手控制进行仿真，依据位置和电流的反馈信息，形成比位置反馈更稳定的双闭环控制，仿真结果表明双闭环控制达到了预期目的，并通过德州仪器的TMS320F2812型DSP芯片构建机械手控制系统，通过编程实现机械手的稳定精确控制。关键词：机械手；仿真；电流；速度引言机械手运动的精确控制对伺服系统精度和稳定性要求较高，一般采用闭环PID控制，传统的数字PID控制是

2、一种技术成熟、应用IL—]．卜l最为广泛的控制算法，其结构简单，调节方便，且不依赖于具体被控壅整———————垡里塑对象的数学模型，具有动、静态性能良好，稳态精度高的特点。但是传统的PID控制对于动特性复杂的控制对象，其一次整定出的PID图2双反馈PI控制框图参数往往不能达到最优。现代控制理论的发展与应用，一定程度上弥补了经典控制理论对时变非线性随机系统无能为力的缺点，但一Wm般对被控对象具有一定的依赖性，不能从根本上解决复杂和不确定系统的控制问题。因此，考虑采用电流和速度双闭环PI控制应用到机械手伺服系统中来。1机

3、械手模型机械手本体动力学建模包括机械手运动学正逆解和机械手刚体动力学建模，是进行机械手控制和基于动力学模型控制算法设计的基础。机械手采用的是典型两自由度平行四边形结构，机构简图如图1所示。图中，共有三组平行四边形，其中杆11、12、14、15为一组，杆11、16、19、110为一组，杆13、17、18、I11为一组。以机械手的力矩输1k入轴为坐标原点，水平方向为x轴，垂直方向为Y轴，建立固定参考一系0一xy。八～l』图3转矩与转速仿真波形从双闭环的转矩和转速仿真图可知，在电机运行到0．1s时突加负载，电机的电磁转矩和

4、转速有明显的波动，但很快便恢复平稳。这是因为当突加负载时，电机出力突然要加大，导致电流也要增加，同时还要保证原来的转速，此时速度、电流PI调节器产生了作用。PI调节器能快速的调节反馈和给定的误差，达到输出跟踪给定的效果。但是为了提高电机转速加大给定值，起始时PI输入的误差会很图1机械手机构简图大，很容易造成系统超调。为了保证转速的准确跟踪，给定的速度就图中0为杆11与X轴正方向的夹角，0为杆12与X轴正方向要受到限制。从图3中可以看出，PI速度调节器控制速度没有产生的夹角，杆111在工作空间内做平动运动。因此，利用解

5、析几何知识超调，系统虽然在启动和突加负载转矩时速度和转矩均有短暂的抖可建立机械手末端点的运动学正解方程：动，但系统能快速的恢复稳定，实现了伺服系统速度模式下的快速Jl=‘c。s—l3cos02⋯跟踪。v=Esin一f1sin芯片和电路板采用TMS320F2812型DSP芯片作为机械手的控制单元，它可以同时控制2个电机，可应用于多轴动态控制，机械手式中，(x，y)为机械手末端点在参考系。一xy中坐标。关节编码器采用摩川TS5668N021型号绝对编码器，解码电路采用由式1求解0、0。得机械手的运动学逆解方程：国产解码电

6、路板，采用100：1的减速器连接伺服电机输出轴与机械手臂。机械手的运动空间为2平方米横截面，可实现截面内任意点的自由精确控制。4结束语根据MATLAB仿真结果，通过电流采集和坐标转换、电机转子角度的反馈计算，实现闭环系统的精确PI控制，达到电机转速准确2PI调节的实现跟踪给定指令的要求，仿真结果符合电机实际运行特性，验证了电一般在应用中，采用位置反馈实现闭环Pl控制，其调节性能并流和速度双闭环控制的伺服控制系统在控制精度和稳定性上均符不理想，经常造成后期的速度响应特性差和力矩剧烈振动，出现波合预期要求。形发散等情况。

7、为克服以上问题文章采用电流反馈和位置反馈的双参考文献闭环系统PI控制模型，即在速度给定下，通过反馈回来的电流和位[1】吴鹏．两自由度并联机械手动力学建模及其模糊变结构控制『D1．置进行电流差和速度差的PI调节：(1)采集电流，经过与对应参数哈尔滨工业大学，2007．比较后送人到PI调节器调节。(2)采集光电编码机械角，转换为电【2】赵永杰．高速轻型并联机械手动态设计理论与方法[D】．天津大学，角度后与给定速度值比较后送人PI调节器。(如图2所示)20063仿真与分析[31ItoK，1wasakiM，MatsuiN．G

8、A—basedpracticalcompensatorde—机械手的驱动伺服电机均采用永磁同步电机，并给定速度=signforamotioncontrolsystem．IEEE／ASME．Transictionon1000rad／s；转矩负载给定为1N·m，当系统运行0．Is后，突加转矩负Mechatronics，2001，6(2)：143—1