专利名称：光电跟踪宏像素迭代质心法的制作方法
技术领域：
本发明属于定位算法领域，具体是一种适用于光电跟踪的高精度宏像素迭 代质心方法。
背景技术：
在汽车防撞警报系统、智能机器人、雷达、通信等领域，光电跟踪是一种 很有吸引力的技术。在光电跟踪中，必须要精确地定位，得到较高精度的误差 信号，然后根据误差信号通过控制器和执行机构完成光电跟踪。低的抗噪声能 力和获取速度较大是目前光电跟踪中定位算法的主要问题。
光电跟踪中， 一般采用质心法(或形心法)定位，该方法首先对激光图像
进行滤波预处理，然后按公式;^ = |>-0.5)^)/|;/(*)获取质心，其中N为图像
总的像素数目，I(k)是第k个像素的灰度值。质心算法对整幅图像的所有像素都 做加权，可充分利用图像中每一点的灰度值。但对所有像素做了获取，影响了
定位速度。在圆高斯光斑图像的情况下，利用质心法可得到较好的定位精度；
但是对于非对称光斑图像，当信噪比较小时，质心精度为较差。所以传统的质
心法并不适合低信噪比的非对称目标图像的定位。
Zeev Z提出了迭代质心算法，该方法首先对质心进行粗略估计(1)按某
个初始阈值将图像数据阈值化；用寻找峰值的办法得到质心的初始值；(2)设
置目标区(ROI)大小M M!，获取ROI内的质心；(3)按上述步骤(2)获取
出来的质心，更新ROI，在新的ROI内的再次获取质心；重复几次后得到质心
C(-l)。然后再精确获取质心(1)减小初始阈值，阈值化后，将ROI内的图像划 分为大小为2i一个的宏像素(i是迭代的次数，&0)，采用公式 C(i) = F(z')^) + [l-F(i)]C("l)获取C(i)，其中^(0是平均宏像素质心，F(i)是权值
函数，F(i)用公式F。 = W-l)xK/)x^,f (:""表示，其中r(i)是比例
函数。(2)重复(1)， "10§2碼。质心迭代通过迭代保证较好的精度。但是过 于频繁地使用迭代影响了定位的速度，而且该方法用在低信噪比的非对称光斑 图像中定位精度较低。
现有定位算法的缺点计算量大，定位速度慢，抗噪声能力弱，定位精度 低，误差大，不适用于低信噪比的非对称光斑图像的定位。
发明内容
本发明的目的是提供一种计算量小、定位速度快、抗噪声能力强、定位精 度高、误差小、并且适用于低信噪比非对称光斑图像的高精度定位方法。
为达到上述目的，本发明所述的一种光电跟踪宏像素迭代质心法，其关键 在于，按照以下步骤进行
步骤一，利用光电跟踪装置获取光斑图像S和无噪声无背景的理想图像So;
步骤二，确定光斑图像S的目标宏像素R，按照以下几步进行
第一歩，确定初始阈值Ith，其表达式为Ith=(Ia-Imin)/40，其中，Ia是所述光 斑图像S的平均灰度值，Lin是该光斑图像S的最小灰度值；
第二步，用所述初始阈值Ith对所述光斑图像S阈值化，得到阈值化光斑图 像S，；
用原始带噪声的光斑图像的灰度值减去初始阈值Ith，得到阈值化后的图像 数据；阈值化可以减少背景噪声。第三步，逐级划分所述阈值化光斑图像S'，按照最大信号像素覆盖率和较 少计算量原则获得最佳宏像素划分值MqXN。，其中所述M。是x方向最佳宏像
素划分值，满足M(T2"1-2， m是大于l的正整数；所述N。是y方向最佳宏像素 划分值，满足Ncr211-2， n是大于l的正整数；
第四步，根据所述最佳宏像素划分值MoXN()重新划分所述阈值化光斑图像 S'，获得初级宏像素组；
按照最佳的Mo和No划分原始图像，可以获得目标覆盖率最大的宏像素， 提高定位精度；选择合适的Mo和No可以大大减少计算量；Mo满足M(p2111-2， No满足Nc=2n-2可以方便对目标宏像素R的划分，减少迭代时的获取时间。
第五歩，比较所述初级宏像素组中各个初级宏像素的灰度值，获得灰度值
最大的初级宏像素Rn^;
宏像素的灰度值是该宏像素所包含像素的灰度值之和。
第六步，将该灰度值最大的初级宏像素Rmax的像素大小扩大为MXN，确
定为所述目标宏像素R，其中x方向像素M二Mo+2-2111， y方向像素N二No+2-2n;
为防止目标落在宏像素边沿，需将初级宏像素四周扩大1个像素，保证了 目标像素的最大覆盖率，提高了定位精度。
步骤三，获取所述目标宏像素R的x方向质心初始值Cx(-l)，其表达式为
1) = |>-0.5)単)/艺単)；
其中，I(k)是该目标宏像素R中x方向第k个像素的灰度值； y方向质心初始值Cy (-l)与所述x方向质心初始值Cx (-l)获取方法一致； Cx (-l)获取的是目标宏像素R在x方向上的情况,可以将此式拓展为y方向 的情况；Q^-l)和Cy(-l)是对目标宏像素R质心的粗略估计，只进行了一次目标 宏像素R质心的获取，减少了迭代环节，大大提高了获取速度。步骤四，确定所述目标宏像素R的X方向质心Cx，按照以下几步进行 第一步，定义迭代次数i的初始值i-O;
第二步，获取第i阈值Ithi，其表达式为Ith尸If(i+l)(Ia-Imta)/50; 第三步，用所述第i阈值Ithi对所述目标宏像素R阈值化，得到阈值化目标 宏像素R、
用较小的阈值Ithi来阈值化可以避免在减少背景噪声的同时减少信号强度。 第四歩，将所述阈值化目标宏像素Ri划分为2iX2i个大小相等的次级宏像 素T;
第五歩，获取第i次迭代中所述次级宏像素T的像素大小其表达式为
第六步，获取第i次迭代中所述阈值化目标宏像素Ri的平均质心雨，其表 达式为
其中，I(P)是第j个所述次级宏像素T中第p个像素的灰度值；
第七步，获取第i次迭代比例函数r(i)，其表达式为r(i)=l+l/5i;
r(i)可以有效提高结果的精度和抗噪的能力。
第八步，获取第i次迭代权重函数F(i)，其表达式为
f(/) = - c(z - 1)]/雨_ c(/ -1)];
F(i)用来自适应调节宏像素平均质心和第i-l次迭代结果。
第九步，获取第i次迭代质心C(i)，其表达式为
c(/) 二 f(/)雨+ (1 _ c(/))c(/ -1);第十歩，判断i是否小于log2M，如果i小于k)g2M，贝l」i加l，返回所述获 取第i阈值Ithi的步骤；如果i等于或大于log2M，则所述目标宏像素R的X方向
质心Cx=C(i);
迭代次数i的取值范围是0《i《log2M，将i限制在该范围内，可以保证输
出结果的精度，且縮短了迭代周期，减少计算量。 对阈值的逐级减小，可以保证信号得到充分利用。
y方向质心Cy与所述X方向质心Cx获取方法一致；
Cy与Cx是经过多次迭代、反复自适应调节后得到的结果，定位精度高，定
位较准确。
确定X方向位置误差信号Sx，按照以下几步进行
第一步，用传统质心算法获取所述理想图像So的x方向质心Cx0;
第二步，获取所述X方向位置误差信号&，其表达式为SX=CX-CX();
y方向位置误差信号sy与所述x方向位置误差信号ex获取方法一致； 步骤六，根据所述x方向位置误差信号^和y方向位置误差信号ey调整所
述光电跟踪装置，实现对光源的跟踪。
根据获得的较高精度的ey和Sx值，通过光电跟踪装置的控制器和执行机构
对跟踪区域进行调整，从而能更精确的实现对目标光源的跟踪。
在所述步骤四第八步中，当1=0时，所述第i次迭代权重函数F(i)的初始值 F(0)=0.5，该值有利于提高精度，减少计算量。
所述光电跟踪装置由第一台电脑PC1、快速倾斜镜FSM、半导体激光器LD、 光学天线、光电图像传感器CCD、数字信号处理器DSP和第二台电脑PC2组成；其中所述第一 台电脑PC 1的控制信号输出端连接所述快速倾斜镜FSM的控
制端，所述半导体激光器LD生成准直激光束图像投影在该快速倾斜镜FSM上， 该快速倾斜镜FSM将激光束图像反射到所述光学天线，该光学天线的光学信号 输出端连接所述光电图像传感器CCD的光学信号输入端，该光电图像传感器 CCD的数据输出端连接所述数字信号处理器DSP的数据输入端，该数字信号处 理器DSP的数据输出端连接所述第二台电脑PC2的数据输入端。
第一台电脑PC1产生扰动信号，对快速倾斜镜FSM施加x方向上的正弦信 号，控制快速倾斜镜FSM的转动角度，使快速倾斜镜FSM能更准确的接收到 半导体激光器LD投射的激光束图像；激光束图像经快速倾斜镜FSM反射后， 经过长距离传输，被光学天线接收，该光学天线将激光束图像成像到所述光电 图像传感器CCD上，光电图像传感器CCD将图像信息输出给数字信号处理器 DSP，该数字信号处理器DSP用宏像素迭代质心法对接收到的图像数据进行处 理，并将结果输出给第二台电脑PC2显示。
本发明的显著效果是迭代环节少，计算量小，定位速度快，抗噪声能力 强，目标像素覆盖率高，定位精度高，误差小，适用于低信噪比非对称光斑图 像的高精度定位。
图1为光电跟踪装置结构图2为本发明的主流程图3为确定目标宏像素的流程图4为确定目标宏像素质心的流程图。
具体实施例方式
下面结合附图和具体实施例对本发明作进一步详细说明。如图1所示，本发明提供的光电跟踪宏像素迭代质心法应用在光电跟踪装
置中，该光电跟踪装置由第一台电脑PC1、快速倾斜镜FSM、半导体激光器LD、 光学天线l、光电图像传感器CCD、数字信号处理器DSP和第二台电脑PC2组成。
半导体激光器LD生成准直激光束图像，该激光束的波长为、=1550nm。
PCl产生x方向上的正弦扰动信号，施加到快速倾斜镜FSM上，控制快速 倾斜镜FSM的转动角度，这样，当激光束图像投影到快速倾斜镜FSM上时， 转动了合适角度的快速倾斜镜FSM能更准确的接收到激光束图像。
激光束图像经快速倾斜镜FSM反射，传输3km后，被光学天线l接收，光 学天线1将激光束图像放大20倍成像到光电图像传感器CCD上，该图像信息 的像元为6.5pm X6.5pm，总像素为128X 128 pixels。数字信号处理器DSP将 CCD中的每帧图像信息取出，采用光电跟踪宏像素迭代质心法对图像数据进行 处理，并将结果输出给第二台电脑PC2显示。
如图2、 3、 4所示，本发明提供的光电跟踪宏像素迭代质心法，按照以下 步骤进行
利用光电跟踪装置获取无噪声无背景的理想图像S。和带有噪声背景的光斑 图像S，总像素均为128X128 pixels。
获取初始阈值Ith =(Ia- Imin)/40，用原始带噪声光斑图像的灰度值减去初始阈 值Ith，得到阈值化后的阈值化光斑图像S'。
逐级划分所述阈值化光斑图像S，，按照最大信号像素覆盖率和较少计算量 原则获得最佳宏像素划分值30X30。将所述阈值化光斑图像S'划分为像素大小为30X30的初级宏像素组，比较
初级宏像素组中各个初级宏像素的灰度值，获得灰度值最大的初级宏像素Rmax，
将Rmax四周扩大1个像素，即Rmax的像素大小为32X32。
根据公式C,(-1) = ^>-0,5)単)/￡/("获取所述目标宏像素R的x方向
质心初始值Cx (-1)， y方向质心初始值Cy (-l)与Cx (-l)的获取方法一致。 以下是确定所述目标宏像素R的x方向质心Cx的步骤 定义迭代次数i的初始值i-O。
获取第0阈值Ith。《th-(0+l)(Ia-Imin)/50，用目标宏像素R的灰度值减去Ith0，
得到阈值化目标宏像素R、
将所述阈值化目标宏像素RG划分为2aX2G个大小相等的次级宏像素T;
获取第0次迭代中所述次级宏像素T的像素大小 、阈值化目标宏像素RQ 的平均质心^、比例函数r(O)、权重函数F(O)，根据公式
C(O = F(/)雨+ (1 - C(O)C(z' -1)，获取第0次迭代质心C(O)。 ，
然后i加1，返回获取第1阈值Ithl=Ith-(l+lXIfD50，按步骤得到第1次 迭代质心C(l)，以此类推，直到i等于或大于log232，输出目标宏像素R的x 方向质心C^C(5); y方向质心Cy与Cx的获取方法一致。
以下是确定X方向位置误差信号Sx的步骤用传统质心算法获取理想图像
So的x方向质心Cx。，获取所述x方向位置误差信号Sx-QrC』；y方向位置误差 信号Sy与Sy的获取方法一致。
最后根据x方向位置误差信号Sx和y方向位置误差信号Sy调整光电跟踪装 置，实现对光源的跟踪。其工作情况如下光电跟踪装置中，第一台电脑PC1控制快速倾斜镜FSM 转动并接收半导体激光器LD生成的激光束图像，激光束图像经快速倾斜镜FSM 反射到光学天线，并在光电图像传感器CCD上成像，图像数据被送入数字信号 处理器DSP中，采用光电跟踪宏像素迭代质心法对图像数据进行处理，并将结 果输出给第二台电脑PC2显示。首先获取光斑图像和理想图像，确定目标宏像 素和目标宏像素的质心初始值，完成对质心的粗略估计；经过多次迭代目标宏 像素，精确获取出目标宏像素的质心，并根据理想图像的质心和目标宏像素的 质心获取位置误差信号；根据位置误差信号调整所述光电跟踪装置，实现对光 源的跟踪。
权利要求
1、一种光电跟踪宏像素迭代质心法，其特征在于，按照以下步骤进行步骤一，利用光电跟踪装置获取光斑图像S和无噪声背景的理想图像S0；步骤二，确定光斑图像S的目标宏像素R，按照以下几步进行第一步，确定初始阈值Ith，其表达式为Ith＝(Ia-Imin)/40，其中，Ia是所述光斑图像S的平均灰度值，Imin是该光斑图像S的最小灰度值；第二步，用所述初始阈值Ith对所述光斑图像S阈值化，得到阈值化光斑图像S’；第三步，逐级划分所述阈值化光斑图像S’，按照最大信号像素覆盖率和较少计算量原则获得最佳宏像素划分值M0×N0，其中所述M0是x方向最佳宏像素划分值，满足M0＝2m-2，m是大于1的正整数；所述N0是y方向最佳宏像素划分值，满足N0＝2n-2，n是大于1的正整数；第四步，根据所述最佳宏像素划分值M0×N0重新划分所述阈值化光斑图像S’，获得初级宏像素组；第五步，比较所述初级宏像素组中各个初级宏像素的灰度值，获得灰度值最大的初级宏像素Rmax；第六步，将该灰度值最大的初级宏像素Rmax的像素大小扩大为M×N，确定为所述目标宏像素R，其中x方向像素M＝M0+2＝2m，y方向像素N＝N0+2＝2n；步骤三，获取所述目标宏像素R的x方向质心初始值Cx(-1)，其表达式为其中，I(k)是该目标宏像素R中x方向第k个像素的灰度值；y方向质心初始值Cy(-1)与所述x方向质心初始值Cx(-1)获取方法一致；步骤四，确定所述目标宏像素R的x方向质心Cx，按照以下几步进行第一步，定义迭代次数i的初始值i＝0；第二步，获取第i阈值Ithi，其表达式为Ithi＝Ith-(i+1)(Ia-Imin)/50；第三步，用所述第i阈值Ithi对所述目标宏像素R阈值化，得到阈值化目标宏像素Ri；第四步，将所述阈值化目标宏像素Ri划分为2i个大小相等的次级宏像素T；第五步，获取第i次迭代中所述次级宏像素T的像素大小Δi，其表达式为Δi＝M/2i第六步，获取第i次迭代中所述阈值化目标宏像素Ri的平均质心<overscore>C(i)</overscore>，其表达式为其中，I(p)是第j个所述次级宏像素T中第p个像素的灰度值；第七步，获取第i次迭代比例函数r(i)，其表达式为r(i)＝1+1/5i；第八步，获取第i次迭代权重函数F(i)，其表达式为F(i)＝r(i)[<overscore>C(i-1)</overscore>-C(i-1)]/[<overscore>C(i)</overscore>-C(i-1)]；第九步，获取第i次迭代质心C(i)，其表达式为C(i)＝F(i)<overscore>C(i)</overscore>+(1-C(i))C(i-1)；第十步，判断i是否小于log2M，如果i小于log2M，则i加1，返回所述获取第i阈值Ithi的步骤；如果i等于或大于log2M，则所述目标宏像素R的x方向质心Cx＝C(i)；y方向质心Cy与所述x方向质心Cx获取方法一致；步骤五，确定x方向位置误差信号εx，按照以下几步进行第一步，用传统质心算法获取所述理想图像S0的x方向质心Cx0；第二步，获取所述x方向位置误差信号εx，其表达式为εx＝Cx-Cx0；y方向位置误差信号εy与所述x方向位置误差信号εx获取方法一致；步骤六，根据所述x方向位置误差信号εx和y方向位置误差信号εy调整所述光电跟踪装置，实现对光源的跟踪。
2、 根据权利要求1所述的光电跟踪宏像素迭代质心法，其特征在于在所 述步骤四第八步中，当i=0时，所述第i次迭代权重函数F(i)的初始值F(0)=0.5。
3、 根据权利要求1所述的光电跟踪宏像素迭代质心法，其特征在于所述 光电跟踪装置由第一台电脑PC1、快速倾斜镜FSM、半导体激光器LD、光学天 线(1)、光电图像传感器CCD、数字信号处理器DSP和第二台电脑PC2组成， 其中所述第一台电脑PC1的控制信号输出端连接所述快速倾斜镜FSM的控制 端，所述半导体激光器LD生成准直激光束图像投影在该快速倾斜镜FSM上， 该快速倾斜镜FSM将激光束图像反射到所述光学天线(1)，该光学天线(1) 的光学信号输出端连接所述光电图像传感器CCD的光学信号输入端，该光电图 像传感器CCD的数据输出端连接所述数字信号处理器DSP的数据输入端，该数 字信号处理器DSP的数据输出端连接所述第二台电脑PC2的数据输入端。
全文摘要
在光电跟踪过程中，光电跟踪装置采用光电跟踪宏像素迭代质心法对图像数据进行处理首先获取光斑图像和理想图像，确定目标宏像素和目标宏像素的质心初始值，完成对质心的粗略估计；经过多次迭代目标宏像素，精确获取出目标宏像素的质心，并根据理想图像的质心和目标宏像素的质心获取位置误差信号；根据位置误差信号调整所述光电跟踪装置，实现对光源的跟踪。本发明的显著效果是迭代环节少，计算量小，定位速度快，抗噪声能力强，目标像素覆盖率高，定位精度高，误差小，适用于低信噪比非对称光斑图像的高精度定位。
文档编号G01B11/00GK101446483SQ20081023729
公开日2009年6月3日 申请日期2008年12月30日 优先权日2008年12月30日
发明者刘丹平, 刘晓明, 勇 印, 段钦义 申请人:重庆大学