在线中文-在线在线ccc66-在线永久免费观看的毛片-在线永久免费观看的a站视频-久久精品最新免费国产成人-久久精品综合一区二区三区

Rss & SiteMap

曙海教育集團論壇 http://www.bjzhda.cn

曙海教育集團論壇
共1 條記錄, 每頁顯示 10 條, 頁簽: [1]
[瀏覽完整版]

標題:vb語言實現(xiàn)的卡爾曼濾波源程序

1樓
wangxinxin 發(fā)表于:2010-12-14 14:47:56
(沒有測試,輸出部分要配合相應的過程)

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
共1 條記錄, 每頁顯示 10 條, 頁簽: [1]

Copyright © 2000 - 2009 曙海教育集團
Powered By 曙海教育集團 Version 2.2
Processed in .03125 s, 2 queries.
主站蜘蛛池模板: 久久er热视频在这里精品 | 欧美日本一区亚洲欧美一区 | 99精品久久久久久久 | 久久久福利| 韩国美女福利专区一区二区 | 99久久综合狠狠综合久久aⅴ | 在线免费观看色视频 | 麻豆精品在线 | 幽灵义庄电影完整版免费观看 | 亚洲日韩中文字幕天堂不卡 | 欧美一区永久视频免费观看 | 自拍 欧美 日韩 | 永久免费在线观看视频 | 亚洲一级影院 | 夏娃的诱惑之吻 | 国产成人综合久久精品亚洲 | 2021天堂在线亚洲精品专区 | 亚洲欧美日韩国产 | 国产精品男人的天堂 | 狠狠狠色丁香婷婷综合久久五月 | 国产手机国产手机在线 | 日韩一区国产二区欧美三区 | 四虎国产精品永久地址49 | 亚洲四虎影视 | 久久国 | 久久久精品久久久久久 | 日本一区二区在线免费观看 | 国产高清色播视频免费看 | 久久成人精品视频 | 久久久久国产成人精品亚洲午夜 | 亚洲第一福利视频导航 | 男女男精品视频网站在线观看 | 综合网激情 | 亚洲第一福利视频 | 在线激情网站 | 羞羞影院男女午夜爽爽影视 | 欧美日韩不卡码一区二区三区 | 中文幕无线码中文字 | 中文字幕avv | 国产精品成人观看视频国产 | 欧美日韩一区在线观看 |