一種連桿結(jié)構(gòu)機械手的運動控制方法及系統(tǒng)的制作方法
【技術(shù)領(lǐng)域】
[0001]本發(fā)明涉及機械手相關(guān)技術(shù)領(lǐng)域，特別是一種連桿結(jié)構(gòu)機械手的運動控制方法及系統(tǒng)。
【背景技術(shù)】
[0002]汽車廠沖壓自動化生產(chǎn)線一般包含4-5臺壓機，壓機之間通過機械手完成上下料；本方案涉及的機械手為連桿雙臂機械手，用于完成X/Z平面的板料傳送；每套機械手包含一臺上料手、一臺下料手以及一個輸送小車，主要實現(xiàn)的功能為上一工位下料手將沖壓工件從壓機內(nèi)取出后放到輸送小車上，輸送小車運行到上料位置后，本工位上料手從小車上取料送入壓機內(nèi)，壓機沖壓完成后，本工位下料手再從壓機內(nèi)將工件取出放到下一工位小車上。
[0003]壓機上料手、下料手以及輸送小車均由兩個伺服電機控制機械運動，上料手、下料手的機械結(jié)構(gòu)完全相同，由兩個運動軸組成，其中一個直線軸Z軸通過帶輪以及皮帶帶動機械手整體沿垂直方向運動，另一個旋轉(zhuǎn)軸通過連桿機構(gòu)將電機的旋轉(zhuǎn)轉(zhuǎn)換為X和Z軸方向的平面運動，
[0004]現(xiàn)有機械手的運動控制方法，需要設(shè)定不同的空間軌跡曲線，然后根據(jù)空間軌跡曲線上的每個點，計算出所需要的電機參數(shù)，在運行時，判斷機械手到達(dá)那個位置點，然后讀取該點對應(yīng)的電機參數(shù)，并控制電機按照電機參數(shù)運行，以使機械手到達(dá)下一個點。
[0005]然而，每個點均是采用空間位置進行保存，系統(tǒng)需要不停的讀取不同的空間位置，并根據(jù)該空間位置獲取其對應(yīng)的電機參數(shù)，特別是當(dāng)機械手抓取不同零件時，其零件大小不一致，導(dǎo)致空間軌跡曲線也不一致，為此需要針對不同的零件，保存不同的空間位置，使得運動平滑性較低，抓取效率不高。

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

