球面并联机构由一个上层和一个基地,通过三对相同的运动子链如图
2。在每一个链,有一个固定的转动关节
z
我和两个自由转动关节
x
我和
y
我连接近端与远端和远端链接链接到上层,分别。所有转动关节的轴线相交于一个共同的观点
O这称为旋转中心。飞机穿过点
O并成为与基地称为球面中心平面,也视为眼球的清单的飞机。
α
1,
α
2,
β
1,
β
2,
η这种机制的参数,在哪里
α
1和
α
2低的结构角链接和上链接,
β
1和
β
2是half-cone角上平台和基础,然后呢
η是初始状态的结构扭转角的平台和基础,也就是说,最初的扭转角。
球面并联机构的运动简图。
图
2演示了我们的SPM平台的运动学,SPM的运动方程是由(
30.]
(1)
θ
˙
=
J
α
1
,
α
2
,
β
1
,
β
2
,
η
,
ϕ
x
,
ϕ
y
,
ϕ
z
ω
,在哪里
θ
˙
=
θ
˙
1
,
θ
˙
2
,
θ
˙
3是角速度向量输入电机的,
ω
=
ω
x
,
ω
y
,
ω
z是角速度向量上的输出平台,然后呢
J是雅可比矩阵决定由机械参数吗
α
1
,
α
2
,
β
1
,
β
2
,
一个
n
d
η和眼球的姿势
ϕ
x
,
ϕ
y
,
一个
n
d
ϕ
z。
α
1和
α
2是较低的链接和上链接的结构角度,分别。
β
1和
β
2基础和上层平台的角度。拟议的PTZ平台也有类似的运动学人眼,如图
3。
模拟摄像机的旋转和眼球运动。我们人眼的SPM原型有相似的运动学。
3所示。视觉跟踪SKL-Based粒子滤波3.1。空间直方图:Spatiogram
颜色直方图是一个共同的目标模型的统计不同的颜色在整个图片的比例没有关心每个颜色的空间位置。因此,它不是旋转而敏感,而是适用于非刚性的或容易变形建模目标对象。目标基于该模型容易受到背景类似的颜色分布或其他干扰,从而导致目标跟踪失败。在这篇文章中,我们改进粒子滤波算法基于一种新的目标模型,spatiogram [
31日),将像素坐标信息添加到传统的颜色直方图和使用SKL度量。二阶spatiogram可以描述如下:
(2)
h
b
=
n
b
,
μ
b
,
Σ
b
,
b
=
1
,
…
,
B
,在哪里
B间隔的总数和吗
n
b
,
μ
b
,
Σ
b每个区间的概率是,坐标的意思是,和协方差矩阵,分别。它们可以使用公式计算如下:
(3)
n
b
=
1
N
∑
j
=
1
N
δ
j
b
,
μ
b
=
1
N
∗
n
b
∑
j
=
1
N
x
j
δ
j
b
,
Σ
b
=
1
N
∗
n
b
- - - - - -
1
∑
j
=
1
N
x
j
- - - - - -
μ
b
x
j
- - - - - -
μ
b
T
δ
j
b
。
B在目标区域内像素的总数,
x
j
=
x
j
,
y
j
T的坐标位置吗
jth像素,
δ
j
b
=
1表示,
j像素是量子化的
bth间隔,而
δ
j
b
=
0表明,
j像素是量子化的其他间隔。
3.2。SKL-Based粒子滤波
为了将spatiogram应用于目标跟踪,我们需要选择一个方法来衡量之间的空间直方图的相似度度量目标和候选目标。我们选择SKL-based相似系数的相似性度量来衡量目标spatiogram
h
b
=
n
b
,
μ
b
,
Σ
b和候选目标spatiogram
h
′
b
=
n
b
′
,
μ
b
′
,
Σ
b
′。
给定一个spatiogram
h
b
=
n
b
,
μ
b
,
Σ
b中,我们使用一个高斯分布来描述每个部分中的所有像素的空间分布。的分布
b部分可以被描述为
(4)
f
b
x
=
1
2
π
Σ
b
1
/
2
经验值
- - - - - -
1
2
x
- - - - - -
μ
b
T
Σ
b
- - - - - -
1
x
- - - - - -
μ
b
,在哪里
μ
b是所有的平均值坐标的像素
bth间隔和
Σ
b是指的是协方差矩阵的坐标的像素
b时间间隔。
KL距离高斯分布
f
b
x和高斯分布
f
b
′
x可以得到一个封闭形式的解决方案是使用以下公式计算:
(5)
K
l
f
b
∥
f
b
′
=
1
2
日志
Σ
b
′
Σ
b
+
T
r
Σ
b
′
- - - - - -
1
Σ
b
- - - - - -
d
+
μ
b
- - - - - -
μ
b
′
T
Σ
b
′
- - - - - -
1
μ
b
- - - - - -
μ
b
′
,在哪里
d是空间维度(spatiogram,
d
=
2)。同样,我们可以得到KL距离高斯分布
f
b
′
x和高斯分布
f
b
x:
(6)
K
l
f
b
′
∥
f
b
=
1
2
日志
Σ
b
Σ
b
′
+
T
r
Σ
b
- - - - - -
1
Σ
b
′
- - - - - -
d
+
μ
b
′
- - - - - -
μ
b
T
Σ
b
- - - - - -
1
μ
b
′
- - - - - -
μ
b
。SKL距离两个高斯分布的
f
b
x和
f
b
′
x是
(7)
年代
K
l
f
b
∥
f
b
′
=
1
2
K
l
f
b
∥
f
b
′
+
K
l
f
b
′
∥
f
b
,
年代
K
l
f
b
∥
f
b
′
=
1
4
T
r
Σ
b
′
- - - - - -
1
Σ
b
+
T
r
Σ
b
- - - - - -
1
Σ
b
′
- - - - - -
2
d
+
1
4
μ
b
- - - - - -
μ
b
′
T
Σ
b
- - - - - -
1
+
Σ
b
′
- - - - - -
1
μ
b
- - - - - -
μ
b
′
。一般来说,相似的范围
(
0 1
],相似
ψ
b每一对的spatiogram可以被描述为间隔
(8)
ψ
b
=
经验值
- - - - - -
年代
K
l
f
b
,
f
b
′
。因此,基于SKL spatiogram距离的相似性可以计算的
(9)
ρ
h
,
h
′
=
∑
b
=
1
B
n
b
n
b
′
ψ
b
=
∑
b
=
1
B
n
b
n
b
′
经验值
- - - - - -
年代
K
l
f
b
,
f
b
′
。
根据(
11),我们可以得到
(10)
ρ
h
,
h
′
=
∑
b
=
1
B
n
b
n
b
经验值
- - - - - -
1
4
T
r
Σ
b
- - - - - -
1
Σ
b
′
+
T
r
Σ
b
- - - - - -
1
Σ
b
′
- - - - - -
2
d
+
0
=
∑
b
=
1
B
n
b
经验值
- - - - - -
1
4
d
+
d
- - - - - -
2
d
=
∑
b
=
1
B
n
b
=
1
。
PTZ视觉系统的基础上,建立坐标系,如图
3。假设物体的运动是未知的;我们如何控制PTZ平台的运动,使运动物体的投影是固定在图像平面的中心,在充分考虑动态效应的“眼球”?为了使
z设在相机坐标系配合的目标通过调整相机的姿势,我们必须补偿之间的偏移角相机和目标。我们雇佣了一个针孔摄像机模型获得更准确的摄像机投影。一般针孔相机模型后,相机的内在参数模型方程给出
(12)
u
v
1
=
f
x
0
u
0
0
f
y
v
0
0
0
1
x
c
z
c
y
c
z
c
1
,在哪里
u
,
v表示图像目标在图像坐标系的坐标。
u
0
,
v
0主要的点的坐标。
x
c
,
y
c
,
z
c是目标相机坐标系中的坐标。
f
x规模因素吗
x坐标方向,
f
y规模因素吗
y协调的方向发展。
为了保证目标跟踪领域的中心,我们需要使目标躺在光轴。目标的位置通过光学轴为代表
0,0
,
z
T,在那里
z
T相机和目标之间的距离。方向是
(13)
x
c
y
c
z
c
=
因为
α
- - - - - -
罪
α
0
罪
α
因为
α
0
0
0
1
因为
β
0
罪
β
0
1
0
- - - - - -
罪
β
0
因为
β
1
0
0
0
因为
γ
- - - - - -
罪
γ
0
罪
γ
因为
γ
0
0
z
T
。
最后,我们可以推断出目标和相机之间的角偏移的视线:
(14)
α
=
反正切
u
f
x
- - - - - -
u
0
f
x
,
β
=
反正切
f
x
f
y
v
- - - - - -
v
0
2
f
x
2
+
u
- - - - - -
u
0
2
。
当机器人在崎岖不平的环境中工作,严格的疙瘩和脉冲抖动造成重大动荡的发生频率和高姿势改变频率较低。因此,机器人的运动信息获取和向前输入控制器补偿外部干扰。在[
34),一个活跃的视觉误差补偿模型提出了根据刑事和解的原则(
15)。在这里,我们使用我们的提议bioinspired控制器补偿运动扰动引起的颠簸抖动。因此,
(15)
E
年代
=
H
年代
- - - - - -
α
T
v
T
n
年代
2
年代
T
v
+
1
年代
T
n
+
1
+
e
年代
λ
年代
+
γ
+
k
e
- - - - - -
l
年代
年代
T
问
T
n
年代
T
n
+
1
,在哪里
e
年代
=
- - - - - -
H
年代
+
E
年代是视网膜滑错误,
H
年代表示的旋转角头,
E
年代就意味着眼球的旋转角度。
α,
λ,
γ代表头旋转的速度信号的收益,视网膜滑动的速度信号,和神经纤维的飙升displayment造成的视网膜,分别。
k小叶的价值补偿重量是误差信号引起的视网膜。在我们的系统中,
α,
λ,
γ等于1,
k
=
2.5。结合位置补偿和速度补偿的眼球,我们的系统是用来建立一个平滑跟踪系统。
此外,图像信息是通过使用高速照相机(孔雀鱼f - 033 c),这是连接到IEEE 1394卡安装在PC与英特尔核心CPU获得视频信号。相机是一个ultracompact,廉价的VGA机器视觉相机CCD传感器(索尼ICX424)。全分辨率,它运行到58 fps。我们雇佣了一个针孔摄像机模型获得更准确的摄像机投影。相机标定是重复十次寻求一个近似相机校正矩阵
K
=
f
x
0
0
;
0
f
y
0
;
u
0
v
0
1。相机校准使用棋盘(
36]。在这里,我们使用一个针孔摄像机模型获得更准确的摄像机投影。一般针孔相机模型后,参数包含在
K被称为内部相机参数或相机的内部取向。参见[
37为更多的细节。