曙海教育集團(tuán)論壇開發(fā)語(yǔ)言培訓(xùn)專區(qū)VB語(yǔ)言 → vb語(yǔ)言實(shí)現(xiàn)的卡爾曼濾波源程序


  共有9992人關(guān)注過(guò)本帖樹形打印

主題:vb語(yǔ)言實(shí)現(xiàn)的卡爾曼濾波源程序

美女呀,離線,留言給我吧!
wangxinxin
  1樓 個(gè)性首頁(yè) | 博客 | 信息 | 搜索 | 郵箱 | 主頁(yè) | UC


加好友 發(fā)短信
等級(jí):青蜂俠 帖子:1393 積分:14038 威望:0 精華:0 注冊(cè):2010-11-12 11:08:23
vb語(yǔ)言實(shí)現(xiàn)的卡爾曼濾波源程序  發(fā)帖心情 Post By:2010-12-14 14:47:56

(沒有測(cè)試,輸出部分要配合相應(yīng)的過(guò)程)

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

支持(0中立(0反對(duì)(0單帖管理 | 引用 | 回復(fù) 回到頂部

返回版面帖子列表

vb語(yǔ)言實(shí)現(xiàn)的卡爾曼濾波源程序








簽名
主站蜘蛛池模板: 欧洲最强rapper网站在线看| 日本理论片理论免费| avav在线看| 免费福利在线观看| 成人无遮挡毛片免费看| 荡公乱妇hd在线| 丰满人妻一区二区三区视频| 国产成人精品久久一区二区三区| 欧美日韩亚洲国产无线码| 88xx成人永久免费观看| 亚洲欧美天堂综合久久| 国产麻豆一精品一av一免费| 热RE99久久6国产精品免费| MM1313亚洲精品无码| 亚洲欧美一二三区| 国产真人无码作爱免费视频| 最新69成人精品毛片| 蜜柚直播在线第一页| 一本色道久久88—综合亚洲精品 | 巨龙征母全文王雪琴笔趣阁| 精品国产一区二区三区色欲| 一区二区三区福利| 亚洲欧美天堂综合久久| 国产成人综合美国十次| 推拿电影完整未删减版资源 | 欧美性狂猛xxxxxbbbbb| 99re热久久这里只有精品首页| 久久久久久久性| 亚洲黄色在线观看网站| 国产欧美精品区一区二区三区| 日本一区免费观看| 男女肉粗暴进来动态图| 老司机久久精品| 中文字幕无码不卡一区二区三区| 亚洲精品国产高清不卡在线| 国产日本在线观看| 夫妇交换性3中文字幕| 最近最新中文字幕高清中文字幕网| 老阿姨哔哩哔哩b站肉片茄子芒果 老阿姨哔哩哔哩b站肉片茄子芒果 | 人妖视频在线观看专区| 国产精品h在线观看|