插图的CVS作为3 d激光雷达扫描环境:
OY1-АМR纵轴;
ОY2-АМR横向轴;P1障碍点;
d
p11和
d
p12垂线的长度轴的障碍
ОY1和
ОY3;
d
p1——远程的
Р1。
使用的物理类比的时刻转动身体的自主移动机器人的纵轴(AMR)
OY1和横向轴
ОY3,考虑到体重是单身,我们获得的浓度
J在轴
ОY1和
ОY3的点
P1:
(1)
J
O
Y
p
1
=
d
p
11
2
,
(2)
J
O
Y
p
3
=
d
p
13
2
。
归一化浓度轴周围的障碍点
ОY1和
ОY3可以由以下公式:
(3)
J
O
Y
p
1
=
∑
我
=
1
米
d
p
我
1
2
∑
j
=
1
米
d
j
1
2
+
∑
我
=
1
米
d
p
我
1
2
,
(4)
J
O
Y
p
3
=
∑
我
=
1
米
d
p
我
3
2
∑
j
=
1
米
d
j
3
2
+
∑
我
=
1
米
d
p
我
3
2
,在哪里
d
π1和
d
π3垂线的长度吗
我th坐标轴的障碍
ОY1和
ОY3,
d
j1和
d
j3垂线的长度吗
jth激光射线,不符合一个坐标轴的障碍
ОY1和
ОY3,
米遇到的障碍是射线的数量,
n射线的数量不满足一个障碍。
让3 d激光雷达有以下特点:
α
盖子:水平扫描角(rad);
β
盖子:垂直扫描角(rad);
l
盖子:激光雷达操作范围(m);
Δ
盖子:激光雷达射线间距(rad)。使用上面的特点,激光雷达能够扫描从左到右和自底向上的空间。垂线的长度
d
π1和
d
π3可以通过以下算法:发现计算的水平角
我th射线(从左到右)
rh我
Δ(
rh我水平的数量吗
我th射线);计算的垂直角度
我th射线(自底向上)
房车我
Δ(
房车我是垂直的吗
我th射线);计算坐标
x
iР,
y
iР,
z
iР的点
Р我使用公式:
x
iР=
d
πcos (
rh
我
Δ)×cos (
房车
我
Δ),
y
iР=
d
πsin (
rh
我
Δ)×cos (
房车
我
Δ),
z
iР=
d
πcos (
rh
我
Δ)×罪(
房车
我
Δ);考虑到AMR取向角(
φ,
υ,
γ),我们需要用(
x
我,
y
我,
z
我由旋转矩阵)坐标向量:
(5)
米
φ
,
υ
,
γ
=
c
φ
c
υ
c
φ
年代
υ
年代
γ
−
年代
φ
c
γ
c
φ
年代
υ
c
γ
+
年代
φ
年代
γ
年代
φ
c
υ
年代
φ
年代
υ
年代
γ
+
c
φ
c
γ
年代
φ
年代
υ
c
γ
−
c
φ
年代
γ
−
年代
υ
c
υ
年代
γ
c
υ
c
γ
,在哪里
年代(·)和
c(·)分别是正弦和余弦;轴的角度
ОY1,
ОY2,
ОY3通过方向余弦被发现:
(6)
α
=
一个
因为
x
1
P
d
p
1
,
β
=
一个
因为
y
1
P
d
p
1
,
ρ
=
一个
因为
z
1
P
d
p
1
。
从点的垂线的长度
P我的轴
ОY1和
ОY2被发现:
d
₁=
d
πsin (
α),
d
pi3=
d
πcos (
β)。最后一个表达式允许使用公式计算障碍点的浓度(
1)- (
4)。
获得学位的评估当地的环境的复杂性,我们可以用以下表达式:
(7)
δ
lос
=
J
О
Y
1
J
О
Y
3
。
为了证实的充分性评估当地的环境的复杂性,我们使用以下给定数据进行模拟:3 d激光雷达参数:
α
盖子=
π/ 2,
β
盖子=
π/ 4,
l
盖子= 20米,
Δ
盖子=
π/ 30,空间从左到右扫描和自底向上的;移动物体参数:
y
1= 0,
y
2= 0,
y
3= 0,
φ= 0,
υ= 0,
γ= 0;和障碍参数:球体半径。
LV的“线速度”,专家确定术语集
T(
v
r)={<低>、<介质>、<高>},它包含三个terms-three模糊变量(艘)。基础设置无视阵线LV“线速度”速度变化范围从
v
rmin来
v
征求。用模糊值进一步简化操作,让我们正常速度变化的范围,减少区间[0,1]。图
16显示了LV阵线成员函数
v
r。LV的“线性加速度”,专家确定术语集
T(
一个
r)={<慢>、<平均>、<快>},其中包含三艘渔船。注意,术语“线性加速”包括加速度和AMR的缺陷。基本设置设置阵线LV“线性加速度”已经从−加速度变化范围
一个rmin到+
一个征求。
以同样的方式,让我们定义LV
ε
r(角速度)和LV
ω
r(角加速度),设置类似的术语集
T(
ε
r),
T(
ω
r)和三艘具有相同的含义。图
18显示了LV阵线成员函数
ε
r。图
19显示了LV阵线成员函数
ω
r。基地集确定为LV阵线
ε
r并为LV阵线
ω
r也归一化,即。,reduced to the range of values [0, 1]. Rule bases of fuzzy classifiers M1 and M2 contain 9 rules of fuzzy output each. Surfaces of fuzzy output for these models are shown in Figures
20(一个)和
20 (b)。输出变量的评估模型的AMR的动力学是一个LV
米
r(“AMR的动态评估”)。
模糊模型,提出了评估的AMR的大小有三个输入和一个输出,如图
22。为LV“长度”,专家确定术语集
T(
l
r)={<小>,<介质>、<好>},其中包含三个模糊变量。基地集确定阵线LV的变化范围从“长度”
l
rmin来
l
征求,这是减少区间[0,1]。图
23显示了LV阵线成员函数
l
r。lv的
h
r(“高度”)和и
b
r(“宽度”)以相同的方式定义。这些变量的隶属度函数给出了数据
(24日)和
24 (b)。评估模型的输出amr LV的大小定义
大小
r用术语集
T(
大小
r)={<小>、<中部>、<大>}。