[发明专利]基于STM32控制L6470H驱动器的多轴步进电机控制系统

说明书

技术领域

本发明涉及全自动分析仪技术领域，具体的说是基于STM32控制L6470H驱动器的多轴步进电机控制系统。

背景技术

步进电机多用于自动化控制的仪器，在全自动化学发光免疫分析仪中往往会使用到多个步进电机，比如使用于三维机械臂、侦测模组、旋转模组、移液模组、混匀模组等。而为了提高步进电机的定位及运动控制的精度需要另外使用高细分的步进电机驱动器，并且需要在每段行程的首末段各安装位置传感器进行配合使用。目前控制多轴步进电机的主要方法：单片机通过通讯接口与三轴步进电机控制器通信连接，三轴步进电机控制器输出控制端通过光电耦合器与步进电机驱动器输入控制端连接，三轴步进电机控制器采样信号输入端与光电位移传感器采样信号输出端连接，光电位移传感器的采样信号输出端连接有过压保护模块；步进电机驱动器输出控制端与步进电机输入控制端连接，步进电机驱动器的控制信号输入端与自动半流模块的信号输出端连接。以此来控制三轴步进电机的转动；上述现有技术的缺陷如下：

1、上述方案中，从单片机发送运行指令，需要三轴步进电机驱动器TMC429-L1作为信号中转站，转换信号后再通过光电隔离，接着再将信号传送至步进电机驱动器，最后才传输到步进电机。这样整个电路会变得复杂，且信号的传输速率及传输质量得不到保证。

2、上述方案中三轴步进电机驱动器TMC429-L1最多可以控制三个步进电机，通常全自动化学发光免疫分析仪需要数十个步进电机，上述方案将不能够很好的满足。

3、上述方案中步进电机驱动器细分数有限，较难实现高精度定位功能。

4、上述方案中驱动控制系统硬件电路结构比较复杂，驱动控制系统的可靠性、安全性、控制精度得不到保证。

5、上述方案中当前电机运行状态无法得到有效监控，缺乏控制系统实时性。

发明内容

为了解决上述全自动分析仪存在的技术问题，本发明提供基于STM32控制L6470H驱动器的多轴步进电机控制系统，通过单片机直接发送运动控制命令给步进电机驱动器，步进电机驱动器将速度、加减速度、方向、行程等控制命令进行芯片内部数字内核处理后传送给步进电机带动负载；在同一根SPI通讯信号线上，在信号的传输速率及传输质量不受影响的情况下。通过步进电机驱动器来控制更多步进电机（多达8个）；实现高精度、精准可靠定位功能需求；简化驱动控制系统的硬件结构，提高控制系统的可靠性、安全性和控制精度。

本发明解决其技术问题所采用的技术方案是：

基于STM32控制L6470H驱动器的多轴步进电机控制系统，包括上位机（ARM控制系统）、STM32系列微控制器、电源供应器、L6470H步进电机驱动器、位置传感器，所述STM32系列微控制器通过SPI接口与五个（或多达8个）L6470H步进电机驱动器进行通信连接，片选信号通过GPIO输入至步进电机驱动器中，位置SENSOR将外部检测到的位置信号输入至步进电机驱动器中；当片选信号1被选中时，X轴L6470H步进电机驱动器可以随时接受控制命令且X轴步进电机处于待启动状态，X轴电机被选中后，在初始化启动运行时会根据控制命令自动去寻找位置SENSOR1完成精准的原点定位，所述电源供应器向各功能模块提供所需电源电压。

进一步地，多轴步进电机控制系统由多个步进电机驱动芯片L6470H（目前是5个）构成，所述片选信号采用的STM32系列微控制器的普通GPIO引脚，五个电机则有五个片选信号，由软件来配置具体哪个片选信号有效，也就是哪个电机将被启动；状态监测及故障信号提示通过FLAG和BUSY引脚将步进电机驱动芯片L6470H的运行状态及故障信号提示实时的传输给STM32系列微控制器，从而方便进行下一步的控制处理；所述位置SENSOR采用对射型光电开关，通过位置SENSOR可实现精准的原点定位；通过步进电机驱动芯片的OUT1A、OUT2A、OUT1B、OIUT2B四个引脚输出接至步进电机的A、B相绕组，电机通过输出轴分别拖动X轴机械臂、Y轴机械臂、Z轴机械臂、侦测模组旋转、侦测模组上盖。