本發(fā)明屬于堆垛機(jī)，具體涉及一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法及裝置。

背景技術(shù)：

1、目前，液晶面板工廠的各個(gè)工藝段中，堆垛機(jī)作為物料中轉(zhuǎn)的核心設(shè)備，承擔(dān)著物料存儲(chǔ)及為生產(chǎn)線上下料的功能。在實(shí)際生產(chǎn)過(guò)程中，為了滿足生產(chǎn)線的正常上料，通常要求堆垛機(jī)的取放精度達(dá)到±2mm。

2、現(xiàn)階段，生產(chǎn)過(guò)程中，堆垛機(jī)搬運(yùn)物料的載體為卡夾，卡夾常因振動(dòng)及其它等因素，造成搬送物料的位置偏移。而物料產(chǎn)生位置偏移后，需要進(jìn)行卡夾位置矯正?？▕A的重量從200kg到1600kg，因此產(chǎn)生偏移后，在高負(fù)重的情況下，幾乎無(wú)法通過(guò)人力來(lái)矯正，導(dǎo)致矯正困難且效率低下。

技術(shù)實(shí)現(xiàn)思路

1、為此，本發(fā)明提供一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法及裝置，解決傳統(tǒng)技術(shù)存在的卡夾位置矯正困難且效率低下的問(wèn)題。

2、為了實(shí)現(xiàn)上述目的，本發(fā)明提供如下技術(shù)方案：一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法，包括：

3、獲取測(cè)距傳感器a1測(cè)量的所述測(cè)距傳感器a1到堆垛機(jī)手臂上放置的卡夾邊框的第一橫向距離la1，所述測(cè)距傳感器a1布置在堆垛機(jī)手臂上的第一位置；

4、獲取測(cè)距傳感器a2測(cè)量的所述測(cè)距傳感器a2到所述卡夾邊框的第二橫向距離la2，所述測(cè)距傳感器a2布置在堆垛機(jī)手臂上的第二位置；

5、根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx；

6、根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，所述測(cè)距傳感器a1所處的所述第一位置和所述測(cè)距傳感器a2所處的所述第二位置的固定間距l(xiāng)，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt；

7、獲取測(cè)距傳感器b測(cè)量的所述測(cè)距傳感器b到所述卡夾邊框的縱向距離ly，根據(jù)所述縱向距離ly和預(yù)設(shè)的縱向標(biāo)準(zhǔn)值，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的縱向偏移量dy；

8、根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt，堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的縱向偏移量dy，檢測(cè)的卡夾尺寸規(guī)格對(duì)卡夾的存放位置進(jìn)行補(bǔ)償校準(zhǔn)。

9、作為堆垛機(jī)卡夾取放位置校準(zhǔn)方法優(yōu)選方案，根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx的公式為：dx=la1-la2。

10、作為堆垛機(jī)卡夾取放位置校準(zhǔn)方法優(yōu)選方案，根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，所述測(cè)距傳感器a1所處的所述第一位置和所述測(cè)距傳感器a2所處的所述第二位置的固定間距l(xiāng)，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt的公式為：dt=arctan(dx/l)。

11、作為堆垛機(jī)卡夾取放位置校準(zhǔn)方法優(yōu)選方案，還包括：將橫向偏移量dx與預(yù)設(shè)的橫向偏移閾值比較，將角度偏差dt與預(yù)設(shè)的角度偏移閾值比較，將縱向偏移量dy與預(yù)設(shè)的縱向偏移閾值比較；若橫向偏移量dx、角度偏差dt、縱向偏移量dy中任一個(gè)超限，則進(jìn)行偏差過(guò)大異常報(bào)警。

12、作為堆垛機(jī)卡夾取放位置校準(zhǔn)方法優(yōu)選方案，還包括：

13、根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾在橫向檢測(cè)距離的中值lm：

14、lm=（la1+la2）/2；

