+

TWI589414B - Tool calibration apparatus of robot manipulator - Google Patents

Tool calibration apparatus of robot manipulator Download PDF

Info

Publication number
TWI589414B
TWI589414B TW105106637A TW105106637A TWI589414B TW I589414 B TWI589414 B TW I589414B TW 105106637 A TW105106637 A TW 105106637A TW 105106637 A TW105106637 A TW 105106637A TW I589414 B TWI589414 B TW I589414B
Authority
TW
Taiwan
Prior art keywords
measuring
tool
measuring plate
axis
sensor
Prior art date
Application number
TW105106637A
Other languages
Chinese (zh)
Other versions
TW201718208A (en
Inventor
黃正豪
徐志銘
Original Assignee
台達電子工業股份有限公司
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 台達電子工業股份有限公司 filed Critical 台達電子工業股份有限公司
Priority to US15/146,725 priority Critical patent/US10065319B2/en
Publication of TW201718208A publication Critical patent/TW201718208A/en
Application granted granted Critical
Publication of TWI589414B publication Critical patent/TWI589414B/en

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/081Touching devices, e.g. pressure-sensitive
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/088Controls for manipulators by means of sensing devices, e.g. viewing or touching devices with position, velocity or acceleration sensors

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)

Description

機械手臂之工具校正裝置Robotic tool calibration device

本案係關於一種工具校正裝置,尤指一種機械手臂之工具校正裝置。This case relates to a tool calibration device, and more particularly to a tool correction device for a robot arm.

隨著工業科技的進步,各式各樣的機器人已廣泛地被研發以應用於生活及產業中。一般而言,機械手臂係機器人之重要元件,且機械手臂會於其端部裝配工具來進行所需的任務。舉例而言,該工具可為銲接工具、鑽孔工具、抓持工具、研磨工具或切割工具。固定於機械手臂之端部的工具需具有一定義的端點,稱為工具中心點(Tool Center Point,以下簡稱TCP)。當工具設置於機械手臂之端部時,該工具之TCP與機械手臂之末端效應點(End-Effect Point)之間相對的偏移量必須精確地取得且預先設定。換言之,在機械手臂裝配工具時必須先知道工具的尺寸,如此一來,當機械手臂在裝配工具運作時,機器人程式可依據取得的偏移量進行校正,藉此使該工具可以運行於正確路徑及位置。With the advancement of industrial technology, a wide variety of robots have been extensively developed for use in life and industry. In general, the robotic arm is an important component of the robot, and the robotic arm assembles tools at its ends to perform the required tasks. For example, the tool can be a welding tool, a drilling tool, a gripping tool, an abrasive tool, or a cutting tool. The tool attached to the end of the robot arm needs to have a defined endpoint called Tool Center Point (hereinafter referred to as TCP). When the tool is placed at the end of the robot arm, the relative offset between the TCP of the tool and the End-Effect Point of the robot arm must be accurately obtained and preset. In other words, the size of the tool must be known when the robot is assembled with the tool, so that when the robot is working on the assembly tool, the robot can correct it based on the offset obtained, thereby enabling the tool to run on the correct path. And location.

目前,為了方便校正工具之TCP,可使用工具校正裝置來實現。傳統工具校正裝置包含框體及複數個紅外線感測器。當工具裝配於機械手臂之端部時,即進行工具校正程序。首先,將工具朝工具校正裝置移動,且進行工具之點位模擬與教導程序,即機械手臂帶動工具於工具校正裝置之框體所定義的空間內移動,且工具校正裝置根據該工具之TCP的移動而進行教導點位程序並建立此工具的樣本。如此一來,當更換相同型態的工具時,工具校正裝置便可比較工具更換前後所產生的偏差量,並使機械手臂可以對工具正確性進行補償,俾完成工具校正程序。Currently, in order to facilitate the TCP of the calibration tool, it can be implemented using a tool correction device. The conventional tool calibration device includes a frame and a plurality of infrared sensors. When the tool is assembled at the end of the robot arm, the tool calibration procedure is performed. First, the tool is moved toward the tool calibration device, and the tool point simulation and teaching program is performed, that is, the robot arm drives the tool to move in the space defined by the frame of the tool calibration device, and the tool calibration device is based on the TCP of the tool. Move to teach the point program and build a sample of this tool. In this way, when replacing the same type of tool, the tool calibration device can compare the amount of deviation generated before and after the tool is replaced, and the robot can compensate the correctness of the tool and complete the tool calibration procedure.

然而,具有紅外線感測器的傳統工具校正裝置價格相當昂貴。此外,當裝配於機械手臂的工具以相同型態的工具更換時,雖然具紅外線感測器之傳統工具校正裝置可以取得工具之TCP與機械手臂之末端效應點之間相對的偏移量,然而當裝配於機械手臂的工具以不同型態的工具更換時,具紅外線感測器的傳統工具校正裝置並無法正確地取得工具之TCP與機械手臂之末端效應點之間相對的偏移量,因此以傳統工具校正裝置進行工具校正之正確性降低。此外,工具的錯位將造成整個產線停機且浪費材料、時間與成本。However, conventional tool correction devices with infrared sensors are quite expensive. In addition, when the tool mounted on the robot arm is replaced with the same type of tool, although the conventional tool correction device with the infrared sensor can obtain the relative offset between the TCP and the end effect point of the robot arm, When the tool mounted on the robot arm is replaced with a different type of tool, the conventional tool correction device with the infrared sensor does not correctly obtain the relative offset between the TCP and the end effect point of the robot arm. The correctness of tool correction with conventional tool calibration devices is reduced. In addition, the misalignment of the tool will cause the entire production line to shut down and waste material, time and cost.

因此,實有必要發展一種機械手臂之工具校正裝置,以解決先前技術所面臨之問題。
Therefore, it is necessary to develop a tool correction device for a robot arm to solve the problems faced by the prior art.

本案之目的在於提供一種機械手臂之工具校正裝置,其成本較低且可模組化組裝。此外,本案之工具校正裝置可正確地量測與取得工具之TCP與機械手臂之末端效應點之間相對的偏移量,藉此機械手臂可以快速地對工具正確性進行補償,以確保工具的正確運作位置。相較於人工校正方式,利用本案之工具校正裝置不只可以節省操作時間,且可以實現工具的高精度校正。The purpose of the present invention is to provide a tool correction device for a robot arm that is low in cost and modular to assemble. In addition, the tool calibration device of the present invention can correctly measure the relative offset between the TCP and the end effect point of the robot arm of the acquisition tool, whereby the robot can quickly compensate the correctness of the tool to ensure the tool's Correct operation position. Compared with the manual correction method, the tool calibration device of the present invention can not only save operation time, but also realize high-precision correction of the tool.

