一种基于模糊控制的小型数字舵机系统的制作方法
【专利摘要】一种基于模糊控制的小型数字舵机系统，其系统包括DSP控制器、驱动器、伺服电机、减速传动机构、位置传感器、执行机构、上位机通信，其算法采用模糊控制算法。所述舵机系统带有测试软件，方便对舵机进行测试操作，并能把测试结果存储在测试仪器或电脑中。舵机运行的任意时刻都可通过上位机控制舵机，并能把实时的舵机转角显示在上位机界面上，方便对舵机设备的检测和维护。该数字化电动伺服控制系统可在船舶，精密数控机床、机器人、军工武器、无人驾驶等自动化控制领域应用。
【专利说明】一种基于模糊控制的小型数字舵机系统【技术领域】
[0001] 本发明属于小型化数字舵机领域，尤其涉及一种高精度、高速度、控制电路数字化、功率器件模块化的数字舵机系统。
【背景技术】
[0002]小型化数字舵机是针对当前模拟舵机控制时器件容易老化和受外界条件影响大等方面因素而设计的。随着微电子集成技术、微计算机技术、数字技术的飞速发展，对于舵机和上位机的研究与开发也有了更快的发展，提高了舵伺服系统控制和检测的能力，推进舵机更快向小型化和智能化发展。
[0003]伺服电机从气动、液压发展到现在正在广泛使用的电动舵机，已有五十多年的历史。现在的舵伺服系统早已今非昔比，无论从舵机的转换效率和控制电路的使用上都有了质的飞跃。电动舵机主要是针对气动舵机响应时间慢、液压舵机系统存在漏油、维修不方便等缺点而发展起来的，电动舵机具有可靠性高、维修简单以及体积小、重量轻等特点，越来越受到人们重视和研究。随着芯片集成化程度的不断提高，一些高级数字运算器由于其运算速度的不断提升，可以实现先进控制算法在实际工程中的应用。目前的发展趋势是向小型化、数字化，智能化方向发展。
[0004]近十年来，国内数字小型化舵机的研究及发展也取得了相当大的成果，但在控制精度、响应时间等性能指标方面还有相当大距离。因此，如何提高舵机的整体性能是当前研究的重要课题，伴随着控制器性能的不断提高，一些先进和智能的控制算法得以在实践进行检验。
【发明内容】
[0005]本发明所要解决的技术问题是提供一种高精度、高速度、结构简单、易于推广、运行稳定的小型化电动舵伺服系统。为了达到以上目的，本发明对舵机伺服系统进行了全面的分析和设计，提出如下解决方案:
一种基于模糊控制的小型数字舵机系统，硬件部分包括舵机控制部分、执行机构和传感器部分，所述舵机控制部分包括主控芯片模块；所述执行机构部分包括功率驱动器、伺服电机、减速传动机构；所述传感器部分包含温度传感器，位置传感器等、速度传感器，采用先进的MEMS (微机电系统)传感器探测更小的角度偏差；硬件部分使用金属齿轮和散热外壳。
[0006]软件部分包括控制算法、上位机通讯和保护程序，所述控制算法为自适应模糊控制算法；所述上位机通讯部分包含:上位机显示舵机旋转角度部分、上位机对下位机进行控制部分，并可以将测试数据保存在上位机中；所述保护程序包含过热保护和过载保护。
[0007]其控制过程包括:采用内置A/D采样把外部输入的模拟控制信号转换为数字信号，并把数字信号传输给主控芯片模块；主控芯片模块对采样信号进行滤波，对滤波后的数字信号进行运算并得到控制量信号，控制量信号经过数模转换芯片得到舵机所要求的模拟控制量，输出给功率驱动器以驱动舵机偏转；上位机通过通讯接口把要求的数据存储起来，并可通过上位机发送数据序列来完成对舵机测试。
[0008]进一步的，所述主控芯片模块内置A/D采样部分，片上外设包括:12路PWM、6通道QEP、2X8通道12位80ns转换时间O~3V量程ADC、2通道SCI异步串口 ；主控芯片模块外接供电系统、时钟系统、复位及配置系统、外部D/A、通讯接口及JTAG下载接口。
[0009]进一步的，所述外部D/A为DAC7724，具有12精度的并行结构，输入数据是用二进制格式表示的。输出电压通过下面的方程式给出:
【权利要求】
1.一种基于模糊控制的小型数字舵机系统，其特征在于: 硬件部分包括舵机控制部分、执行机构和传感器部分，所述舵机控制部分包括主控芯片模块；所述执行机构部分包括功率驱动器、伺服电机、减速传动机构；所述传感器部分包含温度传感器，位置传感器等、速度传感器，采用先进的MEMS (微机电系统)传感器探测更小的角度偏差；所述硬件部分使用金属齿轮和散热外壳； 软件部分包括控制算法、上位机通讯和保护程序，所述控制算法为自适应模糊控制算法；所述上位机通讯部分包含:上位机显示舵机旋转角度部分、上位机对下位机进行控制部分，并可以将测试数据保存在上位机中；所述保护程序包含过热保护和过载保护。
2.根据权利要求1所述的一种基于模糊控制的小型数字舵机系统，其特征在于:所述主控芯片模块内置A/D采样部分，片上外设包括:12路PWM、6通道QEP、2 X 8通道12位80ns转换时间O?3V量程ADC、2通道SCI异步串口 ；主控芯片模块外接供电系统、时钟系统、复位及配置系统、外部D/A、通讯接口及JTAG下载接口。
3.根据权利要求2所述的一种基于模糊控制的小型数字舵机系统，其特征在于:所述外部D/A为DAC7724，具有12精度的并行结构，采用2级缓冲方案，第I级缓冲只分别缓存各通道D/A的数字输入，并不将此数字输入转换为模拟输出;第2级缓冲则将第I级缓存的数字输入打入相应的输出寄存器中，并将数字输入转换为模拟输出，从而实现多通道D/A同时输出。
4.根据权利要求1或2所述的一种基于模糊控制的小型数字舵机系统，其特征在于:所述上位机通讯由RS232通讯和测试界面组成，将传输过来的数字信号进行换算调整，在测试界面上显示或上位机给出信号控制舵机。
5.根据权利要求1所述的一种基于模糊控制的小型数字舵机系统，其特征在于:所述舵机系统属于二维舵伺服控制系统，选择舵面与目标点的偏差和趋近目标点的速度作为控制的输入；控制方式采用自适应模糊控制，实时自适应的修改模糊控制参数；模糊变量误差、误差变化及控制量的模糊集和论域确定后，对模糊语言变量确定隶属度函数。
【文档编号】G05B19/418GK103984327SQ201410233762
【公开日】2014年8月13日 申请日期:2014年5月29日 优先权日:2014年5月29日
【发明者】邢济收, 陈庚, 苏中 申请人:北京信息科技大学