15、將卡夾在橫向檢測(cè)距離的中值lm結(jié)合所述縱向距離ly，與提前示教好的預(yù)設(shè)規(guī)格卡夾的標(biāo)準(zhǔn)位置值進(jìn)行范圍比較，得到當(dāng)前的卡夾尺寸規(guī)格。

16、本發(fā)明還提供一種堆垛機(jī)卡夾取放位置校準(zhǔn)裝置，包括：

17、第一橫向距離獲取模塊，用于獲取測(cè)距傳感器a1測(cè)量的所述測(cè)距傳感器a1到堆垛機(jī)手臂上放置的卡夾邊框的第一橫向距離la1，所述測(cè)距傳感器a1布置在堆垛機(jī)手臂上的第一位置；

18、第二橫向距離獲取模塊，用于獲取測(cè)距傳感器a2測(cè)量的所述測(cè)距傳感器a2到所述卡夾邊框的第二橫向距離la2，所述測(cè)距傳感器a2布置在堆垛機(jī)手臂上的第二位置；

19、橫向偏移量計(jì)算模塊，用于根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx；

20、角度偏差計(jì)算模塊，用于根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，所述測(cè)距傳感器a1所處的所述第一位置和所述測(cè)距傳感器a2所處的所述第二位置的固定間距l(xiāng)，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt；

21、縱向偏移量計(jì)算模塊，用于獲取測(cè)距傳感器b測(cè)量的所述測(cè)距傳感器b到所述卡夾邊框的縱向距離ly，根據(jù)所述縱向距離ly和預(yù)設(shè)的縱向標(biāo)準(zhǔn)值，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的縱向偏移量dy；

22、存放位置補(bǔ)償校準(zhǔn)模塊，用于根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt，堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的縱向偏移量dy，檢測(cè)的卡夾尺寸規(guī)格對(duì)卡夾的存放位置進(jìn)行補(bǔ)償校準(zhǔn)。

23、作為堆垛機(jī)卡夾取放位置校準(zhǔn)裝置優(yōu)選方案，所述橫向偏移量計(jì)算模塊中，根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx的公式為：dx=la1-la2。

24、作為堆垛機(jī)卡夾取放位置校準(zhǔn)裝置優(yōu)選方案，所述角度偏差計(jì)算模塊中，根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，所述測(cè)距傳感器a1所處的所述第一位置和所述測(cè)距傳感器a2所處的所述第二位置的固定間距l(xiāng)，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt的公式為：dt=arctan(dx/l)。

25、作為堆垛機(jī)卡夾取放位置校準(zhǔn)裝置優(yōu)選方案，還包括：

26、異常報(bào)警模塊，用于將橫向偏移量dx與預(yù)設(shè)的橫向偏移閾值比較，將角度偏差dt與預(yù)設(shè)的角度偏移閾值比較，將縱向偏移量dy與預(yù)設(shè)的縱向偏移閾值比較；若橫向偏移量dx、角度偏差dt、縱向偏移量dy中任一個(gè)超限，則進(jìn)行偏差過(guò)大異常報(bào)警。

27、作為堆垛機(jī)卡夾取放位置校準(zhǔn)裝置優(yōu)選方案，還包括：

28、卡夾尺寸規(guī)格分析模塊，用于根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾在橫向檢測(cè)距離的中值lm：

29、lm=（la1+la2）/2；

30、將卡夾在橫向檢測(cè)距離的中值lm結(jié)合所述縱向距離ly，與提前示教好的預(yù)設(shè)規(guī)格卡夾的標(biāo)準(zhǔn)位置值進(jìn)行范圍比較，得到當(dāng)前的卡夾尺寸規(guī)格。

