当接收到同步运动信号后,单片机发送脉冲驱动A, B系统中的步进电机运动,两
子系统在位移传感器接触静止的测量挡板后,进入静态同步运动状态,闭环控制各自系
统中的位移传感器保持SV恒定输出,当挡板开始运动,A, B子系统保持SV恒定输出
动态同步跟随挡板运动,等待上位机发送开始位移检测信号。
当STM32接收到开始位移检测信号后,A系统立即进入检测状态,电机停止运动,
若挡板是向下运动的,传感器0-1 Omm检测挡板向下运动位移,若挡板是向上运动的,
传感器一10-Omm检测挡板向上运动位移;B系统立即进入跟随状态,传感器保持SV恒
定输出,跟随挡板运动。假定测量挡板首先向下/向上运动,当处于检测状态中的A系
统位移传感器输出达到8.9V/1.1 V时,B系统中的电机停止转动,等待A系统位移传感
器检测完毕之后,进入检测状态,而A系统检测完毕之后,进入跟随状态,位移传感器
SV恒定输出,跟随挡板运动。当B系统输出达到8.9V/1.1V时,A系统中的电机停止
工作,等待B系统检测完毕之后进入检测状态,而B系统检测完毕之后,保持位移传
感器输出SV ( Omm)跟随测量挡板向上或向下运动。
若在运动过程中,挡板突然变向,则保持SV跟随运动的系统迅速由跟随状态切换
至检测状态,若是由下降状态变为上升状态,则一10-On un检测挡板向上运动位移,若由
上升状态变为下降状态,则0-1 Omm检测挡板向下运动位移,而原先处于检测状态的系
统立即进入跟随状态,保持SV恒定输出,跟随挡板运动。就这样,通过两个系统交替
处于跟随状态与检测状态,实现对挡板双向大量程高精度位移的检测。
|