TWI713660B - 線性馬達之控制裝置及控制方法 - Google Patents

Abstract

該線性馬達之控制裝置具備：速度控制部，其利用積分動作算出電流指令值，該積分動作使用相對於線性馬達所具備之可動子之移動速度與基於位置指令值算出之速度指令值之差分的第1積分值；電流控制部，其基於電流指令值將電壓施加至線性馬達；及修正值記憶部，其記憶可動子停留在由位置指令值所示之位置時之速度控制部的第1積分值。速度控制部在再次開始對線性馬達之控制時，在制動器控制部關斷制動器裝置之前，將修正值記憶部所記憶之第1積分值設定為積分動作之初始值。

Description

線性馬達之控制裝置及控制方法

本發明係關於一種線性馬達之控制裝置及控制方法。 本發明係基於2015年12月25日於日本申請之日本發明專利2015-253084號而主張其優先權者，且其內容為本說明書所引用。

在將電子零件等之工件安裝於基板時，使用的是將工件安裝於基板之晶片貼裝機等的工作裝置。在工作裝置中，對於在將工件安裝於基板上時之鉛垂方向之動作係使用被伺服控制之線性馬達。在使可動子朝鉛垂方向動作之線性馬達中，存在有在開始伺服控制時因重力而導致可動子落下而自目標位置偏移之可能性。已有藉由修正流動至馬達之電流而產生抵消重力等之外力的推力，從而防止在伺服控制之開始時等因外力而導致之可動子之位置偏移的技術(專利文獻1)。 [先前技術文獻] [專利文獻] [專利文獻1]日本特開2000-075930號公報

[發明所欲解決之問題] 然而，若修正電流值以產生抵消外力之方向之推力，則會減少使可動子朝外力作用之方向移動時的推力，而存在有線性馬達之回應減慢之可能性。 本發明提供一種可提高回應性的線性馬達之控制裝置及控制方法。 [解決問題之技術手段] 根據本發明之第1態樣，線性馬達之控制裝置具備：速度控制部、電流控制部、及修正值記憶部。前述速度控制部利用積分動作算出電流指令值，該積分動作使用相對於線性馬達所具備之可動子之移動速度與基於位置指令值算出之速度指令值之差分的第1積分值。前述電流控制部基於前述電流指令值將電壓施加至前述線性馬達。前述修正值記憶部記憶前述可動子停留在由前述位置指令值所示之位置時之前述速度控制部的第1積分值。前述速度控制部在再次開始對前述線性馬達之控制時，將前述修正值記憶部所記憶之第1積分值設定為積分動作之初始值。 根據本發明之第2態様，可行的是，前述速度控制部在變更使前述可動子移動之方向時，將前述修正值記憶部所記憶之第1積分值設定為積分動作之初始值。 根據本發明之第3態様，前述線性馬達之控制裝置進一步具備制動器控制部，其控制將前述線性馬達之前述可動子予以制動之制動器裝置。可行的是，前述速度控制部在再次開始對前述線性馬達之控制時，在前述制動器控制部關斷前述制動器裝置之前，將前述修正值記憶部所記憶之第1積分值設定為積分動作之初始值。 根據本發明之第4態様，可行的是，前述電流控制部利用積分動作算出施加至前述線性馬達之電壓值，該積分動作使用相對於前述電流指令值與流動至前述線性馬達之電流值之差分的第2積分值。可行的是，前述修正值記憶部記憶前述可動子停留在由前述位置指令值所示之位置時之前述電流控制部的第2積分值。可行的是，前述電流控制部在再次開始對前述線性馬達之控制時，將前述修正值記憶部所記憶之第2積分值設定為積分動作之初始值。 根據本發明之第5態様，可行的是，前述電流控制部在變更使前述可動子移動之方向時，將前述修正值記憶部所記憶之第2積分值設定為積分動作之初始值。 根據本發明之第6態様，係一種線性馬達之控制裝置之控制方法，該線性馬達之控制裝置具備：速度控制部，其利用積分動作算出電流指令值，該積分動作使用相對於線性馬達所具備之可動子之移動速度與基於位置指令值算出之速度指令值之差分的第1積分值；及電流控制部，其基於前述電流指令值將電壓施加至前述線性馬達；且該方法具有：第1步驟，其記憶前述可動子停留在由前述位置指令值所示之位置時之前述速度控制部的第1積分值；及第2步驟，其在再次開始對前述線性馬達之控制時，將所記憶之第1積分值設定為前述速度控制部之積分動作之初始值。 [發明之效果] 根據上述之線性馬達之控制裝置及線性馬達之控制方法，可提高控制線性馬達時之回應性。

