午夜精品一区,国产av人人夜夜澡人人爽麻豆,欧美美女一区二区,激情欧美一区二区三区中文字幕

龍門架行走機構(gòu)通常應(yīng)用于工業(yè)機器人，例如焊接機器人、激光切割機器人等，龍門架行走機構(gòu)包括兩條平行的縱梁以及跨設(shè)在兩條縱梁上的行走橫梁，行走橫梁的兩端分別設(shè)有構(gòu)造相同的**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)，**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)能夠驅(qū)動行走橫梁在兩條縱梁上行走，工業(yè)機器人安裝在行走橫梁上，跟隨行走橫梁行走。

雖然**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)采用相同的傳動裝置和控制方法，但往往因為機械加工制造誤差及**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)之間的動態(tài)耦合導(dǎo)致載荷波動，極易造成驅(qū)動系統(tǒng)失衡，引發(fā)**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)不同步現(xiàn)象，影響加工精度。

**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)的同步控制(下稱雙驅(qū)同步控制)，不僅要保證單軸(驅(qū)動機構(gòu)通常為電機，通過電機輸出軸輸出動力)的準確控制，使單軸具備較快的跟隨響應(yīng)性和較好的抗干擾性，又要實現(xiàn)雙軸之間的同步配合，其所需要的高精度和高穩(wěn)定性也相應(yīng)對雙驅(qū)系統(tǒng)的同步性能及其控制技術(shù)提出了更高的要求。由于雙驅(qū)同步控制技術(shù)還未完全形成系統(tǒng)的理論作為研究依據(jù)，因此對于雙驅(qū)同步控制的同步性能的研究有意義重大。

在雙驅(qū)同步控制系統(tǒng)中，同步是指**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)的運動速度保持一致。傳統(tǒng)的雙驅(qū)同步控制主要采用機械總軸同步的方式，即采用一臺大功率主電機驅(qū)動機械主軸，通過同步帶、齒輪等傳動機構(gòu)將主電機的運動分別傳遞給兩個同步軸，這種同步方式一般占用較大空間，并且齒輪傳動比等機械參數(shù)的波動會引起雙軸傳動比、轉(zhuǎn)速的變化，產(chǎn)生由機械間隙帶來的不確定性誤差，導(dǎo)致同步控制精度不高，這些缺陷限制了機械同步方式的進一步應(yīng)用。

經(jīng)過國內(nèi)外學(xué)者對同步控制的長期研究及伺服控制技術(shù)的不斷發(fā)展，人們逐漸發(fā)現(xiàn)電氣同步控制方式不僅不會受到數(shù)控裝備使用空間的限制，由機械間隙帶來的不確定性誤差也更小，相對于傳統(tǒng)的機械同步方式有著得天獨厚的優(yōu)勢，能夠?qū)崿F(xiàn)精度更高，同步性更好的控制。目前的雙驅(qū)同步控制策略主要分為三種結(jié)構(gòu)方式：并行控制、主從控制和交叉耦合控制。

并行控制系統(tǒng)的架構(gòu)如圖1所示，它是一種相對簡單的雙驅(qū)同步控制系統(tǒng)，采用結(jié)構(gòu)和參數(shù)完全相同的兩套平行伺服驅(qū)動軸。兩軸之間沒有任何交互和影響，屬于同步開環(huán)控制系統(tǒng)，存在一定的累積誤差和同步誤差，一般只適用于精度要求不高的場合。

主從控制系統(tǒng)的架構(gòu)如圖2所示，它采用主動軸帶動從動軸的形式，即主動軸的輸出作為從動軸的輸入，在這種控制方式下當(dāng)主動軸受到擾動和影響時，可以反映到從動軸上，從動軸會進行相應(yīng)的跟隨及調(diào)整來保持一定的同步性，但是也會因為伺服系統(tǒng)的延時形成軸的跟蹤誤差。反之，從動軸受到擾動和影響時反映不到主動軸上，主動軸不能進行相應(yīng)的跟隨及調(diào)整，兩軸之間會產(chǎn)生同步誤差，在應(yīng)用上有一定的局限性。