31、本發(fā)明具有如下優(yōu)點(diǎn)：本發(fā)明能夠利用堆垛機(jī)的高負(fù)荷能力，在取放卡夾的過(guò)程中，進(jìn)行卡夾位置矯正，能夠有效保證卡夾存儲(chǔ)時(shí)的位置精度，即使產(chǎn)生偏移，也可在搬運(yùn)過(guò)程中進(jìn)行矯正；實(shí)現(xiàn)了生產(chǎn)過(guò)程中的自動(dòng)校正，可有效減少因卡夾位置偏移造成的設(shè)備停機(jī)及調(diào)整時(shí)間，提高了工作效率。

技術(shù)特征：

1.一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法，其特征在于，包括：

2.根據(jù)權(quán)利要求1所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法，其特征在于，根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx的公式為：dx=la1-la2。

3.根據(jù)權(quán)利要求1所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法，其特征在于，根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，所述測(cè)距傳感器a1所處的所述第一位置和所述測(cè)距傳感器a2所處的所述第二位置的固定間距l(xiāng)，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt的公式為：dt=arctan(dx/l)。

4.根據(jù)權(quán)利要求1所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法，其特征在于，還包括：將橫向偏移量dx與預(yù)設(shè)的橫向偏移閾值比較，將角度偏差dt與預(yù)設(shè)的角度偏移閾值比較，將縱向偏移量dy與預(yù)設(shè)的縱向偏移閾值比較；若橫向偏移量dx、角度偏差dt、縱向偏移量dy中任一個(gè)超限，則進(jìn)行偏差過(guò)大異常報(bào)警。

5.根據(jù)權(quán)利要求1所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法，其特征在于，還包括：

6.一種堆垛機(jī)卡夾取放位置校準(zhǔn)裝置，其特征在于，包括：

7.根據(jù)權(quán)利要求6所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)裝置，其特征在于，所述橫向偏移量計(jì)算模塊中，根據(jù)所述第一橫向距離la1和所述第二橫向距離la2，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx的公式為：dx=la1-la2。

8.根據(jù)權(quán)利要求6所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)裝置，其特征在于，所述角度偏差計(jì)算模塊中，根據(jù)堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dx，所述測(cè)距傳感器a1所處的所述第一位置和所述測(cè)距傳感器a2所處的所述第二位置的固定間距l(xiāng)，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的角度偏差dt的公式為：dt=arctan(dx/l)。

9.根據(jù)權(quán)利要求6所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)裝置，其特征在于，還包括：

10.根據(jù)權(quán)利要求6所述的一種堆垛機(jī)卡夾取放位置校準(zhǔn)裝置，其特征在于，還包括：

技術(shù)總結(jié)
一種堆垛機(jī)卡夾取放位置校準(zhǔn)方法及裝置，該方法獲取測(cè)距傳感器A1測(cè)量的到卡夾邊框的第一橫向距離LA1；獲取測(cè)距傳感器A2測(cè)量的到卡夾邊框的第二橫向距離LA2；根據(jù)LA1和LA2，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的橫向偏移量dX；根據(jù)橫向偏移量dX，固定間距L，計(jì)算角度偏差dT；獲取測(cè)距傳感器B測(cè)量的測(cè)距傳感器B到卡夾邊框的縱向距離LY，根據(jù)縱向距離LY和預(yù)設(shè)的縱向標(biāo)準(zhǔn)值，計(jì)算堆垛機(jī)手臂上放置的卡夾位置與標(biāo)準(zhǔn)位置的縱向偏移量dY；根據(jù)橫向偏移量dX，角度偏差dT，縱向偏移量dY，檢測(cè)的卡夾尺寸規(guī)格對(duì)卡夾的存放位置進(jìn)行補(bǔ)償校準(zhǔn)。本發(fā)明有效保證卡夾存儲(chǔ)時(shí)的位置精度，提高了工作效率。

技術(shù)研發(fā)人員：趙建普,張艷超
受保護(hù)的技術(shù)使用者：成都思越智能裝備股份有限公司
技術(shù)研發(fā)日：
技術(shù)公布日：2024/12/19