[发明专利]一种面向微装配系统的多轴混合快速控制单元设计方法

摘要

本发明涉及一种面向微装配系统的多轴混合快速控制单元设计方法，包括TMS320F2812芯片，12个电机驱动器，2个光栅尺，2个光电编码器，2个光耦隔离电路，2个信号调理电路，2个四倍频逻辑电路，12个步进电机；其中TMS320F2812芯片包括PWM输出电路、捕获单元CAP、正交编码电路QEP和GPIO引脚；该方法通过TMS320F2812芯片同时产生多路PWM输出波形，实现多轴控制；并根据装配精度要求实现闭环、半闭环和开环的混合控制。

主权项

一种面向微装配系统的多轴混合快速控制单元设计方法,包括TMS320F2812芯片，电机驱动器（1）至（12），光栅尺（1）、（2），光电编码器（1）、（2），光耦隔离电路（1）至（12），信号调理电路（1）、（2），四倍频逻辑电路（1）、（2），步进电机（1）至（12）；其中TMS320F2812芯片包括PWM输出电路、捕获单元CAP、正交编码电路QEP和GPIO引脚；微装配系统包括微动平台和搬运机械手；其特征在于：步进电机（1）至（12）分别通过电机驱动器（1）至（12）与PWM输出电路相连，步进电机（1）至（12）分别通过光耦隔离电路（1）至(12)与GPIO引脚相连，步进电机(1)至(4)分别与微动平台相连，步进电机(5)至(12)与搬运机械手相连，光栅尺(1)、(2)分别通过信号调理电路(1)、(2)与正交编码电路QEP相连，光电编码器(1)、(2)分别安装在步进电机(3)、(4)的主轴上且分别通过四倍频逻辑电路(1)、(2)与捕获单元CAP相连；面向微装配系统的多轴混合快速控制单元包括闭环、半闭环和开环三种控制方法：在闭环系统中，首先设定好微动平台X、Y方向的目标距离，TMS320F2812芯片通过PWM输出电路产生PWM输出波形，输出占空比脉冲信号将其接入电机驱动器中控制步进电机(1)和(2)的运动，步进电机(1)和(2)驱动微动平台在X、Y方向的移动；两个光栅尺分别采集微动平台在X、Y方向的位移量，将其转换为脉冲信号的个数，通过对应的信号调理电路将脉冲信号的幅值稳定在3V后接入到TMS320F2812芯片的正交编码电路QEP中，不断比较光栅尺采集的信号与目标距离的信号实现闭环控制；微动平台的极限位置开关信号通过对应的光耦隔离电路(1)和(2)接入TMS320F2812芯片的GPIO引脚，控制微动平台在设定的行程内运动；在半闭环控制系统中，首先设定好微动平台X、Z方向的旋转角度，TMS320F2812芯片通过PWM输出电路产生PWM输出波形，输出占空比一定的脉冲信号将其接入电机驱动器中控制步进电机(3)和(4)的运动，步进电机(3)和(4)驱动微动平台在Z方向的移动和转动；两个光电编码器分别采集电机转子的位置,将其转换为脉冲信号的个数，通过对应的四倍频逻辑电路实现脉冲信号的四倍频接入捕获单元CAP中，通过不断比较光电编码器采集的信号与目标位置的信号实现半闭环控制；微动平台的极限位置开关信号通过对应的光耦隔离电路(3)和(4)接入TMS320F2812芯片的GPIO引脚，控制微动平台在设定的行程内运动；在开环系统中，首先设定搬运机械手的目标距离，TMS320F2812芯片通过PWM输出电路产生PWM输出波形，输出占空比一定的脉冲信号将其接入电机驱动器中控制步进电机(5)至(12)的运动；将搬运机械手的极限位置开关信号通过对应的光耦隔离电路(5)至(12)接入TMS320F2812芯片的GPIO引脚，控制搬运机械手在设定的行程内运动。