以文本方式查看主題

-  曙海教育集團論壇  (http://m.scb-ycwb.com/bbs/index.asp)
--  VB語言  (http://m.scb-ycwb.com/bbs/list.asp?boardid=77)
----  vb語言實現的卡爾曼濾波源程序  (http://m.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

主站蜘蛛池模板: 男女一级爽爽快视频| 天堂网www资源在线| 欧美性猛交xxxx乱大交蜜桃| 蝌蚪网站免费观看| 99久久99视频| 久久er这里只有精品| 亚洲视频网站在线观看| 怡红院免费手机在线观看| 色欧美片视频在线观看| 一级特黄录像在线观看| 啊灬啊灬啊灬快灬深用力点| 性欧美xxxx| 欧美一级特黄aa大片在线观看免费| 97se色综合一区二区二区| 久久一日本道色综合久久m| 国产v片成人影院在线观看| 日本免费人成视频播放| 北岛玲在线精品视频| 97人人超人超人国产第一页| 欧美69式视频在线播放试看| 国产三级在线观看免费| poren日本| 欧美xxxxx性喷潮| 四虎成人精品在永久免费| a级大片免费观看| 极品美女a∨片在线看| 国产三级久久久精品麻豆三级 | 国产成人无码一区二区三区| 中日韩精品视频在线观看| 特黄大片aaaaa毛片| 国产激情视频在线观看首页| 中文字幕精品视频在线观 | 宅男噜噜噜66网站| 亚洲国产精品毛片AV不卡在线 | sss欧美一区二区三区| bt在线www天堂资源网| 亚洲精品国产综合久久一线 | 蜜桃精品免费久久久久影院| 一区二区三区在线|欧| 亚洲国产成人99精品激情在线 | 日韩一区二区在线视频|