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

以文本方式查看主題

-  曙海教育集團(tuán)論壇  (http://m.022-oo.cn/bbs/index.asp)
--  VB語言  (http://m.022-oo.cn/bbs/list.asp?boardid=77)
----  vb語言實(shí)現(xiàn)的卡爾曼濾波源程序  (http://m.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亚洲AV永久无码精品软件 | 国产成人精品免费视频大全最热 | 仇爱电视剧泰剧在线观看免费播放 | 四虎精品| 狠狠草视频 | 精品国产青草久久久久福利 | 国产精品国产a级 | 午夜精品久久久久久久99黑人 | 久久国产精品视频 | 2018天天操夜夜操 | 日韩精品一二三区 | 久久精品国产视频 | 色午夜日本 | 国产中文字幕在线播放 | 国产欧美一级二级三级在线视频 | 91精品天美精东蜜桃传媒免费 | 久久久蜜桃 | 国产成人免费无庶挡视频 | 中文字幕国产日韩 | 猫鼠游戏电影在线观看免费版 | 99久久国产综合精品网成人影院 | 午夜精品在线播放 | 日本久久高清视频 | 国产二区三区在线播放 | 亚洲人成在线精品 | 一区二区三区视频 | 日本在线免费观看 | 日韩亚洲一区二区 | 久久另类视频 | 国产一有一级毛片视频 | 91婷婷色 | 欧美日韩亚洲一区二区三区在线观看 | 超碰香蕉| 欧美精品一区在线发布 | 久色乳综合思思在线视频 | 亚洲美女一区二区三区 | 久草在线资源福利站 | 日韩视频免费 | 欧美视频一区 | 日韩欧美亚洲国产 | 日韩二区精品 |