200412709 玖、發明說明 【發明所屬之技術領域】 本發明係關於一種雙平行線性伺服馬達同步控制系統,尤 指一種應用在多軸精密機器使其達到同步位移目的者。 【先前技術】 目前設計多軸機器的反饋式驅動器其最重要的關鍵在 於軸向行進軌道的精確度,特別是高速機器的應用。而在 行進軌道中所需考慮的誤差有執跡誤差(cont〇ur err〇r) ’ -般為降低軌跡誤差的手段係提高各軸的位置追跡精確 目W已提出許多運算方式以滿足降低軌跡誤差的要求 ’如回饋控制(feed-forward control)及預先控制 (―W —)及無相位誤差的追縱控制(zer… error trackmg c〇ntr〇1)等。然而對於應用在雙平行同步200412709 发明 Description of the invention [Technical field to which the invention belongs] The present invention relates to a dual-parallel linear servo motor synchronous control system, and particularly to a person applied to a multi-axis precision machine to achieve synchronous displacement. [Previous technology] At present, the most important key for designing feedback drives for multi-axis machines is the accuracy of the axial travel track, especially for high-speed machines. The error that needs to be considered in the traveling track is tracking error (contorurer).-Generally, the means to reduce the trajectory error is to improve the position tracking accuracy of each axis. Many calculation methods have been proposed to reduce the trajectory. Error requirements' such as feed-forward control, advance control (-W-), and tracking control without phase error (zer ... error trackmg c〇ntr〇1). However for applications in dual parallel synchronization
馬達的同步控制上,卻因A 為钱構上的不精確性而令兩平朽 冋步馬達無法達到完全同步,是: 服因機構而無法同步的問題。 有政臾 【發明内容】 為此’本發明者的 行馬達行動的狀況,可係提供—種隨時檢測兩斗 J石Ϊ保兩馬達保持於 以應用於精密位移的多輛機器上。 ' 心下’ 欲達上述目的所使 系統的硬體結構包含有 技術手段,係令同步控帝 ,分別控制主/偉設於兩平行軌道上的主/撲馬, 馬達的驅動電路、兩分別設於主/僕 zuuHiz/uy ,上的位置檢測器’及一同時跨設於主 白機構,該耦合機構於兩馬達 、”、達之間的耦 同步位移控制單元分別與主/僕馬達的主要利用— 位置檢洌器連接,以校 電路及對應的 J 土/僕馬達呈同步作 上述同步控制方式係由同步位移吻作動, 達動作,透㈣合機構帶動僕馬達移動,以=控制主馬 達同步動作,由於兩平行軌道:广兩主/僕馬 主/禮民、去士 p %達間的硬體差異,&出 /僕馬達有非同步現象,此時 ^成 钿rf? 士+ I工, ΌΑ同步位移控制單开合 异兩位置檢測器回傳輪出 早疋會 已非同步行進,而☆如判斷兩主/僕馬達 即,採即時於M "工制兩主/僕馬達的移動速度 才木即時祆測回饋控制方式 才 其間的莩差,而、去^ 主/僕兩馬達隨時修正 7决差,而達到同步的目的。 【實施方式】 首先請參閱第一圖所示, 示咅ffl 係為本發明應用的硬體結構 0) (ml 兩平行執道上的主/僕馬達(1 (2 0 )及一同時跨設 _ )(〇 n , 、該千仃的主/僕馬達(1 〇 2 〇 )之間的耦合機構( it r 1 π ^ , 〇 再組成,其中主/僕馬 構(… 0)機構具有位置檢知功能,又該耦合機 構(7 1 )可於兩主/襟 請逸牛& (10)(20)上平移。 间牛氣^ t Q所不係為驅動前揭主/僕馬達 问步動作的控制系統方 第一皆一 4圖’上述主/僕馬達分別包含有 測器,以檢測馬達對庫4軌:第一、第二位置檢 控制系統係包含有: 道的相對位置,而同步動作 200412709 -力量誤差測量單it (30), 馬達的第一、第二位置檢測器(丄2 )( 2 2妾至主/僕 主/僕馬達間位移差對應的耦合機構變形力旦)以计异 —主馬達速度控制單元(5 〇 ),孫里 , 第一驅動電路,以控制主馬達的動作;、控制该主馬達的 一僕馬達速度控制單元(6 〇 ) 第二驅動電路,以控制主馬達的動作;、工制°亥撲馬達的 -位置控制單元(40),係分別 控制單元(50)/(60)輸入端及第/僕=達速度 ")的輸出端連接’以透過主 立置檢測器( 5〇)/(6〇)隨時控制主逮㈣ 上述同步動作控制系統主要即:達二 _ 道上的相對位置以及其位置差所廡仵主/僕馬達在軌 數值,作為回授控制主/僕馬達達二:合機構變形力量 由於位置控制單元(4 Μ /動作的計算數據。 徑命令輸入至兩馬達時二:的路徑’因此、,在新路 ’以計算目前離新位置的㈣ &所在位置進打比較 差測量單元(3 〇 ) 。耦5機構變形力量誤 形力量比較,則可更準錢差相對的輕合機構變 狀態,而達到同步動作的目的。月1J兩主/僕馬控行進的 乂上為本發明平行馬達同步 說明’以下,針對系統各組成進行說7制系統的主要技術 上述力里誤差洌量單元(3 ^ 構變形力量估測器(3工) )’係包含有一耦合機 、一力量指令產生器(32) 200412709 及力量控制器(33),其中:兩位置檢測器(12)( 22)的輸出數值相減以計算兩主/僕馬達(")(2 ◦)卩了位置誤差值’再將此位置誤差值利用力量估測器 (3 1 )估測出崎合機構變形力量數值後,再與力量 各二產生& ( 3 2 )的預設力量數值相減,將差值輸出至 力:控制器㈡3),以求得實際與預測的耗合機構變形 力里相差數值,並輸出至主/僕馬達速度控制單元( )/ ( 6 〇 )。 上述主馬達控制單元(5〇)主要決定主馬達的移動 速度,而包含有-主馬達速度控制器(51)"法器 (52),該主馬達速唐批制盟〆e,、 度控制為(5 1 )與力量控制器( 3 6 )透過減法器(5 ?、 卜 v D 2 )相減,以計算兩者之差進而透 過第-驅動電路(11)控制主馬達(iq)之速度。 上述僕馬達控制單元(6 〇 )主要決定僕馬達(2 〇 )的移=速度’其包含有一僕馬達速度控制器(6丄)及 加:為(! 2 ) ’該僕馬達速度控制器(6 1 )輪出端 與力量控制器(3 3 )的輸出信號透過加法器(6 2 )相 加,以透過第二驅動電路(21)控制撲馬達( 速度。 上述位置控制單元(4 〇 )主要輸出 (1 0 ) / ( 2 0 )的移程路僻人 俣馬達 生器(川及-主馬達位置控制器(42) = 令產生器(41)需與配合主t私 斤上 馬達(1 0 )目前位置以估 算相距距離’是以’路徑指令產生器(4ι)與第 200412709 檢測器(1 2 )輸出數值相減,再輸入至主馬達位置控制 器(4 2 ) ’而主馬達控制器(4 2 )進一步與第一位置 檢測器(1 2 )輸出數值的相對速度(以微分估測)進行 相減’以求得控制主馬達速度控制器(5 1 )的速度值, 又’至於僕馬達控制器(6 1 )的控制速度值係由路徑指 令產生器(4 1 )與第一位置檢測器(1 2 )的差進一步 與第二位置檢測器(2 2 )輸出的相對速度數值(以微分 進打估測)相減而得,是以,僕馬達(2 〇 )速度控制係 Ik主馬達(1 〇 )的目前位置而變動,而令僕馬達(2 〇 )速度及位移修正至與主馬達(丄〇)同步。 上述控制兩平行主/僕馬達(1 〇 ) / ( 2 〇 )達同 步行進的技術,於初始啟動兩主/僕馬達(丄〇 )/( 2 〇 )日寸’先對主馬$ ( 1 ◦)施以速度及位置的命令,再 依據兩第-、第二位置檢測器(12) (22)回送的數 值,配合力量誤差測量單元(3 〇 ) &主/僕馬達控制單 兀(50)/(60)調整主/僕馬達(1〇) )的行進速度,一直修正到主/僕馬達(i 〇 ) / ( 2 〇 )呈同步打進為止,此修正調整同步技術仍繼續進行,由 於前揭各單元皆可以軟體實現,故可令硬體馬達機構配人 一台電腦控制同步行進,如第三圖所示。 口 由上述可知,本發明係主要利用即時檢測位移差配人 回饋控制兩平行馬達的運轉速度,令兩馬達修正至同+二 運轉’由於僅控制主馬達的位置及速度,目此,僕:、 運轉則由前揭結構跟隨主馬達啟動, 6、 υ止至主、僕馬達 200412709 際運轉時,因硬 馬達於實際運轉 ’並且符合新穎 同乂疋以,本發明考慮到兩平行馬達實 體結構或執道產生的誤差,故可確實使兩 時,隨時保持同步運轉的狀態。 為此,本發明確實具有產業上利用性 進步性等要件,爰依法提出申請。 【圖式簡單說明】 (一)圖式部分 弟一圖 第二圖 第三圖 示意圖 係本發明的立體外觀圖。 係本發明控制手段實體化的方塊圖(代表圖)。 係本發明第一圖配合電腦實現第二圖同步控制的 (二)元件代表符號 (1 0)主馬達 (1 2 )第一位置檢測器 (2 1 )第二驅動電路 (3 〇 )力量誤差測量單 (32)力量指令產生器 (4 〇 )位置控制單元 (4 2 )主馬達位置控制器 (5 1 )主馬達速度控制器 (6 0 )僕馬達控制單 (6 2 )加法器 (71)耦合機構 (1 1 )第一驅動電路 (2 0 )僕馬達 (2 2 )第二位置檢測器 (3 1 )力量估測器 (3 3 )力量控制器 (4 1 )路徑指令產生器 (5 0 )主馬達控制單元 (5 2 )減法器 (6 1 )僕馬達速度控制器 (7 0 )電腦In the synchronization control of the motor, because of the inaccuracy of A for the money structure, the two flattened Liaobu motors could not achieve full synchronization, which is due to the problem that the mechanism cannot synchronize. You Zhengyi [Summary of the Invention] To this end, the present inventor's motor operation status can be provided-a kind of machine that can detect two buckets at any time. J Ishiba guarantees that the two motors are held on multiple machines for precise displacement. 'Under the heart' The hardware structure of the system to achieve the above purpose contains technical means to control the emperor synchronously, respectively controlling the main / puppet horse on two parallel tracks, the drive circuit of the motor, two The position detector 'on the main / servo zuuHiz / uy' and a simultaneous crossover on the main white mechanism, the coupling mechanism between the two motors, ", and the synchronous displacement control unit are respectively connected with the main / servo motor's The main use is to connect the position detector to synchronize the calibration circuit and the corresponding J soil / servo motor. The above synchronous control method is actuated by a synchronous displacement kiss. The movement is achieved by a coupling mechanism that drives the servo motor to control the master. The motors move synchronously due to the hardware differences between the two parallel tracks: the two masters / servant horse owners / limin, and the taxis %%, and the & servo motors are asynchronous, and at this time ^ 钿 钿 rf? 士 + I work, ΌΑ synchronous displacement control, single opening and closing, and the two position detectors return to the wheel. As early as possible, they will have traveled asynchronously. ☆ If two masters / servants are judged, they will be adopted at M " Speed of the motor The difference between the two control systems is the difference between the master and the slave motors. The difference between the master and slave motors can be corrected at any time to achieve synchronization. [Embodiment] First, please refer to the first figure. Hardware structure of 0) (ml of the master / slave motor (1 (2 0) and a crossover _) on two parallel tracks) (〇n,) The coupling mechanism (it r 1 π ^, 〇 is recombined, in which the main / servo structure (… 0) mechanism has a position detection function, and the coupling mechanism (7 1) can be (10) (20) panning up. Time is not good ^ t Q is not a control system that drives the master / slave motor stepping motion before the first one is shown in Figure 4 above. The above master / slave motors each contain a measuring device. In order to detect the 4 rails of the motor to the library: the first and second position detection control systems include: the relative position of the track, and synchronous action 200412709-force error measurement sheet it (30), the first and second position detection of the motor (丄 2) (2 2 妾 to the deformation force of the coupling mechanism corresponding to the displacement difference between the master / slave / slave motor) to calculate the difference—the speed of the main motor Sun Li, a control unit (50), a first drive circuit to control the movement of the main motor; a second motor speed control unit (60) to control the main motor to control the movement of the main motor; The position control unit (40) of the industrial ° Hip motor is connected to the input end of the control unit (50) / (60) and the output end of the first / second = reaching speed ") to detect through the main stand The controller (50) / (60) controls the master at any time. The above-mentioned synchronous motion control system mainly includes: the relative position on the track and the value of the master / slave motor on orbit as the feedback control master / Servo motor up to 2: The deformation force of the joint mechanism due to the position control unit (4 M / action calculation data. When the diameter command is input to the two motors, the path is ‘So’, the new path ’is used to calculate the difference from the new position ㈣ & where the difference is measured (30). The comparison of the deformation force and the misformed force of the 5 mechanism can more accurately change the status of the light-on mechanism with a relatively small difference in money, and achieve the purpose of synchronous action. On January 1J, the description of the two master / servant-controlled marching is the parallel motor synchronous description of the present invention. Below, the main technology of the 7-system system is described for each component of the system. The above-mentioned force measurement unit (3 ^ structural deformation force estimator (3 workers)) 'includes a coupling machine, a force command generator (32) 200412709 and a force controller (33), where: the output values of the two position detectors (12) and (22) are subtracted to calculate the two main / Servo motor (") (2 ◦) 卩 The position error value is' Then this position error value is estimated by the force estimator (3 1) and the deformation force value of the Qihe mechanism is generated. (3 2) Subtract the preset force value and output the difference to the force: controller ㈡ 3) to obtain the difference between the actual and predicted deformation mechanism deformation force and output it to the master / servo motor speed control unit. () / (6 〇). The above-mentioned main motor control unit (50) mainly determines the moving speed of the main motor, and includes a main motor speed controller (51) " implement (52). The control is (5 1) and the power controller (3 6) is subtracted by a subtractor (5?, V v D 2) to calculate the difference between them and then control the main motor (iq) through the first driving circuit (11). Speed. The above-mentioned servo motor control unit (60) mainly determines the displacement of the servo motor (20) = speed ', which includes a servo motor speed controller (6 丄) and plus: (! 2)' The servo motor speed controller ( 6 1) The output signal of the wheel output end and the power controller (3 3) are added through an adder (6 2) to control the flutter motor (speed) through the second driving circuit (21). The above-mentioned position control unit (4 〇) The main output (1 0) / (2 0) is a remote motor driver (Sichuan and-the main motor position controller (42) = the generator (41) needs to cooperate with the main t to load the motor ( 1 0) The current position is used to estimate the distance. 'The output value of the path command generator (4ι) and the 200412709 detector (1 2) is subtracted, and then input to the main motor position controller (4 2)' and the main motor The controller (4 2) further subtracts the relative speed (in differential estimation) of the output value of the first position detector (1 2) to obtain the speed value of the main motor speed controller (5 1). 'As for the servo motor controller (6 1), the control speed value is generated by the path command (4 1) The difference from the first position detector (1 2) is further subtracted from the relative speed value (estimated by differential calculation) output from the second position detector (2 2). Therefore, the servo motor (2) The speed control system Ik changes the current position of the main motor (10), so that the speed and displacement of the servo motor (20) are corrected to synchronize with the main motor (200). The above controls two parallel main / servo motors. (10) / (20) technology to achieve synchronous travel, initially start the two master / slave motors (丄 〇) / (20) daily inch 'first speed and position of the main horse $ (1 ◦) Command, and then adjust the master according to the values returned by the second and second position detectors (12) (22), and cooperate with the power error measurement unit (30) & master / servo motor control unit (50) / (60) / Servant motor (1〇)), until the master / slave motor (i 〇) / (2 〇) is synchronized to advance, this correction adjustment synchronization technology continues, because all units can be opened before The software is implemented, so the hardware motor mechanism can be equipped with a computer to control the synchronous travel, as shown in the third picture. It can be known that the present invention mainly uses the real-time detection of the displacement difference and the feedback of the two parallel motors to control the running speed of the two parallel motors, so that the two motors are corrected to the same + two operations. Because only the position and speed of the main motor are controlled, for this reason, the operation of The front opening structure follows the start of the main motor. 6. When the υ stops at the main motor and the servo motor 200412709, the hard motor is in actual operation and it is in line with the novel concept. The present invention takes into account the two parallel motors' physical structure or execution. Error, so it can be sure to keep the state of synchronous operation at any time. For this reason, the present invention does have the requirements of industrial applicability and progressability, etc., and the application is filed in accordance with the law. [Brief description of the drawings] (1) Schematic part 1 figure 2 figure 3 figure The diagram is a three-dimensional appearance view of the present invention. It is a block diagram (representative map) of the control means of the present invention. The second diagram of the present invention cooperates with a computer to realize the second diagram of the synchronous control of the second diagram (two) the component representative symbol (1 0) the main motor (1 2) the first position detector (2 1) the second drive circuit (30) the power error Measurement sheet (32) Force command generator (4 〇) Position control unit (4 2) Main motor position controller (5 1) Main motor speed controller (6 0) Servo motor control sheet (6 2) Adder (71 ) Coupling mechanism (1 1) First drive circuit (2 0) Servo motor (2 2) Second position detector (3 1) Force estimator (3 3) Force controller (4 1) Path command generator ( 5 0) main motor control unit (5 2) subtracter (6 1) servo motor speed controller (7 0) computer