塑料排水板-植草格-土工膜厂家-泰安东诺工程材料有限公司

以文本方式查看主題

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

主站蜘蛛池模板: 中文字幕免费观看视频 | 欧美一区二区三区免费观看视频 | 日本一级高清不卡视频在线 | 青青草久久伊人 | 久久999视频| 日韩在线观看一区 | 色综合一区二区三区 | 精品成人在线视频 | 欧美精品久久天天躁 | 特级黄色一级片 | 欧美激情免费观看 | 婷婷五月婷婷五月 | 日本日本乱码伦视频在线观看 | 国产高清一区二区 | 久草快播 | 日韩精品久久久久久久电影蜜臀 | 亚洲av无码偷拍在线观看 | 亚洲男同gay在线观看 | 窝窝午夜视频 | 亚洲日本va在线观看 | 久久精品国产视频在热 | 亚洲系列_1页_mmyy11 | 欧美日韩亚洲综合在线一区二区 | 亚洲综合欧美色五月俺也去 | 国产亚洲欧美在线中文无广告 | 任你操在线观看 | 国产高清免费吃奶在线观看 | 深夜福利影院 | 久久久久久国产精品免费无码 | 精品综合久久久久久98 | 大伊香蕉在线精品不卡视频 | 欧美一级毛片免费网站 | 亚洲国产综合自在线另类 | 久久婷婷人人澡人人爱91 | 狠狠色噜噜狠狠狠狠97首创麻豆 | 无码一卡二卡三卡四卡 | 日本特一级片 | 91佛爷在线视频 | 18在线观看国内精品视频 | 四虎影视884a精品国产四虎 | 精品伊人久久大香线蕉网站 |