那曲檬骨新材料有限公司

0
  • 聊天消息
  • 系統消息
  • 評論與回復
登錄后你可以
  • 下載海量資料
  • 學習在線課程
  • 觀看技術視頻
  • 寫文章/發帖/加入社區
會員中心
創作中心

完善資料讓更多小伙伴認識你,還能領取20積分哦,立即完善>

3天內不再提示

Python的自動追蹤算法

新機器視覺 ? 來源:新機器視覺 ? 作者:新機器視覺 ? 2022-10-19 14:17 ? 次閱讀

這里涉及攔截導彈的自動跟蹤。最近,看到了一個挺有趣的自動跟蹤算法,一個Python的簡單模擬版本,分享給大家。

自動追蹤算法,在我們設計2D射擊類游戲時經常會用到,這個聽起來很高大上的東西,其實也并不是軍事學的專利,在數學上解決的話需要去解微分方程。

這個沒有點數學基礎是很難算出來的。但是我們有了計算機就不一樣了,依靠計算機極快速的運算速度,我們利用微分的思想,加上一點簡單的三角學知識,就可以實現它。

好,話不多說,我們來看看它的算法原理,看圖:

be54c770-4f67-11ed-a3b6-dac502259ad0.png

由于待會要用pygame演示,他的坐標系是y軸向下,所以這里我們也用y向下的坐標系。

算法總的思想就是根據上圖,把時間t分割成足夠小的片段(比如1/1000,這個時間片越小越精確),每一個片段分別構造如上三角形,計算出導彈下一個時間片走的方向(即∠a)和走的路程(即vt=|AC|),這時候目標再在第二個時間片移動了位置,這時剛才計算的C點又變成了第二個時間片的初始點,這時再在第二個時間片上在C點和新的目標點構造三角形計算新的vt,然后進入第三個時間片,如此反復即可。

假定導彈和目標的初始狀態下坐標分別是(x1,y1),(x,y),構造出直角三角形ABE,這個三角形用來求∠a的正弦和余弦值,因為vt是自己設置的,我們需要計算A到C點x和y坐標分別移動了多少,移動的值就是AD和CD的長度,這兩個分別用vt乘cosa和sina即可。

計算sina和cosa,正弦對比斜,余弦鄰比斜,斜邊可以利用兩點距離公式計算出,即:

be7d0da2-4f67-11ed-a3b6-dac502259ad0.png

于是

be9584ea-4f67-11ed-a3b6-dac502259ad0.png

AC的長度就是導彈的速度乘以時間即 |AC|=vt,然后即可計算出AD和CD的長度,于是這一個時間片過去后,導彈應該出現在新的位置C點,他的坐標就是老的點A的x增加AD和y減去CD。

于是,新的C點坐標就是:

bebbfbac-4f67-11ed-a3b6-dac502259ad0.png

只要一直反復循環執行這個操作即可,好吧,為了更形象,把第一個時間片和第二個時間片放在一起看看:

bed5636c-4f67-11ed-a3b6-dac502259ad0.png

第一個是時間片構造出的三角形是ABE,經過一個時間片后,目標從B點走到了D點,導彈此時在C點,于是構造新的三角形CDF,重復剛才的計算過程即可。

圖中的角∠b就是導彈需要旋轉的角度,現實中只需要每個時間片修正導彈的方向就可以了,具體怎么讓導彈改變方向,這就不是我們需要研究的問題了。

好,由于最近在用Python的pygame庫制作小游戲玩,接下來我們就用pygame來演示一下這個效果,效果如下圖:

bef4b7c6-4f67-11ed-a3b6-dac502259ad0.gif

很簡單的代碼如下:

importpygame,sys
frommathimport*
pygame.init()
screen=pygame.display.set_mode((800,700),0,32)
missile=pygame.image.load('element/red_pointer.png').convert_alpha()
x1,y1=100,600#導彈的初始發射位置
velocity=800#導彈速度
time=1/1000#每個時間片的長度
clock=pygame.time.Clock()
old_angle=0
whileTrue:
foreventinpygame.event.get():
ifevent.type==pygame.QUIT:
sys.exit()
clock.tick(300)
x,y=pygame.mouse.get_pos()#獲取鼠標位置,鼠標就是需要打擊的目標
distance=sqrt(pow(x1-x,2)+pow(y1-y,2))#兩點距離公式
section=velocity*time#每個時間片需要移動的距離
sina=(y1-y)/distance
cosa=(x-x1)/distance
angle=atan2(y-y1,x-x1)#兩點線段的弧度值
x1,y1=(x1+section*cosa,y1-section*sina)
d_angle=degrees(angle)#弧度轉角度
screen.blit(missile,(x1-missile.get_width(),y1-missile.get_height()/2))
dis_angle=d_angle-old_angle#dis_angle就是到下一個位置需要改變的角度
old_angle=d_angle#更新初始角度
pygame.display.update()

