麻豆精品无码国产在线播放,国产亚洲精品成人AA片新蒲金,国模无码大尺度一区二区三区,神马免费午夜福利剧场

一種群體移動物聯網機器人控制方法與流程

文檔序號:12096452閱讀:來源:國知局

技術特征:

1.一種群體移動物聯網機器人控制方法,本方法的核心思想是令物聯網機器人的控制函數中包含時間項,使其成為關于時間的函數,當時間改變時控制函數也隨之變化;此外,考慮到實際的機器人群體中存在成員分工不同及通信延遲,允許各機器人個體在同一時間點受不同函數驅動,以此進一步增加算法靈活性;其特征在于:

以下給出算法實現細節:

設集合SV={(Vx1+Vy1),(Vx2+Vy2),…,(Vxn+Vyn)}代表位置移動類控制函數集,Vx1,Vx2,…,Vxn為不同類型的關于位置的函數,用于指定機器人在二維空間中向x軸方向的位移,Vy1,Vy2…,Vyn同上,用于指定y軸方向的位移;設集合SO={O1,O2,…,Om}代表其它類型控制函數集,O1,O2,…,Om為控制機器人實現除位置移動外的某種特定功能的控制函數;令S={Ct1E1,Ct2E2,…,CtNEN}代表各種子控制函數的集合,其中1≤N≤m+n,E1,E2,…,EN表示不同類型的子控制函數,各函數均應取自SV或SO,即Ei∈SV∪SO,1≤i≤N,參數用于引入時間變量t;在任意時刻t,作用在某機器人個體上的控制函數f(t)表示為:

<mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>N</mi> </munderover> <msub> <mi>C</mi> <mrow> <mi>t</mi> <mi>i</mi> </mrow> </msub> <msub> <mi>E</mi> <mi>i</mi> </msub> </mrow>

上式表示在任意時刻t,作用于一個可控機器人個體上的子控制函數有且只有一個,t0,t1,…,tN將時間分為N段,當t從t0到tN變化時,集合S中的子控制函數將在每個時間段內依次對機器人個體產生作用,輪流主導機器人行為。

2.根據權利要求1所述的一種群體移動物聯網機器人控制方法,其特征在于:合理規劃集合S中的子控制函數實現豐富的、隨時間變化的控制功能;任何能夠控制機器人實現某種特定功能的控制函數均可作為集合S中的子控制函數。

3.根據權利要求1所述的一種群體移動物聯網機器人控制方法,其特征在于:除提前規劃外,集合S中的子控制函數還可實時、動態地進行增減,以滿足復雜多變的實際工作需求。

4.根據權利要求1所述的一種群體移動物聯網機器人控制方法,其特征在于:任何能夠控制機器人實現某種特定功能包括但姿態調整、數據采集、通信及各類與周圍環境交互的動作。

5.根據權利要求1所述的一種群體移動物聯網機器人控制方法,其特征在于:本方法應用于物聯網機器人控制時基本控制流程如下,

S1.物聯網機器人接收外部指令,規劃任務及任務時間,即構建或修改控制函數集合S;

S2.根據規劃準備一項新任務,即設置或變更控制函數,任何控制函數都應取從上一步中構建或修改的控制函數集合S中選取;

S3.執行當前任務,即機器人在當前控制函數作用下行動;

S4.檢查是否有修改指令的請求,即是否需要修改或重建控制函數集合S;若為是,則轉至步驟S1,若為否,則繼續下一步;

S5.判斷當前任務是否已耗盡預定時間,即是否已超出當前控制函數作用的時間范圍;若為是,則進行下一步,若為否,則轉至步驟S3繼續執行當前任務;

S6.判斷當前任務是否為預定的最后一項任務;若為是,則流程結束,若為否,則轉至S2準備下一項任務。

6.根據權利要求1所述的一種群體移動物聯網機器人控制方法,其特征在于:物聯網機器人集群運動控制中,當個體間同時存在吸引及排斥的相互作用時,每個個體能夠在特定距離下達到受力平衡,而這可以成為群體構成穩定陣型的保障,建立如下控制函數模型:

<mrow> <msub> <mi>V</mi> <mi>xi</mi> </msub> <mo>=</mo> <munderover> <mi>&Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>M</mi> </munderover> <mfrac> <mrow> <msubsup> <mi>k</mi> <mi>j</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> </mrow> <msqrt> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </msqrt> </mfrac> <mover> <mi>&iota;</mi> <mo>&RightArrow;</mo> </mover> </mrow>

<mrow> <msub> <mi>V</mi> <mi>xi</mi> </msub> <mo>=</mo> <munderover> <mi>&Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>M</mi> </munderover> <mfrac> <mrow> <msubsup> <mi>k</mi> <mi>j</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> </mrow> <msqrt> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mtext>j</mtext> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </msqrt> </mfrac> <mtext></mtext> <mover> <mi>j</mi> <mo>&RightArrow;</mo> </mover> </mrow>

Vxi,Vyi分別用于指定機器人沿x軸和y軸方向的位移,分別為x軸和y軸方向的單位向量,x,y為該機器人的當前坐標,xj,yj代表該機器人附近其他第j個機器人的坐標,如果該機器人附近有M個其他機器人,則j為1到M之間的整數;k為比例系數,當該機器人互相位于對方的吸引區內時,引力占主導地位,相應的k應取一負數,當機器人間距在平衡區內時,兩機器人間無互相作用力,k為0,否則斥力占主導地位,k取一正數;設定不同的引力區,平衡區及排斥區范圍即可實現不同的控制效果;

