以文本方式查看主題

-  曙海教育集團論壇  (http://www.scb-ycwb.com/bbs/index.asp)
--  VB語言  (http://www.scb-ycwb.com/bbs/list.asp?boardid=77)
----  vb語言實現的卡爾曼濾波源程序  (http://www.scb-ycwb.com/bbs/dispbbs.asp?boardid=77&id=2608)

--  作者:wangxinxin
--  發布時間:2010-12-14 14:47:56
--  vb語言實現的卡爾曼濾波源程序
(沒有測試,輸出部分要配合相應的過程)

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

主站蜘蛛池模板: 亚洲视频一二三四| 欧美三级 欧美一级| 久久成年人网站| 天天综合在线视频| 中文字幕永久在线观看| 国内毛片毛片毛片毛片毛片| 中文字幕乱码人妻二区三区| 黄色在线观看av| 一二三四区在线| 日韩精品久久久久久久| 国产麻豆剧传媒精品国产| 中国黄色片免费看| 欧美 日韩 人妻 高清 中文| 91插插插插插插插插| 欧美亚洲精品天堂| 国产传媒在线看| 中文字幕人妻互换av久久| 中国精品一区二区| 国产黄色网址在线观看| 亚洲精品91天天久久人人| 欧美一级免费在线| 国产欧美一区二区三区视频在线观看| 亚洲国产美女视频| 天天操天天舔天天干| 青青草久久伊人| 久久精品国产亚洲AV成人婷婷| 超碰在线超碰在线| 91超薄丝袜肉丝一区二区| 午夜一区二区三区四区| 手机毛片在线观看| 日韩人妻无码精品综合区| 欧美一区二区激情视频| 久久亚洲天堂网| 蜜臀av午夜精品久久| 九九热只有精品| 精品亚洲永久免费| 精品人妻无码一区二区三区| 国产精品拍拍拍| 一级黄色大片免费| 亚洲综合在线一区二区| 亚洲综合第一区|