為達上述目的,本案提供一種工具校正裝置,應用於具有工具之機械手臂,機械手臂係帶動工具移動,工具校正裝置包含基座、X軸量測裝置、Y軸量測裝置及Z軸量測裝置。基座具有凹陷部。X軸量測裝置設置於基座上,且包含第一量測板及第一感測器,其中第一量測板係於X軸軸向移動,且第一感測器係於工具驅使第一量測板移動時感測第一量測板所移動之第一位移量。Y軸量測裝置設置於基座上且與X軸量測裝置之一側相鄰設,並且包含第二量測板及第二感測器,其中第二量測板係於Y軸軸向移動,且第二感測器係於工具驅使第二量測板移動時感測第二量測板所移動之第二位移量。Z軸量測裝置,設置於凹陷部且具有兩相鄰側分別與X軸量測裝置及Y軸量測裝置相鄰設,並且包含第三量測板及第三感測器,其中第三量測板係於Z軸軸向移動,且第三感測器係於工具驅使第三量測板移動時感測第三量測板所移動之第三位移量。其中,根據工具於X軸、Y軸及Z軸移動所感測取得之第一位移量、第二位移量及第三位移量,以取得關於工具之工具中心點之資訊,俾進行工具之工具中心點之校正。
In order to achieve the above purpose, the present invention provides a tool calibration device for a robotic arm with a tool that moves the tool. The tool calibration device includes a base, an X-axis measuring device, a Y-axis measuring device, and a Z-axis measurement. Device. The base has a recess. The X-axis measuring device is disposed on the base and includes a first measuring board and a first sensor, wherein the first measuring board is axially moved on the X-axis, and the first sensor is driven by the tool A first displacement amount of the movement of the first measuring plate is sensed when a measuring plate moves. The Y-axis measuring device is disposed on the base and adjacent to one side of the X-axis measuring device, and includes a second measuring plate and a second sensor, wherein the second measuring plate is in the Y-axis axial direction Moving, and the second sensor senses a second displacement amount of movement of the second measuring plate when the tool drives the second measuring plate to move. The Z-axis measuring device is disposed in the recessed portion and has two adjacent sides respectively adjacent to the X-axis measuring device and the Y-axis measuring device, and includes a third measuring plate and a third sensor, wherein the third The measuring plate is axially moved in the Z axis, and the third sensor senses a third displacement amount of the movement of the third measuring plate when the tool drives the third measuring plate to move. Wherein, according to the tool, the first displacement amount, the second displacement amount and the third displacement amount obtained by the sensing are moved in the X-axis, the Y-axis and the Z-axis, so as to obtain information about the tool center point of the tool, and the tool center of the tool is performed. Point correction.

1、1a、1b、1c、1d:工具校正裝置
10:基座
101:槽部
101a:頂面
143a、243a:第一側壁面
102:凹陷部
102a:底面
10a:X軸量測裝置
11:第一量測板
11a:第一滑動部
11b:第一量測部
11c:第一側壁
111c:外側面
112c、212c:內側面
12:第一感測器
12a:第一感測槽
13:第一線性軌道
13a:第一側
13b:第二側
14:第一彈性元件
14a:第一彈簧
144a:第一側壁面
14b:第一柱
10b:Y軸量測裝置
21:第二量測板
21a:第二滑動部
21b:第二量測部
21c:第二側壁
22:第二感測器
22a:第二感測槽
23:第二線性軌道
23a:第一側
23b:第二側
24:第二彈性元件
24a:第二彈簧
24b:第二柱
10c:Z軸量測裝置
31:第三量測板
31a:第三滑動部
31b:第三量測部
31c:第三側壁
32:第三感測器
32a:第三感測槽
33:第三線性軌道
34:第三彈性元件
34a:第三彈簧
34b:第三柱
101c:第一側
102c:第二側
103c:頂面
103:感測空間
2:機械手臂
2a:末端效應點
3:工具
3a:連接端
3b:工具中心點
S1-S6:步驟
1, 1a, 1b, 1c, 1d: tool calibration device
10: base
101: Groove
101a: top surface
143a, 243a: first side wall surface
102: depression
102a: bottom surface
10a: X-axis measuring device
11: The first measuring board
11a: first sliding portion
11b: The first measuring part
11c: first side wall
111c: outer side
112c, 212c: inner side
12: First sensor
12a: first sensing slot
13: First linear orbit
13a: first side
13b: second side
14: first elastic element
14a: first spring
144a: first side wall surface
14b: first column
10b: Y-axis measuring device
21: The second measuring board
21a: second sliding portion
21b: second measuring part
21c: second side wall
22: second sensor
22a: second sensing slot
23: Second linear orbit
23a: first side
23b: second side
24: second elastic element
24a: second spring
24b: second column
10c: Z-axis measuring device
31: third measuring board
31a: third sliding portion
31b: Third measuring part
31c: third side wall
32: third sensor
32a: third sensing slot
33: Third linear orbit
34: third elastic element
34a: third spring
34b: third column
101c: first side
102c: second side
103c: top surface
103: Sensing space
2: Robotic arm
2a: end effect point
3: Tools
3a: connector
3b: Tool Center Point
S1-S6: Steps


第1A圖係為本案第一實施例之工具校正裝置的結構示意圖。
第1B圖係為第1A圖所示之工具校正裝置的結構側視圖。
第2A圖係為機器手臂裝配工具應用於本案之工具校正裝置的結構示意圖。
第2B圖係為第2A圖所示結構之局部放大圖。
第3圖係為機器手臂裝配工具應用於工具校正裝置時之運作流程圖。
第4A圖係為本案第二實施例之工具校正裝置的結構示意圖。
第4B圖係為第4A圖所示之工具校正裝置的結構側視圖。
第5A圖係為本案第三實施例之工具校正裝置的結構示意圖。
第5B圖係為第5A圖所示之工具校正裝置的結構側視圖。
第6A圖係為本案第四實施例之工具校正裝置的結構示意圖。
第6B圖係為第6A圖所示之工具校正裝置的結構側視圖。
第7A圖係為本案第五實施例之校正裝置的結構示意圖。
第7B圖係為第7A圖所示之工具校正裝置的結構側視圖。

Fig. 1A is a schematic structural view of the tool correcting device of the first embodiment of the present invention.
Fig. 1B is a side view showing the structure of the tool correcting device shown in Fig. 1A.
Fig. 2A is a schematic structural view of a tool correcting device applied to the present invention by a robot arm assembly tool.
Fig. 2B is a partial enlarged view of the structure shown in Fig. 2A.
Figure 3 is a flow chart of the operation of the robotic arm assembly tool applied to the tool calibration device.
Fig. 4A is a schematic structural view of the tool correcting device of the second embodiment of the present invention.
Fig. 4B is a side view showing the structure of the tool correcting device shown in Fig. 4A.
Fig. 5A is a schematic structural view of the tool correcting device of the third embodiment of the present invention.
Fig. 5B is a side view showing the structure of the tool correcting device shown in Fig. 5A.
Fig. 6A is a schematic structural view of the tool correcting device of the fourth embodiment of the present invention.
Fig. 6B is a side view showing the structure of the tool correcting device shown in Fig. 6A.
Fig. 7A is a schematic structural view of a correction device of the fifth embodiment of the present invention.
Fig. 7B is a side view showing the structure of the tool correcting device shown in Fig. 7A.

體現本案特徵與優點的一些典型實施例將在後段的說明中詳細敘述。應理解的是本案能夠在不同的態樣上具有各種的變化,其皆不脫離本案的範圍,且其中的說明及圖式在本質上係當作說明之用,而非用於限制本案。Some exemplary embodiments embodying the features and advantages of the present invention are described in detail in the following description. It is to be understood that the present invention is capable of various modifications in the various aspects of the present invention, and the description and drawings are intended to be illustrative and not limiting.

