设计步进电机的调焦控制系统方案

电机招聘专家引言：当摄影镜头拍摄运动的物体时，如果运动轨迹已知，摄影镜头必须对焦距进行调节，从而调整目标的像点的位置，使得目标始终位于焦点上，达到实时拍摄的目标，传统变焦大多是利用机械装置完成的，比如凸轮机构，齿条机构；但是由于机械加工工艺复杂，其精度、平稳性和灵活性都难以满足要求，为此本系统利用步进电机带动摄像机完成变焦，由于步进点机精确地按照步进角转动，并且由 DSP 进行控制，从而满足了以上机械装置无法完成地性能要求。实验结果表明，本系统调焦曲线与理想曲线拟合度较好，拍摄已知运动轨迹的目标，达到了满意效果。1 调焦系统设计思想在光学系统中，采用一组物镜，调节轴向位移，物镜光学系统物象关系是：X=f2/ X其中 X 像距（目标像平面到主焦平面的距离） ；X 物距（目标距离） ；f 光学系统焦距 f常量，像距 X与物距 X 成反比关系。利用已知的摄影调焦曲线确定步进电机转动所需的步数和时间坐标关系，存入 F240数据存储器中，利用 F240 运算速度快、片载 FLASH 存储器大（16K 字）的特点，准确控制步进电机控制器驱动步进电机运转，通过机械装置实现摄影镜头焦距按照规定的曲线变化，从而实现实时拍摄运动物体的功能。2 硬件设计部分2.1 步进驱动器 UP-4HB03M 简介UP-4HB03M 是北京联太工贸有限公司生产的专用步进电机驱动器,4HBO3M 适用于两相六出头混合式及四相混合式步进电机，PWM 恒流控制方式；可选择半步（四相八拍）或者 16 细分两种工作方式；驱动电流为 0.3A 连续可调，并且具有自动半流锁定功能；脱机控制及其相位检测功能；所有控制信号与功率驱动部分光电隔离；散热外壳与驱动器内部完全电绝缘。2.2 TMS320F240 简介TMS320F240(以下简称 F240)由 DSP 内核和片内外设组成。由于 DSP 内核具有较快的计算和响应处理速度，可以应付高速应用的要求，同时也为控制软件的设计提供了更加有力的支持，使控制系统能够完成更加复杂的功能、实现更好的控制效果。同时TMS320F240 具有丰富的片内外设，包括 16 路 10 位 AD 转换器、多个可编程的多路复用 I/O 引脚、硬件 UART 以及 SPI 总线等。特别是 TMS320F240 片内设置了一个事件管理器(EPA)，可以提供 6 路全比较 PWM 通道，能方便地实现各种 PWM 波形的发生。这里使用 F240 主要是考虑 F240 速度快以及有丰富的 I/O 引脚资源；程序烧写方便，利于更新曲线坐标以及修改程序；性价比较高等因素。2.3 硬件设计本系统的硬件接口电路如图 1 所示，74ls14 为反相器，接到 DSP 的 I/O 口以提高其驱动能力，CH1 是一个八脚的插头，用于外接步进机的各项绕组。步进电机以及摄影镜头部分从略。工作过程如下：首先获得摄影调焦曲线，利用 MATLAB 软件，得出时间位移坐标，再换算成步进电机转动所需的步数时间坐标，以数组的行式保存下来。在 F240 的数据存储器中开辟空间存储步数时间数组，利用 F240 定时器完成计时，I/O 口输出相应宽度的脉冲信号，驱动步进电机驱动器 UP-4HB03M，其中 CP 为步进脉冲输入端；FREE 为脱机端，高电平有效，FREE1 时，电机处于释放状态；V/D 为方向控制端，高低电平分别控制电机正反转。电机招聘专家图 1 硬件接口电路图3 软件设计：由于电机的运行和转动步数以及两步之间间隔时间有关系，故采用计时器计时的方法来计算时间，F240 初始化程序如下：void Initcpu(void) /初始化 F240 程序 *WDCR=0x6f; / 禁止自带的看门狗功能；*CKCR1=0x69; / 外部输入晶振为 20MHZ，F240 工作在 20MHZ；*CKCR0=0xc3; / 系统时钟为 10MHZ；*SYSCR=0x4000; / F240 输出频率 CLKOUT=IOPC1（I/O 管脚） ；F240 初始化后，计时器的基本计时时间为 0.1s，考虑到 F240 定时器是 16 位计数器，这难以满足计算长时间的需求，所以采用通过计算进入定时器中断的次数来计算长时间的方法。例如设置定时器周期寄存器值为 800 即*T1PR800，那么进一次定时器中断时间为 800*0.1=80s 如果计时为 1s 的话，则只需进 12500 次中断即可，以此类推；故定义的数组内容表示如下：int table = 25,800,255, /第 1 行. . . . . . /第 n 行其中 25 为电机步数；800 为定时器周期寄存器值；255 每两步间所要进入定时器中断的次数。实现准确地控制步进电机控制器关键在于由 F240 I/O 口产生规定的脉冲信号，提供给步进电机控制器从而驱动步进电机正确转动，程序中包括 F240 初始化、电机正转、等待、电机反转几个程序模块。程序流程图如图 2 所示：图 2 程序流程图以下是实现电机正转的程序。程序中变量解释：step：用于存储数组中电机步数；every step：用于存储数组中每两步间所要进定时中断的次数；flag ：数组行数标志( 程序假设需正转 36 组) 。void interrupt INT2_ISR() while (*EVIVRA=0x0027) /是否是定时器中断 if(flag36) /用来完成正转if (steptotal=step) /是否走完数组每行规定的步数 flag+; /数组行标志加 1steptotal=0; /电机转动步数清零step=table+j; /更新电机运行步数数据*T1PR=table+j; /更新定时器定时周期everystep=table+j; /更新需要进入定时器中断次数*T1CNT=0; /从零开始计时，启动定时器i+; /循环标志位加 1if(i=1) *PADATDIR=0xff05; / 提供下降沿，正转，不脱机else if (i=everystep) i=0;steptotal+; /电机每转一步标志位加 1else*PADATDIR=0xff04; /CP 脚为高电平为产生下降沿准备 ,正转，不脱机电机招聘专家*IMR=0x02; /开定时器中断enable(); /开启 F240 总中断4 实验结果及其注意事项电机转动的步数和时间坐标都是由主机端通过 MATLAB 仿真取得的，因此实际调焦曲线的与理想曲线的拟合程度大大提高了；步进电机控制器采用四相八拍运行方式，并且由 DSP 进行控制，步进机精确地按照步进角（0.9 度）转动。实际应用该调焦系统调整摄影镜