1.一種群體移動(dòng)物聯(lián)網(wǎng)機(jī)器人控制方法,本方法的核心思想是令物聯(lián)網(wǎng)機(jī)器人的控制函數(shù)中包含時(shí)間項(xiàng),使其成為關(guān)于時(shí)間的函數(shù),當(dāng)時(shí)間改變時(shí)控制函數(shù)也隨之變化;此外,考慮到實(shí)際的機(jī)器人群體中存在成員分工不同及通信延遲,允許各機(jī)器人個(gè)體在同一時(shí)間點(diǎn)受不同函數(shù)驅(qū)動(dòng),以此進(jìn)一步增加算法靈活性;其特征在于:
以下給出算法實(shí)現(xiàn)細(xì)節(jié):
設(shè)集合SV={(Vx1+Vy1),(Vx2+Vy2),…,(Vxn+Vyn)}代表位置移動(dòng)類控制函數(shù)集,Vx1,Vx2,…,Vxn為不同類型的關(guān)于位置的函數(shù),用于指定機(jī)器人在二維空間中向x軸方向的位移,Vy1,Vy2…,Vyn同上,用于指定y軸方向的位移;設(shè)集合SO={O1,O2,…,Om}代表其它類型控制函數(shù)集,O1,O2,…,Om為控制機(jī)器人實(shí)現(xiàn)除位置移動(dòng)外的某種特定功能的控制函數(shù);令S={Ct1E1,Ct2E2,…,CtNEN}代表各種子控制函數(shù)的集合,其中1≤N≤m+n,E1,E2,…,EN表示不同類型的子控制函數(shù),各函數(shù)均應(yīng)取自SV或SO,即Ei∈SV∪SO,1≤i≤N,參數(shù)用于引入時(shí)間變量t;在任意時(shí)刻t,作用在某機(jī)器人個(gè)體上的控制函數(shù)f(t)表示為:
上式表示在任意時(shí)刻t,作用于一個(gè)可控機(jī)器人個(gè)體上的子控制函數(shù)有且只有一個(gè),t0,t1,…,tN將時(shí)間分為N段,當(dāng)t從t0到tN變化時(shí),集合S中的子控制函數(shù)將在每個(gè)時(shí)間段內(nèi)依次對(duì)機(jī)器人個(gè)體產(chǎn)生作用,輪流主導(dǎo)機(jī)器人行為。
2.根據(jù)權(quán)利要求1所述的一種群體移動(dòng)物聯(lián)網(wǎng)機(jī)器人控制方法,其特征在于:合理規(guī)劃集合S中的子控制函數(shù)實(shí)現(xiàn)豐富的、隨時(shí)間變化的控制功能;任何能夠控制機(jī)器人實(shí)現(xiàn)某種特定功能的控制函數(shù)均可作為集合S中的子控制函數(shù)。
3.根據(jù)權(quán)利要求1所述的一種群體移動(dòng)物聯(lián)網(wǎng)機(jī)器人控制方法,其特征在于:除提前規(guī)劃外,集合S中的子控制函數(shù)還可實(shí)時(shí)、動(dòng)態(tài)地進(jìn)行增減,以滿足復(fù)雜多變的實(shí)際工作需求。
4.根據(jù)權(quán)利要求1所述的一種群體移動(dòng)物聯(lián)網(wǎng)機(jī)器人控制方法,其特征在于:任何能夠控制機(jī)器人實(shí)現(xiàn)某種特定功能包括但姿態(tài)調(diào)整、數(shù)據(jù)采集、通信及各類與周圍環(huán)境交互的動(dòng)作。
5.根據(jù)權(quán)利要求1所述的一種群體移動(dòng)物聯(lián)網(wǎng)機(jī)器人控制方法,其特征在于:本方法應(yīng)用于物聯(lián)網(wǎng)機(jī)器人控制時(shí)基本控制流程如下,
S1.物聯(lián)網(wǎng)機(jī)器人接收外部指令,規(guī)劃任務(wù)及任務(wù)時(shí)間,即構(gòu)建或修改控制函數(shù)集合S;
S2.根據(jù)規(guī)劃準(zhǔn)備一項(xiàng)新任務(wù),即設(shè)置或變更控制函數(shù),任何控制函數(shù)都應(yīng)取從上一步中構(gòu)建或修改的控制函數(shù)集合S中選取;
S3.執(zhí)行當(dāng)前任務(wù),即機(jī)器人在當(dāng)前控制函數(shù)作用下行動(dòng);
S4.檢查是否有修改指令的請(qǐng)求,即是否需要修改或重建控制函數(shù)集合S;若為是,則轉(zhuǎn)至步驟S1,若為否,則繼續(xù)下一步;
S5.判斷當(dāng)前任務(wù)是否已耗盡預(yù)定時(shí)間,即是否已超出當(dāng)前控制函數(shù)作用的時(shí)間范圍;若為是,則進(jìn)行下一步,若為否,則轉(zhuǎn)至步驟S3繼續(xù)執(zhí)行當(dāng)前任務(wù);
S6.判斷當(dāng)前任務(wù)是否為預(yù)定的最后一項(xiàng)任務(wù);若為是,則流程結(jié)束,若為否,則轉(zhuǎn)至S2準(zhǔn)備下一項(xiàng)任務(wù)。
6.根據(jù)權(quán)利要求1所述的一種群體移動(dòng)物聯(lián)網(wǎng)機(jī)器人控制方法,其特征在于:物聯(lián)網(wǎng)機(jī)器人集群運(yùn)動(dòng)控制中,當(dāng)個(gè)體間同時(shí)存在吸引及排斥的相互作用時(shí),每個(gè)個(gè)體能夠在特定距離下達(dá)到受力平衡,而這可以成為群體構(gòu)成穩(wěn)定陣型的保障,建立如下控制函數(shù)模型:
Vxi,Vyi分別用于指定機(jī)器人沿x軸和y軸方向的位移,分別為x軸和y軸方向的單位向量,x,y為該機(jī)器人的當(dāng)前坐標(biāo),xj,yj代表該機(jī)器人附近其他第j個(gè)機(jī)器人的坐標(biāo),如果該機(jī)器人附近有M個(gè)其他機(jī)器人,則j為1到M之間的整數(shù);k為比例系數(shù),當(dāng)該機(jī)器人互相位于對(duì)方的吸引區(qū)內(nèi)時(shí),引力占主導(dǎo)地位,相應(yīng)的k應(yīng)取一負(fù)數(shù),當(dāng)機(jī)器人間距在平衡區(qū)內(nèi)時(shí),兩機(jī)器人間無(wú)互相作用力,k為0,否則斥力占主導(dǎo)地位,k取一正數(shù);設(shè)定不同的引力區(qū),平衡區(qū)及排斥區(qū)范圍即可實(shí)現(xiàn)不同的控制效果;
現(xiàn)考慮如下情形:在二維環(huán)境中隨機(jī)放置若干物聯(lián)網(wǎng)機(jī)器人,個(gè)體在t0時(shí)刻處于靜止?fàn)顟B(tài),此時(shí)控制函數(shù)表示為:
Vx1=0
Vy1=0
在時(shí)間點(diǎn)t1時(shí)各物聯(lián)網(wǎng)機(jī)器人接收外部指令進(jìn)行必要的初始化設(shè)置,在t2完成操作,本階段控制函數(shù)設(shè)為O1;
之后各機(jī)器人根據(jù)指令執(zhí)行聚攏操作,此階段控制函數(shù)取為:
的取值表示當(dāng)受控機(jī)器人與周圍第j個(gè)機(jī)器人的間距dj<10時(shí)兩個(gè)體相互排斥,dj≥30時(shí)兩個(gè)體相互吸引,排斥作用強(qiáng)于吸引作用以避免碰撞;聚攏完成后希望各個(gè)體有序分散,重新構(gòu)成相對(duì)松散的陣型,設(shè)這一行為在時(shí)間點(diǎn)t3開(kāi)始,t4點(diǎn)結(jié)束,則此階段控制函數(shù)可取為:
綜合考慮以上各階段函數(shù),令SV={(Vx1+Vy1),(Vx2+Vy2),(Vx3+Vy3)}為位置移動(dòng)類控制函數(shù)集,SO={O1}為其他類型控制函數(shù)集,則S={Ct1E1,Ct2E2,Ct3E3,Ct4E4},其中
E3=(Vx2+Vy2),在任意時(shí)刻t,作用在某機(jī)器人個(gè)體上的控制函數(shù)表示為:
上述控制函數(shù)作用于物聯(lián)網(wǎng)機(jī)器人實(shí)現(xiàn)集群陣型控制。