交叉耦合控制系統(tǒng)的架構(gòu)如圖3所示，它是將各軸輸入的位置差和速度差作為反饋信號，系統(tǒng)再進行相應(yīng)的誤差補償，避免了主從控制方式下從軸輸入延遲、擾動不能反饋到主軸上的缺點，同步性能更好。

以上雙驅(qū)同步控制策略均為傳統(tǒng)理念，機械化思維，重復(fù)糾錯造成硬件資源浪費，高速同步效果不理想。對于智能機器時代已不太適用，需要一種更好的學(xué)習(xí)性同步策略才能適應(yīng)智能裝備產(chǎn)業(yè)升級。

發(fā)明內(nèi)容

本發(fā)明的目的在于提供一種用于龍門架行走機構(gòu)的雙驅(qū)智能同步方法，能夠控制雙驅(qū)高速高精度同步。

為解決上述技術(shù)問題，本發(fā)明采用的一個技術(shù)方案是：提供一種用于龍門架行走機構(gòu)的雙驅(qū)智能同步方法，所述龍門架行走機構(gòu)包括兩條平行的縱梁以及跨設(shè)在兩條縱梁上的行走橫梁，所述行走橫梁的兩端分別設(shè)有構(gòu)造相同的**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)，所述**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)能夠驅(qū)動行走橫梁在兩條縱梁上行走，其特征在于，所述雙驅(qū)智能同步方法包括：

S1：同時控制**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)以預(yù)設(shè)速度驅(qū)動行走橫梁行走預(yù)定行程，實時測量行走橫梁兩端實際行程的位置偏差。

S2：重復(fù)步驟S1，判斷**次的位置偏差與第二次的位置偏差之間的差值是否大于設(shè)定值，如果否，則進行步驟S3。

S3：根據(jù)第二次的位置偏差計算位置偏差曲線。

S4：判斷位置偏差曲線的條數(shù)是否達到3條，如果是，則進行步驟S5，如果否，則以預(yù)定速度增量增大所述預(yù)設(shè)速度，并重復(fù)進行一輪步驟S1至S3。

S5：根據(jù)3條位置偏差曲線計算平均位置偏差曲線，計算公式為：

ΔF＝{[F(x3)-F(x2)]/ΔV+[F(x2)-F(x1)]/ΔV}/2

F(X)＝V×(ΔF/ΔV)

其中，ΔV為所述預(yù)定速度增量，F(xiàn)(x1)為**輪測量位置偏差后得到的位置偏差曲線，F(xiàn)(x2)為第二輪測量位置偏差后得到的位置偏差曲線，F(xiàn)(x3)為第三輪測量位置偏差后得到的位置偏差曲線，F(xiàn)(X)為平均位置偏差曲線，V為指令速度，其大于第三輪測量位置偏差時的預(yù)設(shè)速度。

S6：控制**驅(qū)動機構(gòu)驅(qū)動行走橫梁行走預(yù)定時間，實時測量行走橫梁兩端實際行程的追蹤超差。

S7：重復(fù)進行兩輪步驟S6，根據(jù)三輪測量到的追蹤超差計算**驅(qū)動機構(gòu)的速度變化曲線，計算公式為：

Δt＝(t3-t2+t2-t1)/2

r1＝(l3-l2+l2-l1)/Δt

f(v1)＝M×V×F(X)/r1

其中，t1為**輪的預(yù)設(shè)時間，t2為第二輪的預(yù)設(shè)時間，t3為第三輪的預(yù)設(shè)時間，r1為**驅(qū)動機構(gòu)的追蹤衰減震蕩率，l1為**輪的追蹤超差，l2為第二輪的追蹤超差，l3為第三輪的追蹤超差，M為同步系數(shù)，f(v1)為**驅(qū)動機構(gòu)的速度變化曲線。

S8：控制第二驅(qū)動機構(gòu)驅(qū)動行走橫梁行走預(yù)設(shè)時間，實時測量行走橫梁兩端實際行程的追蹤超差。