第1A圖係為本案第一實施例之工具校正裝置的結構示意圖,第1B圖係為第1A圖所示之工具校正裝置的結構側視圖,第2A圖係為機器手臂裝配工具應用於本案之工具校正裝置之結構示意圖(機器手臂係以平面關節型機器人(Selective Compliance Assembly Robot Arm, SCARA)為例,但不以此為限),第2B圖係為第2A圖所示結構之局部放大圖。如第1A、1B、2A及2B圖所示,本案之工具校正裝置1係用於校正機械手臂2之端部所裝配之工具3,以使機械手臂2在執行所需任務時可以確保工具3運作於正確位置。工具校正裝置1包括基座10、X軸量測裝置10a、Y軸量測裝置10b及Z軸量測裝置10c,其中基座10包含複數個槽部101及一凹陷部102。X軸量測裝置10a及Y軸量測裝置10b分別設置於基座10上,而Z軸量測裝置10c則設置於基座10之凹陷部102,其中X軸量測裝置10a之一側與Y軸量測裝置10b之一側係相鄰設置,且X軸量測裝置10a與Y軸量測裝置10b分別鄰設於Z軸量測裝置10c的第一側101c及第二側102c並部分高出Z軸量測裝置10c的頂面103c,藉此使X軸量測裝置10a、Y軸量測裝置10b及Z軸量測裝置10c定義形成感測空間103。1A is a schematic structural view of a tool calibration device according to a first embodiment of the present invention, FIG. 1B is a structural side view of the tool calibration device shown in FIG. 1A, and FIG. 2A is a machine arm assembly tool applied to the case. Schematic diagram of the tool calibration device (the robotic arm is selected from the Selective Compliance Assembly Robot Arm (SCARA), but not limited to this), and the 2B image is a partial enlarged view of the structure shown in Figure 2A. . As shown in Figs. 1A, 1B, 2A and 2B, the tool correcting device 1 of the present invention is for correcting the tool 3 assembled at the end of the robot arm 2 so that the robot arm 2 can secure the tool 3 when performing the required task. Operate in the right place. The tool calibration device 1 includes a base 10, an X-axis measuring device 10a, a Y-axis measuring device 10b, and a Z-axis measuring device 10c. The base 10 includes a plurality of groove portions 101 and a recess portion 102. The X-axis measuring device 10a and the Y-axis measuring device 10b are respectively disposed on the base 10, and the Z-axis measuring device 10c is disposed on the recessed portion 102 of the base 10, wherein one side of the X-axis measuring device 10a is One side of the Y-axis measuring device 10b is disposed adjacent to each other, and the X-axis measuring device 10a and the Y-axis measuring device 10b are respectively disposed adjacent to the first side 101c and the second side 102c of the Z-axis measuring device 10c. The top surface 103c of the Z-axis measuring device 10c is raised, whereby the X-axis measuring device 10a, the Y-axis measuring device 10b, and the Z-axis measuring device 10c are defined to form the sensing space 103.

X軸量測裝置10a包含第一量測板11、第一感測器12、第一線性軌道13及第一彈性元件14。於本實施例中,第一感測器12是鄰設於第一線性軌道13之第一側13a,而第一彈性元件14則是鄰設於第一線性軌道13之第二側13b。第一量測板11包含第一滑動部11a、第一量測部11b及第一側壁11c,其中第一量測部11b與第一感測器12對應設置,用以感測第一量測部11b之位移量。第一感測器12包含第一感測槽12a,且第一感測槽12a與第一量測板11之第一量測部11b對應設置,藉此使第一量測板11之第一量測部11b可於第一感測槽12a內移動,如此一來,第一量測部11b之位移量可利用第一感測器12量測與取得。較佳地,第一感測器12係為位置感測器。第一線性軌道13係固定於基座10之頂面,且第一量測板11之第一滑動部11a與第一線性軌道13係相配合,藉此第一量測板11可滑動於第一線性軌道13上。第一彈性元件14係設置於基座10之對應的槽部101內,並包含第一彈簧14a及第一柱14b,其中第一彈簧14a係套設於第一柱14b,且第一彈簧14a與第一量測板11之第一側壁11c相對應設置,詳言之,第一彈簧14a之一端係抵頂於第一側壁11c之外側面111c,而第一彈簧14a之另一端則是抵頂於槽部101之第一側壁面143a,藉此當第一量測板11之第一側壁11c施力於第一彈簧14a時,第一彈簧14a係被壓縮且產生彈性恢復力,以使第一量測板11移動回復至原來位置。The X-axis measuring device 10a includes a first measuring plate 11, a first sensor 12, a first linear track 13 and a first elastic member 14. In this embodiment, the first sensor 12 is adjacent to the first side 13a of the first linear track 13, and the first elastic element 14 is adjacent to the second side 13b of the first linear track 13. . The first measuring plate 11 includes a first sliding portion 11a, a first measuring portion 11b and a first side wall 11c. The first measuring portion 11b is disposed corresponding to the first sensor 12 for sensing the first measurement. The amount of displacement of the portion 11b. The first sensor 12 includes a first sensing slot 12a, and the first sensing slot 12a is disposed corresponding to the first measuring portion 11b of the first measuring board 11, thereby making the first measuring board 11 first. The measuring portion 11b can be moved in the first sensing slot 12a. In this way, the displacement of the first measuring portion 11b can be measured and acquired by the first sensor 12. Preferably, the first sensor 12 is a position sensor. The first linear track 13 is fixed to the top surface of the base 10, and the first sliding portion 11a of the first measuring plate 11 is coupled with the first linear track 13 whereby the first measuring plate 11 is slidable On the first linear track 13. The first elastic member 14 is disposed in the corresponding groove portion 101 of the base 10 and includes a first spring 14a and a first post 14b, wherein the first spring 14a is sleeved on the first post 14b, and the first spring 14a Corresponding to the first side wall 11c of the first measuring plate 11, in detail, one end of the first spring 14a abuts against the outer side surface 111c of the first side wall 11c, and the other end of the first spring 14a is abutted The first side wall surface 143a of the groove portion 101 is formed, whereby when the first side wall 11c of the first measuring plate 11 is applied to the first spring 14a, the first spring 14a is compressed and generates an elastic restoring force, so that The first measuring plate 11 moves back to the original position.

Y軸量測裝置10b包含第二量測板21、第二感測器22、第二線性軌道23及第二彈性元件24。於本實施例中,第二感測器22是鄰設於第二線性軌道23之第一側23a,而第二彈性元件24則是鄰設於第二線性軌道23之第二側23b。第二量測板21包含第二滑動部21a、第二量測部21b及第二側壁21c,其中第二量測部21b與第二感測器22對應設置,用以感測第二量測部21b之位移量。第二感測器22包含第二感測槽22a,且第二感測槽22a與第二量測板21之第二量測部21b對應設置,藉此使第二量測板21之第二量測部21b可於第二感測槽22a內移動,如此一來,第二量測部21b之位移量可藉由第二感測器22量測與取得。較佳地,第二感測器22係為位置感測器。第二線性軌道23係固定於基座10之頂面,且第二量測板21之第二滑動部21a與第二線性軌道23相互配合,藉此第二量測板21可滑動於第二線性軌道23上。第二彈性元件24係設置於基座10之對應的槽部101內,並包含第二彈簧24a及第二柱24b,其中第二彈簧24a係套設於第二柱24b,且第二彈簧24a與第二量測板21之第二側壁21c相對應設置,詳言之,第二彈簧24a之一端係抵頂於第二側壁21c之外側面(未圖示),而第二彈簧24a之另一端則是抵頂於槽部101之第一側壁面243a,藉此當第二量測板21之第二側壁21c施力於第二彈簧24a時,第二彈簧24a被壓縮且產生彈性恢復力,以使第二量測板21移動回復至原來位置。The Y-axis measuring device 10b includes a second measuring plate 21, a second sensor 22, a second linear track 23, and a second elastic member 24. In this embodiment, the second sensor 22 is adjacent to the first side 23a of the second linear track 23, and the second elastic element 24 is adjacent to the second side 23b of the second linear track 23. The second measuring plate 21 includes a second sliding portion 21a, a second measuring portion 21b and a second side wall 21c. The second measuring portion 21b is correspondingly disposed with the second sensor 22 for sensing the second measurement. The amount of displacement of the portion 21b. The second sensor 22 includes a second sensing slot 22a, and the second sensing slot 22a is disposed corresponding to the second measuring portion 21b of the second measuring board 21, thereby making the second measuring board 21 second. The measuring portion 21b can be moved in the second sensing slot 22a. In this way, the displacement of the second measuring portion 21b can be measured and acquired by the second sensor 22. Preferably, the second sensor 22 is a position sensor. The second linear track 23 is fixed to the top surface of the base 10, and the second sliding portion 21a of the second measuring plate 21 and the second linear track 23 cooperate with each other, whereby the second measuring plate 21 can slide to the second On the linear track 23. The second elastic member 24 is disposed in the corresponding groove portion 101 of the base 10 and includes a second spring 24a and a second column 24b, wherein the second spring 24a is sleeved on the second column 24b, and the second spring 24a Corresponding to the second side wall 21c of the second measuring plate 21, in detail, one end of the second spring 24a abuts against the outer side of the second side wall 21c (not shown), and the second spring 24a is another One end is abutted against the first side wall surface 243a of the groove portion 101, whereby when the second side wall 21c of the second measuring plate 21 is applied to the second spring 24a, the second spring 24a is compressed and generates elastic restoring force. In order to move the second measuring plate 21 back to the original position.