如果僅把導彈考慮為一個質點的話,那么以上算法就已經足矣,我沒有做導彈的旋轉,因為一個質點也不分頭尾不需要旋轉,當然這前提得是你加載的導彈圖片很小的時候不旋轉看起來也沒什么問題。

但是在pygame里面做旋轉并不是一件容易的事情(也可能是我無知),好吧我們先把圖片替換成一張矩形的,再加入旋轉函數看看效果如何。

bfc428a8-4f67-11ed-a3b6-dac502259ad0.png

missiled=pygame.transform.rotate(missile,-(d_angle))
screen.blit(missiled,(x1-missile.get_width(),y1-missile.get_height()/2))

因為圖片的坐標點是它的左上角的點,所以如果我們想讓圖片的坐標固定在箭頭尖點,那么把圖片實際打印位置x減少圖片長度,y減少一半寬度就行。

但是實際運行效果并不好:

bef4b7c6-4f67-11ed-a3b6-dac502259ad0.gif

大致方向相同,但是圖片箭頭的尖點并沒有一直跟隨鼠標,這是為什么呢。經過我的研究(就因為這個問題沒解決一直沒發布),

我發現原來是這個圖旋轉的機制問題,我們看看旋轉后的圖片變成什么樣了:

c0099c94-4f67-11ed-a3b6-dac502259ad0.png

旋轉后的圖片變成了藍色的那個范圍,根據旋轉角度的不同,所變成的圖片大小也不一樣,我們看旋轉90的情況:

c043b488-4f67-11ed-a3b6-dac502259ad0.pngc05f1c14-4f67-11ed-a3b6-dac502259ad0.png

我們發現,旋轉后的圖片不僅面積變大了,導彈頭的位置也變了。那應該怎么解決這個問題呢?思路是,每一次旋轉圖片以后,求出旋轉圖的頭位置(圖中的綠色箭頭點),然后把綠圖的打印位置移動一下,下,x,y分別移動兩個頭的距離,就可以讓旋轉后的導彈頭對準實際我們參與運算的那個導彈頭的位置,移動后應該是這樣的:

c0923806-4f67-11ed-a3b6-dac502259ad0.png

這樣,兩個導彈頭的點就一致了。接下來我們分析求旋轉后的導彈頭的算法。根據旋轉角度的不同,旋轉角在不同象限參數不一樣,所以我們分為這四種情況

1,2象限:

c0b08996-4f67-11ed-a3b6-dac502259ad0.png

3,4象限,它的旋轉只有正負0—180,所以3,4象限就是負角。

c10d8a60-4f67-11ed-a3b6-dac502259ad0.png

顯示圖片的時候我們將他移動。

screen.blit(missiled,(x1-width+(x1-C[0]),y1-height/2+(y1-C[1])))

這里的(x1-width,y1-height/2)其實才是上圖中的(x1,y1)。

所以最后我們加入相關算法代碼,效果就比較完美了。

c15e32f8-4f67-11ed-a3b6-dac502259ad0.gif

大功告成,最后附上全部的算法代碼:

importpygame,sys
frommathimport*
pygame.init()
font1=pygame.font.SysFont('microsoftyaheimicrosoftyaheiui',23)
textc=font1.render('*',True,(250,0,0))
screen=pygame.display.set_mode((800,700),0,32)
missile=pygame.image.load('element/rect1.png').convert_alpha()
height=missile.get_height()
width=missile.get_width()
pygame.mouse.set_visible(0)
x1,y1=100,600#導彈的初始發射位置
velocity=800#導彈速度
time=1/1000#每個時間片的長度
clock=pygame.time.Clock()
A=()
B=()
C=()
whileTrue:
foreventinpygame.event.get():
ifevent.type==pygame.QUIT:
sys.exit()
clock.tick(300)
x,y=pygame.mouse.get_pos()#獲取鼠標位置,鼠標就是需要打擊的目標
distance=sqrt(pow(x1-x,2)+pow(y1-y,2))#兩點距離公式
section=velocity*time#每個時間片需要移動的距離
sina=(y1-y)/distance
cosa=(x-x1)/distance
angle=atan2(y-y1,x-x1)#兩點間線段的弧度值
fangle=degrees(angle)#弧度轉角度
x1,y1=(x1+section*cosa,y1-section*sina)
missiled=pygame.transform.rotate(missile,-(fangle))
if0<=-fangle<=90:
????????A=(width*cosa+x1-width,y1-height/2)
????????B=(A[0]+height*sina,A[1]+height*cosa)