以下，參照圖式，說明本發明之實施方式之線性馬達之控制裝置及控制方法。圖1係顯示本實施方式之線性致動器之概要的圖。線性致動器例如用作搬送裝置及拾取和按壓(pick and press)裝置、半導體之加工裝置等。線性致動器具有：控制裝置1、直動裝置2、旋轉裝置3、及制動器裝置4。 直動裝置2具有線性馬達。直動裝置2使線性馬達之可動子即桿狀體5直線運動。在桿狀體5之前端固定有連結板6。旋轉裝置3具有旋轉式馬達。旋轉裝置3使旋轉式馬達之可動子即桿狀體7以桿狀體7之中心軸為中心而旋轉運動。桿狀體7經由設置於連結板6之未圖示之軸承而旋轉自如地連結於連結板6。桿狀體7由設置於旋轉裝置3之內部之未圖示之花鍵裝置(直動導引裝置)支持。桿狀體7被設定為可進行旋轉運動與直線運動。 於桿狀體7之前端安裝有吸附墊8作為工作裝置。又，亦可替代吸附墊8而將其他工具安裝於桿狀體7之前端。 吸附墊8例如利用外部之裝置所產生之負壓而吸附工件，利用該裝置所產生之正壓使工件脫離。吸附墊8藉由直動裝置2而在沿桿狀體7之中心軸之軸向上移動。具體而言，若桿狀體5藉由直動裝置2在桿狀體5之軸向上移動，則桿狀體7藉由連結板6而與桿狀體5一起在軸向上移動，從而桿狀體7之軸向之吸附墊8之位置發生變位。 制動器裝置4係使桿狀體7之軸向之移動停止者。本實施方式之制動器裝置4係安裝於旋轉裝置3。在本實施方式中，桿狀體5之軸向與桿狀體7之軸向為平行且與重力方向為一致。本實施方式之線性致動器被用於例如晶片貼裝機。晶片貼裝機藉由利用直動裝置2使吸附墊8上下地移動，而重複進行將作為工件之電子零件等摘起並將電子零件朝基板上之特定之位置按壓的作業。在朝基板上之特定之位置按壓電子零件之前，根據基板上之電子零件之安裝方向，旋轉裝置3使吸附墊8就桿狀體7之軸向旋轉。 控制裝置1控制直動裝置2所具有之線性馬達、旋轉裝置3所具有之旋轉式馬達、及制動器裝置4。控制裝置1藉由使三相電樞電流在線性馬達所具備之U、V、W相之線圈中流動，而產生電磁鐵激磁，從而使線性馬達之可動子即桿狀體5相對於定子直線地移動。控制裝置1基於被輸入之動作信號將三相電樞電流供給至線性馬達。又，控制裝置1藉由基於被輸入之θ指令值使旋轉式馬達旋轉，而以相對於基準位置之旋轉位置之角度朝由θ指令值指示之角度變化之方式使桿狀體7之旋轉位置移動。 控制裝置1具備：控制部100、垂直軸驅動器116、旋轉軸驅動器126、及電源150。控制部100基於自安裝於直動裝置2之編碼器21輸出之垂直脈衝信號與動作信號而算出電流指令值。控制部100將算出之電流指令值朝垂直軸驅動器116輸出。垂直軸驅動器116基於電流指令值將自電源150供給之電壓予以變換，並施加至線性馬達。控制部100藉由將電力經由垂直軸驅動器116供給至線性馬達而驅動線性馬達，藉而使吸附墊8上下地移動。 又，控制部100基於自安裝於旋轉裝置3之編碼器31輸出之旋轉脈衝信號與θ指令值而算出電流指令值。控制部100將算出之電流指令值朝旋轉軸驅動器126輸出。旋轉軸驅動器126基於電流指令值將自電源150供給之一定之電壓予以變換，並施加至旋轉式馬達。控制部100藉由將電力經由旋轉軸驅動器126供給至旋轉式馬達而驅動旋轉式馬達，藉而使桿狀體7及吸附墊8旋轉。 圖2係顯示本實施方式之控制部100之構成例的方塊圖。控制部100具備：位置指令輸出部111、位置控制部112、速度限制器113、速度控制部114、電流限制器115、修正值記憶部117、速度算出部118、位置算出部119、位置控制部122、速度控制部124、速度算出部128、位置算出部129、及制動器控制部131。 位置指令輸出部111根據被輸入之動作信號，而輸出以原點位置與按壓位置中任一者之一個位置作為目標位置的位置指令值。原點位置係例如作為將線性馬達之桿狀體5設定於最上側之位置或最上側之位置之附近的位置而被決定。按壓位置係作為在以吸附墊8保持工件之狀態下將工件按壓於基板時之線性馬達之桿狀體5之位置而被決定。位置指令輸出部111例如在動作信號顯示為朝原點位置之移動時輸出以原點位置為目標位置的位置指令值，且在動作信號顯示為朝按壓位置之移動時輸出以按壓位置為目標位置的位置指令值。在以下之說明中，將動作信號顯示為朝原點位置之移動時記載為動作信號為關斷，而將動作信號顯示為朝按壓位置之移動時記載為動作信號為導通。 位置控制部112輸入位置偏差。位置偏差係位置指令輸出部111所輸出之位置指令值與位置算出部119算出之桿狀體5之位置的差分。位置控制部112利用使用所輸入之位置偏差的PI控制或PID控制算出桿狀體5之目標速度。位置控制部112將算出之目標速度作為速度指令值輸出。 速度限制器113在由位置控制部112算出之速度指令值之絕對值超過預先設定之上限值之情形下抑制速度指令值而輸出。在上限值中有第1上限值與第2上限值此2者。第1上限值係桿狀體5在原點位置與切換位置之間移動時之上限值，係可驅動線性馬達之桿狀體5的最高速度。第2上限值係桿狀體5在切換位置與按壓位置之間移動時之上限值，係在吸附墊8接觸於工件時與在由吸附墊8保持之工件接觸於基板時施加於工件之力成為一定以下的速度。速度限制器113基於位置算出部119算出之桿狀體5之位置切換於第1上限值與第2上限值。 此處，切換位置係將位置控制與推力控制予以切換的位置，係在原點位置與按壓位置之間預先設定之位置，即根據將桿狀體5之速度自最高速度減速至由第2上限值所指示之速度為止所需要之距離而設定之位置。位置控制係進行基於目標位置與桿狀體5之位置之偏差的控制。推力控制係進行將由線性馬達產生之推力限制為一定以下之推力的控制。又，桿狀體5朝上移動時之切換位置與桿狀體5朝下移動時之切換位置可為不同。 速度控制部114輸入速度偏差。速度偏差係速度限制器113所輸出之速度指令值與速度算出部118算出之桿狀體5之速度之差分。速度控制部114利用使用所輸入之速度偏差的PI控制而算出流動至線性馬達的目標電流值。速度控制部114將以速度偏差之積分值(第1積分值)乘以積分增益Ki所得到的值與以速度偏差乘以比例增益Kp所得到的值進行加算而算出目標電流值。具體而言，速度控制部114進行將與速度偏差成比例地使電流值變化的比例動作和與速度偏差之積分值成比例地使電流值變化的積分動作予以組合之回饋控制。又，對於速度控制部114之目標電流值之算出而言，亦可使用進一步組合與速度偏差之微分值成比例地使電流值變化之微分動作的PID控制。 電流限制器115在推力控制中，在由速度控制部114算出之電流指令值之絕對值超過預先設定之電流臨限值之情形下，抑制電流指令值而輸出。電流臨限值與相對於速度指令值之第2上限值相同地，被設定為在吸附墊8接觸於工件時與在由吸附墊8保持之工件接觸於基板時施加於工件之力成為一定以下之電流值。電流限制器115在推力控制以外，將由速度控制部114算出之電流指令值保持原樣作為電流指令值朝垂直軸驅動器116輸出。 修正值記憶部117在開始線性馬達之驅動時，取得在僅利用線性馬達之推力將桿狀體5停留在原點位置時之速度控制部114之速度偏差的積分值，並將所取得之積分值記憶為修正值。修正值記憶部117在再次開始線性馬達之驅動時，與完成工件之按壓而將桿狀體5自按壓位置朝原點位置移動時，將所記憶之修正值輸出至速度控制部114。速度控制部114將自修正值記憶部117輸出之積分值作為初始值而進行積分動作。 速度算出部118基於自直動裝置2之線性馬達所具備之編碼器21輸出之垂直脈衝信號，算出桿狀體5移動之速度。位置算出部119基於垂直脈衝信號算出桿狀體5之位置。對於編碼器21而言，可使用增量型與絕對型之任一者。在編碼器21為增量型之情形下，在開始線性馬達之驅動之後，進行使桿狀體5移動至預先設定之原點位置(基準位置)的原點復位。 制動器控制部131在線性馬達之驅動終了開始直至開始驅動為止，為了防止桿狀體5因重力而移動至最下點、或桿狀體5因外力而移動等，而將制動器裝置4導通。制動器控制部131在基於位置指令值之伺服控制一開始，則關斷制動器裝置4。 位置控制部122輸入旋轉位置偏差。旋轉位置偏差係由被輸入之θ指令值所示之旋轉位置與位置算出部129算出之桿狀體7之旋轉位置的差分。位置控制部122利用使用所輸入之位置偏差之PI控制或PID控制而算出桿狀體7之目標旋轉速度。位置控制部122將算出之目標旋轉速度作為速度指令值而輸出。 速度控制部124輸入旋轉速度偏差。旋轉速度偏差係位置控制部122算出之速度指令值與速度算出部128算出之桿狀體7之旋轉速度之差分。速度控制部124利用使用所輸入之旋轉速度偏差之PI控制或PID控制而算出目標電流值。速度控制部124將算出之目標電流值作為電流指令值朝旋轉軸驅動器126輸出。 速度算出部128基於自旋轉裝置3之旋轉式馬達所具備之編碼器31輸出之旋轉脈衝信號，算出桿狀體7旋轉之速度。位置算出部129基於旋轉脈衝信號算出桿狀體7之旋轉位置。對於編碼器31而言，可使用增量型與絕對型之任一者。在編碼器31為增量型之情形下，在開始線性馬達之驅動之後，進行將桿狀體7旋轉至預先設定之原點位置(基準旋轉位置)的原點復位。 圖3係顯示在修正值記憶部117取得修正值時之控制部100之處理的流程圖。在控制部100中，若修正值之取得一開始，則位置指令輸出部111判定動作信號是否為關斷(步驟S101)，且直至其成為關斷為止待機(步驟S101：否)。若動作信號關斷(步驟S101：是)，則位置指令輸出部111輸出以原點位置為目標位置之位置指令，而開始線性馬達之伺服動作(步驟S102)。 若線性馬達之伺服動作一開始，則制動器控制部131關斷制動器裝置4而停止對桿狀體7之制動(步驟S103)。修正值記憶部117基於由位置算出部119算出之桿狀體5之位置，判定桿狀體7是否停留在原點位置(步驟S104)，且直至桿狀體5停留在原點位置為止待機(步驟S104：否)。若桿狀體5停留在原點位置(步驟S104：是)，則修正值記憶部117取得速度控制部114之速度偏差之積分值，並將所取得之積分值記憶為修正值(步驟S105)，而終了修正值之取得。 此外，在步驟S104之判定中，例如由位置算出部119算出之桿狀體5之位置經過特定之期間而位於原點位置時，則判定桿狀體5停留在原點位置。另外，亦可在桿狀體5之位置經過特定之期間而位於包含原點位置之特定之範圍內時，判定桿狀體5停留在原點位置。 圖4係顯示利用線性致動器進行將工件摘起或將工件朝基板按壓之動作時之控制的流程圖。若線性致動器被供給電力等而動作一開始，則在控制部100中，進行圖3所示之取得積分值之處理(步驟S201)。位置指令輸出部111判定動作信號是否導通(步驟S202)，並直至動作信號成為導通為止待機(步驟S202：否)。 若動作信號成為導通(步驟S202：是)，則位置指令輸出部111輸出以按壓位置為目標位置之位置指令值，而開始使桿狀體5朝按壓位置向下移動之動作(步驟S203)。若桿狀體5越過自位置控制切換至推力控制之位置而朝下移動，則速度限制器113及電流限制器115抑制速度指令值及電流指令值。藉由抑制速度指令值及電流指令值，而進行限制桿狀體5之移動速度及施加於桿狀體5之推力的控制(步驟S204)。 若利用推力控制使桿狀體5朝下移動，桿狀體7及吸附墊8與桿狀體5一起移動而吸附墊8接觸於工件，或吸附墊8所保持之工件接觸於基板此一事實，被藉由供給至線性馬達之電流值之變化與桿狀體5之移動速度及位置而檢測出，則按壓動作開始(步驟S205)。若按壓動作開始後經過特定之時間而按壓動作完成(步驟S206)，則位置指令輸出部111判定動作信號是否關斷(步驟S207)，並直至動作信號關斷為止待機(步驟S207：否)。另外，按壓動作開始後所經過之時間可利用設置於控制部100之計時器計測，亦可將開始按壓動作之事實通知給外部之裝置而自外部之裝置取得。 若動作信號成為關斷(步驟S207：是)，則位置指令輸出部111輸出以原點位置為目標位置的位置指令值，而開始使桿狀體5朝上移動之動作(步驟S208)。此時，修正值記憶部117根據動作信號自導通變化為關斷之事實，將所記憶之修正值朝速度控制部114輸出，並使速度控制部114之積分動作之積分值變更為修正值(步驟S209)。 若桿狀體5越過自推力控制切換至位置控制之位置而朝上移動，則速度限制器113及電流限制器115停止對速度指令值及電流指令值之限制。進行解除對桿狀體5之移動速度及對施加於桿狀體5之推力之限制的控制(步驟S210)。 利用位置控制使桿狀體5朝上移動，位置控制部112判定桿狀體5是否到達原點位置(步驟S211)，且直至桿狀體5到達原點位置為止待機(步驟S211：否)。若桿狀體5到達原點位置(步驟S211：是)，則使動作終了。若動作終了，則桿狀體5藉由控制部100所進行之伺服控制而被保持於原點位置。 又，在相同動作被重複進行時，在第2次以後之動作中不進行取得步驟S201之積分值之處理，而進行與步驟S209之處理為相同之處理。具體而言，速度控制部114將自修正值記憶部117輸出之修正值作為積分動作中積分值之初始值而開始處理。此時，在制動器裝置4成為導通之情形下，在制動器控制部131關斷制動器裝置4之前，速度控制部114將積分動作之積分值變更為修正值。 關斷使桿狀體5停止在原點位置附近之制動器裝置4，在開始使桿狀體5位於原點位置之一般之伺服控制時，由於位置偏差及速度偏差為小，故電流指令值變小。因此，在開始伺服控制之後緊接著流動至線性馬達之電流小，而得不到保持桿狀體5之推力，從而存在有因重力等之外力導致桿狀體5落下而自原點位置偏移之可能性。 本實施方式之控制部100若對進行鉛垂方向動作之線性馬達之伺服控制一開始，則關斷對線性馬達之可動子即桿狀體5予以制動的制動器裝置4。此時，控制部100在速度控制部114將積分動作之積分值更新為修正值記憶部117所記憶之修正值之後進行電流指令值之算出。修正值係利用圖3所示之處理而取得之積分值，係使線性馬達產生桿狀體5停留於目標位置之推力時之速度控制部114的積分值。亦即修正值係在幾乎沒有位置偏差之狀態下產生使桿狀體5保持於目標位置之推力的積分值。 藉由將速度控制部114進行之積分動作之積分值之初始值變更為修正值，而可使線性馬達產生保持桿狀體5之推力。由於可獲得保持桿狀體5之推力，故即便關斷制動器裝置4，亦可防止因重力等之外力導致桿狀體5落下而自原點位置偏移。藉由抑制在開始伺服控制之後緊接著之桿狀體5之位置偏移，而可提高開始伺服控制之後緊接著之線性馬達之回應性。又，在控制部100所進行之伺服控制中，由於不進行修正電流值之控制以抵消外力，故可在不降低線性馬達之回應性及動作速度之下提高回應性。如此般，根據控制部100，即便在有外力產生之情形下，亦可提高線性馬達之回應性。 又，在本實施方式之線性致動器中，被要求縮短摘起工件之動作或將工件安裝於基板之動作所需要之時間(節拍時間)。在使桿狀體5朝下移動時，係採用下述動作模式，即：使桿狀體5以高速移動，在即將接觸於工件或所保持之工件即將接觸於基板之前使其減速。 在使桿狀體5朝上移動時，進行縮短將桿狀體5以高速移動直至返回至原點位置為止的時間。藉由增大位置控制部112及速度控制部114之比例動作的比例增益Kp，可在使桿狀體5朝上移動時在短時間內將移動速度變化為最高速度。 控制裝置1由於將旋轉裝置3之旋轉式馬達之旋轉位置固定在由θ指令值所示之旋轉位置，故構成為在使桿狀體5自按壓位置以低速上升時，桿狀體7及吸附墊8之旋轉位置不產生偏移。然而，在使桿狀體5以高速上升時，對旋轉式馬達之控制裝置1之控制追不上桿狀體7及吸附墊8之旋轉位置之變化， 而桿狀體7及吸附墊8之旋轉位置產生偏移。因此，在為了進一步縮短節拍時間而使桿狀體5、桿狀體7及吸附墊8以高速上升方面存在有問題。 本實施方式之控制部100在按壓動作完成後，在使桿狀體5朝上移動時，在速度控制部114將積分動作之積分值更新為修正值記憶部117所記憶之修正值後進行電流指令值之算出。如上述般，修正值係在幾乎沒有位置偏差之狀態下產生將桿狀體5保持於目標位置之推力的積分值。由於係在按壓動作完成時，算出用於使桿狀體5朝下移動之電流指令值，故在積分動作中算出之電流值成為產生朝下之推力的電流值。因此，在控制部100中，在動作信號關斷而開始朝原點位置向上移動之時序下將積分值變更為修正值。藉此，消除產生朝下之推力之原因，且使線性馬達迅速地產生朝上之推力，而可提高線性馬達之回應性，從而可縮短節拍時間。 另外，由於控制部100在桿狀體5朝上移動而吸附墊8與工件離開之位置，轉移至解除對桿狀體5之移動速度及對施加於桿狀體5之推力之限制的控制，故在無需挪移工件之位置之下即可使桿狀體5及吸附墊8朝上高速移動，從而可縮短節拍時間。 使用圖5至圖7說明本實施方式之線性致動器完成按壓動作後使桿狀體5朝上移動時之動作。在圖5至圖7中，記載有顯示桿狀體5之朝上之移動速度、桿狀體7之旋轉位置偏差、動作信號、速度控制部114之積分值各自之時間變化的曲線圖。 圖5係顯示第1比較例之動作例的圖。第1比較例之動作係不進行用於縮短節拍時間之比例增益之變更等之情形之動作。若按壓動作一完成，則動作信號自導通變化為關斷而被賦予以原點位置為位置指令值的上升指令。此時，積分值基於按壓動作所產生之位置偏差而成為負值。由於自負的積分值算出產生朝下之推力的電流值，故即便被賦予上升指令，亦不立即開始桿狀體5之移動。經過一段時間之後，在負的積分值被抵消後，開始桿狀體5之移動。若桿狀體5上升至特定之位置，則對移動速度及推力之限制被解除，而桿狀體5以高速上升。相應於桿狀體5之加速，在桿狀體7之旋轉位置產生晃動。此乃因桿狀體7與桿狀體5一起上升時之移動而產生之晃動(偏差)。 圖6係顯示第2比較例之動作例的圖。第2比較例之動作係進行用於縮短節拍時間之比例增益之變更之情形的動作。若按壓動作一完成，則動作信號自導通變化為關斷而被賦予以原點位置為位置指令值的上升指令。在第2比較例中，被賦予相對於積分增益為非常大之比例增益，而在動作信號由導通切換為關斷時，與積分值成比例地算出之電流值對電流指令值幾乎不造成影響。因此，若被賦予上升指令則產生大的朝上之推力而桿狀體5之移動被以高速開始，而在桿狀體7之旋轉位置產生晃動。由於在吸附墊8自工件離開之前產生桿狀體7之旋轉位置之晃動，故產生工件之位置偏移。 圖7係顯示本實施方式之動作例的圖。本實施方式之動作係為了縮短節拍時間而進行積分值之修正之情形的動作。若按壓動作一完成，則動作信號自導通變化為關斷而被賦予以原點位置為位置指令值的上升指令。此時，速度控制部114之積分值被變更為修正值，積分值被更新為產生保持桿狀體5之推力的值。藉此，與圖5所示之動作相比，直至桿狀體5之移動開始為止之時間被縮短。若桿狀體5上升至特定之位置，則對移動速度及推力之限制被解除，而桿狀體5以高速上升。相應於桿狀體5之加速，在桿狀體7之旋轉位置產生晃動，但由於吸附墊8已經與桿狀體5一起朝上移動而離開工件，故不會使工件之位置產生偏移。 如以上所述般，根據本實施方式之控制部100，在不挪移已安裝工件之位置之下，即可縮短按壓動作完成後直至桿狀體5之開始朝上之移動為止的時間，而可提高線性馬達之回應性，從而可縮短節拍時間。 本實施方式之積分值之修正在相對於線性馬達之控制裝置1之比例增益、積分增益及微分增益之自動調諧之質量推定中亦可使用。在自動調諧中，一般而言質量推定係在各增益之調整前進行。若反映被推定之質量係數，則存在有在反映之後緊接著電流指令值發生變化而無法算出適切之電流指令值，以致產生位置偏移之情形。在本實施方式之積分值之修正中，藉由在反映質量係數時以電流指令值不變化之方式調整積分值，藉而防止位置偏移之產生。 又，在本實施方式之控制裝置1所具備之垂直軸驅動器116(電流控制部)中，在進行基於供給至線性馬達之電流值與電流指令值之PI控制或PID控制時，與速度控制部114相同地，亦可將垂直軸驅動器116之積分動作之積分值(第2積分值)作為第2修正值記憶於修正值記憶部117。例如，在加算以將流動至線性馬達之電流值與電流指令值之電流偏差予以積分的積分值乘以積分增益所獲得之值、與以電流偏差乘以比例增益所獲得之值而由垂直軸驅動器116來算出電壓值時，桿狀體5停留在原點位置時之積分值作為第2修正值被記憶於修正值記憶部117。該情形下，修正值記憶部117以與朝速度控制部114輸出修正值之時序為相同之時序朝垂直軸驅動器116輸出第2修正值，而使垂直軸驅動器116之積分動作之積分值更新為第2修正值。藉由修正垂直軸驅動器116之積分值，可進一步提高線性馬達之回應性。特別是，由於在電性時間常數大之線性馬達中電流開始流動後直至產生推力為止需要時間，故可期待回應性之進一步之提高。 又，在本實施方式中，係說明控制裝置1構成為具備控制部100、電源150、垂直軸驅動器116、及旋轉軸驅動器126之一個裝置之情形。然而，電源150亦可設置於控制裝置1之外部。 又，在本實施方式中，係針對直動裝置2具有之線性馬達之可動子所移動之方向為鉛垂方向之情形進行了說明。然而，線性馬達之可動子所移動之方向並不限定於鉛垂方向，在重力及外力沿可動子所移動之方向發生作用之情形下亦然，可利用控制裝置1提高線性馬達之回應性。又，在本實施方式中，係說明在將線性馬達對可動子之推力自朝下之推力切換為朝上之推力時，控制裝置1將積分動作之積分值更新為修正值之構成。 然而，在線性馬達對可動子之推力自朝上之推力切換為朝下之推力時亦然，控制裝置1可將積分動作之積分值更新為修正值。 又，上述之控制裝置1亦可在內部具有電腦系統。在該情形下，控制裝置1所具備之各部分所進行之處理之過程係以程式之形式記憶於電腦可讀取之記錄媒體內，藉由電腦讀出並執行該程式而進行各機能部之處理。此處，所謂電腦可讀取之記錄媒體是指磁碟、光磁碟、CD-ROM、DVD-ROM、半導體記憶體等。此外，亦可利用通訊線路將該電腦程式發送至電腦，並由接收到此發送的電腦程式之電腦執行該程式。 另外，上述之實施方式係作為例子而提出者，並非意欲限定本發明之範圍。該等新穎之實施方式可利用其他各種方式實施，在不脫離本發明之要旨之範圍內可進行各種省略、置換、變更。該等實施方式及其變化係包含於本發明之範圍及要旨內，且包含於申請專利範圍所記載之發明及其均等之範圍。 [產業上之可利用性] 本發明亦可應用於即便在有外力產生之情形下亦可提高回應性之不可或缺之用途。