Z軸量測裝置10c包含第三量測板31、第三感測器32、第三線性軌道33及第三彈性元件34。第三量測板31包含第三滑動部31a、第三量測部31b及第三側壁31c,其中第三量測部31b與第三感測器32對應設置,用以感測第三量測部31b之位移量。第三感測器32係設置於凹陷部102之底面102a,且包含第三感測槽32a,與第三量測板31之第三量測部31b對應設置,藉此使第三量測板31之第三量測部31b可於第三感測槽32a內移動,如此一來,第三量測部31b之位移量可藉由第三感測器32量測與取得。較佳地,第三感測器32係為位置感測器。第三線性軌道33係鄰設於凹陷部102之側邊,且第三量測板31之第三滑動部31a與第三線性軌道33相互配合,藉此第三量測板31可滑動於第三線性軌道33上。第三彈性元件34係設置於凹陷部102之底面102a,且包含第三彈簧34a及第三柱34b,第三柱34b係垂直連接於凹陷部102之底面102a,其中第三彈簧34a係套設於第三柱34b,且第三彈簧34a與第三量測板31之第三側壁31c相對應設置,詳言之,第三彈簧34a之一端係抵頂第三側壁31c之側面,而第三彈簧34a之另一端則是抵頂於凹陷部102之底面102a,藉此當第三量測板31之第三側壁31c施力於第三彈簧34a時,第三彈簧34a係被壓縮且產生彈性恢復力,以使第三量測板31移動回復至原來位置。The Z-axis measuring device 10c includes a third measuring plate 31, a third sensor 32, a third linear track 33, and a third elastic member 34. The third measuring plate 31 includes a third sliding portion 31a, a third measuring portion 31b and a third side wall 31c. The third measuring portion 31b is disposed corresponding to the third sensor 32 for sensing the third measurement. The amount of displacement of the portion 31b. The third sensor 32 is disposed on the bottom surface 102a of the recess 102, and includes a third sensing slot 32a corresponding to the third measuring portion 31b of the third measuring board 31, thereby making the third measuring board The third measuring portion 31b of the third measuring portion 31b is movable in the third sensing groove 32a. Thus, the displacement amount of the third measuring portion 31b can be measured and obtained by the third sensor 32. Preferably, the third sensor 32 is a position sensor. The third linear track 33 is disposed adjacent to the side of the recess 102, and the third sliding portion 31a of the third measuring plate 31 and the third linear track 33 cooperate with each other, whereby the third measuring plate 31 can slide On the trilinear track 33. The third elastic member 34 is disposed on the bottom surface 102a of the recess portion 102 and includes a third spring 34a and a third post 34b. The third post 34b is vertically connected to the bottom surface 102a of the recess portion 102, wherein the third spring 34a is sleeved. In the third column 34b, and the third spring 34a is disposed corresponding to the third side wall 31c of the third measuring plate 31, in detail, one end of the third spring 34a is abutted against the side of the third side wall 31c, and the third The other end of the spring 34a is abutted against the bottom surface 102a of the recess 102, whereby the third spring 34a is compressed and elastic when the third side wall 31c of the third measuring plate 31 is applied to the third spring 34a. The restoring force is such that the third measuring plate 31 moves back to the original position.

工具3包含連接端3a與工具中心點3b(即末端點),其中連接端3a係與機械手臂2之末端效應點2a相固定且連接,而工具3之工具中心點3b則可移動於X軸量測裝置10a、Y軸量測裝置10b及Z軸量測裝置10c所形成感測空間103中,換言之,機械手臂2可驅動工具3使其工具中心點3b移動於感測空間103內。The tool 3 includes a connecting end 3a and a tool center point 3b (ie, an end point), wherein the connecting end 3a is fixed and connected to the end effect point 2a of the robot arm 2, and the tool center point 3b of the tool 3 is movable to the X axis. The sensing space 103 formed by the measuring device 10a, the Y-axis measuring device 10b, and the Z-axis measuring device 10c, in other words, the robot arm 2 can drive the tool 3 to move the tool center point 3b into the sensing space 103.

以下將進一步敘述工具校正裝置1之運作方式。首先,以X軸向感測為例,當機械手臂2帶動工具3以X軸軸向移動時,工具3之工具中心點3b係以X軸軸向移動於感測空間103中,且從原來位置向第一量測板11移動。工具3將會碰觸到第一量測板11並推動第一量測板11沿著第一線性軌道13滑動。此時,第一量測板11之第一側壁11c會對第一彈性元件14之第一彈簧14a施力,使第一彈簧14a產生彈性恢復力,且第一量測板11之第一量測部11b會移動並置入第一感測器12之第一感測槽12a內,如此一來,第一感測器12便可根據第一量測部11b的位移量取得工具3在X軸軸向的位移參數,即第一位移量。之後,機械手臂2會帶動工具3沿X軸軸向以相反方向移動,而使得第一量測板11因第一彈簧14a之彈性恢復力而移動回復至原來位置。The mode of operation of the tool correcting device 1 will be further described below. First, taking X-axis sensing as an example, when the robot arm 2 drives the tool 3 to move axially in the X-axis, the tool center point 3b of the tool 3 moves axially in the X-axis in the sensing space 103, and The position moves toward the first measuring plate 11. The tool 3 will touch the first measuring plate 11 and push the first measuring plate 11 to slide along the first linear track 13. At this time, the first side wall 11c of the first measuring plate 11 applies a force to the first spring 14a of the first elastic member 14, so that the first spring 14a generates an elastic restoring force, and the first amount of the first measuring plate 11 The measuring portion 11b is moved and placed into the first sensing slot 12a of the first sensor 12, so that the first sensor 12 can acquire the tool 3 according to the displacement amount of the first measuring portion 11b. The displacement parameter of the axial direction of the shaft, that is, the first displacement amount. Thereafter, the robot arm 2 drives the tool 3 to move in the opposite direction along the X-axis axial direction, so that the first measuring plate 11 is moved back to the original position due to the elastic restoring force of the first spring 14a.