現考慮如下情形:在二維環境中隨機放置若干物聯網機器人,個體在t0時刻處于靜止狀態,此時控制函數表示為:

Vx1=0

Vy1=0

在時間點t1時各物聯網機器人接收外部指令進行必要的初始化設置,在t2完成操作,本階段控制函數設為O1

之后各機器人根據指令執行聚攏操作,此階段控制函數取為:

<mrow> <msub> <mi>V</mi> <mi>xi</mi> </msub> <mo>=</mo> <munderover> <mi>&Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>M</mi> </munderover> <mfrac> <mrow> <msubsup> <mi>k</mi> <mi>j</mi> <mrow> <mo>(</mo> <mi>i</mi> <mo>)</mo> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> </mrow> <msqrt> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </msqrt> </mfrac> <mover> <mi>&iota;</mi> <mo>&RightArrow;</mo> </mover> </mrow>

<mrow> <msub> <mi>V</mi> <mrow> <mi>y</mi> <mn>2</mn> </mrow> </msub> <mo>=</mo> <munderover> <mi>&Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>M</mi> </munderover> <mfrac> <mrow> <msubsup> <mi>k</mi> <mi>j</mi> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> </mrow> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mover> <mi>j</mi> <mo>&RightArrow;</mo> </mover> </mrow>

<mrow> <msubsup> <mi>k</mi> <mi>j</mi> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </msubsup> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <mn>6</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>d</mi> <mi>j</mi> </msub> <mo>&lt;</mo> <mn>10</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>0</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mn>10</mn> <mo>&le;</mo> <msub> <mi>d</mi> <mi>j</mi> </msub> <mo>&le;</mo> <mn>30</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>2</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>d</mi> <mi>j</mi> </msub> <mo>&GreaterEqual;</mo> <mn>30</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>

的取值表示當受控機器人與周圍第j個機器人的間距dj<10時兩個體相互排斥,dj≥30時兩個體相互吸引,排斥作用強于吸引作用以避免碰撞;聚攏完成后希望各個體有序分散,重新構成相對松散的陣型,設這一行為在時間點t3開始,t4點結束,則此階段控制函數可取為:

<mrow> <msub> <mi>V</mi> <mrow> <mi>x</mi> <mn>3</mn> </mrow> </msub> <mo>=</mo> <munderover> <mi>&Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>M</mi> </munderover> <mfrac> <mrow> <msubsup> <mi>k</mi> <mi>j</mi> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> </mrow> <msqrt> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>i</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </msqrt> </mfrac> <mover> <mi>&iota;</mi> <mo>&RightArrow;</mo> </mover> </mrow>

<mrow> <msub> <mi>V</mi> <mrow> <mi>y</mi> <mn>3</mn> </mrow> </msub> <mo>=</mo> <munderover> <mi>&Sigma;</mi> <mrow> <mi>j</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>M</mi> </munderover> <mfrac> <mrow> <msubsup> <mi>k</mi> <mi>j</mi> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> </mrow> <msqrt> <mrow> <msup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>x</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> <mo>+</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>y</mi> <mi>j</mi> </msub> <mo>-</mo> <mi>y</mi> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> </msqrt> </mfrac> <mover> <mi>j</mi> <mo>&RightArrow;</mo> </mover> </mrow>

<mrow> <msub> <mi>k</mi> <mn>3</mn> </msub> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <mn>6</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>d</mi> <mi>j</mi> </msub> <mo>&lt;</mo> <mn>60</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>0</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <mn>60</mn> <mo>&le;</mo> <msub> <mi>d</mi> <mi>j</mi> </msub> <mo>&le;</mo> <mn>90</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mn>2</mn> <mo>,</mo> </mrow> </mtd> <mtd> <mrow> <msub> <mi>d</mi> <mi>j</mi> </msub> <mo>&GreaterEqual;</mo> <mn>60</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>

綜合考慮以上各階段函數,令SV={(Vx1+Vy1),(Vx2+Vy2),(Vx3+Vy3)}為位置移動類控制函數集,SO={O1}為其他類型控制函數集,則S={Ct1E1,Ct2E2,Ct3E3,Ct4E4},其中

E3=(Vx2+Vy2),在任意時刻t,作用在某機器人個體上的控制函數表示為:

<mrow> <mi>f</mi> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>4</mn> </munderover> <msub> <mi>C</mi> <mrow> <mi>t</mi> <mi>i</mi> </mrow> </msub> <msub> <mi>E</mi> <mi>i</mi> </msub> </mrow>

上述控制函數作用于物聯網機器人實現集群陣型控制。

當前第2頁1 2 3 
網友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1
主站蜘蛛池模板: 湖口县| 敦煌市| 邢台县| 石屏县| 泊头市| 延津县| 南川市| 永顺县| 方山县| 台东市| 闽清县| 蓝田县| 钦州市| 济南市| 介休市| 甘孜县| 河北省| 会同县| 景泰县| 莎车县| 亚东县| 临高县| 神木县| 兴化市| 尖扎县| 永和县| 长泰县| 泰州市| 东乌| 云林县| 金沙县| 昌平区| 湘潭县| 武冈市| 清涧县| 封开县| 安岳县| 余干县| 阿拉善左旗| 诸暨市| 托里县|