1‧‧‧控制裝置2‧‧‧直動裝置3‧‧‧旋轉裝置4‧‧‧制動器裝置5‧‧‧桿狀體6‧‧‧連結板7‧‧‧桿狀體8‧‧‧吸附墊21‧‧‧編碼器31‧‧‧編碼器100‧‧‧控制部111‧‧‧位置指令輸出部112‧‧‧位置控制部113‧‧‧速度限制器114‧‧‧速度控制部115‧‧‧電流限制器116‧‧‧垂直軸驅動器(電流控制部)117‧‧‧修正值記憶部118‧‧‧速度算出部119‧‧‧位置算出部122‧‧‧位置控制部124‧‧‧速度控制部126‧‧‧旋轉軸驅動器128‧‧‧速度算出部129‧‧‧位置算出部131‧‧‧制動器控制部150‧‧‧電源S101~S105‧‧‧步驟S201~S211‧‧‧步驟

圖1係顯示本發明之實施方式之線性致動器之概要的圖。 圖2係顯示本發明之實施方式之控制部之構成例的方塊圖。 圖3係顯示在修正值記憶部取得修正值時之控制部之處理的流程圖。 圖4係顯示利用線性致動器進行將工件摘起或將工件朝基板按壓之動作時之控制的流程圖。 圖5係顯示第1比較例之動作例的圖。 圖6係顯示第2比較例之動作例的圖。 圖7係顯示本發明之實施方式之動作例的圖。