接著,以Y軸向感測為例,當機械手臂2帶動工具3以Y軸軸向移動時,工具3之工具中心點3b係以Y軸軸向移動於感測空間103中,且從原來位置向第二量測板21移動。工具3將會碰觸到第二量測板21並推動第二量測板21沿著第二線性軌道23滑動。此時,第二量測板21之第二側壁21c會對第二彈性元件24之第二彈簧24a施力,使第二彈簧24a產生彈性恢復力,且第二量測板21之第二量測部21b會移動並置入第二感測器22之第二感測槽22a內,如此一來,第二感測器22便可根據第二量測部21b的位移量取得工具3在Y軸軸向的位移參數,即第二位移量。之後,機械手臂2會帶動工具3沿Y軸軸向以相反相向移動,而使得第二量測板21因第二彈簧24a之彈性恢復力而移動回復至原來位置。Next, taking the Y-axis sensing as an example, when the robot arm 2 drives the tool 3 to move axially in the Y-axis, the tool center point 3b of the tool 3 moves axially in the sensing space 103 with the Y-axis, and The position moves toward the second measuring plate 21. The tool 3 will touch the second measuring plate 21 and push the second measuring plate 21 to slide along the second linear track 23. At this time, the second side wall 21c of the second measuring plate 21 applies a force to the second spring 24a of the second elastic member 24, so that the second spring 24a generates an elastic restoring force, and the second amount of the second measuring plate 21 The measuring portion 21b is moved and placed in the second sensing slot 22a of the second sensor 22, so that the second sensor 22 can acquire the tool 3 in the Y according to the displacement amount of the second measuring portion 21b. The displacement parameter of the axial direction of the shaft, that is, the second displacement amount. Thereafter, the robot arm 2 drives the tool 3 to move in opposite directions along the Y-axis axial direction, so that the second measuring plate 21 is moved back to the original position due to the elastic restoring force of the second spring 24a.

再來,以Z軸向感測為例,當機械手臂2帶動工具3以Z軸軸向移動時,工具3之工具中心點3b係以Z軸軸向移動於感測空間103中,且從原來位置向第三量測板31移動。工具3將會碰觸到第三量測板31並推動第三量測板31沿著第三線性軌道33滑動。此時,第三量測板31之第三側壁31c會對第三彈性元件34之第三彈簧34a施力,使第三彈簧34a產生彈性恢復力,且第三量測板31之第三量測部31b會移動並置入第三感測器32之第三感測槽32a內,如此一來,第三感測器32便可根據第三量測部31b的位移量取得工具3在Z軸軸向的位移參數,即第三位移量。之後,機械手臂2會帶動工具3沿Z軸軸向以相反方向移動,而使得第三量測板31因第三彈簧34a之彈性恢復力而移動回復至原來位置。Further, taking Z-axis sensing as an example, when the robot arm 2 drives the tool 3 to move axially in the Z-axis, the tool center point 3b of the tool 3 moves axially in the sensing space 103 with the Z-axis, and The original position moves toward the third measuring plate 31. The tool 3 will touch the third measuring plate 31 and push the third measuring plate 31 to slide along the third linear track 33. At this time, the third side wall 31c of the third measuring plate 31 applies a force to the third spring 34a of the third elastic member 34, so that the third spring 34a generates an elastic restoring force, and the third amount of the third measuring plate 31 The measuring portion 31b is moved and placed into the third sensing slot 32a of the third sensor 32. In this way, the third sensor 32 can acquire the tool 3 according to the displacement amount of the third measuring portion 31b. The displacement parameter of the axial direction of the shaft, that is, the third displacement amount. Thereafter, the robot arm 2 drives the tool 3 to move in the opposite direction along the Z-axis axial direction, so that the third measuring plate 31 is moved back to the original position due to the elastic restoring force of the third spring 34a.

經過X軸、Y軸及Z軸三軸軸向的感測後,即可取得工具3之工具中心點3b與機械手臂2之末端效應點2a之間相對於X-Y-Z空間的偏移量,如此一來,機械手臂2便可根據偏移量控制工具3進行工具精度補償。After the three-axis axial sensing of the X-axis, the Y-axis, and the Z-axis, the offset between the tool center point 3b of the tool 3 and the end effect point 2a of the robot arm 2 with respect to the XYZ space can be obtained. The robot arm 2 can perform tool accuracy compensation according to the offset control tool 3.

第3圖係為機器手臂裝配工具應用於工具校正裝置時之運作流程圖。首先,將工具校正裝置1設置於機械手臂2之正下方,並取得工具校正裝置1與機械手臂2之間的距離參數(如步驟S1)。接著,將工具3裝配於機械手臂2之端部,使機械手臂2帶動工具3移動至工具校正裝置1,以使工具3之工具中心點3b位於感測空間103中(如步驟S2)。再來,機械手臂2係帶動工具3以X軸軸向移動,且工具3係碰觸並推動第一量測板11移動,使第一量測部11b移動置入第一感測槽12a內,使第一感測器12取得工具3在X軸向的位移參數(即第一位移量),並於X軸向的位移參數取得後,機械手臂2會帶動工具3沿X軸向以相反方向移動,而使得第一量測板11移動回復至原來位置(如步驟S3)。再來,機械手臂2係帶動工具3以Y軸軸向移動,且工具3係碰觸並推動第二量測板21移動,使第二量測部21b移動置入第二感測槽22a內,使第二感測器22取得工具3在Y軸向的位移參數(即第二位移量),並於Y軸向的位移參數取得後,機械手臂2會帶動工具3沿Y軸向以相反方向移動,而使得第二量測板21移動回復至原來位置(如步驟S4)。再來,機械手臂2係帶動工具3以Z軸軸向移動,且工具3係碰觸並推動第三量測板31移動,使第三量測部31b移動置入第三感測槽32a內,使第三感測器32取得工具3在Z軸向的位移參數(即第三位移量),並於Z軸向的位移參數取得後,機械手臂2會帶動工具3沿Z軸向以相反方向移動,而使得第三量測板31移動回復至原來位置(如步驟S5)。最後,經過X軸、Y軸及Z軸三軸軸向的感測後,即可取得工具3之工具中心點3b與機械手臂2之末端效應點2a之間相對於X-Y-Z空間的偏移量,使機械手臂2可根據偏移量控制工具3進行工具精度補償(如步驟S6)。Figure 3 is a flow chart of the operation of the robotic arm assembly tool applied to the tool calibration device. First, the tool correcting device 1 is placed directly under the robot arm 2, and the distance parameter between the tool correcting device 1 and the robot arm 2 is obtained (step S1). Next, the tool 3 is assembled to the end of the robot arm 2, and the robot arm 2 is caused to move the tool 3 to the tool correcting device 1 so that the tool center point 3b of the tool 3 is located in the sensing space 103 (as in step S2). Then, the robot arm 2 drives the tool 3 to move axially in the X-axis, and the tool 3 touches and pushes the first measuring plate 11 to move, so that the first measuring portion 11b is moved into the first sensing slot 12a. After the first sensor 12 obtains the displacement parameter of the tool 3 in the X-axis direction (ie, the first displacement amount), and after the displacement parameter of the X-axis is obtained, the robot arm 2 drives the tool 3 along the X-axis to the opposite direction. The direction is moved to cause the first measuring plate 11 to move back to the original position (step S3). Then, the robot arm 2 drives the tool 3 to move axially in the Y-axis, and the tool 3 touches and pushes the second measuring plate 21 to move, so that the second measuring portion 21b is moved into the second sensing slot 22a. So that the second sensor 22 obtains the displacement parameter of the tool 3 in the Y-axis (ie, the second displacement amount), and after the displacement parameter in the Y-axis is obtained, the robot arm 2 drives the tool 3 along the Y-axis to the opposite The direction is moved to cause the second measuring plate 21 to move back to the original position (step S4). Then, the robot arm 2 drives the tool 3 to move axially in the Z axis, and the tool 3 touches and pushes the third measuring plate 31 to move, so that the third measuring portion 31b is moved into the third sensing slot 32a. After the third sensor 32 obtains the displacement parameter of the tool 3 in the Z-axis (ie, the third displacement amount), and after the displacement parameter of the Z-axis is obtained, the robot arm 2 drives the tool 3 along the Z-axis to reverse The direction is moved to cause the third measuring plate 31 to move back to the original position (step S5). Finally, after the three-axis axial sensing of the X-axis, the Y-axis, and the Z-axis, the offset between the tool center point 3b of the tool 3 and the end effect point 2a of the robot arm 2 with respect to the XYZ space can be obtained. The robot arm 2 can be made to perform tool accuracy compensation according to the offset amount control tool 3 (step S6).

