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

以文本方式查看主題

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

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

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

主站蜘蛛池模板: 97久久精品午夜一区二区 | 欧美一级久久久久久久大 | 国产九九精品视频 | 欧美激情视频一级视频一级毛片 | 韩国美女毛片 | 欧美一区二区不卡视频 | 中文字幕欧美一区 | 美女叉开腿让男人捅 | 成人久久久久 | 一级a俄罗斯毛片免费 | 在线视频观看一区 | 99精品高清不卡在线观看 | 狼人激情网 | 国产一级特黄aa级特黄裸毛片 | 欧美日韩国产亚洲综合不卡 | 国产精品99久久99久久久看片 | 欧美色老头gay | 国产一区二区三区日韩 | 亚洲综合黄色 | 成人区精品一区二区不卡亚洲 | 国产乱码一区二区三区四川人 | 思99re久久这里只有精品首页 | 欧美亚洲国产精品久久 | 国产精品一区二区三区久久 | 中文字幕亚洲精品日韩精品 | 国产真实乱系列2孕妇 | 免费毛片视频网站 | 国产亚洲精品成人久久网站 | 国产一二三区在线 | 亚洲精品推荐 | 国产色手机在线观看播放 | 国产在线观看高清不卡 | 国产毛片a精品毛 | 成年午夜一级毛片视频 | 国产在线视频专区 | 男人的天堂官网 | 欧美夜夜骑 | 精品久久中文网址 | a毛片久久免费观看 | 99在线观看精品免费99 | 一级特黄一欧美俄罗斯毛片 |