[0006]基于此，有必要針對現(xiàn)有技術(shù)的機械手運動控制方法效率較低的技術(shù)問題，提供一種連桿結(jié)構(gòu)機械手的運動控制方法及系統(tǒng)。
[0007]—種連桿結(jié)構(gòu)機械手的運動控制方法，包括:
[0008]步驟11，獲取用于標(biāo)識所述機械手空間位置的多個軌跡點，所述軌跡點包括用于標(biāo)識抓料位置的抓料點、用于標(biāo)識放料位置的放料點、以及所述抓料點和放料點之間的過渡點，所述過渡點包括第一過渡點、第二過渡點、第三過渡點和第四過渡點，所述空間位置為所述機械手的水平位置和豎直位置；
[0009]步驟12，按照抓料點、第一過渡點、第二過渡點、放料點、第三過渡點、第四過渡點和抓料點的順序生成空間軌跡曲線；
[0010]步驟13，所述空間軌跡曲線上的點為空間點，將所述空間軌跡曲線上的多個空間點轉(zhuǎn)換為對應(yīng)的電機角度，根據(jù)所述多個電機角度生成基于時間軸的凸輪曲線；
[0011]步驟14，確定所述空間點所對應(yīng)的電機參數(shù)，并將對應(yīng)的電機參數(shù)與空間點對應(yīng)的電機角度關(guān)聯(lián)，所述電機參數(shù)為控制所述機械手運動的電機在對應(yīng)空間點的運行參數(shù)；
[0012]步驟15，根據(jù)所述凸輪曲線及凸輪曲線上的點所對應(yīng)的電機參數(shù)，控制所述電機轉(zhuǎn)動，從而帶動所述機械手運動。
[0013]一種連桿結(jié)構(gòu)機械手的運動控制系統(tǒng)，包括:
[0014]軌跡點獲取模塊，用于獲取用于標(biāo)識所述機械手空間位置的多個軌跡點，所述軌跡點包括用于標(biāo)識抓料位置的抓料點、用于標(biāo)識放料位置的放料點、以及所述抓料點和放料點之間的過渡點，所述過渡點包括第一過渡點、第二過渡點、第三過渡點和第四過渡點，所述空間位置為所述機械手的水平位置和豎直位置；
[0015]空間軌跡曲線生成模塊，用于按照抓料點、第一過渡點、第二過渡點、放料點、第三過渡點、第四過渡點和抓料點的順序生成空間軌跡曲線；
[0016]凸輪曲線生成模塊，用于所述空間軌跡曲線上的點為空間點，將所述空間軌跡曲線上的多個空間點轉(zhuǎn)換為對應(yīng)的電機角度，根據(jù)所述多個電機角度生成基于時間軸的凸輪曲線；
[0017]電機參數(shù)關(guān)聯(lián)模塊，用于確定所述空間點所對應(yīng)的電機參數(shù)，并將對應(yīng)的電機參數(shù)與空間點對應(yīng)的電機角度關(guān)聯(lián)，所述電機參數(shù)為控制所述機械手運動的電機在對應(yīng)空間點的運行參數(shù)；
[0018]機械手運動模塊，用于根據(jù)所述凸輪曲線及凸輪曲線上的點所對應(yīng)的電機參數(shù)，控制所述電機轉(zhuǎn)動，從而帶動所述機械手運動。
[0019]本發(fā)明將空間軌跡曲線轉(zhuǎn)換為凸輪曲線，則在控制機械手時，僅需要判斷當(dāng)前所處電機角度，并根據(jù)電機角度獲取對應(yīng)的電機參數(shù)。對于不同的空間軌跡曲線上的點，均可以轉(zhuǎn)換為統(tǒng)一的電機角度，使得系統(tǒng)在運行的過程中，能夠以統(tǒng)一的電機角度獲取電機參數(shù)，提供了工作效率，也同時提高了機械手運行的平滑性。
【附圖說明】
[0020]圖1為本發(fā)明一種連桿結(jié)構(gòu)機械手的運動控制方法的工作流程圖；
[0021]圖2為機械手的示意圖；
[0022]圖3為本發(fā)明一個最佳實施例中的空間軌跡曲線示意圖；
[0023]圖4為本發(fā)明一個最佳實施例的大圓弧過渡的示意圖；
[0024]圖5為本發(fā)明一個最佳實施例的小圓弧過渡的TJK意圖；
[0025]圖6為本發(fā)明一個最佳實施例的路徑速度曲線示意圖；
[0026]圖7A為本發(fā)明一個最佳實施例中的X軸凸輪曲線示意圖；
[0027]圖7B為圖7A的X軸凸輪曲線示意圖對應(yīng)的速度曲線示意圖；
[0028]圖7C為圖7A的X軸凸輪曲線示意圖對應(yīng)的加速度曲線示意圖；
[0029]圖8A為本發(fā)明一個最佳實施例中的Z軸凸輪曲線示意圖；
[0030]圖8B為圖8A的Z軸凸輪曲線示意圖對應(yīng)的速度曲線示意圖；
[0031]圖8C為圖8A的Z軸凸輪曲線示意圖對應(yīng)的加速度曲線示意圖；
[0032]圖9為本發(fā)明一種連桿結(jié)構(gòu)機械手的運動控制系統(tǒng)的結(jié)構(gòu)模塊圖。
【具體實施方式】
[0033]下面結(jié)合附圖和具體實施例對本發(fā)明做進一步詳細(xì)的說明。
[0034]如圖1所示為本發(fā)明一種連桿結(jié)構(gòu)機械手的運動控制方法的工作流程圖，包括:
[0035]步驟11，獲取用于標(biāo)識所述機械手空間位置的多個軌跡點，所述軌跡點包括用于標(biāo)識抓料位置的抓料點、用于標(biāo)識放料位置的放料點、以及所述抓料點和放料點之間的過渡點，所述過渡點包括第一過渡點、第二過渡點、第三過渡點和第四過渡點，所述空間位置為所述機械手的水平位置和豎直位置；
[0036]步驟12，按照抓料點、第一過渡點、第二過渡點、放料點、第三過渡點、第四過渡點和抓料點的順序生成空間軌跡曲線；
[0037]步驟13，所述空間軌跡曲線上的點為空間點，將所述空間軌跡曲線上的多個空間點轉(zhuǎn)換為對應(yīng)的電機角度，根據(jù)所述多個電機角度生成基于時間軸的凸輪曲線；
[0038]步驟14，確定所述空間點所對應(yīng)的電機參數(shù)，并將對應(yīng)的電機參數(shù)與空間點對應(yīng)的電機角度關(guān)聯(lián)，所述電機參數(shù)為控制所述機械手運動的電機在對應(yīng)空間點的運行參數(shù)；
[0039]步驟15，根據(jù)所述凸輪曲線及凸輪曲線上的點所對應(yīng)的電機參數(shù)，控制所述電機轉(zhuǎn)動，從而帶動所述機械手運動。
[0040]如圖2所示為機械手的示意圖，機械手的連桿機構(gòu)以O(shè)點為中心旋轉(zhuǎn)，并以