應注意的是,工具校正裝置1並不局限於上述之實施例。第4至7圖係顯示本案第1圖所示之工具校正裝置1的各種可能變化例,且於第4至7圖中,相似於第1圖所示之工具校正裝置1之結構及元件特徵係以相同元件符號表示,於後文不再贅述。It should be noted that the tool correction device 1 is not limited to the above embodiment. 4 to 7 show various possible variations of the tool correcting device 1 shown in Fig. 1 of the present invention, and in Figs. 4 to 7, similar to the structure and component characteristics of the tool correcting device 1 shown in Fig. 1. They are denoted by the same component symbols and will not be described later.

第4A圖係為本案第二實施例之工具校正裝置的結構示意圖,以及第4B圖係為第4A圖所示之工具校正裝置的結構側視圖。相較於第1A圖及第1B圖所示之工具校正裝置1,本實施例之工具校正裝置1a之第一彈簧14a及第二彈簧24a係設置於不同的位置。第一彈簧14a之一端係固定於槽部101之第一側壁面144a,而第一彈簧14a之另一端則係固定於第一側壁11c之內側面112c。當第一量測板11於X軸軸向移動時,第一量測板11之第一側壁11c係對應地移動,如此一來,第一量測板11之第一側壁11c便會拉伸第一彈簧14a,使第一彈簧14a產生彈性恢復力,而可使第一量測板11移動回復至原來位置。此外,第二彈簧24a之一端係固定於槽部101之第二側壁面(未圖示),而第二彈簧24a之另一端則係固定於第二側壁21c之內側面212c。當第二量測板21於Y軸軸向移動時,第二量測板21之第二側壁21c係對應地移動,如此一來,第二量測板21之第二側壁21c便會拉伸第二彈簧24a,使第二彈簧24a產生彈性恢復力,而可使第二量測板21移動回復至原來位置。Fig. 4A is a structural schematic view of the tool correcting device of the second embodiment of the present invention, and Fig. 4B is a side view showing the structure of the tool correcting device shown in Fig. 4A. The first spring 14a and the second spring 24a of the tool correcting device 1a of the present embodiment are disposed at different positions than the tool correcting device 1 shown in Figs. 1A and 1B. One end of the first spring 14a is fixed to the first side wall surface 144a of the groove portion 101, and the other end of the first spring 14a is fixed to the inner side surface 112c of the first side wall 11c. When the first measuring plate 11 moves axially in the X-axis, the first side wall 11c of the first measuring plate 11 moves correspondingly, so that the first side wall 11c of the first measuring plate 11 is stretched. The first spring 14a causes the first spring 14a to generate an elastic restoring force, and the first measuring plate 11 can be moved back to the original position. Further, one end of the second spring 24a is fixed to the second side wall surface (not shown) of the groove portion 101, and the other end of the second spring 24a is fixed to the inner side surface 212c of the second side wall 21c. When the second measuring plate 21 moves axially in the Y-axis, the second side wall 21c of the second measuring plate 21 moves correspondingly, so that the second side wall 21c of the second measuring plate 21 is stretched. The second spring 24a causes the second spring 24a to generate an elastic restoring force, and the second measuring plate 21 can be moved back to the original position.

第5A圖係為本案第三實施例之工具校正裝置的結構示意圖,以及第5B圖係為第5A圖所示之工具校正裝置的結構側視圖。相較於第1A圖及第1B圖所示之工具校正裝置1,本實施例之工具校正裝置1b之基座10並不具有對應的槽部101,且第一彈性元件14及第二彈性元件24係分別設置於基座10之頂面101a上。Fig. 5A is a structural schematic view of the tool correcting device of the third embodiment of the present invention, and Fig. 5B is a side view showing the structure of the tool correcting device shown in Fig. 5A. The base 10 of the tool correcting device 1b of the present embodiment does not have a corresponding groove portion 101, and the first elastic member 14 and the second elastic member are compared with the tool correcting device 1 shown in FIGS. 1A and 1B. The 24 series are respectively disposed on the top surface 101a of the base 10.

第6A圖係為本案第四實施例之工具校正裝置的結構示意圖,以及第6B圖係為第6A圖所示之工具校正裝置的結構側視圖。相較於第1A圖及第1B圖所示之工具校正裝置1,本實施例之工具校正裝置1c之基座10同樣不具有對應的槽部101,且第一彈性元件14及第二彈性元件24係同樣也是分別設置於基座10之頂面101a上。此外,第一感測器12是設置於第一線性軌道13之第二側13b,而第一彈性元件14則是設置於第一線性軌道13之第一側13a。另外,第二感測器22是設置於第二線性軌道23之第二側23b,而第二彈性元件24則是設置於第二線性軌道23之第一側23a。Fig. 6A is a structural schematic view of the tool correcting device of the fourth embodiment of the present invention, and Fig. 6B is a side view showing the structure of the tool correcting device shown in Fig. 6A. The base 10 of the tool correcting device 1c of the present embodiment also has no corresponding groove portion 101, and the first elastic member 14 and the second elastic member are the same as the tool correcting device 1 shown in FIGS. 1A and 1B. The 24 series are also respectively disposed on the top surface 101a of the base 10. In addition, the first sensor 12 is disposed on the second side 13b of the first linear track 13, and the first elastic element 14 is disposed on the first side 13a of the first linear track 13. In addition, the second sensor 22 is disposed on the second side 23b of the second linear track 23, and the second elastic member 24 is disposed on the first side 23a of the second linear track 23.

第7A圖係為本案第五實施例之工具校正裝置的結構示意圖,以及第7B圖係為第7A圖所示之工具校正裝置的結構側視圖。相較於第1A圖及第1B圖所示之工具校正裝置1,本實施例之工具校正裝置1d係採用不同的感測器,也就是說,本實施例之第一感測器12、第二感測器22及第三感測器32係分別可使用接觸式開關,其與前述實施例之感測器的差別在於:當第一量測部11b、第二量測部21b或第三量測部31b移動並碰觸到接觸式開關時,接觸式開關係可對應地感測第一量測部11b、第二量測部21b及第三量測部31b之位移量。因此,接觸式開關與感測器同樣可測得第一量測部11b、第二量測部21b及第三量測部31b之位移量。Fig. 7A is a structural schematic view of the tool correcting device of the fifth embodiment of the present invention, and Fig. 7B is a structural side view of the tool correcting device shown in Fig. 7A. Compared with the tool calibration device 1 shown in FIG. 1A and FIG. 1B, the tool calibration device 1d of the present embodiment uses different sensors, that is, the first sensor 12 and the first embodiment of the present embodiment. The second sensor 22 and the third sensor 32 can respectively use a contact switch, which differs from the sensor of the foregoing embodiment in that the first measuring portion 11b, the second measuring portion 21b or the third When the measuring unit 31b moves and touches the contact switch, the contact opening relationship can correspondingly sense the displacement amounts of the first measuring unit 11b, the second measuring unit 21b, and the third measuring unit 31b. Therefore, the contact switch and the sensor can also measure the displacement amounts of the first measuring portion 11b, the second measuring portion 21b, and the third measuring portion 31b.

綜上所述,本案係提供一種機械手臂之工具校正裝置,其成本較低且可模組化組裝。此外,本案之工具校正裝置可正確地量測與取得工具之TCP與機械手臂之末端效應點之間相對的偏移量,藉此機械手臂可以快速地對工具正確性進行補償,以確保工具的正確運作位置。相較於人工校正方法,利用本案之工具校正裝置不只可以節省操作時間,且可以實現工具的高精度校正。In summary, the present invention provides a tool correction device for a robot arm, which is low in cost and modular in assembly. In addition, the tool calibration device of the present invention can correctly measure the relative offset between the TCP and the end effect point of the robot arm of the acquisition tool, whereby the robot can quickly compensate the correctness of the tool to ensure the tool's Correct operation position. Compared with the manual correction method, the tool calibration device of the present invention not only saves operation time, but also can realize high-precision correction of the tool.

