[发明专利]滤光组件的切换定位控制方法

摘要

本发明公开了一种滤光组件的切换定位控制方法，属于光电控制技术领域。该方法是由置有切换定位控制软件包的控制器实现的，控制器上电后，首先让滤光盘逆时针旋转，通过最短下降沿间隔时间寻找到第1号滤光片后继续运行一段时间，将第1号滤光片精确定位到光路中；然后根据切换指令，使滤光盘以最小旋转角度的方向进行旋转，通过脉冲计数确定相应的滤光片大致进入光路后，采用延迟停止的精确定位方法将相应的滤光片切换到光路中，从而保证滤光片的中心与光轴在一条直线上。本发明采用粗精组合的方法实现了使用一只位置检测器件精确定位切换多个滤光片，降低了滤光组件的调试难度，提高了滤光组件的定位精度。

主权项

一种滤光组件的切换定位控制方法，该方法是由置有切换定位控制软件包的控制器实现的，其特征在于：当控制器上电后，执行以下操作步骤：第一步：寄存器初始化，从存储器中调用TZ、TP[i]和TN[i]且i=1、2、3、…、n，i为滤光片的编号,n的取值与滤光组件中的滤光片数量一致，并令tP=0，mP=0，ts=0；其中，TZ为用于寻零粗略定位的预定下降沿间隔时间,TP[i]为滤光盘逆时针旋转时第i号滤光片的预定偏移时间，TN[i]为滤光盘顺时针旋转时第i号滤光片的预定偏移时间，tP为下降沿间隔时间计时器，mP为下降沿个数，ts为延迟停止时间计时器；第二步：调用“寻零子程序”，并执行以下步骤：2.1向电机发送滤光盘逆时针旋转指令，其中逆时针旋转指令是指滤光片按照i、i+1的顺序进入光路的指令，顺时针旋转指令是指滤光片按照i、i‑1的顺序进入光路的指令；2.2下降沿间隔时间计时器tP开始计时；2.3判断是否检测到位置检测器件反馈信号的下降沿，如果为假，继续检测；如果为真，下降沿间隔时间计时器tP停止计时且下降沿个数mP加1；2.4判断下降沿个数mP是否等于1，如果为真，下降沿间隔时间计时器tP清0，并返回执行2.2步骤；如果为假，执行2.5步骤；2.5判断下降沿间隔时间计时器tP的值是否小于等于TZ,如果为假，下降沿间隔时间计时器tP清0，并返回执行2.2步骤；如果为真，延迟停止时间计时器ts开始计时；2.6当ts≥TP[1]时，延迟停止时间计时器ts停止计时，并向电机发送滤光盘停止旋转指令；第三步：等待接收切换指令，如果接收到位置指令x，执行第四步；第四步：调用“切换子程序”，并执行以下步骤：4.1判断0＜x‑i≤n/2或者x‑i≤‑n/2，如果为真，向电机发送滤光盘逆时针旋转指令；如果为假，向电机发送滤光盘顺时针旋转指令；4.2判断是否检测到位置检测器件反馈信号的下降沿，如果为假，继续检测；如果为真，则执行4.3步骤；4.3判断滤光盘的旋转方向：4.3.1当判断滤光盘为逆时针旋转时，则i＝i+1；接着判断i＞n,如果为真，则i＝0，如果为假，则i＝i；4.3.2当判断滤光盘为顺时针旋转时，则i＝i‑1；接着判断i＜0，如果为真，则i＝n，如果为假，则i＝i；4.4判断i是否等于x，如果为假，返回4.2步骤执行；如果为真，延迟停止时间计时器ts清0并重新开始计时；4.5判断滤光盘的旋转方向：4.5.1当判断滤光盘为逆时针旋转且ts≥TP[i]时，延迟停止时间计时器ts停止计时，并向电机发送滤光盘停止旋转指令；4.5.2当判断滤光盘为顺时针旋转且ts≥TN[i]时，延迟停止时间计时器ts停止计时，并向电机发送滤光盘停止旋转指令；第五步：判断是否有关机指令，如果为假，返回第三步，如果为真，结束。