S9：重復(fù)進行兩輪步驟S8，根據(jù)三輪測量到的追蹤超差計算第二驅(qū)動機構(gòu)的速度變化曲線，計算公式為：

Δt＝(t3-t2+t2-t1)/2

r2＝(l3-l2+l2-l1)/Δt

f(v2)＝M×V×F(X)/r2

其中，r2為第二驅(qū)動機構(gòu)的追蹤衰減震蕩率，f(v2)為第二驅(qū)動機構(gòu)的速度變化曲線。

其中，對于不同速度，兩個驅(qū)動機構(gòu)的衰減震蕩曲線是不一樣的。因此，需進行三次主從控制行走采樣，每次的行走速度遞增，以此計算出追蹤衰減震蕩率。

S10：根據(jù)**驅(qū)動機構(gòu)的速度變化曲線和第二驅(qū)動機構(gòu)的速度變化曲線計算平均速度變化曲線，計算公式為：

f(v)＝{f(v1)+f(v2)}/2。

S11：根據(jù)平均速度變化曲線計算**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)的同步動態(tài)速度曲線，計算公式為：

F(v)＝μf(v)

其中，F(xiàn)(v)為同步動態(tài)速度曲線，μ為同步精度差比。

優(yōu)選的，所述步驟S2還包括：如果是，則進行步驟S12；

S12：重復(fù)步驟S1，直至**次的位置偏差與第二次的位置偏差之間的差值小于設(shè)定值為止。

區(qū)別于現(xiàn)有技術(shù)的情況，本發(fā)明的有益效果是：通過模擬人的認路過程，利用辨識記憶，實現(xiàn)高速高精度雙驅(qū)同步控制，摒棄了重復(fù)閉環(huán)、追蹤、交叉耦合等復(fù)雜過程，使控制更為簡便。

附圖說明

圖1是并行控制系統(tǒng)的架構(gòu)圖；

圖2是主從控制系統(tǒng)的架構(gòu)圖。

圖3是交叉耦合控制系統(tǒng)的架構(gòu)圖。

圖4是本發(fā)明實施例提供的用于龍門架行走機構(gòu)的雙驅(qū)智能同步方法的流程示意圖。

具體實施方式

下面將結(jié)合本發(fā)明實施例中的附圖，對本發(fā)明實施例中的技術(shù)方案進行清楚、完整地描述，顯然，所描述的實施例僅是本發(fā)明的一部分實施例，而不是全部的實施例。基于本發(fā)明中的實施例，本領(lǐng)域普通技術(shù)人員在沒有做出創(chuàng)造性勞動前提下所獲得的所有其他實施例，都屬于本發(fā)明保護的范圍。

參閱圖4，本發(fā)明實施例中，龍門架行走機構(gòu)包括兩條平行的縱梁以及跨設(shè)在兩條縱梁上的行走橫梁，行走橫梁的兩端分別設(shè)有構(gòu)造相同的**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)，**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)能夠驅(qū)動行走橫梁在兩條縱梁上行走，本實施例的雙驅(qū)智能同步方法包括以下步驟：

S1：同時控制**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)以預(yù)設(shè)速度驅(qū)動行走橫梁行走預(yù)定行程，實時測量行走橫梁兩端實際行程的位置偏差；

S2：重復(fù)步驟S1，判斷**次的位置偏差與第二次的位置偏差之間的差值是否大于設(shè)定值，如果否，則進行步驟S3；

S3：根據(jù)第二次的位置偏差計算位置偏差曲線；

S4：判斷位置偏差曲線的條數(shù)是否達到3條，如果是，則進行步驟S5，如果否，則以預(yù)定速度增量增大所述預(yù)設(shè)速度，并重復(fù)進行一輪步驟S1至S3；

S5：根據(jù)3條位置偏差曲線計算平均位置偏差曲線，計算公式為：

ΔF＝{[F(x3)-F(x2)]/ΔV+[F(x2)-F(x1)]/ΔV}/2

F(X)＝V×(ΔF/ΔV)

