TWI739620B - Velocity feedforward adjustment system and method thereof - Google Patents

Velocity feedforward adjustment system and method thereof Download PDF

Info

Publication number
TWI739620B
TWI739620B TW109134476A TW109134476A TWI739620B TW I739620 B TWI739620 B TW I739620B TW 109134476 A TW109134476 A TW 109134476A TW 109134476 A TW109134476 A TW 109134476A TW I739620 B TWI739620 B TW I739620B
Authority
TW
Taiwan
Prior art keywords
speed
command
error value
module
position error
Prior art date
Application number
TW109134476A
Other languages
Chinese (zh)
Other versions
TW202215767A (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 TW109134476A priority Critical patent/TWI739620B/en
Application granted granted Critical
Publication of TWI739620B publication Critical patent/TWI739620B/en
Publication of TW202215767A publication Critical patent/TW202215767A/en

Links

Images

Abstract

A velocity feedforward adjustment system is disclosed in the present invention. The velocity feedforward adjustment system includes a filtering module, a computing module, a determining module, and an adjustment module. The filtering module is utilized to filter a position command and a motor feedback position. The computing module is utilized to compute a position error value by using the position command and the motor feedback position. The determining module is utilized to determine the position error value and the position command meet an increase condition or a decrease condition so as to use the adjustment module to increase or decrease a velocity feedforward parameter setting by a velocity feedforward controller. A velocity feedforward adjustment method is also disclosed in the present invention.

Description

轉速前饋調整系統及其方法Speed feedforward adjustment system and method

本發明係有關於一種系統及方法,尤其是指一種轉速前饋調整系統及其方法。The present invention relates to a system and method, in particular to a speed feedforward adjustment system and method.

一般來說,伺服馬達包含一位置控制迴路與一速度控制迴路,其中,位置控制迴路與速度控制迴路各自包含回授部分與控制部分。Generally speaking, a servo motor includes a position control loop and a speed control loop. The position control loop and the speed control loop each include a feedback part and a control part.

位置控制迴路主要為使馬達能夠精準定位,主要是由上位控制器產生的位置命令與編碼器的位置回授產生位置誤差,進行位置控制計算獲得轉速命令。速度控制迴路則透過位置控制器產生轉速命令,再由偵測馬達的馬達回授位置經由差分計算獲得轉速回授並與轉速命令產生轉速誤差帶入轉速控制器獲得驅動器電流命令進行驅動。在先前技術中,為了提升響應速度,還會再加入一轉速前饋控制器。The position control loop is mainly to enable the motor to be accurately positioned. It is mainly the position command generated by the upper controller and the position feedback of the encoder to produce a position error, and the position control calculation is performed to obtain the speed command. The speed control loop generates a speed command through the position controller, and then detects the motor feedback position of the motor to obtain the speed feedback through differential calculation. The speed error generated from the speed command is brought into the speed controller to obtain the drive current command for driving. In the prior art, in order to improve the response speed, a speed feedforward controller will be added.

請參閱第一圖,第一圖係顯示先前技術之伺服馬達系統之方塊圖。如圖所示,伺服馬達系統PA100包含一位置控制器PA1、一轉速控制器PA2、一轉速前饋控制器PA3、一電流控制器PA4、一逆變器PA5、一馬達PA6、一馬達回授位置接收模組PA7、一轉速處理器PA8、一第一計算器PA91、一第二計算器PA92與一電流運算模組PA93。馬達回授位置接收模組PA7與轉速處理器PA8用以偵測並處理出一馬達回授位置與一馬達回授轉速信號。第二計算器PA92接收馬達回授位置與一由上位控制器所產生的位置命令PAS1,藉以計算出一位置誤差。位置控制器PA1接收位置誤差,用以產生一轉速命令。第一計算器PA91用以接收轉速命令與馬達回授轉速信號,藉以計算出一轉速誤差,且轉速誤差經過轉速控制器PA2後係形成一電流命令。Please refer to the first figure. The first figure shows a block diagram of a prior art servo motor system. As shown in the figure, the servo motor system PA100 includes a position controller PA1, a speed controller PA2, a speed feedforward controller PA3, a current controller PA4, an inverter PA5, a motor PA6, and a motor feedback The position receiving module PA7, a rotational speed processor PA8, a first calculator PA91, a second calculator PA92 and a current calculation module PA93. The motor feedback position receiving module PA7 and the rotation speed processor PA8 are used to detect and process a motor feedback position and a motor feedback rotation speed signal. The second calculator PA92 receives the feedback position of the motor and a position command PAS1 generated by the upper controller to calculate a position error. The position controller PA1 receives the position error to generate a speed command. The first calculator PA91 is used to receive the rotational speed command and the motor feedback rotational speed signal to calculate a rotational speed error, and the rotational speed error forms a current command after passing through the rotational speed controller PA2.

在先前技術中,轉速前饋控制器PA3會接收位置命令PAS1,並設定一轉速前饋參數,藉以確保並提升系統響應。然而,轉速前饋控制器PA3提升轉速前饋參數容易使伺服馬達系統PA100產生一過衝量。而過衝量會影響伺服馬達系統PA100的運作,甚至是對伺服馬達系統PA100造成損壞。因此,先前技術具有改善的空間。In the prior art, the speed feedforward controller PA3 receives the position command PAS1 and sets a speed feedforward parameter to ensure and improve the system response. However, the speed feedforward controller PA3 increases the speed feedforward parameter easily to cause the servo motor system PA100 to generate an overshoot. The overshoot will affect the operation of the servo motor system PA100, and even cause damage to the servo motor system PA100. Therefore, the prior art has room for improvement.

有鑒於在先前技術中,轉速前饋控制器提升轉速前饋參數所存在以及衍生的種種問題。本發明之一主要目的係提供一種轉速前饋調整系統,用以解決先前技術中的至少一個問題。In view of the existing and derived problems in the prior art, the speed feedforward controller improves the speed feedforward parameters. One of the main objects of the present invention is to provide a speed feedforward adjustment system to solve at least one of the problems in the prior art.

本發明為解決先前技術之問題,所採用之必要技術手段為提供一種轉速前饋調整系統,電性連接一位置控制器、一轉速控制器、一轉速前饋控制器與一用以偵測一馬達回授位置與一馬達回授轉速信號之馬達回授位置接收模組,該位置控制器係接收一位置命令並據以產生一轉速命令,該轉速命令經由該轉速控制器係形成一電流命令,轉速前饋調整系統包含一低通濾波模組、一誤差計算模組、一判斷模組與一調整模組。In order to solve the problem of the prior art, the necessary technical means adopted by the present invention is to provide a speed feedforward adjustment system, which is electrically connected to a position controller, a speed controller, a speed feedforward controller and a speed feedforward controller for detecting a A motor feedback position receiving module for motor feedback position and a motor feedback speed signal. The position controller receives a position command and generates a speed command accordingly. The speed command forms a current command through the speed controller , The speed feedforward adjustment system includes a low-pass filter module, an error calculation module, a judgment module and an adjustment module.

低通濾波模組用以接收並濾波位置命令、馬達回授位置、馬達回授轉速信號與轉速命令。誤差計算模組電性連接低通濾波模組,用以接收濾波後之位置命令與濾波後之馬達回授位置,並據以計算出一位置誤差值。判斷模組電性連接低通濾波模組與誤差計算模組,用以接收濾波後之位置命令與位置誤差值,並在判斷出位置命令與位置誤差值滿足一調升條件時,產生一調升控制信號;並在判斷出位置命令與位置誤差值滿足一調降條件時,產生一調降控制信號。調整模組電性連接判斷模組與轉速前饋控制器,用以在接收到調升控制信號時,調升轉速前饋控制器所設定之一轉速前饋參數;並在接收到調降控制信號時,調降轉速前饋參數,藉以使位置誤差值趨近於轉速命令。The low-pass filter module is used to receive and filter the position command, the motor feedback position, the motor feedback speed signal and the speed command. The error calculation module is electrically connected to the low-pass filter module to receive the filtered position command and the filtered motor feedback position, and calculate a position error value accordingly. The judgment module is electrically connected to the low-pass filter module and the error calculation module to receive the filtered position command and position error value, and when it is judged that the position command and the position error value meet an increase condition, an adjustment is generated. When it is judged that the position command and the position error value meet a lowering condition, a lowering control signal is generated. The adjustment module is electrically connected to the judgment module and the speed feedforward controller to increase one of the speed feedforward parameters set by the speed feedforward controller when the increase control signal is received; and when the decrease control is received Signal, reduce the speed feedforward parameter, so that the position error value approaches the speed command.

在上述必要技術手段的基礎下,本發明所衍生之一附屬技術手段為使轉速前饋調整系統中之判斷模組,包含一同號判斷單元,同號判斷單元用以判斷位置命令與位置誤差值是否同號,且調升條件為位置命令與位置誤差值同號。On the basis of the above-mentioned necessary technical means, one of the subsidiary technical means derived from the present invention is to make the judgment module in the speed feedforward adjustment system, including the same number judgment unit, which is used to judge the position command and the position error value Whether it is the same number, and the increase condition is that the position command and the position error value have the same number.

在上述必要技術手段的基礎下,本發明所衍生之一附屬技術手段為使轉速前饋調整系統中之判斷模組,包含一誤差區間判斷單元,誤差區間判斷單元電性連接同號判斷單元,用以在位置命令與位置誤差值異號時,進一步判斷位置誤差值是否位於一位置誤差區間內,且調降條件係為位置誤差值位於位置誤差區間外。On the basis of the above-mentioned necessary technical means, an auxiliary technical means derived from the present invention is to make the judgment module in the speed feedforward adjustment system include an error interval judgment unit, and the error interval judgment unit is electrically connected to the judgment unit of the same number. It is used to further determine whether the position error value is within a position error interval when the position command and the position error value have different signs, and the reduction condition is that the position error value is outside the position error interval.

在上述必要技術手段的基礎下,本發明所衍生之一附屬技術手段為使轉速前饋調整系統中之判斷模組更包含一位置命令判斷單元與一回授轉速判斷單元。位置命令判斷單元用以接收位置命令,並判斷位置命令是否為0。回授轉速判斷單元電性連接位置命令判斷單元,用以在位置命令判斷單元判斷位置命令為0時,進一步判斷馬達回授轉速信號是否低於一判斷門檻值,並在判斷出馬達回授轉速信號低於判斷門檻值,利用同號判斷單元進行判斷。Based on the above-mentioned necessary technical means, an auxiliary technical means derived from the present invention is to make the judgment module in the speed feedforward adjustment system further include a position command judgment unit and a feedback speed judgment unit. The position command judging unit is used to receive the position command and judge whether the position command is 0. The feedback speed judging unit is electrically connected to the position command judging unit for further judging whether the motor feedback speed signal is lower than a judgment threshold when the position command judging unit judges that the position command is 0, and when the motor feedback speed is judged If the signal is lower than the judgment threshold, the judgment unit with the same number is used for judgment.

在上述必要技術手段的基礎下,本發明所衍生之一附屬技術手段為使轉速前饋調整系統中之低通濾波模組,係一低通濾波器。On the basis of the above-mentioned necessary technical means, an auxiliary technical means derived from the present invention is to make the low-pass filter module in the speed feedforward adjustment system a low-pass filter.

本發明為解決先前技術之問題,所採用之必要技術手段為另外提供一種轉速前饋調整方法,利用上述之轉速前饋調整系統加以實施,並包含以下步驟:利用低通濾波模組接收並濾波位置命令、馬達回授位置、馬達回授轉速信號與轉速命令;利用誤差計算模組接收濾波後之位置命令與濾波後之馬達回授位置,並據以計算出位置誤差值;利用判斷模組接收濾波後之位置命令與位置誤差值,並在判斷出位置命令與位置誤差值滿足調升條件時,產生調升控制信號;並在判斷出位置命令與位置誤差值滿足調降條件時,產生調降控制信號;利用調整模組在接收到調升控制信號,調升轉速前饋控制器所設定之轉速前饋參數;並在接收到調降控制信號,調降轉速前饋參數,藉以使位置誤差值趨近於0。In order to solve the problems of the prior art, the necessary technical means adopted by the present invention are to provide another speed feedforward adjustment method, which is implemented by the above-mentioned speed feedforward adjustment system, and includes the following steps: use a low-pass filter module to receive and filter Position command, motor feedback position, motor feedback speed signal and speed command; use the error calculation module to receive the filtered position command and the filtered motor feedback position, and calculate the position error value accordingly; use the judgment module Receive the filtered position command and position error value, and when it is judged that the position command and the position error value meet the increase condition, generate the increase control signal; and when it is judged that the position command and the position error value meet the decrease condition, generate Decrease the control signal; use the adjustment module to increase the speed feedforward parameters set by the speed feedforward controller after receiving the increase control signal; and after receiving the decrease control signal, reduce the speed feedforward parameters, so that The position error value approaches zero.

在上述必要技術手段的基礎下,本發明所衍生之一附屬技術手段為使轉速前饋調整方法中之步驟,更包含以下步驟:利用判斷模組之一同號判斷單元判斷位置命令與位置誤差值是否同號,且調升條件為位置命令與位置誤差值同號。On the basis of the above-mentioned necessary technical means, one of the subsidiary technical means derived from the present invention is the step in the speed feedforward adjustment method, and further includes the following steps: using the same number judgment unit of the judgment module to judge the position command and the position error value Whether it is the same number, and the increase condition is that the position command and the position error value have the same number.

在上述必要技術手段的基礎下,本發明所衍生之一附屬技術手段為使轉速前饋調整方法中之步驟,更包含以下步驟:在位置命令與位置誤差值異號時,利用判斷模組之一誤差區間判斷單元進一步判斷位置誤差值是否位於一位置誤差區間內,且調降條件係為位置誤差值位於位置誤差區間外。On the basis of the above-mentioned necessary technical means, an auxiliary technical means derived from the present invention is the steps in the speed feedforward adjustment method, which further includes the following steps: when the position command and the position error value have different signs, use the judgment module An error interval judging unit further judges whether the position error value is within a position error interval, and the reduction condition is that the position error value is outside the position error interval.

在上述必要技術手段的基礎下,本發明所衍生之一附屬技術手段為使轉速前饋調整方法中之步驟,更包含以下步驟:利用判斷模組之一位置命令判斷單元接收位置命令,並判斷位置命令是否為0;在位置命令判斷單元判斷該位置命令為0時,利用判斷模組之一回授轉速判斷單元進一步判斷馬達回授轉速信號是否低於一判斷門檻值,並在判斷出馬達回授轉速信號低於判斷門檻值時,進行上述步驟。On the basis of the above-mentioned necessary technical means, one of the subsidiary technical means derived from the present invention is the step in the speed feedforward adjustment method, and further includes the following steps: using a position command judgment unit of the judgment module to receive the position command, and judge Whether the position command is 0; when the position command judgment unit judges that the position command is 0, the feedback speed judgment unit of one of the judgment modules is used to further judge whether the feedback speed signal of the motor is lower than a judgment threshold value, and the motor is judged When the feedback speed signal is lower than the judgment threshold, perform the above steps.

承上所述,本發明所提供之轉速前饋調整系統及其方法,利用低通濾波模組、誤差計算模組、判斷模組與調整模組,計算出位置誤差值,並在判斷出位置命令與位置誤差值滿足調升條件時,調升轉速前饋參數;並在位置命令與位置誤差值滿足調降條件時,調降轉速前饋參數。相較於先前技術設定轉速前饋參數時所造成及衍生出的種種問題,本發明利用判斷模組判斷位置命令與位置誤差值是滿足調升條件還是調降條件,藉以即時且適當地調整轉速前饋參數,不僅可以避免產生過衝量,也可以達到調升系統響應的功效。Based on the above, the speed feedforward adjustment system and method provided by the present invention uses a low-pass filter module, an error calculation module, a judgment module, and an adjustment module to calculate the position error value and determine the position When the command and position error value meet the increase condition, increase the speed feedforward parameter; and when the position command and the position error value meet the decrease condition, decrease the speed feedforward parameter. Compared with the various problems caused and derived when setting the speed feedforward parameters in the prior art, the present invention uses the judgment module to determine whether the position command and the position error value satisfy the up-regulation condition or the down-regulation condition, so as to adjust the rotation speed in real time and appropriately. The feedforward parameter can not only avoid overshoot, but also achieve the effect of increasing the system response.

下面將結合示意圖對本發明的具體實施方式進行更詳細的描述。根據下列描述和申請專利範圍,本發明的優點和特徵將更清楚。需說明的是,圖式均採用非常簡化的形式且均使用非精準的比例,僅用以方便、明晰地輔助說明本發明實施例的目的。 The specific embodiments of the present invention will be described in more detail below in conjunction with the schematic diagrams. According to the following description and the scope of patent application, the advantages and features of the present invention will be more clear. It should be noted that the drawings all adopt a very simplified form and all use imprecise proportions, which are only used to conveniently and clearly assist in explaining the purpose of the embodiments of the present invention.

請一併參閱第二圖至第六圖,其中,第二圖係顯示本發明較佳實施例所提供之轉速前饋調整系統之方塊圖;第三圖係顯示本發明較佳實施例所提供之轉速前饋調整系統電性連接伺服馬達系統之示意圖;第四圖係顯示本發明較佳實施例所提供之轉速前饋調整系統與先前技術之比較圖;第五圖係顯示本發明較佳實施例所提供之轉速前饋調整系統之位置誤差區間之示意圖;第六圖係顯示本發明較佳實施例所提供之轉速前饋調整方法之流程圖。如圖所示,一種轉速前饋調整系統1包含一低通濾波模組11、一誤差計算模組12、一判斷模組13與一調整模組14,並電性連接一伺服馬達系統100。 Please refer to Figures 2 to 6 together. Figure 2 is a block diagram showing the speed feedforward adjustment system provided by the preferred embodiment of the present invention; Figure 3 is a block diagram showing the speed feedforward adjustment system provided by the preferred embodiment of the present invention. The schematic diagram of the speed feedforward adjustment system electrically connected to the servo motor system; the fourth diagram is a diagram showing the comparison between the speed feedforward adjustment system provided by the preferred embodiment of the present invention and the prior art; the fifth diagram shows the preferred embodiment of the present invention The schematic diagram of the position error interval of the speed feedforward adjustment system provided by the embodiment; the sixth figure is a flow chart of the speed feedforward adjustment method provided by the preferred embodiment of the present invention. As shown in the figure, a speed feedforward adjustment system 1 includes a low-pass filter module 11, an error calculation module 12, a judgment module 13 and an adjustment module 14, and is electrically connected to a servo motor system 100.

伺服馬達系統100包含一位置控制器2、一轉速控制器3、一轉速前饋控制器4、一電流控制器5、一逆變器6、一馬達7、一馬達回授位置接收模組8、一轉速處理器9、一第一計算器91、一第二計算器92與一電流運算模組93。馬達回授位置接收模組8用以偵測並處理出一馬達回授位置與一馬達回授轉速信號S2。第二計算器92接收馬達回授位置與一位置命令S1,藉以計算出一位置誤差,其中,位置命令S1通常是由一上位控制器所產 生。位置控制器2接收位置誤差,用以產生一轉速命令。第一計算器91用以接收轉速命令與馬達回授轉速信號S2,藉以計算出一轉速誤差,且轉速誤差經過轉速控制器3後係形成一電流命令。 The servo motor system 100 includes a position controller 2, a speed controller 3, a speed feedforward controller 4, a current controller 5, an inverter 6, a motor 7, and a motor feedback position receiving module 8. , A rotational speed processor 9, a first calculator 91, a second calculator 92, and a current calculation module 93. The motor feedback position receiving module 8 is used to detect and process a motor feedback position and a motor feedback speed signal S2. The second calculator 92 receives the feedback position of the motor and a position command S1 to calculate a position error. The position command S1 is usually generated by a host controller pregnancy. The position controller 2 receives the position error to generate a speed command. The first calculator 91 is used to receive the rotational speed command and the motor feedback rotational speed signal S2 to calculate a rotational speed error, and the rotational speed error forms a current command after passing through the rotational speed controller 3.

低通濾波模組11用以接收並濾波位置命令S1、馬達回授位置、馬達回授轉速信號S2與轉速命令(如步驟S101)。低通濾波模組11的用意在於濾除命令與信號中的高頻雜訊,藉以避免受到雜訊的干擾,使得接下來的運算與處理更為精確。 The low-pass filter module 11 is used to receive and filter the position command S1, the motor feedback position, the motor feedback speed signal S2, and the speed command (such as step S101). The purpose of the low-pass filter module 11 is to filter out high-frequency noise in commands and signals, so as to avoid interference from noise, and make subsequent calculations and processing more accurate.

誤差計算模組12電性連接低通濾波模組11,用以接收濾波後的位置命令S1與濾波後的馬達回授位置,並據以計算出一位置誤差值EP(如步驟S102)。在本實施例中,誤差計算模組12會利用濾波後的位置命令S1減掉濾波後的馬達回授位置而計算出位置誤差值EP。 The error calculation module 12 is electrically connected to the low-pass filter module 11 to receive the filtered position command S1 and the filtered motor feedback position, and calculate a position error EP accordingly (as in step S102). In this embodiment, the error calculation module 12 uses the filtered position command S1 to subtract the filtered motor feedback position to calculate the position error EP.

判斷模組13電性連接低通濾波模組11與誤差計算模組12,用以接收濾波後的位置命令S1與位置誤差值EP,並在判斷出濾波後的位置命令S1與位置誤差值EP滿足一調升條件時,產生一調升控制信號;並在判斷出濾波後的位置命令S1與位置誤差值EP滿足一調降條件時,產生一調降控制信號(如步驟S103至步驟S106)。 The judgment module 13 is electrically connected to the low-pass filter module 11 and the error calculation module 12 to receive the filtered position command S1 and the position error value EP, and determine the filtered position command S1 and the position error value EP When an increase condition is met, an increase control signal is generated; and when it is determined that the filtered position command S1 and the position error value EP meet a decrease condition, a decrease control signal is generated (e.g., step S103 to step S106) .

調整模組14電性連接判斷模組13與轉速前饋控制器4,用以在接收到該調升控制信號時,調升該轉速前饋控制器4所設定的一轉速前饋參數(如步驟S107);並在接收到調降控制信號時,調降轉速前饋參數(如步驟S108),藉以使位置誤差值EP趨近於轉速命令。The adjustment module 14 is electrically connected to the judging module 13 and the speed feedforward controller 4, so as to increase a speed feedforward parameter set by the speed feedforward controller 4 (such as Step S107); and when receiving the reduction control signal, reduce the speed feedforward parameter (such as step S108), so that the position error value EP approaches the speed command.

更詳細的說明,在本實施例中,判斷模組13更包含一位置命令判斷單元131、一回授轉速判斷單元132、一同號判斷單元133與一誤差區間判斷單元134。In more detail, in this embodiment, the judging module 13 further includes a position command judging unit 131, a feedback speed judging unit 132, a number judging unit 133, and an error interval judging unit 134.

位置命令判斷單元131用以判斷位置命令S1是否為0(如步驟S103)。The position command judging unit 131 is used to judge whether the position command S1 is 0 (for example, step S103).

回授轉速判斷單元132用以在位置命令判斷單元131判斷出位置命令S1為0時,進一步判斷馬達回授轉速信號S2是否低於一判斷門檻值TH(如步驟S104)。The feedback speed determination unit 132 is used for determining whether the motor feedback speed signal S2 is lower than a determination threshold TH when the position command determination unit 131 determines that the position command S1 is 0 (step S104).

同號判斷單元133用以在回授轉速判斷單元132判斷出馬達回授轉速信號S2低於判斷門檻值TH時,進一步判斷該位置命令S1與該位置誤差值EP是否同號(如步驟S105)。此時,調升條件為位置命令S1與位置誤差值EP同號。實務上,判斷門檻值TH可以是設定實際數值或是設定馬達7額定轉數的百分比。The same number judging unit 133 is used to determine whether the position command S1 and the position error value EP have the same sign when the feedback speed judgment unit 132 judges that the motor feedback speed signal S2 is lower than the judgment threshold TH (for example, step S105) . At this time, the condition for increasing is that the position command S1 has the same sign as the position error value EP. In practice, the judgment threshold TH can be a set actual value or a percentage of the rated speed of the motor 7.

需說明的是,位置命令S1與位置誤差值EP同號表示伺服馬達系統100沒有產生過衝量。當沒有過衝量時,就可以調升轉速前饋參數,以提升伺服馬達系統100的系統響應。因此,當位置命令S1與位置誤差值EP同號時,位置命令S1與位置誤差值EP便滿足調升條件,故調整模組14會調升轉速前饋參數。It should be noted that the position command S1 and the position error value EP have the same sign, which indicates that the servo motor system 100 does not generate an overshoot. When there is no overshoot, the speed feedforward parameter can be increased to improve the system response of the servo motor system 100. Therefore, when the position command S1 and the position error value EP have the same sign, the position command S1 and the position error value EP meet the increase condition, so the adjustment module 14 will increase the speed feedforward parameter.

舉例來說,位置命令S1為正9,馬達回授位置為正7,位置誤差值EP為正2,因為位置誤差值EP(正2)與位置命令S1(正9)同號,故此時不會產生過衝量,因此,位置命令S1與位置誤差值EP滿足調升條件。當位置命令S1為正9,馬達回授位置為正12的時候,位置誤差值EP為負3,因為位置誤差值EP(負3)與位置命令S1(正9)不同號,也就是異號,故此時可以視為伺服馬達系統100有可能會產生過衝量。同理,當位置命令S1為負值時亦相同,故不多加贅述。在本發明的其中一個實施例中,判斷模組13可以將位置誤差值EP與位置命令S1異號視為滿足調降條件,並進一步利用調整模組14會調降轉速前饋參數。For example, the position command S1 is positive 9, the motor feedback position is positive 7, and the position error value EP is positive 2. Because the position error value EP (positive 2) is the same number as the position command S1 (positive 9), it is not Will produce overshoot, therefore, the position command S1 and the position error value EP meet the conditions of increase. When the position command S1 is positive 9 and the motor feedback position is positive 12, the position error value EP is negative 3, because the position error value EP (negative 3) is different from the position command S1 (positive 9), that is, the opposite sign Therefore, it can be considered that the servo motor system 100 may generate overshoot at this time. Similarly, it is the same when the position command S1 is a negative value, so I won't repeat it. In one of the embodiments of the present invention, the judgment module 13 may regard the position error value EP and the position command S1 with the different sign as satisfying the reduction condition, and further use the adjustment module 14 to reduce the speed feedforward parameter.

在本實施例中,同號判斷單元133判斷出位置命令S1與位置誤差值EP異號時,誤差區間判斷單元134會進一步判斷位置誤差值EP是否位於一位置誤差區間A內(如步驟S106)。此時,調降條件為位置命令S1與位置誤差值EP異號且位置誤差值EP位於位置誤差區間A外。一般來說,位置誤差區間A具有一上限值LU與一下限值LD,其中,上限值LU與下限值LD互為相反數,藉以因應位置命令S1有正值也有負值的情形。In this embodiment, when the same number determining unit 133 determines that the position command S1 and the position error value EP have different signs, the error interval determining unit 134 will further determine whether the position error value EP is within a position error interval A (for example, step S106) . At this time, the lowering condition is that the position command S1 is different from the position error value EP, and the position error value EP is outside the position error interval A. Generally speaking, the position error interval A has an upper limit value LU and a lower limit value LD, where the upper limit value LU and the lower limit value LD are opposite to each other, so as to correspond to the situation where the position command S1 has a positive value and a negative value.

更詳細的說明,位置誤差值EP可能因為各種因素而存在誤差,造成位置誤差值EP與位置命令S1異號,而被視為會產生過衝量。因此,在本實施例中,誤差區間判斷單元134會進一步判斷位置誤差值EP是否位於位置誤差區間A內。當誤差區間判斷單元134判斷位置誤差值EP位於位置誤差區間A外時,表示位置誤差值EP並非因為上述誤差而導致與位置命令S1異號,故判斷此時的伺服馬達系統100極有可能會產生過衝量。因此,此時的位置命令S1與位置誤差值EP滿足調降條件,故會進一步利用調整模組14調降轉速前饋參數,藉以避免過衝量的產生。In more detail, the position error value EP may have errors due to various factors, causing the position error value EP and the position command S1 to have different signs, which is regarded as an overshoot. Therefore, in this embodiment, the error interval determining unit 134 will further determine whether the position error value EP is within the position error interval A. When the error interval judging unit 134 judges that the position error value EP is outside the position error interval A, it means that the position error value EP is not due to the above-mentioned error and has a different sign from the position command S1. Therefore, it is judged that the servo motor system 100 at this time is very likely to be Generate overshoot. Therefore, the position command S1 and the position error value EP at this time satisfy the reduction condition, so the adjustment module 14 is further used to reduce the speed feedforward parameter to avoid overshoot.

另一方面,當同號判斷單元133判斷出位置命令S1與位置誤差值EP異號,但是誤差區間判斷單元134判斷位置誤差值EP位於位置誤差區間A內時,表示位置誤差值EP可能基於上述誤差導致與位置命令S1異號,故判斷此時的伺服馬達系統100相較於上述位置誤差值EP位於位置誤差區間A外的情形,並沒有那麼高的機率會產生過衝量。因此,此時的位置命令S1與位置誤差值EP滿足調升條件,故會進一步利用調整模組14調升轉速前饋參數。On the other hand, when the same sign judgment unit 133 judges that the position command S1 is different from the position error value EP, but the error interval judgment unit 134 judges that the position error value EP is within the position error interval A, it means that the position error value EP may be based on the above The error results in a different sign from the position command S1. Therefore, it is judged that the servo motor system 100 at this time is less than the position error value EP outside the position error interval A, and there is no such high probability that the overshoot will occur. Therefore, the position command S1 and the position error value EP at this time satisfy the increase condition, so the adjustment module 14 is further used to increase the speed feedforward parameter.

因此,在本實施例中,調降條件為位置誤差值EP與位置命令S1異號且位置誤差值EP位於位置誤差區間A外。調升條件有兩種,一種是位置誤差值EP與位置命令S1同號,另一種是位置誤差值EP與位置命令S1異號且位置誤差值EP位於位置誤差區間A內。也就是說,本實施例會確認位置誤差值EP與位置命令S1的同異號以及位置誤差值EP是否位於位置誤差區間A內,藉以在判斷出伺服馬達系統100極有可能產生過衝量的情況下,調降轉速前饋參數,避免產生過衝量而對伺服馬達系統100造成損壞;並在判斷出伺服馬達系統100不可能產生過衝量,或是不太可能產生過衝量的情況下,調升轉速前饋參數,藉以在伺服馬達系統100不太可能產生過衝量的情況下,盡可能的提升伺服馬達系統100的系統響應。Therefore, in this embodiment, the lowering condition is that the position error value EP is different from the position command S1 and the position error value EP is outside the position error interval A. There are two adjustment conditions, one is that the position error value EP has the same sign as the position command S1, and the other is that the position error value EP has a different sign from the position command S1 and the position error value EP is within the position error interval A. That is to say, this embodiment will confirm whether the position error value EP and the position command S1 have the same or different signs and whether the position error value EP is within the position error interval A, so as to determine that the servo motor system 100 is likely to produce overshoot. , Reduce the speed feedforward parameters to avoid overshoot and damage the servo motor system 100; and when it is judged that the servo motor system 100 is unlikely to produce overshoot, or is unlikely to produce overshoot, increase the speed The feedforward parameter is used to improve the system response of the servo motor system 100 as much as possible when the servo motor system 100 is unlikely to generate overshoot.

實務上,當位置命令S1與位置誤差值EP滿足調升條件時,判斷模組13會產生一個調升控制信號。調整模組14接收到調升控制信號時,便會調升轉速前饋控制器4所設定的轉速前饋參數。因此,可以在伺服馬達系統100並沒有產生過衝量的情況下,進一步提升系統響應;當位置命令S1與位置誤差值EP滿足調降條件時,判斷模組13會產生一個調降控制信號。調整模組14接收到調降控制信號時,便會調降轉速前饋控制器4所設定的轉速前饋參數。因此,可以達到避免伺服馬達系統100產生過衝量及其所衍生出的種種問題。In practice, when the position command S1 and the position error value EP satisfy the increase condition, the judgment module 13 will generate an increase control signal. When the adjustment module 14 receives the increase control signal, it increases the speed feedforward parameter set by the speed feedforward controller 4. Therefore, when the servo motor system 100 does not generate an overshoot, the system response can be further improved; when the position command S1 and the position error value EP meet the droop condition, the judgment module 13 will generate a droop control signal. When the adjustment module 14 receives the reduction control signal, it reduces the speed feedforward parameter set by the speed feedforward controller 4. Therefore, the overshoot of the servo motor system 100 and various problems derived therefrom can be avoided.

可參閱第四圖,圖中包含位置命令S1經由微分後所形成的一脈波速度命令S1’、馬達回授轉速信號S2、先前技術的位置誤差值PAEP與本發明的位置誤差值EP。需說明的是,位置命令S1以響應表示的話,會以位置命令S1的微分值,也就是俗稱的脈波速度命令S1’表示。另外,因為圖式同時包含轉速與位置,故圖式的縱坐標同時標示位置誤差值與轉速。Refer to the fourth figure, which contains a pulse wave speed command S1' formed after the position command S1 is differentiated, the motor feedback speed signal S2, the position error value PAEP of the prior art, and the position error value EP of the present invention. It should be noted that if the position command S1 is expressed as a response, it will be expressed by the differential value of the position command S1, which is commonly known as the pulse wave speed command S1'. In addition, because the graph includes both speed and position, the ordinate of the graph indicates the position error value and the speed at the same time.

在先前技術中,為了提升系統響應,故會調升轉速前饋參數,卻也造成了過衝量的問題。可參閱圖式,位置誤差值PAEP上下震盪的情形,造成了過衝量OS的產生。而在本發明較佳實施例中,判斷模組13會進行上述各種判斷,並利用調整模組14對轉速前饋參數進行相對應地調整,因此,位置誤差值EP並不會像先前技術一樣產生過衝量OS,而是逐漸趨近於0,且不會產生跟位置命令異號的數值。另一方面,因為位置命令S1逐漸趨近於0,故脈波速度命令S1’也會逐漸趨近於0,馬達回授轉速信號S2也會逐漸趨近於0,因此,也可以視為位置誤差值EP會趨近於位置命令S1、脈波速度命令S1’與馬達回授轉速信號S2中的任一者。In the prior art, in order to improve the response of the system, the speed feedforward parameter is increased, but it also causes the problem of overshoot. Refer to the diagram, the position error value PAEP oscillates up and down, causing the overshoot OS to be generated. In the preferred embodiment of the present invention, the judgment module 13 will make the above-mentioned various judgments, and use the adjustment module 14 to correspondingly adjust the speed feedforward parameters. Therefore, the position error value EP is not the same as in the prior art. The overshoot OS is generated, but gradually approaches 0, and there is no value that is different from the position command. On the other hand, because the position command S1 gradually approaches 0, the pulse wave speed command S1' will gradually approach 0, and the motor feedback speed signal S2 will gradually approach 0. Therefore, it can also be regarded as a position. The error value EP will be close to any one of the position command S1, the pulse wave speed command S1', and the motor feedback speed signal S2.

另外,當位置誤差值EP趨近於0時,表示伺服馬達系統100產生的誤差越來越小,故伺服馬達系統100會趨近於穩定。在本發明較佳實施例中,位置誤差值EP收斂於0,需要花費時間區間T1。而在先前技術中,位置誤差值PAEP收斂於0,需要花費時間區間T2。因為位置誤差值PAEP會上下震盪,故先前技術的時間區間T2會大於本發明的時間區間T1。也就是說,本發明應用於伺服馬達系統100,相較於先前技術,可以達到提升系統響應的功效。In addition, when the position error value EP approaches 0, it means that the error generated by the servo motor system 100 is getting smaller and smaller, so the servo motor system 100 will tend to be stable. In the preferred embodiment of the present invention, the position error value EP converges to 0, and it takes a time interval T1. However, in the prior art, the position error value PAEP converges to 0, and it takes a time interval T2. Because the position error value PAEP oscillates up and down, the time interval T2 of the prior art will be greater than the time interval T1 of the present invention. That is to say, when the present invention is applied to the servo motor system 100, compared with the prior art, the effect of improving the response of the system can be achieved.

如第六圖所示,一種轉速前饋調整方法是利用如第二圖所示的轉速前饋調整系統1加以實施,並包含以下步驟S101至步驟S108。As shown in the sixth figure, a speed feedforward adjustment method is implemented using the speed feedforward adjustment system 1 shown in the second figure, and includes the following steps S101 to S108.

步驟S101:利用低通濾波模組接收並濾波位置命令、馬達回授位置、馬達回授轉速信號與轉速命令。Step S101: Use the low-pass filter module to receive and filter the position command, the motor feedback position, the motor feedback speed signal and the speed command.

步驟S101利用如第二圖中的低通濾波模組11。低通濾波模組11進行濾波的用意在於濾除高頻雜訊。Step S101 uses the low-pass filter module 11 as shown in the second figure. The purpose of filtering by the low-pass filter module 11 is to filter out high-frequency noise.

步驟S102:利用誤差計算模組接收濾波後之位置命令與濾波後之馬達回授位置,並據以計算出位置誤差值。Step S102: Use the error calculation module to receive the filtered position command and the filtered motor feedback position, and calculate the position error value accordingly.

步驟S102利用如第二圖中的誤差計算模組12。實務上來說,誤差計算模組12會利用濾波後的位置命令減去濾波後的馬達回授位置而計算出位置誤差值EP。Step S102 uses the error calculation module 12 as shown in the second figure. In practice, the error calculation module 12 uses the filtered position command to subtract the filtered motor feedback position to calculate the position error EP.

步驟S103:利用位置命令判斷單元判斷位置命令是否為0。Step S103: Use the position command judging unit to judge whether the position command is 0.

步驟S104:利用回授轉速判斷單元判斷馬達回授轉速信號是否低於判斷門檻值。Step S104: Use the feedback speed determination unit to determine whether the feedback speed signal of the motor is lower than the determination threshold value.

步驟S103與步驟S104利用如第二圖中的位置命令判斷單元131與回授轉速判斷單元132。在本實施例中,轉速前饋調整方法包含步驟S103與步驟S104,但不以此為限。在本發明其他實施例中,也可以不包含本實施例中的步驟S103與步驟S104。Steps S103 and S104 use the position command judging unit 131 and the feedback rotation speed judging unit 132 as shown in the second figure. In this embodiment, the speed feedforward adjustment method includes step S103 and step S104, but it is not limited thereto. In other embodiments of the present invention, steps S103 and S104 in this embodiment may not be included.

步驟S105:利用同號判斷單元判斷位置命令與位置誤差值是否同號。Step S105: Use the same number determining unit to determine whether the position command and the position error value have the same number.

步驟S106:利用誤差區間判斷單元判斷位置誤差值是否位於位置誤差區間內。Step S106: Use the error interval judging unit to judge whether the position error value is within the position error interval.

步驟S105與步驟S106利用如第二圖中的同號判斷單元133與誤差區間判斷單元134進行判斷。而判斷的過程與判斷的依據已在前述相關段落中進行描述,故不在此贅述。Step S105 and step S106 are determined by the same number determining unit 133 and the error interval determining unit 134 in the second figure. The judgment process and judgment basis have been described in the aforementioned relevant paragraphs, so I will not repeat them here.

步驟S107:利用調整模組調升轉速前饋控制器所設定之轉速前饋參數。Step S107: Use the adjustment module to increase the speed feedforward parameter set by the speed feedforward controller.

步驟S108:利用調整模組調降轉速前饋參數。Step S108: Use the adjustment module to reduce the speed feedforward parameter.

步驟S107與步驟S108利用如第二圖中的調整模組14去調整轉速前饋參數,相關的調整情形亦在前述相關段落中進行描述,故不多加贅述。Steps S107 and S108 use the adjustment module 14 as shown in the second figure to adjust the speed feedforward parameters, and the relevant adjustment situations are also described in the aforementioned relevant paragraphs, so no further description is given.

綜上所述,本發明所提供之轉速前饋調整系統及其方法,利用低通濾波模組、誤差計算模組、判斷模組與調整模組,計算出位置誤差值,並在判斷出位置命令與位置誤差值滿足調升條件時,調升轉速前饋參數;並在位置命令與位置誤差值滿足調降條件時,調降轉速前饋參數。相較於先前技術設定轉速前饋參數時所造成及衍生出的種種問題,本發明利用判斷模組判斷位置命令與位置誤差值是滿足調升條件還是調降條件,藉以即時且適當地調整轉速前饋參數,不僅可以避免產生過衝量,也可以在不會產生過衝量的情況下達到調升系統響應的功效。To sum up, the speed feedforward adjustment system and method provided by the present invention use low-pass filter module, error calculation module, judgment module and adjustment module to calculate the position error value, and determine the position When the command and position error value meet the increase condition, increase the speed feedforward parameter; and when the position command and the position error value meet the decrease condition, decrease the speed feedforward parameter. Compared with the various problems caused and derived when setting the speed feedforward parameters in the prior art, the present invention uses the judgment module to determine whether the position command and the position error value satisfy the up-regulation condition or the down-regulation condition, so as to adjust the rotation speed in real time and appropriately. The feedforward parameter can not only avoid overshoot, but also achieve the effect of increasing the system response without overshoot.

此外,本發明中的誤差區間判斷單元,會更進一步判斷位置誤差值是否位於位置誤差區間內,藉以避免因為誤差而造成的錯誤判斷情形,進而避免錯誤調降轉速前饋參數的情形,可以有效確保伺服馬達系統在極有可能會產生過衝量的情況下,才進一步調降轉速前饋參數。In addition, the error interval judging unit in the present invention will further judge whether the position error value is within the position error interval, so as to avoid incorrect judgments caused by errors, and to avoid incorrectly reducing the speed feedforward parameters, which can be effective Ensure that the servo motor system is likely to produce overshoot before further reducing the speed feedforward parameters.

藉由以上較佳具體實施例之詳述,係希望能更加清楚描述本發明之特徵與精神,而並非以上述所揭露的較佳具體實施例來對本發明之範疇加以限制。相反地,其目的是希望能涵蓋各種改變及具相等性的安排於本發明所欲申請之專利範圍的範疇內。Through the detailed description of the above preferred embodiments, it is hoped that the characteristics and spirit of the present invention can be described more clearly, and the scope of the present invention is not limited by the preferred embodiments disclosed above. On the contrary, the purpose is to cover various changes and equivalent arrangements within the scope of the patent for which the present invention is intended.

PA100:伺服馬達系統 PA1:位置控制器 PA2:轉速控制器 PA3:轉速前饋控制器 PA4:電流控制器 PA5:逆變器 PA6:馬達 PA7:馬達回授位置接收模組 PA8:轉速處理器 PA91:第一計算器 PA92:第二計算器 PA93:電流運算模組 PAEP:位置誤差值 PAS1:位置命令 1:轉速前饋調整系統 11:低通濾波模組 12:誤差計算模組 13:判斷模組 131:位置命令判斷單元 132:回授轉速判斷單元 133:同號判斷單元 134:誤差區間判斷單元 14:調整模組 100:伺服馬達系統 2:位置控制器 3:轉速控制器 4:轉速前饋控制器 5:電流控制器 6:逆變器 7:馬達 8:馬達回授位置接收模組 9:轉速處理器 91:第一計算器 92:第二計算器 93:電流運算模組 A:位置誤差區間 EP:位置誤差值 LD:下限值 LU:上限值 OS:過衝量 S1:位置命令 S1’:脈波速度命令 S2:馬達回授轉速信號 T1,T2:時間區間 TH:判斷門檻值 PA100: Servo motor system PA1: Position controller PA2: Speed controller PA3: Speed feedforward controller PA4: current controller PA5: inverter PA6: Motor PA7: Motor feedback position receiving module PA8: Speed processor PA91: The first calculator PA92: second calculator PA93: Current calculation module PAEP: Position error value PAS1: Position command 1: Speed feedforward adjustment system 11: Low-pass filter module 12: Error calculation module 13: Judgment module 131: Position command judgment unit 132: Feedback speed judgment unit 133: Same number judgment unit 134: Error interval judgment unit 14: Adjust the module 100: Servo motor system 2: Position controller 3: Speed controller 4: Speed feedforward controller 5: Current controller 6: Inverter 7: Motor 8: Motor feedback position receiving module 9: Speed processor 91: The first calculator 92: second calculator 93: Current calculation module A: Position error interval EP: position error value LD: lower limit LU: upper limit OS: Overshoot S1: Position command S1’: Pulse wave speed command S2: Motor feedback speed signal T1, T2: time interval TH: Judgment threshold

第一圖係顯示先前技術之伺服馬達系統之方塊圖; 第二圖係顯示本發明較佳實施例所提供之轉速前饋調整系統之方塊圖; 第三圖係顯示本發明較佳實施例所提供之轉速前饋調整系統電性連接伺服馬達系統之示意圖; 第四圖係顯示本發明較佳實施例所提供之轉速前饋調整系統與先前技術之比較圖; 第五圖係顯示本發明較佳實施例所提供之轉速前饋調整系統之位置誤差區間之示意圖;以及 第六圖係顯示本發明較佳實施例所提供之轉速前饋調整方法之流程圖。 The first figure is a block diagram showing the prior art servo motor system; The second figure is a block diagram showing the speed feedforward adjustment system provided by the preferred embodiment of the present invention; The third figure is a schematic diagram showing that the speed feedforward adjustment system provided by the preferred embodiment of the present invention is electrically connected to the servo motor system; The fourth diagram is a comparison diagram between the speed feedforward adjustment system provided by the preferred embodiment of the present invention and the prior art; The fifth figure is a schematic diagram showing the position error interval of the speed feedforward adjustment system provided by the preferred embodiment of the present invention; and The sixth figure is a flow chart of the speed feedforward adjustment method provided by the preferred embodiment of the present invention.

1:轉速前饋調整系統 1: Speed feedforward adjustment system

11:低通濾波模組 11: Low-pass filter module

12:誤差計算模組 12: Error calculation module

13:判斷模組 13: Judgment module

131:位置命令判斷單元 131: Position command judgment unit

132:回授轉速判斷單元 132: Feedback speed judgment unit

133:同號判斷單元 133: Same number judgment unit

134:誤差區間判斷單元 134: Error interval judgment unit

14:調整模組 14: Adjust the module

100:伺服馬達系統 100: Servo motor system

2:位置控制器 2: Position controller

3:轉速控制器 3: Speed controller

4:轉速前饋控制器 4: Speed feedforward controller

5:電流控制器 5: Current controller

6:逆變器 6: Inverter

7:馬達 7: Motor

8:馬達回授位置接收模組 8: Motor feedback position receiving module

9:轉速處理器 9: Speed processor

91:第一計算器 91: The first calculator

92:第二計算器 92: second calculator

93:電流運算模組 93: Current calculation module

S1:位置命令 S1: Position command

Claims (7)

一種轉速前饋調整系統,係電性連接一位置控制器、一轉速控制器、一轉速前饋控制器與一用以偵測一馬達回授位置與一馬達回授轉速信號之馬達回授位置接收模組,該位置控制器係接收一位置命令並據以產生一轉速命令,該轉速命令經由該轉速控制器係形成一電流命令,該轉速前饋調整系統包含: 一低通濾波模組,用以接收並濾波該位置命令、該馬達回授位置、該馬達回授轉速信號與該轉速命令; 一誤差計算模組,係電性連接該低通濾波模組,用以接收濾波後之該位置命令與濾波後之該馬達回授位置,並據以計算出一位置誤差值; 一判斷模組,係電性連接該低通濾波模組與該誤差計算模組,用以接收濾波後之該位置命令與該位置誤差值,並在判斷出該位置命令與該位置誤差值滿足一調升條件時,產生一調升控制信號;並在判斷出該位置命令與該位置誤差值滿足一調降條件時,產生一調降控制信號;以及 一調整模組,係電性連接該判斷模組與該轉速前饋控制器,用以在接收到該調升控制信號時,調升該轉速前饋控制器所設定之一轉速前饋參數;並在接收到該調降控制信號時,調降該轉速前饋參數,藉以使該位置誤差值趨近於0。 A speed feedforward adjustment system is electrically connected with a position controller, a speed controller, a speed feedforward controller and a motor feedback position for detecting a motor feedback position and a motor feedback speed signal The receiving module, the position controller receives a position command and generates a rotation speed command accordingly, the rotation speed command forms a current command through the rotation speed controller, and the rotation speed feedforward adjustment system includes: A low-pass filter module for receiving and filtering the position command, the motor feedback position, the motor feedback speed signal and the speed command; An error calculation module is electrically connected to the low-pass filter module to receive the filtered position command and the filtered motor feedback position, and calculate a position error value accordingly; A judgment module is electrically connected to the low-pass filter module and the error calculation module to receive the filtered position command and the position error value, and determine that the position command and the position error value satisfy When an increase condition is generated, an increase control signal is generated; and when it is determined that the position command and the position error value satisfy a decrease condition, a decrease control signal is generated; and An adjustment module is electrically connected to the judgment module and the speed feedforward controller, and is used to increase a speed feedforward parameter set by the speed feedforward controller when the increase control signal is received; And when receiving the reduction control signal, the speed feedforward parameter is reduced, so that the position error value approaches zero. 如請求項1所述之轉速前饋調整系統,其中,該判斷模組包含一同號判斷單元,該同號判斷單元係用以判斷該位置命令與該位置誤差值是否同號,且該調升條件係為該位置命令與該位置誤差值同號。 The speed feedforward adjustment system according to claim 1, wherein the judgment module includes a same number judgment unit, and the same number judgment unit is used to judge whether the position command and the position error value have the same sign, and the increase The condition is that the position command has the same number as the position error value. 如請求項2所述之轉速前饋調整系統,其中,該判斷模組包含一誤差區間判斷單元,該誤差區間判斷單元係電性連接該同號判斷單元,用以在該位置命令與該位置誤差值異號時,進一步判斷該位置誤差值是否位於一位置誤差區間內,且該調降條件係為該位置誤差值位於該位置誤差區間外。 The speed feedforward adjustment system according to claim 2, wherein the judgment module includes an error interval judgment unit, and the error interval judgment unit is electrically connected to the same number judgment unit for commanding the position and the position When the error value has a different sign, it is further determined whether the position error value is within a position error interval, and the adjustment condition is that the position error value is outside the position error interval. 如請求項1所述之轉速前饋調整系統,其中,該低通濾波模組係一低通濾波器。 The speed feedforward adjustment system according to claim 1, wherein the low-pass filter module is a low-pass filter. 一種轉速前饋調整方法,係利用如請求項1所述之轉速前饋調整系統加以實施,並包含以下步驟:(a)利用該低通濾波模組接收並濾波該位置命令、該馬達回授位置、該馬達回授轉速信號與該轉速命令;(b)利用該誤差計算模組接收濾波後之該位置命令與濾波後之該馬達回授位置,並據以計算出該位置誤差值;(c)利用該判斷模組接收濾波後之該位置命令與該位置誤差值,並在判斷出該位置命令與該位置誤差值滿足該調升條件時,產生該調升控制信號;並在判 斷出該位置命令與該位置誤差值滿足該調降條件時,產生該調降控制信號;(d)利用該調整模組在接收到該調升控制信號,調升該轉速前饋控制器所設定之該轉速前饋參數;並在接收到該調降控制信號,調降該轉速前饋參數,藉以使該位置誤差值趨近於該轉速命令。 A speed feedforward adjustment method is implemented using the speed feedforward adjustment system as described in claim 1, and includes the following steps: (a) Use the low-pass filter module to receive and filter the position command and the motor feedback Position, the motor feedback speed signal and the speed command; (b) using the error calculation module to receive the filtered position command and the filtered motor feedback position, and calculate the position error value accordingly; c) Use the judgment module to receive the filtered position command and the position error value, and when it is judged that the position command and the position error value satisfy the increase condition, the increase control signal is generated; and in the judgment When the position command and the position error value meet the derating condition, the derating control signal is generated; (d) using the adjustment module to increase the speed feedforward controller after receiving the ramping control signal Set the speed feedforward parameter; and after receiving the reduction control signal, reduce the speed feedforward parameter, so that the position error value approaches the speed command. 如請求項5所述之轉速前饋調整方法,其中,該步驟(c)更包含以下步驟:(c1)利用該判斷模組之一同號判斷單元判斷該位置命令與該位置誤差值是否同號,且該調升條件係為該位置命令與該位置誤差值同號。 The speed feedforward adjustment method according to claim 5, wherein the step (c) further includes the following steps: (c1) using a same number judgment unit of the judgment module to judge whether the position command and the position error value have the same number , And the increase condition is that the position command has the same sign as the position error value. 如請求項6所述之轉速前饋調整方法,其中,該步驟(c)更包含以下步驟:(c2)在該位置命令與該位置誤差值異號時,利用該判斷模組之一誤差區間判斷單元進一步判斷該位置誤差值是否位於一位置誤差區間內,且該調降條件係為該位置誤差值位於該位置誤差區間外。 The speed feedforward adjustment method according to claim 6, wherein the step (c) further includes the following steps: (c2) when the position command and the position error value have different signs, use an error interval of the judgment module The determining unit further determines whether the position error value is within a position error interval, and the adjustment condition is that the position error value is outside the position error interval.
TW109134476A 2020-10-05 2020-10-05 Velocity feedforward adjustment system and method thereof TWI739620B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW109134476A TWI739620B (en) 2020-10-05 2020-10-05 Velocity feedforward adjustment system and method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW109134476A TWI739620B (en) 2020-10-05 2020-10-05 Velocity feedforward adjustment system and method thereof

