久久中文视频-久久中文网-久久中文亚洲国产-久久中文字幕久久久久-亚洲狠狠成人综合网-亚洲狠狠婷婷综合久久久久

以文本方式查看主題

-  曙海教育集團(tuán)論壇  (http://www.xinguifushi.cn/bbs/index.asp)
--  VB語言  (http://www.xinguifushi.cn/bbs/list.asp?boardid=77)
----  vb語言實(shí)現(xiàn)的卡爾曼濾波源程序  (http://www.xinguifushi.cn/bbs/dispbbs.asp?boardid=77&id=2608)

--  作者:wangxinxin
--  發(fā)布時(shí)間:2010-12-14 14:47:56
--  vb語言實(shí)現(xiàn)的卡爾曼濾波源程序
(沒有測(cè)試,輸出部分要配合相應(yīng)的過程)

Dim num1, num2, num3
Dim a(), a1(), e() As Single
Dim alf, xgm(), p(), k1(), k2, k(), p1(), p2(), c(), c1, k3(), k4(), cc() As Single
Private Sub Command1_Click()
CommonDialog1.ShowOpen
Open CommonDialog1.FileName For Input As #1
num3 = Val(Text1.Text) + 2
num2 = Val(Text2.Text)
ReDim a(num3, num2)
For j = 1 To num3
For i = 1 To num2
Input #1, a(j, i)
Next i
Next j
Close #1

End Sub

Private Sub Command2_Click()
CommonDialog1.ShowSave
Open CommonDialog1.FileName For Append As #2

For i = 1 To num2
Print #2, cc(i, 1), cc(i, 2), cc(i, 3)
Next i

Close #2
Shell "c:\\windows\\notepad " & CommonDialog1.FileName
End Sub

Private Sub Command3_Click()

num1 = Val(Text1.Text) + 1
num2 = Val(Text2.Text)
num3 = Val(Text1.Text) + 2
ReDim a1(num2), e(num1, num2) As Single
ReDim xgm(num1), p(num1, num1), k1(num1), k(num1), p1(num1, num1), p2(num1, num1), c(num1), k3(num1), k4(num1), cc(num2, num1) As Single





c(1) = c(2) = c(3) = 0
r = 0.000001
alf = 10
For j = 1 To num1
For i = 1 To num2
e(j, i) = a(j, i)
a1(i) = a(num3, i)
Next i
Next j
For x = 1 To num1
xgm(x) = alf * Sqr(r / e(x, 1))
p(x, x) = xgm(x) ^ 2
Next x

For q = 1 To num2
For i = 1 To num1
k3(i) = k4(i) = 0
Next i
k2 = 0
For i = 1 To num1
For j = 1 To num1
p1(i, j) = p2(i, j) = 0
Next j
Next i
c1 = 0

For m = 1 To num1
k3(m) = 0
For n = 1 To num1
k3(m) = k3(m) + e(n, q) * p(n, m)
Next n
Next m

For m = 1 To num1
k4(m) = 0
k4(m) = k4(m) + 1000 * k3(m) * e(m, q)
Next m

For i = 1 To num1
k2 = k2 + k4(i)
Next i

For v = 1 To num1
k(v) = 0
k(v) = k3(v) * (k2 / 1000 + r) ^ -1
Next v

For i = 1 To num1
For j = 1 To 3
p1(i, j) = k(i) * e(j, q)
Next j
Next i

For l = 1 To num1
For i = 1 To num1
p2(l, i) = 0
For j = 1 To num1

p2(l, i) = 1000 * p1(l, j) * p(j, i) + p2(l, i)
Next j
Next i
Next l

For i = 1 To num1
For j = 1 To num1
p(i, j) = p(i, j) - p2(i, j) / 1000
Next j
Next i

For i = 1 To num1
c1 = c1 + e(i, q) * c(i)
Next i
For i = 1 To num1
c(i) = c(i) + k(i) * (a1(q) - c1)

Next i


For i = 1 To num1

cc(q, i) = c(i)
Next i
Next q

End Sub

Private Sub Command4_Click()
End
End Sub

主站蜘蛛池模板: 男人天堂网址 | 国产亚洲欧美一区 | 国产美女在线一区二区三区 | 国产在线视频一区 | 欧美乱一级在线观看 | 美女张开腿给男生桶下面视频 | 国产成人精品久久一区二区小说 | 国产猛烈无遮掩视频免费网站男女 | 在线黄网| 久久精品国产精品青草色艺 | 男女性男女刺激大片免费观看 | 国产高清视频免费观看 | 韩国毛片基地 | 一级视频在线免费观看 | 欧美一二三区在线 | 亚洲国产成人在线 | 9久re在线观看视频精品 | 免费人成年短视频在线观看免费网站 | 久久久香蕉| 99av视频| 日本三级香港三级三级人!妇久 | 美国毛片aa | 草草影院国产第一页 | 国产精品网站 夜色 | 久草草视频在线观看免费高清 | 久久久亚洲欧美综合 | 久久99国产乱子伦精品免 | 亚洲精品视频免费在线观看 | 成 人 黄 色 激 情视频网站 | 日韩精品一区二区三区高清 | 欧美色欧美色 | 亚洲第一视频在线播放 | 鸥美毛片 | 91热久久免费频精品黑人99 | 亚洲一区二区三区高清视频 | 亚洲精品不卡午夜精品 | 日本污污网站 | 欧美日韩精品一区二区 | 国产伦码精品一区二区三区 | 欧美成免费 | 无遮挡一级毛片私人影院 |