本案得由熟習此技術之人士任施匠思而為諸般修飾,然皆不脫如附申請專利範圍所欲保護者。
This case has been modified by people who are familiar with the technology, but it is not intended to be protected by the scope of the patent application.

 

1:工具校正裝置
10:基座
101:槽部
243a:第一側壁面
102:凹陷部
102a:底面
10a:X軸量測裝置
11:第一量測板
11a:第一滑動部
11b:第一量測部
11c:第一側壁
12:第一感測器
12a:第一感測槽
13:第一線性軌道
13a:第一側
13b:第二側
14:第一彈性元件
10b:Y軸量測裝置
21:第二量測板
21a:第二滑動部
21b:第二量測部
21c:第二側壁
22:第二感測器
22a:第二感測槽
23:第二線性軌道
23a:第一側
23b:第二側
24:第二彈性元件
24a:第二彈簧
24b:第二柱
10c:Z軸量測裝置
32a:第三感測槽
33:第三線性軌道
101c:第一側
102c:第二側
103c:頂面
103:感測空間
1: Tool calibration device
10: base
101: Groove
243a: first side wall surface
102: depression
102a: bottom surface
10a: X-axis measuring device
11: The first measuring board
11a: first sliding portion
11b: The first measuring part
11c: first side wall
12: First sensor
12a: first sensing slot
13: First linear orbit
13a: first side
13b: second side
14: first elastic element
10b: Y-axis measuring device
21: The second measuring board
21a: second sliding portion
21b: second measuring part
21c: second side wall
22: second sensor
22a: second sensing slot
23: Second linear orbit
23a: first side
23b: second side
24: second elastic element
24a: second spring
24b: second column
10c: Z-axis measuring device
32a: third sensing slot
33: Third linear orbit
101c: first side
102c: second side
103c: top surface
103: Sensing space

Claims (11)

一種工具校正裝置,應用於一機械手臂,該機械手臂係具有一工具,且該機械手臂係帶動該工具移動,該工具校正裝置包含:
一基座,具有一凹陷部;
一X軸量測裝置,設置於該基座上,且包含一第一量測板及一第一感測器,其中該第一量測板係於X軸軸向移動,且該第一感測器係於該工具驅使該第一量測板移動時感測該第一量測板所移動之一第一位移量;
一Y軸量測裝置,設置於該基座上且與該X軸量測裝置之一側相鄰設,並且包含一第二量測板及一第二感測器,其中該第二量測板係於Y軸軸向移動,且該第二感測器係於該工具驅使該第二量測板移動時感測該第二量測板所移動之一第二位移量;以及
一Z軸量測裝置,設置於該凹陷部且具有兩相鄰側分別與該X軸量測裝置及該Y軸量測裝置相鄰設,並且包含一第三量測板及一第三感測器,其中該第三量測板係於Z軸軸向移動,且該第三感測器係於該工具驅使該第三量測板移動時感測該第三量測板所移動之一第三位移量;
其中,根據該工具於該X軸、該Y軸及該Z軸移動所感測取得之該第一位移量、該第二位移量及該第三位移量,以取得關於該工具之一工具中心點之資訊,俾進行該工具之該工具中心點之校正。
A tool calibration device is applied to a robot arm having a tool, and the robot arm drives the tool to move. The tool calibration device comprises:
a base having a recess;
An X-axis measuring device is disposed on the base and includes a first measuring plate and a first sensor, wherein the first measuring plate is axially moved on the X axis, and the first feeling The detector senses a first displacement amount of movement of the first measuring plate when the tool drives the first measuring plate to move;
a Y-axis measuring device is disposed on the base and adjacent to one side of the X-axis measuring device, and includes a second measuring plate and a second sensor, wherein the second measuring device The plate is axially moved in the Y-axis, and the second sensor senses a second displacement amount of the movement of the second measuring plate when the tool drives the second measuring plate to move; and a Z-axis The measuring device is disposed on the recessed portion and has two adjacent sides respectively adjacent to the X-axis measuring device and the Y-axis measuring device, and includes a third measuring plate and a third sensor. The third measuring plate is axially moved in the Z axis, and the third sensor senses a third displacement of the third measuring plate when the tool drives the third measuring plate to move. the amount;
The first displacement amount, the second displacement amount, and the third displacement amount obtained by the sensing on the X axis, the Y axis, and the Z axis are obtained by the tool to obtain a tool center point of the tool. Information, the correction of the tool's center point for the tool.
如申請專利範圍第1項所述之工具校正裝置,其中該X軸量測裝置更包含一第一線性軌道及一第一彈性元件,該第一線性軌道係供該第一量測板滑動,且該第一彈性元件係於該工具驅使該第一量測板移動時產生彈性恢復力,其中該Y軸量測裝置更包含一第二線性軌道及一第二彈性元件,該第二線性軌道係供該第二量測板滑動,且該第二彈性元件係於該工具驅使該第二量測板移動時產生彈性恢復力,其中該Z軸量測裝置更包含一第三線性軌道及一第三彈性元件,該第三線性軌道係供該第三量測板滑動,且該第三彈性元件係於該工具驅使該第三量測板移動時產生彈性恢復力。The tool calibration device of claim 1, wherein the X-axis measuring device further comprises a first linear track and a first elastic element, wherein the first linear track is for the first measuring plate Sliding, and the first elastic element generates an elastic restoring force when the tool drives the first measuring plate to move, wherein the Y-axis measuring device further comprises a second linear track and a second elastic element, the second a linear track for the second measuring plate to slide, and the second elastic element generates an elastic restoring force when the tool drives the second measuring plate to move, wherein the Z-axis measuring device further comprises a third linear track And a third elastic member for sliding the third measuring plate, and the third elastic member is configured to generate an elastic restoring force when the tool drives the third measuring plate to move. 如申請專利範圍第2項所述之工具校正裝置,其中該第一量測板包含一第一滑動部,與該第一線性軌道相配合,以使該第一量測板滑動於該第一線性軌道上,其中該第二量測板包含一第二滑動部,與該第二線性軌道相配合,以使該第二量測板滑動於該第二線性軌道上,其中該第三量測板包含一第三滑動部,與該第三線性軌道相配合,以使該第三量測板滑動於該第三線性軌道上。The tool calibration device of claim 2, wherein the first measuring plate comprises a first sliding portion that cooperates with the first linear track to slide the first measuring plate to the first a linear track, wherein the second measuring plate comprises a second sliding portion that cooperates with the second linear track to slide the second measuring plate on the second linear track, wherein the third measuring plate The measuring plate includes a third sliding portion that cooperates with the third linear track to slide the third measuring plate on the third linear track. 如申請專利範圍第3項所述之工具校正裝置,其中該第一量測板包含一第一量測部與該第一感測器對應設置,用以感測該第一量測部之位移量,其中該第二量測板包含一第二量測部與該第二感測器對應設置,用以感測該第二量測部之位移量,其中該第三量測板包含一第三量測部與該第三感測器對應設置,用以感測該第三量測部之位移量。The tool calibration device of claim 3, wherein the first measuring plate comprises a first measuring portion corresponding to the first sensor for sensing a displacement of the first measuring portion The second measuring device includes a second measuring portion corresponding to the second sensor for sensing a displacement amount of the second measuring portion, wherein the third measuring plate comprises a first The three measuring portion is disposed corresponding to the third sensor for sensing the displacement amount of the third measuring portion. 如申請專利範圍第4項所述之工具校正裝置,其中該第一感測器、該第二感測器及該第三感測器係分別為一位置感測器或一接觸式開關。The tool calibration device of claim 4, wherein the first sensor, the second sensor, and the third sensor are respectively a position sensor or a contact switch. 如申請專利範圍第4項所述之工具校正裝置,其中該第一感測器更包含一第一感測槽與該第一量測部對應設置,該第二感測器更包含一第二感測槽與該第二量測部對應設置,且該第三感測器包含一第三感測槽與該第三量測部對應設置。The tool calibration device of claim 4, wherein the first sensor further comprises a first sensing slot corresponding to the first measuring portion, and the second sensor further comprises a second The sensing slot is disposed corresponding to the second measuring portion, and the third sensor includes a third sensing slot corresponding to the third measuring portion. 如申請專利範圍第6項所述之工具校正裝置,其中該第一量測板包含一第一側壁與該第一彈性元件相抵頂,該第二量測板包含一第二側壁與該第二彈性元件相抵頂,且該第三量測板包含一第三側壁與該第三彈性元件相抵頂。The tool calibration device of claim 6, wherein the first measuring plate comprises a first sidewall opposite to the first elastic member, and the second measuring panel comprises a second sidewall and the second The elastic member abuts against the top, and the third measuring plate includes a third sidewall abutting the third elastic member. 如申請專利範圍第7項所述之工具校正裝置,其中該第一彈性元件包含一第一彈簧及一第一柱,且該第一彈簧係套設於該第一柱,其中該第二彈性元件包含一第二彈簧及一第二柱,且該第二彈簧係套設於該第二柱,其中該第三彈性元件包含一第三彈簧及一第三柱,且該第三彈簧係套設於該第三柱。The tool calibration device of claim 7, wherein the first elastic component comprises a first spring and a first post, and the first spring is sleeved on the first post, wherein the second elastic The component includes a second spring and a second post, and the second spring is sleeved on the second post, wherein the third elastic component comprises a third spring and a third post, and the third spring sleeve Located in the third column. 如申請專利範圍第8項所述之工具校正裝置,其中該第一感測器係設置於該第一線性軌道之一側,且該第一彈性元件係設置於該第一線性軌道之另一側,其中該第二感測器係設置於該第二線性軌道之一側,且該第二彈性元件係設置於該第二線性軌道之另一側。The tool calibration device of claim 8, wherein the first sensor is disposed on one side of the first linear track, and the first elastic element is disposed on the first linear track. The other side, wherein the second sensor is disposed on one side of the second linear track, and the second elastic element is disposed on the other side of the second linear track. 如申請專利範圍第8項所述之工具校正裝置,其中該基座包含複數個槽部,供該第一彈性元件及該第二彈性元件設置於對應之該槽部內。The tool calibration device of claim 8, wherein the base comprises a plurality of groove portions, wherein the first elastic member and the second elastic member are disposed in the corresponding groove portion. 如申請專利範圍第1項所述之工具校正裝置,其中該第一量測板與該第二量測板係分別鄰設於該第三量測板之該兩相鄰側,並且部分高出於該第三量測板之一頂面,其中該第一量測板、該第二量測板與該第三量測板係定義形成一感測空間,以供該機械手臂帶動該工具之該工具中心點於該感測空間內移動。
The tool calibration device of claim 1, wherein the first measuring plate and the second measuring plate are respectively adjacent to the two adjacent sides of the third measuring plate, and the portion is higher a top surface of the third measuring board, wherein the first measuring board, the second measuring board and the third measuring board define a sensing space for the mechanical arm to drive the tool The tool center moves within the sensing space.
TW105106637A 2015-11-30 2016-03-04 Tool calibration apparatus of robot manipulator TWI589414B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
US15/146,725 US10065319B2 (en) 2015-11-30 2016-05-04 Tool calibration apparatus of robot manipulator

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
US201562260924P 2015-11-30 2015-11-30

