TW202222476A - Control system and control method for disc type tool magazine will generate a corresponding signal when the transmission error exceeds the acceptable margin of error - Google Patents

Control system and control method for disc type tool magazine will generate a corresponding signal when the transmission error exceeds the acceptable margin of error Download PDF

Info

Publication number
TW202222476A
TW202222476A TW109143541A TW109143541A TW202222476A TW 202222476 A TW202222476 A TW 202222476A TW 109143541 A TW109143541 A TW 109143541A TW 109143541 A TW109143541 A TW 109143541A TW 202222476 A TW202222476 A TW 202222476A
Authority
TW
Taiwan
Prior art keywords
encoder
gear
pulse
pulse signal
control system
Prior art date
Application number
TW109143541A
Other languages
Chinese (zh)
Other versions
TWI751829B (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 TW109143541A priority Critical patent/TWI751829B/en
Application granted granted Critical
Publication of TWI751829B publication Critical patent/TWI751829B/en
Publication of TW202222476A publication Critical patent/TW202222476A/en

Links

Images

Landscapes

  • Automatic Tool Replacement In Machine Tools (AREA)

Abstract

A control system for a disc type tool magazine comprises a servo motor, a first encoder, a reducer, a transmission mechanism, a second encoder and a servo driver. A first encoder is disposed on the servo motor. The reducer is disposed between the servo motor and the transmission mechanism. The second encoder is disposed on the transmission mechanism. A control method of the control system includes: the servo driver receives a rotation signal and controls the servo motor based on the rotation signal; and the servo driver receives a first pulse signal from the first encoder and a second pulse signal from the second encoder, and will send out a signal when the pulse number of the first pulse signal reaches an upper limit pulse number and the pulse number of the second pulse signal has not reached a predetermined pulse number, that is, when the transmission error exceeds the acceptable margin of error.

Description

圓盤式刀庫的控制系統及控制方法Control system and control method of disc type tool magazine

本發明係與圓盤式刀庫有關;特別是指一種圓盤式刀庫的控制系統及控制方法。The invention relates to a disc type tool magazine; in particular, it refers to a control system and a control method of the disc type tool magazine.

請參圖1所示,為一種已知工具機的自動換刀機構,其包括有一圓盤式刀庫1、一伺服馬達2、一減速機3、一傳動機構4、一編碼器5與一伺服驅動器6。其中,該圓盤式刀庫1上包括一轉盤1a與複數個刀套1b,刀套1b供容置不同的刀具。伺服馬達2的輸出軸連接該減速機3。該減速機3包括有多數不同齒輪比的齒輪。該傳動機構4包括一小齒輪4a與一大齒輪4b,小齒輪4a連接於減速機3,大齒輪4b連接於圓盤式刀庫1的轉盤1a;該編碼器5裝設於該伺服馬達2上,僅用以偵測該伺服馬達2之轉子的轉速與轉動角度是否確實及到位,而輸出對應的脈波訊號回授給該伺服驅動器6。該伺服驅動器6對該伺服馬達2發出驅動或剎車的控制指令。該伺服馬達2透過該減速機3與該傳動機構4以驅使該圓盤式刀庫1轉動而達到選刀目的。Please refer to FIG. 1, which is an automatic tool changing mechanism of a known machine tool, which includes a disc-type tool magazine 1, a servo motor 2, a reducer 3, a transmission mechanism 4, an encoder 5 and a Servo drive 6. Wherein, the disc-type tool magazine 1 includes a turntable 1a and a plurality of tool pockets 1b, and the tool pockets 1b are used for accommodating different tools. The reducer 3 is connected to the output shaft of the servo motor 2 . The reducer 3 includes a number of gears with different gear ratios. The transmission mechanism 4 includes a pinion 4a and a large gear 4b, the pinion 4a is connected to the reducer 3, and the large gear 4b is connected to the turntable 1a of the disc-type tool magazine 1; the encoder 5 is installed in the servo motor 2 The above is only used to detect whether the rotation speed and rotation angle of the rotor of the servo motor 2 are indeed in place, and output the corresponding pulse signal back to the servo driver 6 . The servo driver 6 issues a driving or braking control command to the servo motor 2 . The servo motor 2 drives the disc-type tool magazine 1 to rotate through the reducer 3 and the transmission mechanism 4 to achieve the purpose of tool selection.

上述機構雖可完成選刀作業,讓特定的刀套移動到換刀位置,供換刀臂在換刀位置取刀具或置放刀具。惟,該減速機3及傳動機構4的齒輪部分易在長期使用後產生背隙(back lash)問題,而這微小的間隙將導致傳動誤差,並影響該圓盤式刀庫1的旋轉位置。除此之外,該圓盤式刀庫1亦可能因負載過重而影響旋轉位置,導致轉動不確實。前述情形皆將使得自動換刀機構動作錯誤。然而,習用的自動換刀機構並無法由編碼器5之脈波訊號得知特定的刀套1b尚未移動到換刀位置,只能待換刀臂無法在換刀位置取刀具或置放刀具時,才能發出警示。是以,前述已知技術未臻完善而待改進。Although the above mechanism can complete the tool selection operation, the specific tool pocket can be moved to the tool changing position, so that the tool changing arm can take the tool or place the tool at the tool changing position. However, the gear parts of the reducer 3 and the transmission mechanism 4 are prone to backlash after long-term use, and the slight backlash will cause transmission errors and affect the rotational position of the disc-type tool magazine 1 . Besides, the disc-type tool magazine 1 may also affect the rotation position due to the heavy load, resulting in inaccurate rotation. All of the above situations will make the automatic tool changer operate incorrectly. However, the conventional automatic tool changing mechanism cannot know from the pulse signal of the encoder 5 that the specific tool pocket 1b has not moved to the tool changing position, only when the tool changing arm cannot pick up the tool or place the tool at the tool changing position , to issue a warning. Therefore, the aforementioned known techniques are not perfect and need to be improved.

有鑑於此,本發明之目的在於提供一種圓盤式刀庫的控制系統及其控制方法,可以在傳動誤差超出容許的誤差範圍時,產生對應的訊號。In view of this, the purpose of the present invention is to provide a control system and a control method for a disc type tool magazine, which can generate a corresponding signal when the transmission error exceeds the allowable error range.

緣以達成上述目的,本發明提供的一種圓盤式刀庫的控制系統,該圓盤式刀庫包括一轉盤與複數個刀套,該些刀套設置於該轉盤上;該控制系統包含一伺服馬達、一第一編碼器、一減速機、一傳動機構、一第二編碼器與一伺服驅動器,其中,該伺服馬達具有一輸出軸;該第一編碼器設置於該伺服馬達;該第一編碼器用以對應該輸出軸的轉動而輸出一第一脈波訊號;該減速機具有一輸入端與一輸出端,該輸入端耦接該輸出軸;該傳動機構包括相嚙合的一第一齒件與一第二齒件,該第一齒件耦接該輸出端,該第二齒件耦接該轉盤;且該第一齒件受該輸出端帶動而轉動時,該第一齒件能夠帶動該第二齒件轉動,進而帶動該轉盤轉動;該第二編碼器設置於該第一齒件與該第二齒件之其中一者,該第二編碼器用以對應所設置之該第一齒件或該第二齒件的轉動而輸出一第二脈波訊號;該伺服驅動器電性連接該伺服馬達、該第一編碼器與該第二編碼器,該伺服驅動器控制該伺服馬達轉動或停止轉動;In order to achieve the above object, the present invention provides a control system for a disc type tool magazine, the disc type tool magazine includes a turntable and a plurality of tool pockets, and the tool pockets are arranged on the turntable; the control system includes a Servo motor, a first encoder, a reducer, a transmission mechanism, a second encoder and a servo driver, wherein the servo motor has an output shaft; the first encoder is arranged on the servo motor; the first encoder An encoder is used for outputting a first pulse signal corresponding to the rotation of the output shaft; the reducer has an input end and an output end, the input end is coupled to the output shaft; the transmission mechanism includes a first meshing a toothed part and a second toothed part, the first toothed part is coupled to the output end, the second toothed part is coupled to the turntable; and when the first toothed part is driven by the output end to rotate, the first toothed part It can drive the second gear to rotate, and then drive the turntable to rotate; the second encoder is arranged on one of the first gear and the second gear, and the second encoder is used to correspond to the set first gear. The rotation of a gear or the second gear outputs a second pulse signal; the servo driver is electrically connected to the servo motor, the first encoder and the second encoder, and the servo driver controls the servo motor to rotate or stop turning;

其中,該些刀套的數量為N;該輸出軸轉動一圈時,該第一編碼器輸出的第一脈波訊號具有一第一預定脈波數,該第一預定脈波數為K1;該第二編碼器所設置的該第一齒件轉動一圈或該第二編碼器所設置的該第二齒件轉動1/N圈時,該第二編碼器輸出的第二脈波訊號具有一第二預定脈波數,該第二預定脈波數為K2;該減速機的減速比為M:1;Wherein, the number of the tool pockets is N; when the output shaft rotates one revolution, the first pulse signal output by the first encoder has a first predetermined pulse number, and the first predetermined pulse number is K1; The second pulse signal output by the second encoder has a second predetermined number of pulse waves, the second predetermined number of pulse waves is K2; the reduction ratio of the reducer is M:1;

該伺服驅動器於滿足一第一條件時,發出一訊號,其中,該第一條件為:於收到之該第一編碼器輸出的第一脈波訊號之脈波數達到K1×M+E,並且收到之該第二編碼器輸出的第二脈波訊號之脈波數小於K2;其中,E為一誤差脈波數。The servo driver sends a signal when a first condition is satisfied, wherein the first condition is: the number of pulses of the first pulse signal output by the first encoder reaches K1×M+E, And the received pulse number of the second pulse signal output by the second encoder is less than K2; wherein, E is an error pulse number.

本發明另提供的一種圓盤式刀庫的控制系統,該控制系統包含一伺服馬達、一第一編碼器、一減速機、一傳動機構、一第二編碼器與一伺服驅動器,其中,該伺服馬達具有一輸出軸;該第一編碼器設置於該伺服馬達;該第一編碼器用以對應該輸出軸的轉動而輸出一第一脈波訊號;該減速機具有一輸入端與一輸出端,該輸入端耦接該輸出軸;該傳動機構耦接於該輸出端與該轉盤之間;該第二編碼器設置於該傳動機構,該第二編碼器用以對應該傳動機構的轉動而輸出一第二脈波訊號;該伺服驅動器電性連接該伺服馬達、該第一編碼器與該第二編碼器,該伺服驅動器接收一轉動訊號,並依據該轉動訊號控制該伺服馬達,使該輸出軸轉動並透過該減速機及該傳動機構帶動該轉盤轉動;該伺服驅動器接收該第一脈波訊號及該第二脈波訊號,並於該第一脈波訊號的脈波數達到一上限脈波數且該第二脈波訊號的脈波數尚未達到一預定脈波數時,該伺服驅動器發出一訊號。The present invention also provides a control system for a disc type tool magazine, the control system includes a servo motor, a first encoder, a reducer, a transmission mechanism, a second encoder and a servo driver, wherein the The servo motor has an output shaft; the first encoder is arranged on the servo motor; the first encoder is used to output a first pulse signal corresponding to the rotation of the output shaft; the reducer has an input end and an output end , the input end is coupled to the output shaft; the transmission mechanism is coupled between the output end and the turntable; the second encoder is arranged in the transmission mechanism, and the second encoder is used to output the output corresponding to the rotation of the transmission mechanism a second pulse signal; the servo driver is electrically connected to the servo motor, the first encoder and the second encoder, the servo driver receives a rotation signal, and controls the servo motor according to the rotation signal, so that the output The shaft rotates and drives the turntable to rotate through the reducer and the transmission mechanism; the servo driver receives the first pulse signal and the second pulse signal, and when the pulse number of the first pulse signal reaches an upper limit pulse When the wave number and the pulse number of the second pulse signal have not reached a predetermined pulse number, the servo driver sends a signal.

本發明另提供的一種圓盤式刀庫的控制系統之控制方法,該控制系統包含一伺服馬達,具有一輸出軸;一第一編碼器,用以對應該輸出軸的轉動而輸出一第一脈波訊號;一減速機,具有一輸入端與一輸出端,該輸入端耦接該輸出軸;一傳動機構,包括相嚙合的一第一齒件與一第二齒件,該第一齒件耦接該輸出端,該第二齒件耦接該轉盤;且該第一齒件受該輸出端帶動而轉動時,該第一齒件能夠帶動該第二齒件轉動,進而帶動該轉盤轉動;一第二編碼器,用以對應該第一齒件與該第二齒件之其中一者的轉動而輸出一第二脈波訊號;一伺服驅動器,電性連接該伺服馬達、該第一編碼器與該第二編碼器;其中,該些刀套的數量為N,該輸出軸轉動一圈時,該第一編碼器輸出的第一脈波訊號具有一第一預定脈波數,該第一預定脈波數為K1;該第二編碼器所對應的該第一齒件轉動一圈或該第二編碼器所對應的該第二齒件轉動1/N圈時,該第二編碼器輸出的第二脈波訊號具有一第二預定脈波數,該第二預定脈波數為K2;該減速機的減速比為M:1;該控制方法係由該伺服驅動器所執行,包含下列步驟:The present invention also provides a control method for a control system of a disc type tool magazine. The control system includes a servo motor with an output shaft and a first encoder for outputting a first encoder corresponding to the rotation of the output shaft. a pulse signal; a reducer with an input end and an output end, the input end is coupled to the output shaft; a transmission mechanism, including a first gear and a second gear that mesh with each other, the first gear The first gear is coupled to the output end, and the second gear is coupled to the turntable; and when the first gear is driven by the output to rotate, the first gear can drive the second gear to rotate, thereby driving the turntable rotation; a second encoder for outputting a second pulse signal corresponding to the rotation of one of the first gear and the second gear; a servo driver electrically connected to the servo motor, the first gear an encoder and the second encoder; wherein the number of the tool pockets is N, and when the output shaft rotates one revolution, the first pulse signal output by the first encoder has a first predetermined number of pulses, The first predetermined pulse number is K1; when the first gear corresponding to the second encoder rotates once or the second gear corresponding to the second encoder rotates 1/N The second pulse signal output by the encoder has a second predetermined pulse number, and the second predetermined pulse number is K2; the reduction ratio of the reducer is M:1; the control method is executed by the servo driver, Contains the following steps:

A. 接收一轉動訊號;A. Receive a rotation signal;

B. 控制該伺服馬達,使該輸出軸轉動,及接收該第一脈波訊號與該第二脈波訊號;B. Control the servo motor to rotate the output shaft and receive the first pulse signal and the second pulse signal;

C. 計數該第一脈波訊號的脈波數,及計數該第二脈波訊號的脈波數;C. Count the number of pulses of the first pulse signal, and count the number of pulses of the second pulse signal;

D. 於滿足一第一條件時,發出一訊號,其中,該第一條件為:該第一脈波訊號之脈波數達到K1×M+E,並且該第二脈波訊號之脈波數小於K2;其中,E為一誤差脈波數。D. When a first condition is met, a signal is sent, wherein the first condition is: the number of pulses of the first pulse signal reaches K1×M+E, and the number of pulses of the second pulse signal is less than K2; wherein, E is an error pulse number.

本發明之效果在於,藉由第一編碼器與第二編碼器的脈波訊號,該伺服驅動器可在傳動誤差超出容許的誤差範圍時,則發出訊號,以供後續的處理。The effect of the present invention is that, with the pulse signals of the first encoder and the second encoder, the servo driver can send a signal for subsequent processing when the transmission error exceeds the allowable error range.

為能更清楚地說明本發明,茲舉較佳實施例並配合圖式詳細說明如後。請參圖2所示,為本發明第一較佳實施例之圓盤式刀庫1的控制系統100,其係用以控制圖3與圖4所示之圓盤式刀庫1,該圓盤式刀庫1包括一轉盤1a與複數個刀套1b,該些刀套1b設置於該轉盤1a且隨轉該轉盤1a轉動。In order to describe the present invention more clearly, preferred embodiments are given and described in detail with the drawings as follows. Please refer to FIG. 2 , which is a control system 100 of the disk-type tool magazine 1 according to the first preferred embodiment of the present invention, which is used to control the disk-type tool magazine 1 shown in FIGS. 3 and 4 . The disk-type tool magazine 1 includes a turntable 1a and a plurality of tool pockets 1b. The tool pockets 1b are disposed on the turntable 1a and rotate with the turntable 1a.

該控制系統100包含一伺服馬達10、一第一編碼器12、一減速機14、一傳動機構16、一第二編碼器18與一伺服驅動器20。The control system 100 includes a servo motor 10 , a first encoder 12 , a reducer 14 , a transmission mechanism 16 , a second encoder 18 and a servo driver 20 .

該伺服馬達10具有一輸出軸102,且該伺服馬達10受控制而使輸出軸102轉動。該第一編碼器12設置於該伺服馬達10,且與該輸出軸102同動,該第一編碼器12用以對應該輸出軸102的轉動而輸出一第一脈波訊號。該輸出軸102轉動一圈時,該第一編碼器12輸出的第一脈波訊號具有一預定脈波(於後定義為一第一預定脈波數K1說明)。The servo motor 10 has an output shaft 102 , and the servo motor 10 is controlled to rotate the output shaft 102 . The first encoder 12 is disposed on the servo motor 10 and moves simultaneously with the output shaft 102 . The first encoder 12 is used for outputting a first pulse signal corresponding to the rotation of the output shaft 102 . When the output shaft 102 rotates once, the first pulse signal output by the first encoder 12 has a predetermined pulse wave (defined as a first predetermined pulse wave number K1 hereinafter).

該減速機14具有一輸入端142與一輸出端144,該輸入端142耦接該輸出軸102,該減速機14具有一減速比,減速比為M:1,亦即該伺服馬達10的輸出軸102帶動該輸入端142轉動M圈,則輸出端144轉動一圈。於本實施例中,M以10為例,但不以此為限。該減速機14包括多數不同齒輪比的齒輪,以進行減速,例如可為行星齒輪減速機或蝸輪減速機,但不以此為限。The reducer 14 has an input end 142 and an output end 144 , the input end 142 is coupled to the output shaft 102 , the reducer 14 has a reduction ratio, and the reduction ratio is M:1, that is, the output of the servo motor 10 The shaft 102 drives the input end 142 to rotate M circles, and the output end 144 rotates one circle. In this embodiment, M is 10 as an example, but not limited thereto. The speed reducer 14 includes most gears with different gear ratios for speed reduction, such as, but not limited to, a planetary gear reducer or a worm gear reducer.

該傳動機構16耦接於該輸出端144與該圓盤式刀庫1的轉盤1a之間。於本實施例中,該傳動機構16包括相嚙合的一第一齒件162與一第二齒件164,該第一齒件162耦接該減速機14的輸出端144,該第二齒件164耦接該轉盤1a,並且第二齒件164與該轉盤1a同動。該第一齒件162受該減速機的輸出端144帶動而轉動時,該第一齒件162能夠帶動該第二齒件164轉動,進而帶動該轉盤1a轉動,該第二齒件164轉動一圈等同該圓盤式刀庫1的轉盤1a轉動一圈。本實施例中,第一齒件162以蝸桿為例,該第二齒件164以蝸輪為例,該蝸桿的一端耦接該減速機14的輸出端144,該蝸桿的桿身與該蝸輪的外周緣嚙合,該蝸輪的一輪體耦接該轉盤1a。在正常狀態下(即第一齒件162緊靠並帶動第二齒件164轉動),該第一齒件162轉動一圈,則帶動該第二齒件164轉動1/N圈,其中N為刀庫的數量。本實施例中,N以10為例,但不以此為限。該第一齒件162轉動一圈、或該第二齒件164轉動1/N圈,皆對應該圓盤式刀庫1轉動1/N圈(即切換一個刀位)。切換刀位即可使特定的一個刀套1b對應於一換刀位置。The transmission mechanism 16 is coupled between the output end 144 and the turntable 1 a of the disk-type tool magazine 1 . In this embodiment, the transmission mechanism 16 includes a first gear member 162 and a second gear member 164 that are engaged with each other, the first gear member 162 is coupled to the output end 144 of the reducer 14 , and the second gear member 164 is coupled to the turntable 1a, and the second gear 164 moves together with the turntable 1a. When the first gear 162 is rotated by the output end 144 of the reducer, the first gear 162 can drive the second gear 164 to rotate, thereby driving the turntable 1a to rotate, and the second gear 164 rotates a A circle is equivalent to one rotation of the turntable 1a of the disk-type tool magazine 1 . In this embodiment, the first gear 162 is a worm, and the second gear 164 is a worm wheel. One end of the worm is coupled to the output end 144 of the reducer 14, and the shaft of the worm is connected to the worm gear. The outer periphery is engaged, and the wheel body of the worm gear is coupled to the turntable 1a. In a normal state (that is, the first toothed member 162 abuts against and drives the second toothed member 164 to rotate), the first toothed member 162 rotates once, then drives the second toothed member 164 to rotate 1/N turn, where N is The number of tool magazines. In this embodiment, N is 10 as an example, but not limited thereto. One rotation of the first toothed member 162 or 1/N rotation of the second toothed member 164 corresponds to 1/N rotation of the disk-type tool magazine 1 (ie, switching one tool position). Switching the tool positions can make a specific tool pocket 1b correspond to a tool changing position.

該第二編碼器18設置於該傳動機構16,該第二編碼器18用以對應該傳動機構16的轉動而輸出一第二脈波訊號,該第二編碼器18可設置於該第一齒件162與該第二齒件164之其中一者,該第二編碼器18用以對應所設置之該第一齒件162或該第二齒件164的轉動而輸出該第二脈波訊號。本實施例中,該第二編碼器18係設置於第二齒件164,更詳而言,是設置於第二齒件164的轉動中心(即蝸輪的輪體之轉動中心),第二編碼器18用以對應該第二齒件164的轉動。該第二齒件164轉動1/N圈時,該第二編碼器18輸出的第二脈波訊號具有一預定脈波(於後定義為一第二預定脈波數K2)。The second encoder 18 is disposed on the transmission mechanism 16 , the second encoder 18 is used for outputting a second pulse signal corresponding to the rotation of the transmission mechanism 16 , and the second encoder 18 can be disposed on the first tooth One of the gear 162 and the second gear 164, the second encoder 18 is used for outputting the second pulse signal corresponding to the rotation of the first gear 162 or the second gear 164. In this embodiment, the second encoder 18 is arranged on the second gear member 164, more specifically, is arranged at the rotation center of the second gear member 164 (ie, the rotation center of the wheel body of the worm gear). The gear 18 is used to correspond to the rotation of the second toothed member 164 . When the second gear member 164 rotates 1/N turn, the second pulse signal output by the second encoder 18 has a predetermined pulse wave (hereinafter defined as a second predetermined pulse wave number K2).

該伺服驅動器20電性連接該伺服馬達10、該第一編碼器12與該第二編碼器18,該伺服驅動器20控制該伺服馬達10轉動或停止轉動。本實施例中,該伺服驅動器20連接一控制器22,該控制器22可例如為可程式邏輯控制器,該控制器22對該伺服驅動器20發送控制訊號,該伺服驅動器20依據控制訊號控制該伺服馬達10轉動或停止轉動。當該控制器22所輸出的控制訊號為一轉動訊號時,該伺服驅動器20控制該伺服馬達10,使該輸出軸102轉動。本實施例中,該轉動訊號對應該圓盤式刀庫1的轉盤沿一第一預定轉動方向或沿一第二預定轉動方向轉動至少1/N圈,該第一轉動方向與該第二轉動方向相反,亦即使該圓盤式刀庫1至少切換一個刀位,但不以此為限,該轉動訊號亦可對應該圓盤式刀庫1的轉盤轉2/N圈以上,亦即切換二個以上的刀位。The servo driver 20 is electrically connected to the servo motor 10 , the first encoder 12 and the second encoder 18 , and the servo driver 20 controls the servo motor 10 to rotate or stop rotating. In this embodiment, the servo driver 20 is connected to a controller 22, and the controller 22 can be, for example, a programmable logic controller. The controller 22 sends a control signal to the servo driver 20, and the servo driver 20 controls the servo driver 20 according to the control signal. The servo motor 10 rotates or stops rotating. When the control signal output by the controller 22 is a rotation signal, the servo driver 20 controls the servo motor 10 to rotate the output shaft 102 . In this embodiment, the rotation signal corresponds to at least 1/N rotation of the turntable of the disc-type tool magazine 1 along a first predetermined rotation direction or along a second predetermined rotation direction, and the first rotation direction and the second rotation direction The direction is opposite, even if the disc-type tool magazine 1 switches at least one tool position, but not limited to this, the rotation signal can also correspond to the turntable of the disc-type tool magazine 1 turning more than 2/N turns, that is, switching More than two knife positions.

藉由上述之控制系統100,即可進行本實施例之控制方法,該控制方法由該伺服驅動器20所執行,且包含圖5所示之下列步驟:With the above-mentioned control system 100 , the control method of this embodiment can be implemented. The control method is executed by the servo driver 20 and includes the following steps shown in FIG. 5 :

該伺服驅動器20接收該轉動訊號。該轉動訊號係以對應該圓盤式刀庫1的轉盤1a轉1/N圈為例,以切換一個刀位。The servo driver 20 receives the rotation signal. The rotation signal is taken as an example corresponding to the 1/N turn of the turntable 1a of the disk-type tool magazine 1 to switch a tool position.

該伺服驅動器20依據該轉動訊號控制該伺服馬達10,使該輸出軸102轉動,及接收該第一編碼器12的第一脈波訊號與該第二編碼器18的第二脈波訊號。The servo driver 20 controls the servo motor 10 according to the rotation signal to rotate the output shaft 102 , and receives the first pulse signal of the first encoder 12 and the second pulse signal of the second encoder 18 .

該伺服驅動器20持續計數該第一脈波訊號的脈波數,以及持續計數該第二脈波訊號的脈波數。The servo driver 20 continuously counts the number of pulses of the first pulse signal and continuously counts the number of pulses of the second pulse signal.

該伺服驅動器20於滿足一第一條件時,發出一訊號,其中,該第一條件為:該第一脈波訊號之脈波數達到一上限脈波數,並且該第二脈波訊號之脈波數小於第二預定脈波數K2。該上限脈波數及該第二預定脈波數可預先儲存於該伺服驅動器20的記憶單元中,以供判斷。本實施例中,該上限脈波數為K1×M+E,其中E為一誤差脈波數。本實施例中,E=K1×0.1,換言之,以第一預定脈波數的10%作為容許的誤差脈波數。於其它實施例中亦可以第一預定脈波數的5~15%作為容許的誤差脈波數,亦即E介於K1×0.05至K1×0.15之間。The servo driver 20 sends a signal when a first condition is satisfied, wherein the first condition is: the pulse number of the first pulse signal reaches an upper limit pulse number, and the pulse number of the second pulse signal The wave number is smaller than the second predetermined pulse wave number K2. The upper limit pulse number and the second predetermined pulse number can be pre-stored in the memory unit of the servo driver 20 for judgment. In this embodiment, the upper limit pulse wave number is K1×M+E, where E is an error pulse wave number. In this embodiment, E=K1×0.1, in other words, 10% of the first predetermined pulse number is taken as the allowable error pulse number. In other embodiments, 5-15% of the first predetermined pulse number can also be used as the allowable error pulse number, that is, E is between K1×0.05 to K1×0.15.

換言之,在正常狀態下,欲切換一個刀位時,該伺服馬達10的輸出軸102應轉動M圈,透過該減速機14帶動該第一齒件162轉動一圈,並帶動第二齒件164轉動1/N圈。上述第一條件的意義代表:當輸出軸102轉動了M圈再加上0.1圈的誤差時,而第二齒件164尚未轉動至1/N圈,意即輸出軸102與第二齒件164之間的傳動誤差已經超過容許的誤差範圍,此時,該伺服驅動器20則發出該訊號。本實施例中,該訊號可包括一警示訊號及/或停止訊號。該伺服驅動器20可將警示訊號傳送至該控制器22,以向該控制器22警示。於其它實施例中,該伺服驅動器20亦可直接或透過該控制器22將該警示訊號發送至一警示單元,警示單元可例如為顯示器、警示燈、發聲元件等。In other words, in a normal state, when a tool position is to be switched, the output shaft 102 of the servo motor 10 should rotate M circles, the first gear 162 is driven to rotate one circle through the reducer 14, and the second gear 164 is driven 1/N turn. The meaning of the above first condition means: when the output shaft 102 has rotated M turns plus an error of 0.1 turns, and the second gear 164 has not rotated to 1/N turn, that is, the output shaft 102 and the second gear 164 The transmission error between them has exceeded the allowable error range, and at this time, the servo driver 20 sends the signal. In this embodiment, the signal may include a warning signal and/or a stop signal. The servo driver 20 can transmit a warning signal to the controller 22 to warn the controller 22 . In other embodiments, the servo driver 20 can also send the warning signal to an warning unit directly or through the controller 22, and the warning unit can be, for example, a display, a warning light, a sounding element, and the like.

該伺服驅動器20可將停止訊號傳送至該伺服馬達10,以控制該伺服馬達10停止轉動,供維修人員進行後續的校正。The servo driver 20 can transmit a stop signal to the servo motor 10 to control the servo motor 10 to stop rotating for maintenance personnel to perform subsequent calibration.

在尚未滿足該第一條件之前,該伺服驅動器20於收到之該第一編碼器12輸出的第一脈波訊號之脈波數大於K1×M且小於K1×M+E時,該伺服驅動器20控制該伺服馬達10,使該輸出軸102繼續轉動。亦即,當輸出軸102轉動了M圈以上,但尚未達到M圈再加上0.1圈的誤差時,該伺服驅動器20在傳動誤差在容許的誤差範圍內仍允許該伺服馬達10繼續轉動。直到該第二編碼器18輸出的第二脈波訊號之脈波數等於K2時,代表第二齒件164已轉動至1/N圈,意即已經切換一個刀位,則該伺服驅動器20控制該伺服馬達10,使該輸出軸102停止轉動。Before the first condition is met, when the pulse number of the first pulse signal output by the first encoder 12 received by the servo driver 20 is greater than K1×M and less than K1×M+E, the servo driver 20 controls the servo motor 10 so that the output shaft 102 continues to rotate. That is, when the output shaft 102 has rotated more than M turns, but has not reached the error of M turns plus 0.1 turns, the servo driver 20 still allows the servo motor 10 to continue to rotate if the transmission error is within the allowable error range. Until the pulse number of the second pulse signal output by the second encoder 18 is equal to K2, it means that the second gear 164 has rotated to 1/N turn, which means that a tool position has been switched, then the servo driver 20 controls The servo motor 10 stops the rotation of the output shaft 102 .

藉由上述實施例,該伺服驅動器20可在容許的誤差範圍內,繼續使圓盤式刀庫1切換刀位,而在傳動誤差超過容許的誤差範圍時,則發出訊號,以供後續的處理。With the above embodiment, the servo driver 20 can continue to switch the tool position of the disc tool magazine 1 within the allowable error range, and when the transmission error exceeds the allowable error range, a signal is sent for subsequent processing. .

圖6所示者為本發明第二較佳實施例之圓盤式刀庫的控制系統200,其具有大致相同於第一實施例之結構,不同的是,本實施例中,第二編碼器24是設置於第一齒件162上,亦即設置在蝸輪的另一端,且該另一端與相對於減速機之輸出端相對。該第二編碼器24用以對應該第一齒件162的轉動而輸出一第二脈波訊號,該第一齒件162轉動一圈時,該第二編碼器24輸出的第二脈波訊號具有一第二預定脈波數K2。FIG. 6 shows a control system 200 of a disc-type tool magazine according to a second preferred embodiment of the present invention, which has substantially the same structure as that of the first embodiment. The difference is that in this embodiment, the second encoder 24 is disposed on the first gear 162, that is, disposed on the other end of the worm gear, and the other end is opposite to the output end of the reducer. The second encoder 24 is used for outputting a second pulse signal corresponding to the rotation of the first gear member 162 . When the first gear member 162 rotates one revolution, the second pulse signal output by the second encoder 24 There is a second predetermined pulse wave number K2.

本實施例的控制方法與第一實施例大致相同,同樣地,當該伺服驅動器20於滿足該第一條件時,發出一訊號。該第一條件為:該第一脈波訊號之脈波數達到一上限脈波數,並且該第二脈波訊號之脈波數小於第二預定脈波數K2。上述第一條件的意義代表:當輸出軸102轉動了M圈再加上0.1圈的誤差時,而第一齒件162尚未轉動至一圈,意即輸出軸102與第一齒件162之間的傳動誤差已經超過容許的誤差範圍,此時,該伺服驅動器20則發出該訊號。The control method of this embodiment is substantially the same as that of the first embodiment. Similarly, when the servo driver 20 satisfies the first condition, it sends out a signal. The first condition is: the pulse number of the first pulse signal reaches an upper limit pulse number, and the pulse number of the second pulse signal is less than the second predetermined pulse number K2. The meaning of the above-mentioned first condition means: when the output shaft 102 has rotated M turns plus an error of 0.1 turns, and the first toothed member 162 has not rotated to one turn, that is, between the output shaft 102 and the first toothed member 162 The transmission error has exceeded the allowable error range, and at this time, the servo driver 20 sends out the signal.

圖7所示者為本發明第三較佳實施例之圓盤式刀庫的控制系統300,其係以第一實施例之結構為基礎,更包括一第三編碼器26,該第三編碼器26電性連接該伺服驅動器20。FIG. 7 shows a control system 300 of a disk-type tool magazine according to a third preferred embodiment of the present invention, which is based on the structure of the first embodiment, and further includes a third encoder 26. The third encoder The drive 26 is electrically connected to the servo driver 20 .

該第二編碼器18設置於該第一齒件162與該第二齒件164之其中一者,該第三編碼器26設置於該第一齒件162與該第二齒件164之其中另一者。本實施例中,該第三編碼器26與第二實施例之第二編碼器24的設置位置及作用相同。該第三編碼器26用以對應該第一齒件162的轉動而輸出一第三脈波訊號。第一齒件162轉動一圈,第三編碼器26輸出的第三脈波訊號具有一預定脈波數(於後定義為一第三預定脈波數K3)。The second encoder 18 is disposed on one of the first gear 162 and the second gear 164 , and the third encoder 26 is disposed on the other of the first gear 162 and the second gear 164 one. In this embodiment, the third encoder 26 has the same setting position and function as the second encoder 24 of the second embodiment. The third encoder 26 is used for outputting a third pulse signal corresponding to the rotation of the first gear 162 . When the first gear 162 rotates once, the third pulse signal output by the third encoder 26 has a predetermined pulse number (hereinafter defined as a third predetermined pulse number K3).

本實施例的控制方法係以第一實施例基礎,更包括:The control method of this embodiment is based on the first embodiment, and further includes:

該伺服驅動器20接收該第三脈波訊號,以及計數該第三脈波訊號的脈波數。The servo driver 20 receives the third pulse signal and counts the number of pulses of the third pulse signal.

該伺服驅動器20於滿足一第二條件時,發出另一訊號,其中,該第二條件為:The servo driver 20 sends out another signal when a second condition is satisfied, wherein the second condition is:

第一脈波訊號之脈波數大於K1×M+E,並且收到之該第三編碼器輸出的第二脈波訊號之脈波數小於K3。The pulse number of the first pulse signal is greater than K1×M+E, and the received pulse number of the second pulse signal output by the third encoder is less than K3.

該第二條件的意義代表:當輸出軸102轉動了M圈再加上0.1圈的誤差時,而第一齒件162尚未轉動至一圈,意即輸出軸102與第一齒件之間的傳動誤差已經超過容許的誤差範圍,此時,該伺服驅動器20則發出該另一訊號。The meaning of the second condition means: when the output shaft 102 has rotated M turns plus an error of 0.1 turns, and the first toothed member 162 has not rotated one turn, that is, the gap between the output shaft 102 and the first toothed member is The transmission error has exceeded the allowable error range, and at this time, the servo driver 20 sends out the other signal.

該另一訊號可包括一警示訊號及/或一停止訊號。The other signal may include a warning signal and/or a stop signal.

警示訊號傳送至該控制器22,以向控制器警示。於其它實施例中,該伺服驅動器20亦可直接或透過該控制器22將該警示訊號發送至警示單元。該停止訊號傳送至該伺服馬達10,以控制該伺服馬達10停止轉動,供維修人員進行後續的校正。The warning signal is sent to the controller 22 to warn the controller. In other embodiments, the servo driver 20 can also send the warning signal to the warning unit directly or through the controller 22 . The stop signal is transmitted to the servo motor 10 to control the servo motor 10 to stop rotating for maintenance personnel to perform subsequent calibration.

藉由本實施例之控制系統300及控制方法,該伺服驅動器20可在輸出軸102與第二齒件164之間的傳動誤差已經超過容許的誤差範圍(第一條件)發出該訊號,或者輸出軸102與第一齒件162之間的傳動誤差已經超過容許的誤差範圍(第二條件)發出該另一訊號。With the control system 300 and the control method of this embodiment, the servo driver 20 can send the signal when the transmission error between the output shaft 102 and the second gear 164 has exceeded the allowable error range (first condition), or the output shaft The transmission error between 102 and the first gear 162 has exceeded the allowable error range (second condition) to issue the other signal.

圖8所示為本發明第四較佳實施例之圓盤式刀庫的控制系統400,其具有大致相同於第一實施例之結構,不同的是,本實施例的傳動機構28的第一齒件282為一小齒輪,第二齒件284為一大齒輪。同樣的,第一齒件282轉動一圈,帶動第二齒件284轉動1/N圈。本實施例的控制方法與第一實施例相同,容不贅述。另外,本實施例的傳動機構28亦可應用於第二、第三實施例中。FIG. 8 shows a control system 400 of a disk-type tool magazine according to a fourth preferred embodiment of the present invention, which has substantially the same structure as that of the first embodiment. The difference is that the first The toothed member 282 is a small gear, and the second toothed member 284 is a large gear. Similarly, when the first toothed member 282 rotates one turn, the second toothed member 284 is driven to rotate 1/N turn. The control method of this embodiment is the same as that of the first embodiment, and will not be repeated. In addition, the transmission mechanism 28 of this embodiment can also be applied to the second and third embodiments.

以上所述僅為本發明較佳可行實施例而已,舉凡應用本發明說明書及申請專利範圍所為之等效變化,理應包含在本發明之專利範圍內。The above descriptions are only preferred feasible embodiments of the present invention, and any equivalent changes made by applying the description of the present invention and the scope of the patent application should be included in the patent scope of the present invention.

1:圓盤式刀庫 1a:轉盤 1b:刀套 100:控制系統 10:伺服馬達 102:輸出軸 12:第一編碼器 14:減速機 142:輸入端 144:輸出端 16:傳動機構 162:第一齒件 164:第二齒件 18:第二編碼器 20:伺服驅動器 22:控制器 200:控制系統 24:第二編碼器 300:控制系統 26:第三編碼器 400:控制系統 28:傳動機構 282:第一齒件 284:第二齒件 1: Disc type tool magazine 1a: Turntable 1b: Knife Cover 100: Control System 10: Servo motor 102: Output shaft 12: The first encoder 14: Reducer 142: input terminal 144: output terminal 16: Transmission mechanism 162: The first gear 164:Second gear 18: Second encoder 20: Servo drive 22: Controller 200: Control System 24: Second encoder 300: Control System 26: Third encoder 400: Control System 28: Transmission mechanism 282: First gear 284:Second gear

圖1為習用的自動換刀機構之示意圖。 圖2為本發明第一較佳實施例之控制系統的示意圖。 圖3為本發明第一較佳實施例之控制系統與圓盤式刀庫連接的示意圖。 圖4為本發明第一較佳實施例之圓盤式刀庫的示意圖。 圖5為本發明第一較佳實施例之控制系統的控制方法流程圖。 圖6為本發明第二較佳實施例之控制系統的示意圖。 圖7為本發明第三較佳實施例之控制系統的示意圖。 圖8為本發明第四較佳實施例之控制系統與圓盤式刀庫連接的示意圖。 FIG. 1 is a schematic diagram of a conventional automatic tool changing mechanism. FIG. 2 is a schematic diagram of the control system according to the first preferred embodiment of the present invention. 3 is a schematic diagram of the connection between the control system and the disc type tool magazine according to the first preferred embodiment of the present invention. FIG. 4 is a schematic diagram of the disk-type tool magazine according to the first preferred embodiment of the present invention. FIG. 5 is a flowchart of a control method of the control system according to the first preferred embodiment of the present invention. FIG. 6 is a schematic diagram of a control system according to a second preferred embodiment of the present invention. FIG. 7 is a schematic diagram of a control system according to a third preferred embodiment of the present invention. FIG. 8 is a schematic diagram of the connection between the control system and the disk-type tool magazine according to the fourth preferred embodiment of the present invention.

100:控制系統 100: Control System

10:伺服馬達 10: Servo motor

102:輸出軸 102: Output shaft

12:第一編碼器 12: The first encoder

14:減速機 14: Reducer

142:輸入端 142: input terminal

144:輸出端 144: output terminal

16:傳動機構 16: Transmission mechanism

162:第一齒件 162: The first gear

164:第二齒件 164:Second gear

18:第二編碼器 18: Second encoder

20:伺服驅動器 20: Servo drive

22:控制器 22: Controller

Claims (26)

一種圓盤式刀庫的控制系統,該圓盤式刀庫包括一轉盤與複數個刀套,該些刀套設置於該轉盤上;該控制系統包含: 一伺服馬達,具有一輸出軸; 一第一編碼器,設置於該伺服馬達;該第一編碼器用以對應該輸出軸的轉動而輸出一第一脈波訊號; 一減速機,具有一輸入端與一輸出端,該輸入端耦接該輸出軸; 一傳動機構,包括相嚙合的一第一齒件與一第二齒件,該第一齒件耦接該輸出端,該第二齒件耦接該轉盤;且該第一齒件受該輸出端帶動而轉動時,該第一齒件能夠帶動該第二齒件轉動,進而帶動該轉盤轉動; 一第二編碼器,設置於該第一齒件與該第二齒件之其中一者,該第二編碼器用以對應所設置之該第一齒件或該第二齒件的轉動而輸出一第二脈波訊號; 一伺服驅動器,電性連接該伺服馬達、該第一編碼器與該第二編碼器,該伺服驅動器控制該伺服馬達轉動或停止轉動; 其中,該些刀套的數量為N;該輸出軸轉動一圈時,該第一編碼器輸出的第一脈波訊號具有一第一預定脈波數,該第一預定脈波數為K1;該第二編碼器所設置的該第一齒件轉動一圈或該第二編碼器所設置的該第二齒件轉動1/N圈時,該第二編碼器輸出的第二脈波訊號具有一第二預定脈波數,該第二預定脈波數為K2;該減速機的減速比為M:1; 該伺服驅動器於滿足一第一條件時,發出一訊號,其中,該第一條件為: 於收到之該第一編碼器輸出的第一脈波訊號之脈波數達到K1×M+E,並且收到之該第二編碼器輸出的第二脈波訊號之脈波數小於K2;其中,E為一誤差脈波數。 A control system of a disc type tool magazine, the disc type tool magazine comprises a turntable and a plurality of tool pockets, the tool pockets are arranged on the turntable; the control system comprises: a servo motor with an output shaft; a first encoder disposed on the servo motor; the first encoder is used for outputting a first pulse signal corresponding to the rotation of the output shaft; a reducer, which has an input end and an output end, the input end is coupled to the output shaft; a transmission mechanism, comprising a first gear member and a second gear member that mesh with each other, the first gear member is coupled to the output end, the second gear member is coupled to the turntable; and the first gear member is subjected to the output When the end is driven to rotate, the first gear can drive the second gear to rotate, thereby driving the turntable to rotate; A second encoder is disposed on one of the first gear member and the second gear member, and the second encoder is used to output a corresponding rotation of the first gear member or the second gear member. the second pulse signal; a servo driver, electrically connected to the servo motor, the first encoder and the second encoder, the servo driver controls the servo motor to rotate or stop rotating; Wherein, the number of the tool pockets is N; when the output shaft rotates one revolution, the first pulse signal output by the first encoder has a first predetermined pulse number, and the first predetermined pulse number is K1; The second pulse signal output by the second encoder has a second predetermined number of pulse waves, the second predetermined number of pulse waves is K2; the reduction ratio of the reducer is M:1; The servo driver sends out a signal when a first condition is met, wherein the first condition is: When the received pulse number of the first pulse signal output by the first encoder reaches K1×M+E, and the received pulse number of the second pulse signal output by the second encoder is less than K2; Among them, E is an error pulse number. 如請求項1所述之圓盤式刀庫的控制系統,其中該訊號傳送至該伺服馬達,以控制該伺服馬達停止轉動。The control system of the disc type tool magazine according to claim 1, wherein the signal is transmitted to the servo motor to control the servo motor to stop rotating. 如請求項1所述之圓盤式刀庫的控制系統,其中該第一齒件為一蝸桿,該第二齒件為一蝸輪;該蝸桿的一端耦接該減速機的輸出端,該蝸輪耦接該轉盤;該第二編碼器設置於該蝸桿的另一端或該蝸輪的轉動中心。The control system for a disc type tool magazine according to claim 1, wherein the first gear is a worm, the second gear is a worm gear; one end of the worm is coupled to the output end of the reducer, and the worm gear is coupled to the turntable; the second encoder is arranged at the other end of the worm or the rotation center of the worm wheel. 如請求項1所述之圓盤式刀庫的控制系統,包含一第三編碼器,設置於該第一齒件與該第二齒件之其中另一者且電性連接該伺服驅動器,該第三編碼器用以對應所設置之該第一齒件或該第二齒件的轉動而輸出一第三脈波訊號;該第三編碼器所設置的該第一齒件轉動一圈或該第三編碼器所設置的該第二齒件轉動1/N圈時,該第三編碼器輸出的第三脈波訊號具有一第三預定脈波數,該第二預定脈波數為K3; 該伺服驅動器於滿足一第二條件時,發出另一訊號,其中,該第二條件為: 於收到之該第一編碼器輸出的第一脈波訊號之脈波數大於K1×M+E,並且收到之該第三編碼器輸出的第二脈波訊號之脈波數小於K3。 The control system of the disc-type tool magazine as claimed in claim 1, comprising a third encoder disposed on the other of the first gear member and the second gear member and electrically connected to the servo driver, the The third encoder is used to output a third pulse signal corresponding to the rotation of the set first gear or the second gear; the first gear set by the third encoder rotates once or the first gear When the second gear set by the three encoders rotates 1/N turn, the third pulse signal output by the third encoder has a third predetermined pulse number, and the second predetermined pulse number is K3; The servo driver sends out another signal when a second condition is satisfied, wherein the second condition is: The received pulse number of the first pulse signal output by the first encoder is greater than K1×M+E, and the received pulse number of the second pulse signal output by the third encoder is less than K3. 如請求項4所述之圓盤式刀庫的控制系統,其中該另一訊號傳送至該伺服馬達,以控制該伺服馬達停止轉動。The control system of the disc type tool magazine according to claim 4, wherein the other signal is transmitted to the servo motor to control the servo motor to stop rotating. 如請求項4所述之圓盤式刀庫的控制系統,其中該第二編碼器設置於該第二齒件,該第三編碼器設置於該第一齒件。The control system of the disk-type tool magazine according to claim 4, wherein the second encoder is arranged on the second gear member, and the third encoder is arranged on the first gear member. 如請求項5所述之圓盤式刀庫的控制系統,其中該第一齒件為一蝸桿,該第二齒件為一蝸輪;該蝸桿的一端耦接該減速機的輸出端,該蝸桿的桿身與該蝸輪的外周緣嚙合;該蝸輪的一輪體耦接該轉盤;該第二編碼器設置於該蝸輪的輪體之轉動中心;該第三編碼器設置於該蝸桿的另一端。The control system of the disc type tool magazine according to claim 5, wherein the first gear is a worm, the second gear is a worm gear; one end of the worm is coupled to the output end of the reducer, and the worm is The shaft of the worm gear is engaged with the outer periphery of the worm wheel; the wheel body of the worm wheel is coupled to the turntable; the second encoder is arranged at the rotation center of the wheel body of the worm wheel; the third encoder is arranged at the other end of the worm. 如請求項1所述之圓盤式刀庫的控制系統,其中該第二編碼器設置於該第二齒件;該伺服驅動器於收到之該第一編碼器輸出的第一脈波訊號之脈波數小於K1×M+E時,該伺服驅動器控制該伺服馬達,使該輸出軸繼續轉動。The control system of the disk-type tool magazine according to claim 1, wherein the second encoder is arranged on the second gear; the servo driver receives the first pulse signal output from the first encoder When the number of pulses is less than K1×M+E, the servo driver controls the servo motor to make the output shaft continue to rotate. 如請求項8所述之圓盤式刀庫的控制系統,其中該伺服驅動器於收到之該第一編碼器輸出的第一脈波訊號之脈波數小於K1×M+E時,且該第二編碼器輸出的第二脈波訊號之脈波數等於K2時,該伺服驅動器控制該伺服馬達,使該輸出軸停止轉動。The control system for a disc type tool magazine according to claim 8, wherein when the pulse number of the first pulse signal output by the first encoder received by the servo driver is less than K1×M+E, and the When the pulse number of the second pulse signal output by the second encoder is equal to K2, the servo driver controls the servo motor to stop the rotation of the output shaft. 如請求項1所述之圓盤式刀庫的控制系統,其中該誤差脈波數滿足下列條件:E介於K1×0.05至K×0.15之間。The control system for a disc type tool magazine according to claim 1, wherein the error pulse wave number satisfies the following conditions: E is between K1×0.05 to K×0.15. 一種圓盤式刀庫的控制系統,該圓盤式刀庫包括一轉盤與複數個刀套,該些刀套設置於該轉盤上;該控制系統包含: 一伺服馬達,具有一輸出軸; 一第一編碼器,設置於該伺服馬達;該第一編碼器用以對應該輸出軸的轉動而輸出一第一脈波訊號; 一減速機,具有一輸入端與一輸出端,該輸入端耦接該輸出軸; 一傳動機構,耦接於該輸出端與該轉盤之間; 一第二編碼器,設置於該傳動機構,該第二編碼器用以對應該傳動機構的轉動而輸出一第二脈波訊號; 一伺服驅動器,電性連接該伺服馬達、該第一編碼器與該第二編碼器,該伺服驅動器接收一轉動訊號,並依據該轉動訊號控制該伺服馬達,使該輸出軸轉動並透過該減速機及該傳動機構帶動該轉盤轉動;該伺服驅動器接收該第一脈波訊號及該第二脈波訊號,並於該第一脈波訊號的脈波數達到一上限脈波數且該第二脈波訊號的脈波數尚未達到一預定脈波數時,該伺服驅動器發出一訊號。 A control system of a disc type tool magazine, the disc type tool magazine comprises a turntable and a plurality of tool pockets, the tool pockets are arranged on the turntable; the control system comprises: a servo motor with an output shaft; a first encoder disposed on the servo motor; the first encoder is used for outputting a first pulse signal corresponding to the rotation of the output shaft; a reducer, which has an input end and an output end, the input end is coupled to the output shaft; a transmission mechanism, coupled between the output end and the turntable; a second encoder disposed on the transmission mechanism, the second encoder is used for outputting a second pulse signal corresponding to the rotation of the transmission mechanism; A servo driver is electrically connected to the servo motor, the first encoder and the second encoder, the servo driver receives a rotation signal, and controls the servo motor according to the rotation signal, so that the output shaft rotates through the deceleration The machine and the transmission mechanism drive the turntable to rotate; the servo driver receives the first pulse signal and the second pulse signal, and when the pulse number of the first pulse signal reaches an upper limit pulse number and the second pulse wave When the pulse number of the pulse signal has not reached a predetermined pulse number, the servo driver sends a signal. 如請求項11所述之圓盤式刀庫的控制系統,其中該訊號傳送至該伺服馬達,以控制該伺服馬達停止轉動。The control system of the disc type tool magazine as claimed in claim 11, wherein the signal is transmitted to the servo motor to control the servo motor to stop rotating. 如請求項11所述之圓盤式刀庫的控制系統,其中該傳動機構包括相嚙合的一第一齒件與一第二齒件,該第一齒件耦接該輸出端,該第二齒件耦接該轉盤;該第一齒件受該輸出端帶動而轉動時,該第一齒件能夠帶動該第二齒件轉動,進而帶動該轉盤轉動;該第二編碼器設置於該第一齒件與該第二齒件之其中一者。The control system for a disk-type tool magazine as claimed in claim 11, wherein the transmission mechanism comprises a first gear member and a second gear member that mesh with each other, the first gear member is coupled to the output end, and the second gear member The gear is coupled to the turntable; when the first gear is driven by the output end to rotate, the first gear can drive the second gear to rotate, thereby driving the turntable to rotate; the second encoder is arranged on the first gear one of a tooth and the second tooth. 如請求項13所述之圓盤式刀庫的控制系統,其中該第一齒件為一蝸桿,該第二齒件為一蝸輪;該蝸桿的一端耦接該減速機的輸出端,該蝸輪耦接該轉盤;該第二編碼器設置於該蝸桿的另一端或該蝸輪的轉動中心。The control system for a disc type tool magazine as claimed in claim 13, wherein the first gear is a worm, the second gear is a worm gear; one end of the worm is coupled to the output end of the reducer, and the worm gear is coupled to the turntable; the second encoder is arranged at the other end of the worm or the rotation center of the worm wheel. 如請求項13所述之圓盤式刀庫的控制系統,包含一第三編碼器,設置於該第一齒件且電性連接該伺服驅動器,該第三編碼器用以對應該第一齒件的轉動而輸出一第三脈波訊號;該第二編碼器設置於該第二齒件;該伺服驅動器接收該三脈波訊號,並於該第一脈波訊號的脈波數達到該上限脈波數且於該第二脈波訊號的脈波數尚未達到另一預定脈波數時,該伺服驅動器發出另一訊號。The control system of the disk-type tool magazine according to claim 13, comprising a third encoder disposed on the first gear and electrically connected to the servo driver, the third encoder corresponding to the first gear rotates to output a third pulse signal; the second encoder is arranged on the second gear; the servo driver receives the three pulse signals, and when the number of pulses of the first pulse signal reaches the upper limit pulse and when the pulse number of the second pulse signal has not reached another predetermined pulse number, the servo driver sends out another signal. 如請求項15所述之圓盤式刀庫的控制系統,其中該另一訊號傳送至該伺服馬達,以控制該伺服馬達停止轉動。The control system of the disc type tool magazine as claimed in claim 15, wherein the other signal is transmitted to the servo motor to control the servo motor to stop rotating. 如請求項15所述之圓盤式刀庫的控制系統,其中該第一齒件為一蝸桿,該第二齒件為一蝸輪;該蝸桿的一端耦接該減速機的輸出端,該蝸桿的桿身與該蝸輪的外周緣嚙合;該蝸輪的一輪體耦接該轉盤;該第二編碼器設置於該蝸輪的輪體之轉動中心;該第三編碼器設置於該蝸桿的另一端。The control system for a disc type tool magazine according to claim 15, wherein the first gear is a worm, the second gear is a worm wheel; one end of the worm is coupled to the output end of the reducer, and the worm is The shaft of the worm gear is engaged with the outer periphery of the worm wheel; the wheel body of the worm wheel is coupled to the turntable; the second encoder is arranged at the rotation center of the wheel body of the worm wheel; the third encoder is arranged at the other end of the worm. 如請求項13所述之圓盤式刀庫的控制系統,其中該第二編碼器設置於該第二齒件;該伺服驅動器於收到第一脈波訊號之脈波數小於該上限脈波數且該第二脈波訊號之脈波數尚未達到該預定脈波數時,該伺服驅動器控制該伺服馬達,使該輸出軸繼續轉動。The control system for a disk-type tool magazine as claimed in claim 13, wherein the second encoder is disposed on the second gear; the number of pulses received by the servo driver of the first pulse signal is less than the upper limit pulse When the number of pulses of the second pulse signal has not reached the predetermined number of pulses, the servo driver controls the servo motor so that the output shaft continues to rotate. 如請求項18所述之圓盤式刀庫的控制系統,其中該伺服驅動器於收到第一脈波訊號之脈波數小於該上限脈波數,且該第二脈波訊號之脈波數達到該預定脈波數時,該伺服驅動器控制該伺服馬達,使該輸出軸停止轉動。The control system for a disc tool magazine as claimed in claim 18, wherein the pulse number of the first pulse signal received by the servo driver is less than the upper limit pulse number, and the pulse number of the second pulse signal is When the predetermined pulse number is reached, the servo driver controls the servo motor to stop the rotation of the output shaft. 一種圓盤式刀庫的控制系統之控制方法,該圓盤式刀庫包括一轉盤與複數個刀套,該些刀套設置於該轉盤上;該控制系統包含一伺服馬達,具有一輸出軸;一第一編碼器,用以對應該輸出軸的轉動而輸出一第一脈波訊號;一減速機,具有一輸入端與一輸出端,該輸入端耦接該輸出軸;一傳動機構,包括相嚙合的一第一齒件與一第二齒件,該第一齒件耦接該輸出端,該第二齒件耦接該轉盤;且該第一齒件受該輸出端帶動而轉動時,該第一齒件能夠帶動該第二齒件轉動,進而帶動該轉盤轉動;一第二編碼器,用以對應該第一齒件與該第二齒件之其中一者的轉動而輸出一第二脈波訊號;一伺服驅動器,電性連接該伺服馬達、該第一編碼器與該第二編碼器;其中,該些刀套的數量為N,該輸出軸轉動一圈時,該第一編碼器輸出的第一脈波訊號具有一第一預定脈波數,該第一預定脈波數為K1;該第二編碼器所對應的該第一齒件轉動一圈或該第二編碼器所對應的該第二齒件轉動1/N圈時,該第二編碼器輸出的第二脈波訊號具有一第二預定脈波數,該第二預定脈波數為K2;該減速機的減速比為M:1;該控制方法係由該伺服驅動器所執行,包含下列步驟: A. 接收一轉動訊號; B. 控制該伺服馬達,使該輸出軸轉動,及接收該第一脈波訊號與該第二脈波訊號; C. 計數該第一脈波訊號的脈波數,及計數該第二脈波訊號的脈波數; D. 於滿足一第一條件時,發出一訊號,其中,該第一條件為: 該第一脈波訊號之脈波數達到K1×M+E,並且該第二脈波訊號之脈波數小於K2;其中,E為一誤差脈波數。 A control method for a control system of a disc type tool magazine, the disc type tool magazine comprises a turntable and a plurality of tool pockets, the tool pockets are arranged on the turntable; the control system includes a servo motor with an output shaft ; a first encoder for outputting a first pulse signal corresponding to the rotation of the output shaft; a reducer, having an input end and an output end, the input end is coupled to the output shaft; a transmission mechanism, It includes a first gear and a second gear that are engaged with each other, the first gear is coupled to the output end, and the second gear is coupled to the turntable; and the first gear is driven by the output end to rotate , the first gear can drive the second gear to rotate, thereby driving the turntable to rotate; a second encoder is used to output the output corresponding to the rotation of one of the first gear and the second gear a second pulse signal; a servo driver electrically connected to the servo motor, the first encoder and the second encoder; wherein, the number of the tool sleeves is N, when the output shaft rotates once, the The first pulse signal output by the first encoder has a first predetermined pulse number, and the first predetermined pulse number is K1; the first gear corresponding to the second encoder rotates once or the second When the second gear corresponding to the encoder rotates 1/N turn, the second pulse signal output by the second encoder has a second predetermined pulse number, and the second predetermined pulse number is K2; the deceleration The reduction ratio of the machine is M:1; the control method is executed by the servo driver and includes the following steps: A. Receive a rotation signal; B. Control the servo motor to rotate the output shaft and receive the first pulse signal and the second pulse signal; C. Count the number of pulses of the first pulse signal, and count the number of pulses of the second pulse signal; D. Sending a signal when a first condition is met, wherein the first condition is: The pulse number of the first pulse signal reaches K1×M+E, and the pulse number of the second pulse signal is less than K2; wherein, E is an error pulse number. 如請求項20所述圓盤式刀庫的控制系統之控制方法,其中步驟D中,於滿足該第一條件時,該訊號傳送至該伺服馬達,以控制該伺服馬達停止轉動。The control method of the control system of the disc tool magazine according to claim 20, wherein in step D, when the first condition is satisfied, the signal is transmitted to the servo motor to control the servo motor to stop rotating. 如請求項20所述圓盤式刀庫的控制系統之控制方法,其中該第二編碼器用以對應該第二齒件的轉動而輸出該第二脈波訊號;步驟D中包含於第一脈波訊號之脈波數小於K1×M+E時,控制該伺服馬達,使該輸出軸繼續轉動。The control method of the control system of the disc type tool magazine according to claim 20, wherein the second encoder is used for outputting the second pulse signal corresponding to the rotation of the second gear; step D is included in the first pulse signal When the pulse number of the wave signal is less than K1×M+E, the servo motor is controlled to make the output shaft continue to rotate. 如請求項22所述圓盤式刀庫的控制系統之控制方法,步驟D中包含於第一脈波訊號之脈波數小於K1×M+E時,且該第二編碼器輸出的第二脈波訊號之脈波數等於K2時,控制該伺服馬達,使該輸出軸停止轉動。According to the control method of the control system of the disc type tool magazine according to claim 22, the step D includes when the pulse number of the first pulse signal is less than K1×M+E, and the second encoder output When the pulse number of the pulse signal is equal to K2, the servo motor is controlled to stop the rotation of the output shaft. 如請求項20所述圓盤式刀庫的控制系統之控制方法,其中該控制系統包含一第三編碼器,用以對應該第一齒件與該第二齒件之其中另一者的轉動而輸出一第三脈波訊號,該第三編碼器所對應的該第一齒件轉動一圈或該第三編碼器所對應的該第二齒件轉動1/N圈時,該第三編碼器輸出的第三脈波訊號具有一第三預定脈波數,該第三預定脈波數為K3;該控制方法包含: 步驟B中包含接收該第三脈波訊號; 步驟C中包含計數該第三脈波訊號的脈波數; 步驟C中包含於滿足一第二條件時,發出另一訊號,其中,該第二條件為: 該第一脈波訊號之脈波數達到K1×M+E,並且該第三脈波訊號之脈波數小於K3。 The control method of the control system of the disc type tool magazine as claimed in claim 20, wherein the control system comprises a third encoder for corresponding to the rotation of the other one of the first gear member and the second gear member A third pulse signal is output, when the first gear corresponding to the third encoder rotates one revolution or the second gear corresponding to the third encoder rotates 1/N revolution, the third encoder The third pulse signal output by the device has a third predetermined pulse number, and the third predetermined pulse number is K3; the control method includes: Step B includes receiving the third pulse signal; Step C includes counting the number of pulses of the third pulse signal; Step C includes sending another signal when a second condition is satisfied, wherein the second condition is: The pulse number of the first pulse signal reaches K1×M+E, and the pulse number of the third pulse signal is less than K3. 如請求項24所述圓盤式刀庫的控制系統之控制方法,其中步驟D中,該另一訊號傳送至該伺服馬達,以控制該伺服馬達停止轉動。The control method of the control system of the disc type tool magazine according to claim 24, wherein in step D, the other signal is transmitted to the servo motor to control the servo motor to stop rotating. 如請求項20所述圓盤式刀庫的控制系統之控制方法,其中該誤差脈波數滿足下列條件:E介於K1×0.05至K×0.15之間。The control method for a control system of a disc-type tool magazine according to claim 20, wherein the error pulse wave number satisfies the following conditions: E is between K1×0.05 to K×0.15.
TW109143541A 2020-12-10 2020-12-10 Disc-type tool magazine control system and control method TWI751829B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW109143541A TWI751829B (en) 2020-12-10 2020-12-10 Disc-type tool magazine control system and control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW109143541A TWI751829B (en) 2020-12-10 2020-12-10 Disc-type tool magazine control system and control method

Publications (2)

Publication Number Publication Date
TWI751829B TWI751829B (en) 2022-01-01
TW202222476A true TW202222476A (en) 2022-06-16

Family

ID=80809152

Family Applications (1)

Application Number Title Priority Date Filing Date
TW109143541A TWI751829B (en) 2020-12-10 2020-12-10 Disc-type tool magazine control system and control method

Country Status (1)

Country Link
TW (1) TWI751829B (en)

Family Cites Families (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002059329A (en) * 2000-08-23 2002-02-26 Sankyo Mfg Co Ltd Tool magazine
TWM447813U (en) * 2012-09-19 2013-03-01 Bei Jyu Prec Machine Co Ltd Tool magazine structure of processing machining
TWI589389B (en) * 2015-03-06 2017-07-01 Machine tool intelligent control system and its control method
JP6746429B2 (en) * 2016-08-17 2020-08-26 Dmg森精機株式会社 Tool changer
TWM560362U (en) * 2018-01-16 2018-05-21 Sanjet International Co Ltd Rotary cutter tool magazine assembly station
TWM567157U (en) * 2018-05-29 2018-09-21 聖杰國際股份有限公司 Disc type magazine structure for machine tool
TWI685208B (en) * 2018-12-07 2020-02-11 財團法人工業技術研究院 Position encoding device and method
TWM596679U (en) * 2020-03-31 2020-06-11 新代科技股份有限公司 Tool magazine controlling system
TWM609239U (en) * 2020-12-10 2021-03-11 聖杰國際股份有限公司 Disc-type tool magazine control system

Also Published As

Publication number Publication date
TWI751829B (en) 2022-01-01

Similar Documents

Publication Publication Date Title
US10084362B2 (en) Servomotor and control method thereof
US5242336A (en) Planet gear apparatus
JP2016164768A (en) Machine-tool smart control system and method for controlling the same
JP4871644B2 (en) Backlash removing method and apparatus
JP6808474B2 (en) Absolute encoder for motor with gear
JP7220484B2 (en) CONTROL SYSTEM AND CONTROL METHOD OF DISC TYPE KNIFE MAGAZINE
TWM609239U (en) Disc-type tool magazine control system
TWI751829B (en) Disc-type tool magazine control system and control method
KR102395546B1 (en) Control system for drum-type tool magazine and control method thereof
JP2017009107A (en) Differential device and processing device using the same
EP0250609A1 (en) Shiftable transmission motor drive with assured input-output relationship
CN214444882U (en) Control system of disc type tool magazine
KR200483492Y1 (en) Intelligent control system for machine tool
CN114619279A (en) Control system and control method of disc type tool magazine
JPS61258113A (en) Position encoder
KR20180030311A (en) Planetary gear simulator
JP2011031878A (en) Superimposing type transmission for steering system
JP2018205895A (en) Movement precision monitoring system and rotation table provided with movement precision monitoring function, machine tool and nc apparatus
CN220540260U (en) Transmission assembly, driver, protection device and projector
JPH1047996A (en) Rotary encoder
CN115045967B (en) Face gear-based split-confluence multi-gear speed change device
JP2013255344A (en) Electrically-driven rotary actuator
EP3931466B1 (en) Self-binding non-jamming stop module for rotary drive actuator
CN210372660U (en) Camera angle adjusting mechanism and camera system
CN102582506A (en) Steering device