电子产品世界
作者简介：陈岳海(2000—)，廖墀坤、张涵(1999—)，陈少真、陈星如(1998—)，男，主要从事集成电路设计、自然语言处理、信号处理的研究、或器件仿真等的学习与研究。
*
Research Based on Wujian100 Multi-function Motor Control System
陈岳海，廖墀坤，张 涵，陈少真，陈星如 (广东工业大学，广州 510006)
摘 要：本文提出基于Wujian100 开源SoC平台实现一个多功能、高精度的步进电机控制系统。本系统使用自适应BP神经网络PID算法，可动态调节控制参数，提高系统的稳定性。搭配梯形加减速、SPTA以及电机速度控制算法，实现对步进电机的旋转角度和速度的控制。搭载温湿度传感器、电压电流检测模块、电机表面温度测量装置等来保证电机工作环境的适宜性。本系统在基于对单个电机精确控制的基础上实现了对三轴电机的多功能控制，包括角度和速度。此外为实现本地离线和远程在线控制，系统通过串口触摸屏、WiFi传输模块，搭配阿里云物联网平台，设计了多种人机控制界面，均可进行多功能控制。关键词：电机控制；SoC设计；神经网络PID；传感器；物联网 *本项目获得“2020年全国大学生集成电路创新创业大赛”“平头哥杯”二等奖。
0 引言
随着物联网时代的到来以及自动控制领域的发展，以智能化为代表的机器人在社会的各行各业影响到我们，并发挥了神奇的力量。在各领域中，涉及自动化控制的系统，均与电机的控制相关，尤其在高精度系统中，要求电机控制精度非常高。由此，研究高精度、高效率、成本低的电机控制系统非常必要。
Wujian100 SoC 平台的开发，自适应BP 神经网络PID 、梯形加减速、SPTA 、电机速度闭环控制算法。最终实现了控制系统的搭建，包括硬件结构、软件结构及系统仿真和调试。
1 电机控制系统总体设计方案
１．１ 电机控制方式
本系统采用57式两相四线步进电机，使用DM860电机驱动器，该驱动器可实现400~40 000细分，在本系统中使用1 600细分的精度，驱动器有三种控制信号：PUL 、DIR 、ENA 。PUL 可控制步进电机的转动，每一个步进电机都有固定的步距角，即一个脉冲信号电机会运行一步，通过细分技术可以改变电机转动一圈所需的
步数，即改变所需脉冲个数[1]。在细分数不变的情况下，PUL 的频率决定了电机转动的速率，PUL 的脉冲个数决定了电机运行的步数。DIR 信号决定了电机运行的方向，ENA 决定了电机的锁定状态，在通电后，电机会被锁定不可拧动，只能通过ENA 信号解除锁定状态。因此，通过调整PUL 脉冲信号的个数和频率，即可以完成对步进电机的控制，本系统的电机控制研究均基于此原理。
１．２ 电机控制系统总体方案
本步进电机控制系统基于Wujian100综合、实现、生成的Bit 流文件，配置Xilinx 的A7200T 的FPGA 开发板，搭配57步进电机开发，以自适应BP 神经网络PID 算法为核心算法。搭载WiFi 传输模块、Usart -GPU 串口屏等模块，实现对步进电机的加减速、正反转以及角度的精确控制，并可通过继电器模块实现开闭环的控制选择。在应用扩展上，基于该系统使用三个步进电机，实现三轴控制。控制算法共采用了开环和闭环两套控制算法，分别是SPTA 和BP 神经网络PID 算法。人机交互控制界面是将阿里云物联网平台、安卓APP 、串口触摸屏有机地结合在一起，可实现云端互联，通过APP
设计应用
esign & Application
理事会决议D
操纵电机，或者直接利用串口屏进行操纵（如图1
）。图１ 电机控制系统实物图
法希文2 控制系统硬件平台
２．１ 电机控制单元的选择
主控平台选择面向AIoT 的国内首个开源SoC 平台——Wujian100，搭载基于RISC -V CPU 架构的玄铁902处理器，提供了UART 、SPI 、PWM 等多种外设以及驱动，并在AHB 、APB 总线上提供了dummy 接口，可实现将自主设计的IP 模块集成到该SoC
平台。
图２ 控制单元俯视图
２．２ 闭环控制系统的搭建
本系统的电机运动信号采集使用龙邱mini4096线增量式光电编码器，输出AB 相正交信号。该编码器在 10 00 rpm 的高速条件下不会发生丢步情况，且转动一圈AB 相均会输出4 096个脉冲，则精度达到了0.087 9°/
脉冲，当对脉冲进行4倍频，脉冲计数会达到16 384个，精度会达到0.021 9°/脉冲，满足实现搭建高精度位置、速度可控的电机控制系统。
２．３ 外围传感器构成的电机保护系统
步进电机控制系统中使用DHT11温湿度模块、高精度电压电流检测模块和磁吸式K 型热电偶电机测温模块等传感器，以组成电机保护系统。温/湿度传感器主要负责对环境进行监测，判断环境是否满足电机工作条件。高精度电压、电流检测模块用于检测电机在工作状态时的电压电流值，判断电机是否工作在正常状态。磁吸式K 型热电偶测温模块则用于检测在电机工作时
的表面温度，防止电机温度过高。综上，多个传感器有机结合在一起，保证电机的安全运行。
２．４ 三轴电机扩展控制
本系统在基于单轴电机控制的基础上，进行三轴电机的扩展开发应用[2]，使用三个步进电机，组成仿机械臂结构，三个电机分别对应控制X 、Y 、Z 轴，三个轴的控制是互相独立的，但又可作为一个整体来控制，使用三套不同的控制算法，位置控制分别是自适应PID 算法、增量式PID 算法和SPTA 算法，速度控制算法均采用闭环速度PID 。可在串口触摸屏、阿里云IoT Studio 网页端、安卓APP 端实现对三轴电机的各种控制。
3 SoC系统设计
３．１ 内存扩展
二维傅里叶变换在实际应用中，为了防止Wujian100的内存不足，在步进电机控制系统项目初期对Wujian100内存进行了扩展，在AHB 总线上预留的两个dummy 接口（imemdummy 和dmemdummy ）上来扩展ISRAM 及DSRAM ，对应的设备是s1和s5，防止因平台内存不足而产生其他问题。
３．２ 正交解码脉冲计数器ＩＰ设计
本次设计是输入AB 相信号的所有边沿都会进行采样，首先对输入的信号进行数字滤波，然后采用正交信号的四倍频技术，因此处理后只需要判断当前两个信号组成的数字值与上一次是否相等，如果不
等便需要进行判断，首先得出当前转动方向，然后与设定方向比较，
电子产品世界
判断计数器是进行加运算还是减运算。最后通过功能仿真，编写IP 模块接口，将其集成到Wujian100的APB 总线上，便可以通过总线访问IP
内部寄存器。
图３ ＩＰ模块接口
4 控制算法设计
４．１ ＢＰ神经网路自适应调整ＰＩＤ算法
基于BP 神经网络的PID 控制系统结构如图4所示。控制器由两部分组成：①经典的PID 控制器：直接对被控对象进行闭环控制，并且三个参数K p 、K i 、K d 为在线调整方式[3]。②BP 神经网络：根据系统的运行状态，调节PID 控制器的参数，以其达到某种性能指标的最优化，即使输出层神经元的输出状态对应于PID 控制器的三个可调参数K p 、K i 、K d ，通过神经网络的自身学习、加权系数调整，从而使其稳定状态对应于某种最优控制规律下的PID 控制器参数[4]
。
图４ ＢＰ神经网络ＰＩＤ算法结构
４．２ ＳＰＴＡ加减速算法
SPTA 算法是以时间计算为中心，根据时间来计算
运动步数相关参数，它的做法是将步进电机的运动时间分割成若干个合适的时间片段，在每个时间片段计时达到后，它都将速度参数加到位置参数上，如果位置参数溢出，则输出一个脉冲，控制步进电机运行一步，速度参数根据加速度参数和时间的改变而改变。随着时间推移，速度参数越来越大，位置参数溢出频率越来越高[5]，则步进电机的运行频率也越来越高。
４．３ 电机速度控制算法
速度控制算法基于闭环控制，系统设定20 ms 采集一次编码器的计数值。利用M 法测速，可以得出当前电机的转速。再通过经典的速度环控制，使电机达到对应的速度。速度控制可实现达到指定速度、停止运行以
及实现电机运行过程中的反转等功能，其中也包括了三轴电机的控制，在反转的过程，首先让电机停止，然后继续反向加速到指定速度。
图５ 丰富的控制界面
5 总结与展望
本文从需求出发，介绍了一个基于Wujian100平台的步进电机控制系统。首先介绍研究背景，接着以整
体系统的功能实现为基础介绍电机的整体方案设计，再以电机系统结构为基础介绍SoC 系统、软件系统的设计。根据整篇文章的介绍，可知系统采用了基于BP
设计应用
esign & Application
D
神经网络自适应PID 算法，搭配SPTA 、梯形加减速等工业界使用较多的步进电机控制算法。难点主要是在Wujian100平台上搭建了一个神经网络，通过误差反向传播，适时调整权值，实现对PID 的参数K p ，K i ，K d 的自适应调节。同时结合闭环控制系统，实现了对单轴、三轴电机的高精度速度控制，并搭配阿里云物联网平台，设计多种人机控制方案，使整个系统控制方式更加丰富。到目前为止，一个高精度、反应速度快的步进电机系统基本完成。
但是由于只是实现了基本功能，所以还有很多后续研究工作可以开展，例如后续将继续完善拓扑结构，使步进电机的反应更加灵敏，提高精度，以及完善APP 。
机械控制涉及生活的方方面面，本系统有较好的移植性，是机械精准度控制不可缺失的一部分，可移植到如云台、机械臂、智能机器人等精确控制的领域中，后续的开发工作我们也将继续进行下去。
参考文献：
[1] 徐建国.步进电机智能控制的设计与实现[J].电子技术与软件工
程,2016(22):139.
水性聚氨酯[2] 李俊敏.多轴运动实验平台的控制系统研究[J].现代制造技术与装备,2017(7):145-146
[3] 周建新，熊延辉.基于神经网络的蓄热式加热炉的温度控制研究[J].科技风,2019(8):165.
[4] 陈忠华，李雷，赵力.基于BP神经网络的自适应补偿控制方法[J].计算机仿真,2012(7):202-204.
[5] 王岩.基于FPGA的SpTa自适应电机控制算法[J].科技资讯,2018(25):11-12.河北医药教育网
（上接第４１页）压电流，还要根据光伏面板的性能及实际效率设计合适的“光之翼供电系统”。
３．１．３ 电机选择
本装置电机涉及范围较广，既有直流电机亦有交流电机。从机装置通过双出轴直流电机牵引主机于光伏面板上纵向运动，考虑到主机质量、体积等因素，该直流电机的输出转矩选定为2.5 N·m ；但又考虑到电机连续
云杉镇
t
τL τ
max
因此，当A 与ηN 均为常数时，电动机额定功率P N
与允许温升τmax 成正比关系，绝缘材料等级越高，电动机额定功率越大。同时，上式还表明，一台电动机允许温升不变时，若设法提高效率、提高散热能力，都可以增大它的额定功率[5]。
除此之外，电机的选择还要考虑到安装方式、防护方式、额定电压、额定转速、过载倍数等因素。结合《电机拖动与基础》[5]综合考虑种种因素，最终确定电机选择方案并经过多次实验测试确定最终方案。
３．２ 比赛参后感
大学为我们提供了许多探索科技、创新实践的机会与平台，作为大学生的我们不应仅着眼于课堂理论知识的学习，更应该将理论运用到实践中。建立项目团队并参加科创竞赛，从发现问题、提出创意到做成实物、日益完善的过程中，自己亲手解决一个个问题，整个团队共同克服各种困难，这些都将成为我们学习生涯中无可替代的宝贵经历。在“中国制造2025”、“工业4.0”的时代背景下，我们将继续带着对知识的渴求与对创新的热情，不断探索，力争为科技事业的进步添砖加瓦。
参考文献：
[1] 刘根水，蒋健，陈炜.基于物联网和云计算的可视化工程测量平台设计与实现[J].网络首发,2020.8.2
1.
[2] 胡慧之，陈从悦，惠蕴心，等.基于STM32的人脸识别门禁系统的设计[J].电脑知识与技术.2018(34):176-177.
[3] 赵智敏，李俊峤，谢涛，等.基于小程序云开发的客观题练习程序设计与开发[J].电子世界.2020(16):66-67.
[4] 闻邦椿.机械设计手册[M].北京：机械工业出版社,2010.
[5] 李发海，王岩.电机拖动与基础[M].3版.北京：清华大学出版社,2013.
豫公网安备41160202000603
站长QQ:729038198
关于我们
投诉建议