<dfn id="is4kg"></dfn>
  • <ul id="is4kg"></ul>
  • <abbr id="is4kg"></abbr>
  • <ul id="is4kg"></ul>
    <bdo id="is4kg"></bdo>
    以文本方式查看主題

    -  曙海教育集團(tuán)論壇  (http://www.hufushizhe.com/bbs/index.asp)
    --  VB語言  (http://www.hufushizhe.com/bbs/list.asp?boardid=77)
    ----  vb語言實(shí)現(xiàn)的卡爾曼濾波源程序  (http://www.hufushizhe.com/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片在线观看免费| 成年女人免费播放影院| 亚洲国产欧美日韩第一香蕉| 狠狠色丁香婷婷综合潮喷| 国产乱淫a∨片免费视频| 91av福利视频| 女性成人毛片a级| 久久精品99无色码中文字幕| 欧美人与动性行为网站免费| 免费大香伊蕉在人线国产| 色偷偷噜噜噜亚洲男人| 国产精品亚洲成在人线| www中文字幕在线观看| 成人欧美一区二区三区的电影| 亚洲а∨天堂久久精品| 欧美日韩国产高清| 免费能直接在线观看黄的视频 | 99re在线视频| 婷婷国产成人精品视频| 久久精品人人槡人妻人人玩AV| 欧美一日本频道一区二区三区| 偷拍激情视频一区二区三区| 精品无人区一区二区三区| 国产性生大片免费观看性| 97久久婷婷五月综合色d啪蜜芽| 婷婷色香五月激情综合2020| 久久国产一区二区三区| 日韩精品福利在线| 亚洲日韩国产成网在线观看 | 狠色狠色狠狠色综合久久| 国产亚洲人成a在线v网站| 麻豆国产在线观看免费| 国产精品线在线精品| youjizcom亚洲| 小雪老师又嫩又紧的| 久久天天躁狠狠躁夜夜免费观看| 极品新婚夜少妇真紧|