Publications (2)

Publication Number Publication Date
TWI739620B true TWI739620B (en) 2021-09-11
TW202215767A TW202215767A (en) 2022-04-16

Family

ID=78778014

Family Applications (1)

Application Number Title Priority Date Filing Date
TW109134476A TWI739620B (en) 2020-10-05 2020-10-05 Velocity feedforward adjustment system and method thereof

Country Status (1)

Country Link
TW (1) TWI739620B (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101877567A (en) * 2009-04-29 2010-11-03 鸿富锦精密工业(深圳)有限公司 Motor speed command generating device and method
TW201041293A (en) * 2009-04-14 2010-11-16 Mitsubishi Electric Corp Motor controlling apparatus
TW201135382A (en) * 2010-01-27 2011-10-16 Mitsubishi Electric Corp Motor control device
CN105978428A (en) * 2015-03-13 2016-09-28 光宝科技股份有限公司 Servo motor system and control method thereof
US10715075B2 (en) * 2016-09-29 2020-07-14 Panasonic Intellectual Property Management Co., Ltd. Motor control device and motor control method
US10773748B2 (en) * 2018-05-17 2020-09-15 Steering Solutions Ip Holding Corporation Compensator anti-windup for motion control systems

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW201041293A (en) * 2009-04-14 2010-11-16 Mitsubishi Electric Corp Motor controlling apparatus
CN101877567A (en) * 2009-04-29 2010-11-03 鸿富锦精密工业(深圳)有限公司 Motor speed command generating device and method
TW201135382A (en) * 2010-01-27 2011-10-16 Mitsubishi Electric Corp Motor control device
CN105978428A (en) * 2015-03-13 2016-09-28 光宝科技股份有限公司 Servo motor system and control method thereof
US10715075B2 (en) * 2016-09-29 2020-07-14 Panasonic Intellectual Property Management Co., Ltd. Motor control device and motor control method
US10773748B2 (en) * 2018-05-17 2020-09-15 Steering Solutions Ip Holding Corporation Compensator anti-windup for motion control systems

Also Published As

Publication number Publication date
TW202215767A (en) 2022-04-16

Similar Documents

Publication Publication Date Title
KR101562419B1 (en) Apparatus for operating interior permanent magnet synchronous machine
CN100463355C (en) Direct torque brushless DC servo control system and its working method
CN109155606B (en) Power conversion device and air conditioner
JPWO2005093943A1 (en) Control device for permanent magnet synchronous motor
TWI739620B (en) Velocity feedforward adjustment system and method thereof
CN113037072B (en) Narrow pulse suppression method and device and bridge type switching circuit
CN112436769A (en) Control system and method for low carrier ratio operation of permanent magnet synchronous motor
CN107947649B (en) Motor rotor position correction method, device and equipment and storage medium
CN110932633A (en) Motor control method and device and variable frequency controller
JP5564828B2 (en) AC motor control device
WO2020217764A1 (en) Power conversion device, and electric vehicle system provided therewith
WO2020063331A1 (en) Control device and control method for induction motor
US11370479B2 (en) Apparatus for and method of compensating for steering error in advanced driving assistance system
CN112234876B (en) Motor torque harmonic compensation method for electric power steering system
KR100966270B1 (en) Active steering apparatus for car
CN104506049A (en) Device and method for inhibiting transient fluctuation of inverter power supply output voltage
WO2020063330A1 (en) Control apparatus and control method for alternating-current electric motor
CN109586646B (en) Angle error self-adaption method for permanent magnet synchronous motor
TWI776344B (en) Judgment system and method for automatic adjustment of servo motor
JP3891080B2 (en) Regenerative control method for motor-driven power converter
JP2000253506A (en) Controller for electric rolling stock using speed- sensorless control
CN112491315A (en) Method for inhibiting torque pulsation of permanent magnet synchronous motor
JP2010011687A (en) Electric driving controller, electric vehicle, and overvoltage prevention method
JP3716520B2 (en) Electric vehicle motor drive control device
TWI741754B (en) Servomotor stiffness adjustment system and method thereof