????if?90<-fangle<=180:
????????A?=?(x1?-?width,?y1?-?height/2+height*(-cosa))
????????B?=?(x1?-?width+height*sina,?y1?-?height/2)

????if?-90<=-fangle<0:
????????A?=?(x1?-?width+missiled.get_width(),?y1?-?height/2+missiled.get_height()-height*cosa)
????????B?=?(A[0]+height*sina,?y1?-?height/2+missiled.get_height())

????if?-180<-fangle<-90:
????????A?=?(x1-width-height*sina,?y1?-?height/2+missiled.get_height())
????????B?=?(x1?-?width,A[1]+height*cosa?)

????C?=?((A[0]?+?B[0])?/?2,?(A[1]?+?B[1])?/?2)

????screen.fill((0,0,0))
????screen.blit(missiled,?(x1-width+(x1-C[0]),y1-height/2+(y1-C[1])))
????screen.blit(textc,?(x,y))?#鼠標用一個紅色*代替
????pygame.display.update()

最后

這是一個簡單的,用 Python 實現的自動跟蹤算法,真正的導彈攔截跟蹤算法要復雜很多。

審核編輯:彭靜
聲明:本文內容及配圖由入駐作者撰寫或者入駐合作網站授權轉載。文章觀點僅代表作者本人,不代表電子發燒友網立場。文章及其配圖僅供工程師學習之用,如有內容侵權或者其他違規問題,請聯系本站處理。 舉報投訴
  • 代碼
    +關注

    關注

    30

    文章

    4827

    瀏覽量

    69054
  • 自動跟蹤
    +關注

    關注

    0

    文章

    21

    瀏覽量

    9383
  • python
    +關注

    關注

    56

    文章

    4807

    瀏覽量

    85039

原文標題:太強了,手擼一款導彈跟蹤算法(Python版)

文章出處:【微信號:vision263com,微信公眾號:新機器視覺】歡迎添加關注!文章轉載請注明出處。