100‧‧‧控制部

111‧‧‧位置指令輸出部

112‧‧‧位置控制部

113‧‧‧速度限制器

114‧‧‧速度控制部

115‧‧‧電流限制器

117‧‧‧修正值記憶部

118‧‧‧速度算出部

119‧‧‧位置算出部

122‧‧‧位置控制部

124‧‧‧速度控制部

128‧‧‧速度算出部

129‧‧‧位置算出部

131‧‧‧制動器控制部

Claims (6)

1. 一種線性馬達之控制裝置，其具備：速度控制部，其利用積分動作算出電流指令值，該積分動作使用相對於線性馬達所具備之可動子之移動速度與基於位置指令值算出之速度指令值之差分的第1積分值；電流控制部，其基於前述電流指令值將電壓施加至前述線性馬達；及修正值記憶部，其在重力沿上述可動子所移動之方向發生作用之情形下，記憶前述可動子停留在由前述位置指令值所示之位置時之前述速度控制部的第1積分值；且前述速度控制部在再次開始對前述線性馬達之控制時，將前述修正值記憶部所記憶之第1積分值設定為積分動作之初始值。
2. 如請求項1之線性馬達之控制裝置，其中前述速度控制部在變更使前述可動子移動之方向時，將前述修正值記憶部所記憶之第1積分值設定為積分動作之初始值。
3. 如請求項1或2之線性馬達之控制裝置，其中進一步具備制動器控制部，其控制將前述線性馬達之前述可動子予以制動之制動器裝置，且前述速度控制部在再次開始對前述線性馬達之控制時，在前述制動器控制部將前述制動器裝置關斷之前，將前述修正值記憶部所記憶之第1積分值設定為積分動作之初始值。
4. 如請求項1或2之線性馬達之控制裝置，其中前述電流控制部利用積 分動作算出施加至前述線性馬達之電壓值，該積分動作使用相對於前述電流指令值與流動至前述線性馬達之電流值之差分的第2積分值，且前述修正值記憶部記憶前述可動子停留在由前述位置指令值所示之位置時之前述電流控制部的第2積分值，並且前述電流控制部在再次開始對前述線性馬達之控制時，將前述修正值記憶部所記憶之第2積分值設定為積分動作之初始值。
5. 如請求項4之線性馬達之控制裝置，其中前述電流控制部在變更使前述可動子移動之方向時，將前述修正值記憶部所記憶之第2積分值設定為積分動作之初始值。
6. 一種線性馬達之控制裝置之控制方法，該線性馬達之控制裝置具備：速度控制部，其利用積分動作算出電流指令值，該積分動作使用線性馬達所具備之可動子之移動速度與基於位置指令值算出之速度指令值之差分的第1積分值；及電流控制部，其基於前述電流指令值將電壓施加至前述線性馬達；且該控制方法具有：第1步驟，其在重力沿上述可動子所移動之方向發生作用之情形下，記憶前述可動子停留在由前述位置指令值所示之位置時之前述速度控制部之第1積分值；及第2步驟，其在再次開始對前述線性馬達之控制時，將所記憶之第1積分值設定為前述速度控制部之積分動作之初始值。

Images