硬件模块设计 - 基于MSP430单片机的光电跟踪伺服系统研究方案

　　2 硬件模块设计

　　2.1 硬件电路设计原理

　　依据总体设计方案，硬件电路主要由电源模块、四象限信号放大处理模块、系统控制模块、电机驱动模块以及相关辅助模块构成（见图2）。

　　四象限探测器可探测波长范围（380~1 100 nm），其原理是将光照强度转换为电流信号。但由于其输出电流信号较小，四象限探测器的预处理模块电路实现将电流信号经放大和运算处理，并将电流转化为单片机A/D能够采集到电压范围0~2.5 V.采样的数字信号经单片机内的数字滤波和算法的运算，进而控制PWM波的占空比来调节电机的速度。

　　2.2 机械模拟机构实验设计原理

　　模拟机构设计灵感源于地动仪的设计原理，采用两个不同的轴来调节两个不同但相关的平面实现四象限探测器的大范围搜寻目标的目的，模型图如图4所示。

　　其中下平板主要用于带动上平板实现大范围搜寻目标，上平板及其配置设备实现精确定位和跟踪功能。研究中利用皮筋的弹性以及牵引丝线柔软且形变相对较小的优势，实现搜索平面的任意角度转动。并利用废弃的中心笔管代替齿轮实现轴的小摩擦先转动。使得模型轻小便捷，制作简单方便，并且变废为宝。

　　

　　四象限放大处理电路如图3所示。

　　

　　3 软件编程

　　软件编程部分主要包括目标的粗搜寻和目标的精定位及跟踪两个部分。编程中载入自动搜索程序搜寻目标光源，对目标进行三维维的空间片区性搜索，并载入判别搜到目标程序，具体通过A/D采集到的电压范围判别是否搜到目标。目标一旦搜到，即载入坐标运算程序，计算当前四象限面板与目标位置的归一化坐标差值，进而调用PID 算法程序，将PID 的调节量转化为PWM 波的输出持续时间和占空比，通过调用控制电机转动圈数程序对目标进行追踪。通道误差计算程序如图5所示。