收藏 人收藏

    評論

    相關推薦

    DRV2605:自動諧振追蹤要點剖析

    DRV260x系列器件使用一種名為自動諧振追蹤的特殊LRA控制算法。自動諧振追蹤使用LRA的反電動勢 (back-EMF) 來檢測和
    發表于 10-29 11:36 ?9308次閱讀
    DRV2605:<b class='flag-5'>自動</b>諧振<b class='flag-5'>追蹤</b>要點剖析

    盤點史上最全的Python算法

    本文是一些機器人算法(特別是自動導航算法)的Python代碼合集。其主要特點有以下三點:選擇了在實踐中廣泛應用的算法;依賴最少;容易閱讀,容
    的頭像 發表于 02-21 10:04 ?6081次閱讀

    Python的Apriori算法和FP-Growth算法是什么

    [源碼和文檔分享]基于Python實現的Apriori算法和FP-Growth算法的頻繁項集挖掘的研究與實現
    發表于 06-04 12:49

    追蹤算法自行車模型

    追蹤算法自行車模型自行車模型是對汽車運動描述的一種簡化方法,其基于幾個假設:忽略車輛垂直方向上的運動假設前面的兩個輪胎具有一致的角度和轉速,后面也如此,這樣車輛就可以簡化成自行車結構車輛運動
    發表于 08-17 08:58

    什么是純追蹤算法?

    什么是純追蹤算法
    發表于 11-22 06:08

    什么是基追蹤算法?基于改進基追蹤方法的信號去噪

    追蹤(basis pursuit)算法是一種用來求解未知參量L1范數最小化的等式約束問題的算法。字典的構造 對于觀測到的離散信號s∈H,H為Hilbert空間,給定H中的字典φ={φγ,γ∈Γ},其中Γ為指標集,φγ為H中的基
    發表于 12-01 16:04 ?1.1w次閱讀
    什么是基<b class='flag-5'>追蹤</b><b class='flag-5'>算法</b>?基于改進基<b class='flag-5'>追蹤</b>方法的信號去噪

    蟻群算法python編程實現

    本文主要介紹了Python編程實現蟻群算法詳解,涉及螞蟻算法的簡介,主要原理及公式,以及Python中的實現代碼,具有一定參考價值。
    發表于 02-02 10:36 ?7498次閱讀
    蟻群<b class='flag-5'>算法</b><b class='flag-5'>python</b>編程實現

    光線追蹤算法匯總

    在基本光線追蹤算法中,只追蹤有限數目的光線。
    的頭像 發表于 05-11 15:58 ?1.7w次閱讀
    光線<b class='flag-5'>追蹤</b><b class='flag-5'>算法</b>匯總

    組合29個簡單Python代碼塊,自動發現新算法

    本文提出了一種基于演化算法的搜索策略,將其AAD中實現。AAD可以基于Python的子集作為語法結構,組合成復雜度相對較高的程序(循環,嵌套塊,嵌套函數調用等),并生成可執行的Python代碼。在本文中使用AAD來發現數組/向量
    的頭像 發表于 04-19 13:47 ?3577次閱讀

    Python模擬導彈自動追蹤的代碼實例

    自動追蹤算法,在我們制作射擊類游戲時經常會用到。這個聽起來很高大上的東西,其實并不是軍事學的專利,從數學上來說就是解微分方程,這個沒有點數學基礎是很難算出來的。但是我們有了計算機就不一樣了,依靠
    的頭像 發表于 06-13 16:35 ?1466次閱讀
    <b class='flag-5'>Python</b>模擬導彈<b class='flag-5'>自動</b><b class='flag-5'>追蹤</b>的代碼實例

    Python實現所有算法-基本牛頓法

    Python實現所有算法-二分法 Python實現所有算法-力系統是否靜態平衡 Python實現所有算法
    的頭像 發表于 07-13 10:40 ?1683次閱讀

    Python實現自動駕駛

    今天來一個好玩一點的,汽車已經能夠自動駕駛了,Python怎么能沒有呢?這不,必須安排上。 一、安裝環境 gym是用于開發和比較強化學習算法的工具包,在python中安裝gym庫和其中
    發表于 06-06 10:43 ?1次下載
    <b class='flag-5'>Python</b>實現<b class='flag-5'>自動</b>駕駛

    [源代碼]Python算法詳解

    [源代碼]Python算法詳解[源代碼]Python算法詳解
    發表于 06-06 17:50 ?0次下載

    如何使用Python進行圖像識別的自動學習自動訓練?

    如何使用Python進行圖像識別的自動學習自動訓練? 使用Python進行圖像識別的自動學習和自動
    的頭像 發表于 01-12 16:06 ?652次閱讀

    Python建模算法與應用

    上成為理想的腳本語言,特別適用于快速的應用程序開發。本文將詳細介紹Python在建模算法中的應用,包括常見的建模算法、Python在建模中的優勢、常用庫以及實際案例。
    的頭像 發表于 07-24 10:41 ?659次閱讀
    全讯网网址xb112| 皇冠网vip小说| 百家乐官网猜大小规则| 太阳城百家乐作弊| 网络娱乐| 百家乐官网线路图分析| 威尼斯人娱乐怎么样| 澳门百家乐官网怎样下注| 百家乐棋牌官网| 文昌市| 百家乐在线直播| 百家乐怎么玩| 永利高百家乐现金网| 皇冠网全讯通| 百家乐试玩全讯网2| 沙湾县| 澳门百家乐博客| 百家乐官网技巧运气| 百家乐有无规律可循| 玛沁县| 百家乐7scs娱乐平台| 百家乐官网分析软件下| 澳门百家乐赌场娱乐网规则| 线上百家乐官网赌法| 大发888官网df888| 赌博百家乐官网的玩法技巧和规则| 九乐棋牌下载| 正品百家乐官网网站| 菲律宾太子娱乐城| 温州市百家乐ktv招聘| 澳门百家乐官网网上直赌| 大发888娱乐城送钱| 24山向吉凶详解| 莱西市| 百家乐平注法到656| 澳门百家乐官网职业| 大发888公司赌场| 百家乐游戏论坛| 百家乐官网视频多开器| 威尼斯人娱乐城提款| 三合四局24向黄泉|