其中，ΔV為所述預(yù)定速度增量，F(xiàn)(x1)為**輪測量位置偏差后得到的位置偏差曲線，F(xiàn)(x2)為第二輪測量位置偏差后得到的位置偏差曲線，F(xiàn)(x3)為第三輪測量位置偏差后得到的位置偏差曲線，F(xiàn)(X)為平均位置偏差曲線，V為指令速度，其大于第三輪測量位置偏差時的預(yù)設(shè)速度；

S6：控制**驅(qū)動機構(gòu)驅(qū)動行走橫梁行走預(yù)定時間，實時測量行走橫梁兩端實際行程的追蹤超差；

S7：重復(fù)進行兩輪步驟S6，根據(jù)三輪測量到的追蹤超差計算**驅(qū)動機構(gòu)的速度變化曲線，計算公式為：

Δt＝(t3-t2+t2-t1)/2

r1＝(l3-l2+l2-l1)/Δt

f(v1)＝M×V×F(X)/r1

其中，t1為**輪的預(yù)設(shè)時間，t2為第二輪的預(yù)設(shè)時間，t3為第三輪的預(yù)設(shè)時間，r1為**驅(qū)動機構(gòu)的追蹤衰減震蕩率，l1為**輪的追蹤超差，l2為第二輪的追蹤超差，l3為第三輪的追蹤超差，M為同步系數(shù)，f(v1)為**驅(qū)動機構(gòu)的速度變化曲線。

同步系數(shù)M的單位是1/S，由機械結(jié)構(gòu)慣性決定，由實驗獲得。

S8：控制第二驅(qū)動機構(gòu)驅(qū)動行走橫梁行走預(yù)設(shè)時間，實時測量行走橫梁兩端實際行程的追蹤超差；

S9：重復(fù)進行兩輪步驟S8，根據(jù)三輪測量到的追蹤超差計算第二驅(qū)動機構(gòu)的速度變化曲線，計算公式為：

Δt＝(t3-t2+t2-t1)/2

r2＝(l3-l2+l2-l1)/Δt

f(v2)＝M×V×F(X)/r2

其中，r2為第二驅(qū)動機構(gòu)的追蹤衰減震蕩率，f(v2)為第二驅(qū)動機構(gòu)的速度變化曲線；

S10：根據(jù)**驅(qū)動機構(gòu)的速度變化曲線和第二驅(qū)動機構(gòu)的速度變化曲線計算平均速度變化曲線，計算公式為：

f(v)＝{f(v1)+f(v2)}/2

S11：根據(jù)平均速度變化曲線計算**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)的同步動態(tài)速度曲線，計算公式為：

F(v)＝μf(v)

其中，F(xiàn)(v)為同步動態(tài)速度曲線，μ為同步精度差比。

同步精度差比μ是線性比例系數(shù)，決定動態(tài)速度變化曲線整體偏移情況，由實測同步精度中間值決定，實驗獲得。

通過同步動態(tài)速度曲線F(v)來控制**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)的運動速度，可以將**驅(qū)動機構(gòu)和第二驅(qū)動機構(gòu)的運動精度逼近，實現(xiàn)盲走場景。

在本實施例中，步驟S2還包括：如果是，則進行步驟S12；

S12：重復(fù)步驟S1，直至**次的位置偏差與第二次的位置偏差之間的差值小于設(shè)定值為止。

通過上述方式，本發(fā)明實施例的用于龍門架行走機構(gòu)的雙驅(qū)智能同步方法先控制雙驅(qū)同步行走，實測位置偏差，實現(xiàn)認路過程；再控制雙驅(qū)各自為主進行追蹤行走，實測追蹤衰減震蕩和各自的速度變化曲線，實現(xiàn)熟悉和記憶過程；**得到同步動態(tài)速度曲線可以實現(xiàn)盲走場景，做到高速高精度同步。

以上所述僅為本發(fā)明的實施例，并非因此限制本發(fā)明的專利范圍，凡是利用本發(fā)明說明書及附圖內(nèi)容所作的等效結(jié)構(gòu)或等效流程變換，或直接或間接運用在其他相關(guān)的技術(shù)領(lǐng)域，均同理包括在本發(fā)明的專利保護范圍內(nèi)。