波多在线播放_激情深爱五月_久久欧美精品_成人超碰_国产久_www.pixiv.moe

以文本方式查看主題

-  曙海教育集團(tuán)論壇  (http://www.022-oo.cn/bbs/index.asp)
--  VB語言  (http://www.022-oo.cn/bbs/list.asp?boardid=77)
----  vb語言實(shí)現(xiàn)的卡爾曼濾波源程序  (http://www.022-oo.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

主站蜘蛛池模板: av一级毛片| 中文字幕亚洲一区 | 伊人色综合网 | 欧美3区| 成人 精品 | 欧美一区精品 | 天天摸夜夜操 | 久久久一区二区 | 国产一区二区三区久久 | 日韩精品无码一区二区三区 | 国产一区二区自拍 | 久操免费在线视频 | 奇米激情 | 精品乱码| 麻豆专区一区二区三区四区五区 | 亚洲经典在线中文字幕 | 性做久久久 | 草草线在成人免费视频 | 免费无码一区二区三区A片18 | 2018天天干夜夜操 | 一区二区三区回区在观看免费视频 | 美女色黄网站 | 国产亚洲美女精品久久久久 | 欧美日韩精品一区二区在线播放 | 欧美十区 | 天天做天天爱天天影视综合 | 久久香蕉综合精品国产 | 一区二区三区在线观看视频 | 奇米影音先锋 | 欧美成人做性视频在线播放 | 国产精品1 | 一区二区三区免费 | www.中文字幕在线观看 | 色老头xxxwww作爱视频 | 欧美日韩国产手机在线观看视频 | 日韩在线高清 | 四色成人av永久网址 | 日韩久久精品 | 99久久久国产精品免费观看 | 毛片链接 | 精品国产一区二区在线 |