Publications (2)

Publication Number Publication Date
TW201718208A TW201718208A (en) 2017-06-01
TWI589414B true TWI589414B (en) 2017-07-01

Family

ID=59106282

Family Applications (1)

Application Number Title Priority Date Filing Date
TW105106637A TWI589414B (en) 2015-11-30 2016-03-04 Tool calibration apparatus of robot manipulator

Country Status (2)

Country Link
CN (1) CN106808483B (en)
TW (1) TWI589414B (en)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110614630B (en) * 2018-06-19 2022-10-18 台达电子工业股份有限公司 Tool correcting device of mechanical arm
ES2788274B2 (en) * 2019-04-17 2022-07-21 Loxin 2002 Sl MACHINING HEAD WITH ACTIVE CORRECTION, OPERATION PROCEDURE AND USE
CN112902898B (en) 2019-12-03 2022-11-29 台达电子工业股份有限公司 Calibration method of three-dimensional measuring device and applicable mechanical arm
CN113799115B (en) * 2020-06-11 2023-03-24 台达电子工业股份有限公司 Coordinate correction method of robot arm

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
SE508161C2 (en) * 1995-03-30 1998-09-07 Asea Brown Boveri Method and apparatus for calibrating motion shafts of an industrial robot
US6434449B1 (en) * 2000-08-03 2002-08-13 Pierre De Smet Method and device for automated robot-cell calibration
DE102009041734B4 (en) * 2009-09-16 2023-11-02 Kuka Roboter Gmbh Measuring a manipulator
CN105091807B (en) * 2014-04-30 2017-12-01 鸿富锦精密工业(深圳)有限公司 The bearing calibration of robot tool coordinate system
CN105066884B (en) * 2015-09-09 2018-07-06 大族激光科技产业集团股份有限公司 A kind of robot end's deviations bearing calibration and system

Also Published As

Publication number Publication date
CN106808483B (en) 2019-06-11
TW201718208A (en) 2017-06-01
CN106808483A (en) 2017-06-09

Similar Documents

Publication Publication Date Title
US10065319B2 (en) Tool calibration apparatus of robot manipulator
TWI589414B (en) Tool calibration apparatus of robot manipulator
JP6511715B2 (en) Robot control device, robot system, and robot
CN110614630B (en) Tool correcting device of mechanical arm
Lee et al. Accuracy improvement of miniaturized machine tool: geometric error modeling and compensation
JP6667376B2 (en) Component press-in method and component press-in system
CN112902898B (en) Calibration method of three-dimensional measuring device and applicable mechanical arm
JP5939202B2 (en) Robot teaching auxiliary device, robot system, and robot teaching method
TWI648135B (en) Tool calibration apparatus of robot manipulator
US10016892B2 (en) System and method for determining tool offsets
JP2010531238A (en) Apparatus and method for position adjustment of universal bearing device for cutting machine
JP2014176943A (en) Robot system, calibration method and method for manufacturing workpiece
JP4613955B2 (en) Rotation axis calculation method, program creation method, operation method, and robot apparatus
US20150209926A1 (en) Workpiece positioning device positioning workpiece at two reference surfaces
JP2020142324A (en) Robot device and automatic correction method
Bruzzone et al. Modelling and control of peg-in-hole assembly performed by a translational robot
CN113799115A (en) Coordinate correction method of robot arm
JP2021028585A (en) Flaw detection device
JP2006297559A (en) Calibration system and robot calibration method
JPS59178310A (en) Alignment device for coordinate system calibration of articulated robots
JP6674953B2 (en) Method and apparatus for measuring a path in a loaded state
TWI725646B (en) Three dimensional measuring device and calibration method of robotic arm using the same
KR100529904B1 (en) The method of zero point setting for fine stage
KR100244758B1 (en) Calibration method of vertical articulated welding robot and its device
JPH02180580A (en) Origin adjusting device for industrial robot
点击 这是indexloc提供的php浏览器服务,不要输入任何密码和下载