TWI703808B - Electric motor controlling system and vibration restraining method for using the same - Google Patents

Electric motor controlling system and vibration restraining method for using the same Download PDF

Info

Publication number
TWI703808B
TWI703808B TW109105406A TW109105406A TWI703808B TW I703808 B TWI703808 B TW I703808B TW 109105406 A TW109105406 A TW 109105406A TW 109105406 A TW109105406 A TW 109105406A TW I703808 B TWI703808 B TW I703808B
Authority
TW
Taiwan
Prior art keywords
vibration suppression
error signal
torque command
motor
control system
Prior art date
Application number
TW109105406A
Other languages
Chinese (zh)
Other versions
TW202133542A (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 TW109105406A priority Critical patent/TWI703808B/en
Application granted granted Critical
Publication of TWI703808B publication Critical patent/TWI703808B/en
Publication of TW202133542A publication Critical patent/TW202133542A/en

Links

Images

Abstract

An electric motor controlling system used for restraining vibration of an electrical vehicle is disclosed. The controlling system includes a PID-controller and a vibration restraining compensator. The PID-controller generates a basic torque command through performing a calculation on input speed-error signal of the electrical vehicle, the vibration restraining compensator generates a compensated torque command through performing a compensation-gain procedure on the input speed-error signal. The vibration restraining compensator further receives a motor speed of the electrical vehicle, sets its output as the compensated torque command when the motor speed is smaller than a pre-set active speed level, otherwise sets the output as 0. The controlling system generates an output torque command via adding up the basic torque command and the output of the vibration restraining compensator, and controls the operation of electrical-components of the electrical vehicle through the output torque command.

Description

電機控制系統及其震動抑制方法Motor control system and its vibration suppression method

本發明涉及一種控制系統,尤其涉及一種電機控制系統,以及該電機控制系統採用的震動抑制方法。The invention relates to a control system, in particular to a motor control system, and a vibration suppression method adopted by the motor control system.

近年來,已經大規模電動化且最為市場所接受的電子器具應屬工業用載具,例如堆高機、無人搬運車等。由於工業用載具的應用環境大多為廠房、倉庫等室內空間,此類環境不宜存在對人體有害的廢氣,因此相較於民生用載具而言,電動化的工業用載具更能夠被市場所接受。In recent years, the electronic appliances that have been electrified on a large scale and are most accepted by the market should be industrial vehicles, such as stackers and unmanned vehicles. Since most of the application environments of industrial vehicles are indoor spaces such as workshops and warehouses, such environments should not contain exhaust gases that are harmful to the human body. Therefore, compared with vehicles for civilian use, electric industrial vehicles are more marketable. Place accepted.

雖然現有的工業用載具對於操控性和乘坐感仍具有基本的要求門檻,但因為成本考量工業用載具的傳動機構和懸吊系統與民生用載具相比通常較為簡單。是以,如何透過控制技術來彌補工業用載具結構的先天性不足,即成為各家廠商開發工業用載具時的主要課題。Although the existing industrial vehicles still have basic requirements for maneuverability and ride feeling, the transmission mechanism and suspension system of industrial vehicles are usually simpler than civilian vehicles due to cost considerations. Therefore, how to make up for the inherent deficiencies of the industrial vehicle structure through control technology has become a major issue for manufacturers when developing industrial vehicles.

電動載具的控制模式一般可分為轉矩控制模式和速度控制模式兩種架構。轉矩控制模式常見於電動機車、電動車等民生用載具。轉矩控制模式的電動載具是將油門訊號直接轉換為轉矩命令,故駕駛人只要調整油門狀態就可以直接調整電機輸出扭矩,進而將電動載具控制到目標的速度與目標的位置。The control modes of electric vehicles can generally be divided into two architectures: torque control mode and speed control mode. Torque control mode is common in electric vehicles, electric vehicles and other civilian vehicles. The electric vehicle in torque control mode directly converts the throttle signal into a torque command, so the driver can directly adjust the motor output torque by adjusting the throttle state, and then control the electric vehicle to the target speed and target position.

相較之下,工業用載具需要較穩定的速度,甚至有些電動載具(例如堆高機)需要在放開油門時自帶減速煞車力,因此絕大部分的工業用載具都會以速度控制模式來運行。In contrast, industrial vehicles require a relatively stable speed, and even some electric vehicles (such as stackers) need to have their own deceleration and braking force when the accelerator is released. Therefore, most industrial vehicles will be at speed. Control mode to run.

參閱圖1A,其為速度控制模式的電動載具的方塊圖。如圖1A所示,一般以速度控制模式來運行的電動載具至少會具備有一個PID控制器11,由PID控制器11接收電動載具的輸入速度誤差訊號12,並且經過運算後產生一個對應的轉矩命令13。藉此,電動載具可通過轉矩命令13來控制後方的電機構件(例如牽引電機,圖未繪示)。所述PID控制器11主要是用以追隨駕駛人所下達的速度命令,其取得駕駛人給定的油門訊號與實際輸出值(例如實際的馬達轉速)所構成的偏差,並且基於所述偏差進行線性運算以產生對應的控制量,再依據此控制量對電機構件的運轉進行控制。Refer to FIG. 1A, which is a block diagram of the electric vehicle in speed control mode. As shown in Fig. 1A, an electric vehicle generally operating in a speed control mode will have at least one PID controller 11. The PID controller 11 receives the input speed error signal 12 of the electric vehicle, and generates a corresponding signal after calculation. The torque command 13. In this way, the electric vehicle can control the rear motor components (such as a traction motor, not shown in the figure) through the torque command 13. The PID controller 11 is mainly used to follow the speed command issued by the driver. It obtains the deviation between the throttle signal given by the driver and the actual output value (for example, the actual motor speed), and performs processing based on the deviation Linear operation is used to generate the corresponding control quantity, and then the operation of the motor components is controlled according to this control quantity.

然而,一般使用PID控制器11的速度控制模式無法克服電動載具運行時基於傳動機構(如例如齒輪箱、轉向差速器等)的機械特性所造成的震動問題,因而會造成駕駛人的控制效果與乘坐感不佳。However, generally using the speed control mode of the PID controller 11 cannot overcome the vibration problem caused by the mechanical characteristics of the transmission mechanism (such as gearbox, steering differential, etc.) when the electric vehicle is running, which will cause the driver to control The effect and ride feel are not good.

如圖1B所示,其為齒輪的非線性死區的示意圖。如圖1B所示,齒輪2的接合處會具有一個齒隙距離W,故當駕駛人改變輸入方向時,一開始的輸入改變量會無法即時影響輸出,而是需要等待輸入側的齒輪2移動該段齒隙距離W使得齒輪2重新接合時,之後的輸入改變量才能夠實際影響輸出。因此,當輸入方向改變或是一開始齒輪2為非接合的狀態時,系統模型中會產生一非線性的死區(dead zone),而在此死區中駕駛人的輸入是無法影響電動載具的輸出的。As shown in Fig. 1B, it is a schematic diagram of the non-linear dead zone of the gear. As shown in Figure 1B, the joint of the gear 2 will have a backlash distance W, so when the driver changes the input direction, the initial input change will not affect the output immediately, but need to wait for the gear 2 on the input side to move The backlash distance W enables the subsequent input change to actually affect the output when the gear 2 is re-engaged. Therefore, when the input direction changes or the gear 2 is initially in a non-engaged state, a non-linear dead zone (dead zone) will be generated in the system model, and the driver’s input cannot affect the electric load in this dead zone. The output of the tool.

如上所述,目前的線性控制器(例如上述圖1A的PID控制器11)無法有效處理傳動機構(例如上述圖1B的齒輪2)所具有的上述非線性特性,因此電動載具在遇到上述死區時會有響應不佳或是異常扭轉、震動等的情形產生(例如使牽引電機在某些操作區產生震動而降低乘車舒適度),進而造成不良的工作狀態。As mentioned above, the current linear controller (such as the PID controller 11 in FIG. 1A) cannot effectively deal with the above-mentioned nonlinear characteristics of the transmission mechanism (such as the gear 2 in FIG. 1B). Therefore, the electric vehicle encounters the above-mentioned nonlinear characteristics. In the dead zone, there will be poor response or abnormal torsion, vibration, etc. (for example, the traction motor will vibrate in certain operating areas to reduce the comfort of the car), which will cause poor working conditions.

本發明之主要目的,在於提供一種電機控制系統及其震動抑制方法,用於電動載具,可抑制電動載具的傳動機構所導致的異常扭轉與震動。The main purpose of the present invention is to provide a motor control system and a vibration suppression method for electric vehicles, which can suppress abnormal torsion and vibration caused by the transmission mechanism of the electric vehicles.

為了達成上述之目的,本發明的電機控制系統主要是應用於一電動載具,並且包括:一PID控制器,接收該電動載具的一輸入速度誤差訊號,對該輸入速度誤差訊號進行計算以產生一基礎轉矩命令;以及一震動抑制補償器,與該PID控制器並聯設置,接收該輸入速度誤差訊號及該電動載具的一馬達轉速,對該輸入速度誤差訊號進行補償增益以產生一補償轉矩命令。In order to achieve the above object, the motor control system of the present invention is mainly applied to an electric vehicle, and includes: a PID controller, receiving an input speed error signal of the electric vehicle, and calculating the input speed error signal Generate a basic torque command; and a vibration suppression compensator, set in parallel with the PID controller, receive the input speed error signal and a motor speed of the electric vehicle, and perform a compensation gain on the input speed error signal to generate a Compensation torque command.

其中,該震動抑制補償器於判斷該馬達轉速不小於預設的一致能準位時設定一輸出量為0,於判斷該馬達轉速小於該致能準位時設定該輸出量為該補償轉矩命令。該電機控制系統將該基礎轉矩命令與該震動抑制補償器的該輸出量相加以產生一輸出轉矩命令,並依據該輸出轉矩命令控制該電動載具的一電機構件的運轉。Wherein, the vibration suppression compensator sets an output value to 0 when judging that the motor speed is not less than the preset consistent energy level, and sets the output value as the compensation torque when judging that the motor speed is less than the enable level command. The motor control system adds the basic torque command and the output of the vibration suppression compensator to generate an output torque command, and controls the operation of a motor component of the electric vehicle according to the output torque command.

為了達成上述之目的,本發明的電機控制系統的震動抑制方法,應用於一電動載具中的一電機控制系統,並且包括下列步驟:In order to achieve the above object, the vibration suppression method of the motor control system of the present invention is applied to a motor control system in an electric vehicle, and includes the following steps:

步驟a):由該電機控制系統中的一PID控制器接收該電動載具的一輸入速度誤差訊號;Step a): A PID controller in the motor control system receives an input speed error signal of the electric vehicle;

步驟b):由該PID控制器對該輸入速度誤差訊號進行計算以產生一基礎轉矩命令;Step b): The PID controller calculates the input speed error signal to generate a basic torque command;

步驟c):由該電機控制系統中的一震動抑制補償器接收該輸入速度誤差訊號及該電動載具的一馬達轉速;Step c): Receive the input speed error signal and a motor speed of the electric vehicle by a vibration suppression compensator in the motor control system;

步驟d):由該震動抑制補償器對該輸入速度誤差訊號進行補償增益以產生一補償轉矩命令;Step d): The input speed error signal is compensated by the vibration suppression compensator to generate a compensation torque command;

步驟e):由該震動抑制補償器於判斷該馬達轉速不小於預設的一致能準位時設定一輸出量為0,於判斷該馬達轉速小於該致能準位時設定該輸出量為該補償轉矩命令;Step e): The vibration suppression compensator sets an output value to 0 when judging that the motor rotation speed is not less than the preset consistent energy level, and sets the output value to the value when judging that the motor rotation speed is less than the enable level Compensation torque command;

步驟f):由該電機控制系統將該基礎轉矩命令與該震動抑制補償器的該輸出量相加以產生一輸出轉矩命令;Step f): The motor control system adds the basic torque command and the output of the vibration suppression compensator to generate an output torque command;

步驟g):由該電機控制系統將該輸出轉矩命令傳送至該電動載具的一電機構件以控制該電機構件的運轉;以及Step g): The motor control system transmits the output torque command to a motor component of the electric vehicle to control the operation of the motor component; and

步驟h):由該電機控制系統持續判斷該電動載具是否關閉,並於該電動載具關閉前持續執行該步驟a)至該步驟g)。Step h): The motor control system continuously judges whether the electric vehicle is closed, and continues to execute the steps a) to g) before the electric vehicle is closed.

本發明相較於相關技術可達到的技術功效在於,可藉由震動抑制補償器來抑制電動載具運行時基於傳動機構的非線性特性而產生的異常扭轉與震動現象,藉此提升整體電動載具的乘坐舒適性。Compared with the related technology, the technical effect of the present invention is that the vibration suppression compensator can suppress abnormal torsion and vibration caused by the nonlinear characteristics of the transmission mechanism during the operation of the electric vehicle, thereby improving the overall electric load. With great ride comfort.

並且,只要適當調整震動抑制補償器所使用的參數,例如個別設定致能準位、增益值或低通/高通濾波器所採用的頻寬等,就可以令本發明適用於各種不同類型的電動載具以達到預期的震動抑制效果,因此更具備了使用彈性與便利性。Moreover, as long as the parameters used by the vibration suppression compensator are appropriately adjusted, such as individually setting the enable level, gain value, or bandwidth used by the low-pass/high-pass filter, the present invention can be applied to various types of electric motors. The vehicle can achieve the expected vibration suppression effect, so it is more flexible and convenient to use.

茲就本發明之一較佳實施例,配合圖式,詳細說明如後。For a preferred embodiment of the present invention, with the drawings, the detailed description is as follows.

首請參閱圖2,其為本發明的電機控制系統的方塊圖。圖2具體揭露了本發明的電機控制系統3,所述電機控制系統3主要應用於電動載具。具體地,本發明的電機控制系統3主要是應用於以速度控制模式來運行的工業用電動載具,例如堆高機、搬運機等,但不加以限定。First, please refer to FIG. 2, which is a block diagram of the motor control system of the present invention. Fig. 2 specifically discloses the motor control system 3 of the present invention, which is mainly applied to electric vehicles. Specifically, the motor control system 3 of the present invention is mainly applied to industrial electric vehicles operating in a speed control mode, such as stackers, conveyors, etc., but is not limited.

如圖2所示,本發明的電機控制系統3主要具有一比例積分微分(Proportional-Integral-Derivative, PID)控制器31以及一震動抑制補償器32。本發明中,PID控制器31用以追隨電動載具的駕駛人所下達的一速度命令(即,對應至油門操作的轉動幅度的一訊號),而震動抑制補償器32則用以於條件符合時,對PID控制器31輸出的一轉矩命令進行補償,以抑制電動載具運行時因為內部的傳動構件(例如齒輪箱、轉向差速器等或其組合)的非線性特性而產生的不正常扭轉與震動。As shown in FIG. 2, the motor control system 3 of the present invention mainly has a Proportional-Integral-Derivative (PID) controller 31 and a vibration suppression compensator 32. In the present invention, the PID controller 31 is used to follow a speed command issued by the driver of the electric vehicle (that is, a signal corresponding to the rotation amplitude of the throttle operation), and the vibration suppression compensator 32 is used to meet the conditions When the time, a torque command output by the PID controller 31 is compensated to suppress the non-linear characteristics of the internal transmission components (such as gearbox, steering differential, etc. or a combination) of the electric vehicle during operation. Normal torsion and vibration.

於一實施例中,所述PID控制器31與震動抑制補償器32分別由不同的硬體元件來實現,並且彼此以並聯方式電性連接。於另一實施例中,所述PID控制器31與震動抑制補償器32可為韌體,並且可由相同或不同的處理器來分別執行,以實現對應的功能,但不加以限定。In one embodiment, the PID controller 31 and the vibration suppression compensator 32 are implemented by different hardware components, and are electrically connected in parallel with each other. In another embodiment, the PID controller 31 and the vibration suppression compensator 32 can be firmware, and can be executed by the same or different processors to achieve corresponding functions, but is not limited.

所述PID控制器31主要是由比例單元(Proportional Unit)、積分單元(Integral Unit)及微分單元(Derivative Unit)所組成的,PID控制器31的設計者可以通過分別設定比例單元增益Kp、積分單元增益Ki及微分單元增益Kd來調整PID控制器31的特性,藉此令PID控制器31適用於基本上線性,且動態特性不隨時間變化的系統。具體地,PID控制器31通常做為一種反饋迴路元件來使用,其將輸出資料和一個參考值做比較,再基於比較後得到的差異計算新的輸入值。藉由新的輸入值的使用,可以讓系統的輸出資料達到,或是保持在所述參考值,藉此可令整個系統更加穩定。The PID controller 31 is mainly composed of a proportional unit (Proportional Unit), an integral unit (Integral Unit) and a derivative unit (Derivative Unit). The designer of the PID controller 31 can set the proportional unit gain Kp and integral unit respectively. The unit gain Ki and the differential unit gain Kd are used to adjust the characteristics of the PID controller 31, thereby making the PID controller 31 suitable for a system that is basically linear and whose dynamic characteristics do not change with time. Specifically, the PID controller 31 is usually used as a feedback loop element, which compares the output data with a reference value, and then calculates a new input value based on the difference obtained after the comparison. By using the new input value, the output data of the system can be reached or maintained at the reference value, thereby making the entire system more stable.

一般來說,PID控制器31的比例單元、積分單元和微分單元係分別對應至目前誤差、過去累計誤差和未來誤差,因此若其中有任一個單元不需使用,只要將不使用的單元的參數設定為零即可。於本發明的一實施例中,所述電機控制系統3可以在PID控制器31不使用微分單元的情況下被實現(即,將PID控制器31中的微分單元的參數設定為零),而可將PID控制器31轉換為一個PI控制器,但不以此為限。Generally speaking, the proportional unit, integral unit and differential unit of the PID controller 31 correspond to the current error, past cumulative error and future error respectively. Therefore, if any of the units does not need to be used, just change the parameters of the unused units Just set it to zero. In an embodiment of the present invention, the motor control system 3 can be implemented without using a differential unit in the PID controller 31 (that is, the parameter of the differential unit in the PID controller 31 is set to zero), and The PID controller 31 can be converted into a PI controller, but not limited to this.

如圖2所示,所述PID控制器31主要接收電動載具的一輸入速度誤差訊號43,並且再對輸入速度誤差訊號43進行計算以產生對應的一基礎轉矩命令44。本發明中,當電動載具沒有出現異常扭轉或震動的現象時,電機控制系統3將直接以PID控制器31產生的基礎轉矩命令44做為最終的一輸出轉矩命令46使用,即,不對基礎轉矩命令44進行補償,或視為對基礎轉矩命令44進行補償但補償值為0。As shown in FIG. 2, the PID controller 31 mainly receives an input speed error signal 43 of the electric vehicle, and then calculates the input speed error signal 43 to generate a corresponding basic torque command 44. In the present invention, when there is no abnormal torsion or vibration of the electric vehicle, the motor control system 3 directly uses the basic torque command 44 generated by the PID controller 31 as the final output torque command 46, that is, The basic torque command 44 is not compensated, or it is deemed that the basic torque command 44 is compensated but the compensation value is 0.

值得一提的是,於一實施例中,電動載具具有供駕駛人操作以產生對應的一速度訊號41的一油門單元(圖未繪示),以及用以偵測對應速度訊號41轉動的一電機構件5(例如馬達)之一馬達轉速42的一感測器(圖未繪示)。本實施例中,電機控制系統3主要是從油門單元處接收基於駕駛人的操作而產生的速度訊號41,並且從感測器處接收實際的馬達轉速42,並將速度訊號41與馬達轉速42相減以獲取所述輸入速度誤差訊號43。本發明中,電機控制系統3將輸入速度誤差訊號43做為PID控制器31的一輸入訊號,也就是說,電機控制系統3主要是採用速度控制模式來運作。It is worth mentioning that in one embodiment, the electric vehicle has a throttle unit (not shown) for the driver to operate to generate a corresponding speed signal 41, and a throttle unit (not shown) for detecting the rotation of the corresponding speed signal 41 A sensor (not shown in the figure) of a motor component 5 (such as a motor) and a motor speed 42. In this embodiment, the motor control system 3 mainly receives the speed signal 41 generated based on the driver's operation from the throttle unit, and receives the actual motor speed 42 from the sensor, and combines the speed signal 41 with the motor speed 42 Subtract to obtain the input speed error signal 43. In the present invention, the motor control system 3 uses the input speed error signal 43 as an input signal of the PID controller 31, that is, the motor control system 3 mainly operates in a speed control mode.

所述震動抑制補償器32主要是與PID控制器31並聯設置且電性連接,即,與PID控制器31共用輸入端口與輸出端口。本發明中,震動抑制補償器32可接收所述速度誤差訊號43,並且對輸入速度誤差訊號43執行一補償增益程序以產生一補償轉矩命令45。本發明中,當電動載具出現了異常扭轉或震動的現象時,電機控制系統3會將PID控制器31產生的所述基礎轉矩命令44與震動抑制補償器32產生的所述補償轉矩命令45相加,以做為最終的一輸出轉矩命令46,即,藉由補償轉矩命令45來對基礎轉矩命令44進行補償。藉此,由輸出轉矩命令46中的補償轉矩命令45部分,來消除電動載具運行時因為傳動構件的非線性特性而產生的異常扭轉、震動現象。The vibration suppression compensator 32 is mainly arranged in parallel with the PID controller 31 and electrically connected, that is, it shares an input port and an output port with the PID controller 31. In the present invention, the vibration suppression compensator 32 can receive the speed error signal 43 and execute a compensation gain program on the input speed error signal 43 to generate a compensation torque command 45. In the present invention, when the electric vehicle has abnormal torsion or vibration, the motor control system 3 will combine the basic torque command 44 generated by the PID controller 31 with the compensation torque generated by the vibration suppression compensator 32 The command 45 is added together to be the final output torque command 46, that is, the basic torque command 44 is compensated by the compensation torque command 45. In this way, the compensation torque command 45 in the output torque command 46 is used to eliminate the abnormal torsion and vibration caused by the nonlinear characteristics of the transmission member during the operation of the electric vehicle.

具體地,於將本發明的電機控制系統3設置於任一電動載具後,駕駛人可對電動載具進行乘坐測試,藉此得出電動載具運行時會出現所述異常扭轉、震動現象的一個特定速度或一速度區間,稍後詳述。Specifically, after the motor control system 3 of the present invention is installed on any electric vehicle, the driver can conduct a ride test on the electric vehicle, thereby obtaining the abnormal torsion and vibration phenomena when the electric vehicle is running. A specific speed or a range of speeds, as detailed later.

於一實施例中,駕駛人可以在測試完畢後對電機控制系統3設定一個致能準位(例如圖3與圖4所示的致能準位6),即,將此致能準位6設定為前述測試出的電動載具運行時會出現異常扭轉、震動現象的一特定速度或一速度區間。於電動載具運行時震動抑制補償器32會持續由感測器處接收馬達轉速42,並且判斷馬達轉速42是否小於預設的致能準位6。當馬達轉速42小於預設的致能準位6時,表示電動載具即將出現或已經出現異常扭轉、震動現象,即,電動載具內的傳動機構的齒輪(圖未繪示)即將進入或已經進入會產生非線性特性的死區。In one embodiment, the driver can set an enabling level (for example, the enabling level 6 shown in FIGS. 3 and 4) to the motor control system 3 after the test is completed, that is, setting the enabling level 6 It is a specific speed or a speed range at which abnormal torsion and vibration occurs when the electric vehicle tested above is running. When the electric vehicle is running, the vibration suppression compensator 32 continuously receives the motor speed 42 from the sensor, and determines whether the motor speed 42 is less than the preset enable level 6. When the motor speed 42 is less than the preset enable level 6, it means that the electric vehicle is about to appear or has abnormal torsion and vibration, that is, the gear of the transmission mechanism in the electric vehicle (not shown) is about to enter or Has entered a dead zone that will produce nonlinear characteristics.

為解決上述問題,本發明的震動抑制補償器32會在判斷馬達轉速42小於所述致能準位6時,將其產出的一輸出量設定為所產生的補償轉矩命令45。此時,電機控制系統3的輸出轉矩命令46的值即等於基礎轉矩命令44與補償轉矩命令45的運算之和。換句話說,本發明的電機控制系統3藉由補償轉矩命令45的值來抑制因為電動載具內的傳動機構的齒輪進入上述死區而造成的異常扭轉、震動現象。In order to solve the above-mentioned problem, the vibration suppression compensator 32 of the present invention will set an output produced by it as the generated compensation torque command 45 when judging that the motor speed 42 is less than the enable level 6. At this time, the value of the output torque command 46 of the motor control system 3 is equal to the calculated sum of the basic torque command 44 and the compensation torque command 45. In other words, the motor control system 3 of the present invention compensates for the value of the torque command 45 to suppress abnormal torsion and vibration caused by the gears of the transmission mechanism in the electric vehicle entering the dead zone.

另外,當震動抑制補償器32判斷馬達轉速42不小於所述致能準位6時,即大於或等於所述致能準位6時,則會將其輸出量直接設定為0。此時,即使電機控制系統3基於所述基礎轉矩命令44與震動抑制補償器32的輸出量的運算之和來產生輸出轉矩命令46,但此時輸出轉矩命令46的值仍會相等於基礎轉矩命令44的值。換句話說,在馬達轉速42不小於所述致能準位6時,代表電動載具內的傳動機構的齒輪尚未進入上述死區,電動載具尚未出現所述異常扭轉、震動現象,因此沒有對基礎轉矩命令44進行補償的必要,即,此時不進行補償。In addition, when the vibration suppression compensator 32 determines that the motor speed 42 is not less than the enable level 6, that is, when it is greater than or equal to the enable level 6, it will directly set its output to zero. At this time, even if the motor control system 3 generates the output torque command 46 based on the calculated sum of the basic torque command 44 and the output of the vibration suppression compensator 32, the value of the output torque command 46 will still be the same at this time. Equal to the value of base torque command 44. In other words, when the motor speed 42 is not less than the enabling level 6, the gears representing the transmission mechanism in the electric vehicle have not yet entered the dead zone, and the electric vehicle has not yet experienced the abnormal torsion and vibration phenomenon, so there is no It is necessary to compensate the basic torque command 44, that is, no compensation is performed at this time.

於一實施例中,震動抑制補償器32可以只在判斷馬達轉速42小於所述致能準位6時才對輸入速度誤差訊號43執行補償增益程序並產生補償轉矩命令45,而於判斷馬達轉速42不小於所述致能準位6時則不執行所述補償增益程序而直接將其輸出量設定為0。藉此,可以有效節省系統效能。In one embodiment, the vibration suppression compensator 32 can execute the compensation gain program on the input speed error signal 43 and generate the compensation torque command 45 only when it determines that the motor speed 42 is less than the enable level 6, and then determines the motor When the speed 42 is not less than the enable level 6, the compensation gain program is not executed and the output is directly set to 0. In this way, system performance can be effectively saved.

於另一實施例中,震動抑制補償器32可持續對輸入速度誤差訊號43執行補償增益程序並持續產生補償轉矩命令45,但只在馬達轉速42小於所述致能準位6時才輸出所產生的補償轉矩命令45。藉此,可以有效提昇系統的補償效率。In another embodiment, the vibration suppression compensator 32 can continue to execute the compensation gain program on the input speed error signal 43 and continue to generate the compensation torque command 45, but only output when the motor speed 42 is less than the enable level 6 The generated compensation torque command 45. In this way, the compensation efficiency of the system can be effectively improved.

本發明中,電機控制系統3是將PID控制器31的基礎轉矩命令44與震動抑制補償器32的輸出量(即,0或補償轉矩命令45)相加,以產生最終的輸出轉矩命令46,藉此依據輸出轉矩命令46控制電動載具後方的電機構件5的運轉。本實施例中,所述電機構件5與電機控制系統3電性連接,但不加以限定。In the present invention, the motor control system 3 adds the basic torque command 44 of the PID controller 31 and the output of the vibration suppression compensator 32 (ie, 0 or compensation torque command 45) to generate the final output torque The command 46 is used to control the operation of the motor member 5 behind the electric vehicle according to the output torque command 46. In this embodiment, the motor component 5 is electrically connected to the motor control system 3, but it is not limited.

續請參閱圖3,其為本發明的震動抑制補償器的方塊圖的第一具體實施例。於圖3的實施例中,震動抑制補償器32主要可以硬體或軟體或混合配置的方式來實現,並且依據所執行的功能區分為多個部分,包括一低通濾波器321、一處理器322、一增益器323及一比較器324。Please continue to refer to FIG. 3, which is a first specific embodiment of the block diagram of the vibration suppression compensator of the present invention. In the embodiment of FIG. 3, the vibration suppression compensator 32 can be mainly implemented in hardware or software or a mixed configuration, and is divided into multiple parts according to the functions performed, including a low-pass filter 321 and a processor 322, a gainer 323 and a comparator 324.

所述低通濾波器321接收輸入速度誤差訊號43,並且對輸入速度誤差訊號43進行濾波處理,以取出輸入速度誤差訊號43的一訊號低頻部分。所述處理器322接收輸入速度誤差訊號43,並且由低通濾波器321處接收輸入速度誤差訊號43的訊號低頻部分,再將輸入速度誤差訊號43與訊號低頻部分相減,藉此取出輸入速度誤差訊號43的一訊號高頻部分431。本發明中,駕駛人可自行設定所述低通濾波器321所採用的頻寬,藉此確保處理器322運算所得的訊號保留了輸入速度誤差訊號43的訊號高頻部分431。The low-pass filter 321 receives the input speed error signal 43 and performs filtering processing on the input speed error signal 43 to extract a low frequency part of the input speed error signal 43. The processor 322 receives the input speed error signal 43, and the low-pass filter 321 receives the low-frequency part of the input speed error signal 43, and then subtracts the input speed error signal 43 from the low-frequency part of the signal, thereby extracting the input speed The high frequency part 431 of the error signal 43 is a signal. In the present invention, the driver can set the bandwidth used by the low-pass filter 321 by himself, thereby ensuring that the signal calculated by the processor 322 retains the high frequency part 431 of the input speed error signal 43.

所述增益器323接收處理器322所生成的訊號高頻部分431,並且對訊號高頻部分431進行補償增益,以產生所述補償轉矩命令45。The gainer 323 receives the high frequency part 431 of the signal generated by the processor 322 and compensates the high frequency part 431 of the signal to generate the compensation torque command 45.

具體地,本發明先濾除了輸入速度誤差訊號43的訊號低頻部分,並且僅對輸入速度誤差訊號43的訊號高頻部分431執行補償增益,藉此可令所產生的補償轉矩命令45更直接地反應所接收的輸入速度誤差訊號43。值得一提的是,不同的電動載具,其輸入速度誤差訊號43與最終的輸出轉矩命令46的對應關係也會有所不同。因此,本發明令駕駛人可自行設定震動抑制補償器32內的增益器323所採用的一增益值,藉此讓本發明的電機控制系統3可輕易適用於各種不同類型的電動載具。Specifically, the present invention first filters out the low-frequency part of the input speed error signal 43, and only performs compensation gain on the high-frequency part 431 of the input speed error signal 43, thereby making the generated compensation torque command 45 more direct. The ground reflects the received input speed error signal 43. It is worth mentioning that for different electric vehicles, the corresponding relationship between the input speed error signal 43 and the final output torque command 46 will also be different. Therefore, the present invention allows the driver to set a gain value used by the gain 323 in the vibration suppression compensator 32 by himself, so that the motor control system 3 of the present invention can be easily applied to various types of electric vehicles.

並且,本實施例中的震動抑制補償器32可進一步通過比較器324接收電動載具的馬達轉速42以及所述致能準位6,並且將馬達轉速42與致能準位6進行比較,以判斷要將震動抑制補償器32的輸出量設定為0,或是設定為所產生的補償轉矩命令45。Moreover, the vibration suppression compensator 32 in this embodiment may further receive the motor speed 42 of the electric vehicle and the enable level 6 through the comparator 324, and compare the motor speed 42 with the enable level 6 to It is determined whether the output of the vibration suppression compensator 32 is to be set to 0 or to the generated compensation torque command 45.

如上所述,不同的電動載具有不同的傳動系統配置,其會使得齒輪進入死區而出現異常扭轉或震動現象的速度或速域皆不相同。因此,本發明令駕駛人可自行設定震動抑制補償器32內的比較器324所採用的致能準位6(即,自行設定的特定速度或速度區間),藉此讓本發明的電機控制系統3可輕易適用於各種不同類型的電動載具。As mentioned above, different electric loads have different transmission system configurations, which will cause the gears to enter the dead zone and cause abnormal torsion or vibration in the speed or speed range. Therefore, the present invention allows the driver to set the enable level 6 used by the comparator 324 in the vibration suppression compensator 32 (that is, the specific speed or speed range set by himself), thereby enabling the motor control system of the present invention 3 It can be easily applied to various types of electric vehicles.

於一實施例中,震動抑制補償器32主要是於馬達轉速42不小於致能準位6時(即,電動載具的速度不低於會出現異常扭轉或震動現象的速度)將輸出量設定為0,並且於馬達轉速42小於致能準位6時(即,電動載具的速度低於會出現異常扭轉或震動現象的速度)將輸出量設定為補償轉矩命令45。換句話說,當馬達轉速42不小於致能準位6時,即大於或等於致能準位6時,電機控制系統3的輸出轉矩命令46的內容為基礎轉矩命令44與0的運算之和,即,單純為基礎轉矩命令44,此時不作補償;而當馬達轉速42小於致能準位6時,電機控制系統3的輸出轉矩命令46的值為基礎轉矩命令44與補償轉矩命令45的運算之和。In one embodiment, the vibration suppression compensator 32 mainly sets the output when the motor speed 42 is not less than the enable level 6 (that is, the speed of the electric vehicle is not lower than the speed at which abnormal torsion or vibration occurs) When the motor speed 42 is less than the enable level 6 (ie, the speed of the electric vehicle is lower than the speed at which abnormal torsion or vibration may occur), the output is set as the compensation torque command 45. In other words, when the motor speed 42 is not less than the enable level 6, that is, greater than or equal to the enable level 6, the content of the output torque command 46 of the motor control system 3 is the calculation of the basic torque command 44 and 0 The sum, that is, it is simply the basic torque command 44, and no compensation is made at this time; and when the motor speed 42 is less than the enable level 6, the value of the output torque command 46 of the motor control system 3 is the basic torque command 44 and Compensation torque command 45 is the calculated sum.

如前文所述,本發明的震動抑制補償器32主要是對輸入速度誤差訊號43的訊號高頻部分進行補償增益。於其他實施例中,震動抑制補償器32亦可直接通過高通濾波器來對輸入速度誤差訊號43進行濾波處理。As mentioned above, the vibration suppression compensator 32 of the present invention mainly compensates and gains the high frequency part of the input speed error signal 43. In other embodiments, the vibration suppression compensator 32 can also directly filter the input speed error signal 43 through a high-pass filter.

參閱圖4,其為本發明的震動抑制補償器的方塊圖的第二具體實施例。圖4的實施例中的震動抑制補償器32’可由硬體或軟體或混合配置的方式來實現,並且依據所執行的功能區分為多個部分,包括一高通濾波器325、一增益器323及一比較器324。Refer to FIG. 4, which is a second specific embodiment of the block diagram of the vibration suppression compensator of the present invention. The vibration suppression compensator 32' in the embodiment of FIG. 4 can be implemented by hardware or software or a hybrid configuration, and is divided into multiple parts according to the functions performed, including a high-pass filter 325, a gainer 323 and A comparator 324.

本實施例中,震動抑制補償器32’由高通濾波器325接收輸入速度誤差訊號43,並且對輸入速度誤差訊號43進行濾波處理以直接取出輸入速度誤差訊號43的一訊號高頻部分431。相較於圖3的實施例,圖4所示實施例的震動抑制補償器32’不需另外設置一處理器322,並且可省略前述實施例將輸入速度誤差訊號43與訊號低頻部分進行相減的程序,因此可有效提高處理效率。In this embodiment, the vibration suppression compensator 32' receives the input speed error signal 43 through the high-pass filter 325, and filters the input speed error signal 43 to directly extract a signal high frequency part 431 of the input speed error signal 43. Compared with the embodiment of FIG. 3, the vibration suppression compensator 32' of the embodiment shown in FIG. 4 does not need to be additionally provided with a processor 322, and the foregoing embodiment can be omitted to subtract the input speed error signal 43 from the low frequency part of the signal. Therefore, the processing efficiency can be effectively improved.

本發明中,駕駛人可自行設定所述高通濾波器325所採用的頻寬,藉此確保高通濾波器325處理後的訊號保留了輸入速度誤差訊號43的訊號高頻部分431。In the present invention, the driver can set the bandwidth used by the high-pass filter 325 by himself, so as to ensure that the signal processed by the high-pass filter 325 retains the high frequency part 431 of the input speed error signal 43.

值得一提的是,由於圖3中的震動抑制補償器32是先擷取出輸入速度誤差訊號43的訊號低頻部分,再從原始的輸入速度誤差訊號43中刪除訊號低頻部分以取得訊號高頻部分431,因此所得到的訊號高頻部分431的雜訊相對會少於圖4的震動抑制補償器32’直接藉由高通濾波器325所得到的訊號高頻部分431的雜訊。It is worth mentioning that the vibration suppression compensator 32 in Figure 3 first extracts the low-frequency part of the input speed error signal 43, and then deletes the low-frequency part of the signal from the original input speed error signal 43 to obtain the high-frequency part of the signal. 431, therefore, the noise of the high-frequency part 431 of the obtained signal is relatively less than the noise of the high-frequency part 431 of the signal obtained by the vibration suppression compensator 32' of FIG. 4 directly through the high-pass filter 325.

與圖3所示的實施例相似,圖4示意及所述實施例中增益器323會接收高通濾波器325過濾後所生成的訊號高頻部分431,並且對訊號高頻部分431進行補償增益,以產生所述補償轉矩命令45。並且,震動抑制補償器32’通過比較器324接收電動載具的馬達轉速42以及所述致能準位6,並且將馬達轉速42與致能準位6進行比較,以判斷要將震動抑制補償器32’的輸出量設定為0,或是設定為所產生的補償轉矩命令45。Similar to the embodiment shown in FIG. 3, the gainer 323 in FIG. 4 and the described embodiment receives the high-frequency part 431 of the signal generated after filtering by the high-pass filter 325, and compensates the high-frequency part 431 of the signal. To generate the compensation torque command 45. In addition, the vibration suppression compensator 32' receives the motor speed 42 of the electric vehicle and the enable level 6 through the comparator 324, and compares the motor speed 42 with the enable level 6 to determine whether to compensate for the vibration suppression The output of the device 32' is set to 0, or set to the generated compensation torque command 45.

相似地,於圖4的實施例中,震動抑制補償器32’是於馬達轉速42不小於致能準位6時將輸出量設定為0,並且於馬達轉速42小於致能準位6時將輸出量設定為補償轉矩命令45。Similarly, in the embodiment of FIG. 4, the vibration suppression compensator 32' sets the output to 0 when the motor speed 42 is not less than the enable level 6, and when the motor speed 42 is less than the enable level 6 The output quantity is set to compensation torque command 45.

參閱圖5,其為震動抑制補償器設置前、後的訊號比對圖。Refer to Figure 5, which is a signal comparison diagram before and after the vibration suppression compensator is set.

圖5(a)顯示了沒有應用本發明的震動抑制補償器32的電動載具的實驗數據。由圖5(a)可看出,當轉矩命令72下降時馬達轉速71會跟著下降,而當馬達轉速71下降至某個數值時,會出現嚴重的轉速漣波(圖式右側)。這些漣波會令電動載具出現前述的異常扭轉或震動現象,進而造成駕駛人乘坐上的不舒服及電動載具的不穩定。Fig. 5(a) shows the experimental data of the electric vehicle without applying the vibration suppression compensator 32 of the present invention. It can be seen from Fig. 5(a) that when the torque command 72 drops, the motor speed 71 will decrease, and when the motor speed 71 drops to a certain value, severe speed ripples (right side of the figure) will appear. These ripples can cause the aforementioned abnormal torsion or vibration of the electric vehicle, which in turn causes the driver's uncomfortable ride and the instability of the electric vehicle.

圖5(b)顯示應用了本發明的震動抑制補償器32或32’的電動載具的實驗數據。由圖5(b)可明顯看出當轉矩命令82下降時馬達轉速81會跟著下降,只有當馬達轉速81下降至某個數值的瞬間會出現少許的轉速漣波(圖式右側),而之後馬達轉速81可以平穩地下降至零。由此可看出,藉由本發明的震動抑制補償器32、32’,電動載具的異常扭轉或震動將可被有效地抑制,進而改善駕駛人的乘坐感。Fig. 5(b) shows the experimental data of the electric vehicle to which the vibration suppression compensator 32 or 32' of the present invention is applied. It can be clearly seen from Figure 5(b) that when the torque command 82 decreases, the motor speed 81 will also decrease. Only when the motor speed 81 drops to a certain value, there will be a little speed ripple (right side of the diagram). After that, the motor speed 81 can smoothly drop to zero. It can be seen that, with the vibration suppression compensator 32, 32' of the present invention, the abnormal torsion or vibration of the electric vehicle can be effectively suppressed, thereby improving the rider feeling of the driver.

續請參閱圖6,其為本發明的震動抑制方法的流程圖。圖6具體揭露了本發明的電機控制系統的震動抑制方法,應用於一電動載具(基於版面簡潔,下面將於說明書中統一簡稱為震動抑制方法),所述震動抑制方法主要是應用於如圖2所示的電機控制系統3,並且所述電機控制系統3設置於任一電動載具中,與電動載具中的電機構件5電性連接,並控制電機構件5的運轉。Please continue to refer to FIG. 6, which is a flowchart of the vibration suppression method of the present invention. Figure 6 specifically discloses the vibration suppression method of the motor control system of the present invention, which is applied to an electric vehicle (based on the concise layout, and will be referred to as the vibration suppression method in the manual below). The vibration suppression method is mainly applied to The motor control system 3 shown in FIG. 2 is provided in any electric vehicle, electrically connected to the motor component 5 in the electric vehicle, and controls the operation of the motor component 5.

如圖6所示,本發明中,電動載具是通過本發明的電機控制系統3中的PID控制器31來接收電動載具的輸入速度誤差訊號43(步驟S10),並且由PID控制器31對所接收的輸入速度誤差訊號43進行計算,以產生基礎轉矩命令44(步驟S12)。具體地,步驟S10中主要是由電機控制系統3接收電動載具本身的速度訊號41及馬達轉速42,並且將速度訊號41及馬達轉速42相減,以取得所述輸入速度誤差訊號43。As shown in FIG. 6, in the present invention, the electric vehicle receives the input speed error signal 43 of the electric vehicle through the PID controller 31 in the motor control system 3 of the present invention (step S10), and the PID controller 31 The received input speed error signal 43 is calculated to generate the basic torque command 44 (step S12). Specifically, in step S10, the motor control system 3 mainly receives the speed signal 41 and the motor speed 42 of the electric vehicle itself, and subtracts the speed signal 41 and the motor speed 42 to obtain the input speed error signal 43.

並且,電機控制系統3還通過內部的震動抑制補償器32接收所述輸入速度誤差訊號43以及電動載具本身的馬達轉速42(步驟S14),並且對輸入速度誤差訊號43進行補償增益,以產生補償轉矩命令45(步驟S16)。In addition, the motor control system 3 also receives the input speed error signal 43 and the motor speed 42 of the electric vehicle itself through the internal vibration suppression compensator 32 (step S14), and performs a compensation gain on the input speed error signal 43 to generate Compensate the torque command 45 (step S16).

於一實施例中,電機控制系統3是採用如圖3所示的震動抑制補償器32。具體來說,震動抑制補償器32在步驟S16中是通過低通濾波器321對輸入速度誤差訊號43進行濾波處理,以取出輸入速度誤差訊號43的訊號低頻部分,並且再通過處理器322將輸入速度誤差訊號43與所述訊號低頻部分相減,以取出輸入速度誤差訊號43的訊號高頻部分431。接著,震動抑制補償器32再通過增益器323對訊號高頻部分431進行補償增益,以產生補償轉矩命令45。In one embodiment, the motor control system 3 uses a vibration suppression compensator 32 as shown in FIG. 3. Specifically, in step S16, the vibration suppression compensator 32 filters the input speed error signal 43 through the low-pass filter 321 to extract the low frequency part of the input speed error signal 43, and then passes the processor 322 to input The speed error signal 43 is subtracted from the low frequency part of the signal to extract the high frequency part 431 of the input speed error signal 43. Then, the vibration suppression compensator 32 performs a compensation gain on the signal high frequency part 431 through the gainer 323 to generate a compensation torque command 45.

於另一實施例中,電機控制系統3是採用如圖4所示的震動抑制補償器32’。具體來說,震動抑制補償器32’在步驟S16中是通過高通濾波器325對輸入速度誤差訊號43進行濾波處理,以直接取出輸入速度誤差訊號43的訊號高頻部分431。並且,震動抑制補償器32’再通過增益器323對訊號高頻部分431進行補償增益,以產生補償轉矩命令45。In another embodiment, the motor control system 3 uses a vibration suppression compensator 32' as shown in FIG. Specifically, in step S16, the vibration suppression compensator 32' filters the input speed error signal 43 through the high-pass filter 325 to directly extract the high frequency part 431 of the input speed error signal 43. In addition, the vibration suppression compensator 32' then uses the gainer 323 to compensate the high frequency part 431 of the signal to generate a compensation torque command 45.

步驟S16後,震動抑制補償器32、32’進一步判斷電動載具當前的馬達轉速42是否小於預設的致能準位6(步驟S18),例如,震動抑制補償器32、32’可通過如圖3、圖4所示的比較器324來比較馬達轉速42與致能準位6。並且,震動抑制補償器32、32’會在判斷馬達轉速42小於致能準位6時設定其輸出量為所述補償轉矩命令45(步驟S20),而在判斷馬達轉速42不小於致能準位6時設定其輸出量為0(步驟S22)。After step S16, the vibration suppression compensator 32, 32' further determines whether the current motor speed 42 of the electric vehicle is less than the preset enable level 6 (step S18). For example, the vibration suppression compensator 32, 32' can pass as The comparator 324 shown in FIG. 3 and FIG. 4 compares the motor speed 42 with the enable level 6. In addition, the vibration suppression compensator 32, 32' will set its output to the compensation torque command 45 when judging that the motor speed 42 is less than the enabling level 6 (step S20), and when judging that the motor speed 42 is not less than the enabling level 6, When the level is 6, the output is set to 0 (step S22).

接著,電機控制系統3將所述基礎轉矩命令44與震動抑制補償器32的輸出量(即,步驟S22的0或步驟S20的補償轉矩命令45)相加,以產生最終的輸出轉矩命令46(步驟S24),並且將輸出轉矩命令46傳送至電動載具的電機構件5,以控制電機構件5的運轉(步驟S26)。Next, the motor control system 3 adds the basic torque command 44 and the output of the vibration suppression compensator 32 (ie, 0 in step S22 or the compensation torque command 45 in step S20) to generate the final output torque Command 46 (step S24), and transmit the output torque command 46 to the motor component 5 of the electric vehicle to control the operation of the motor component 5 (step S26).

本發明中,電機控制系統3會持續判斷電動載具是否關閉(步驟S28),並且於電動載具關閉前持續及重複執行步驟S10至步驟S26,以持續對電動載具的輸出轉矩命令46進行補償,藉此避免電動載具出現異常扭轉或震動現象而影響駕駛人的乘坐感。In the present invention, the motor control system 3 will continue to determine whether the electric vehicle is closed (step S28), and continue and repeat steps S10 to S26 before the electric vehicle is closed to continuously output torque commands to the electric vehicle 46 Compensation is carried out to avoid abnormal torsion or vibration of the electric vehicle and affect the rider's feeling.

通過本發明的技術方案,電動載具可以藉由震動抑制補償器32、32’來抑制因為傳動機構的非線性特性而產生的異常扭轉與震動,藉此提升電動載具的乘坐舒適性。並且,駕駛人可以依據電動載具的種類來對震動抑制補償器32、32’中的低通濾波器321、高通濾波器325所採用的頻寬、增益器323所採用的增益值以及致能準位6等進行個別調整,藉此令本發明的震動抑制補償器32、32’以及震動抑制方法可輕易地適用於各種不同類型的電動載,相當便利且具有彈性。With the technical solution of the present invention, the electric vehicle can suppress abnormal torsion and vibration caused by the nonlinear characteristics of the transmission mechanism by the vibration suppression compensator 32, 32', thereby improving the riding comfort of the electric vehicle. In addition, the driver can determine the bandwidth used by the low-pass filter 321 and the high-pass filter 325 in the vibration suppression compensator 32, 32', the gain value used by the gainer 323, and the enable according to the type of electric vehicle. The level 6 etc. are adjusted individually, so that the vibration suppression compensator 32, 32' and the vibration suppression method of the present invention can be easily applied to various types of electric loads, which is quite convenient and flexible.

以上所述僅為本發明之較佳具體實例,非因此即侷限本發明之專利範圍,故舉凡運用本發明內容所為之等效變化,均同理皆包含於本發明之範圍內,合予陳明。The above are only preferred specific examples of the present invention, and are not limited to the scope of the patent of the present invention. Therefore, all equivalent changes made by using the content of the present invention are included in the scope of the present invention in the same way. Bright.

11:PID控制器11: PID controller

12:輸入速度誤差訊號12: Input speed error signal

13:轉矩命令13: Torque command

2:齒輪2: gear

3:電機控制系統3: Motor control system

31:PID控制器31: PID controller

32、32’:震動抑制補償器32, 32’: Vibration suppression compensator

321:低通濾波器321: low pass filter

322:處理器322: processor

323:增益器323: Gainer

324:比較器324: Comparator

325:高通濾波器325: high pass filter

41:速度訊號41: Speed signal

42:馬達轉速42: Motor speed

43:輸入速度誤差訊號43: Input speed error signal

431:訊號高頻部分431: signal high frequency part

44:基礎轉矩命令44: Basic torque command

45:補償轉矩命令45: Compensation torque command

46:輸出轉矩命令46: Output torque command

5:電機構件5: Motor components

6:致能準位6: Enable level

71、81:馬達轉速71, 81: Motor speed

72、82:轉矩命令72, 82: Torque command

W:齒隙距離W: Backlash distance

S10~S28:控制步驟S10~S28: Control steps

圖1A為速度控制模式的電動載具的方塊圖。Figure 1A is a block diagram of an electric vehicle in a speed control mode.

圖1B為齒輪的非線性死區的示意圖。Figure 1B is a schematic diagram of the non-linear dead zone of the gear.

圖2為本發明的電機控制系統的方塊圖。Figure 2 is a block diagram of the motor control system of the present invention.

圖3為本發明的震動抑制補償器的方塊圖的第一具體實施例。Fig. 3 is a first embodiment of the block diagram of the vibration suppression compensator of the present invention.

圖4為本發明的震動抑制補償器的方塊圖的第二具體實施例。FIG. 4 is a second embodiment of the block diagram of the vibration suppression compensator of the present invention.

圖5為震動抑制補償器設置前、後的訊號比對圖。Figure 5 shows the signal comparison diagram before and after the vibration suppression compensator is set.

圖6為本發明的震動抑制方法的流程圖。Fig. 6 is a flowchart of the vibration suppression method of the present invention.

3:電機控制系統 3: Motor control system

31:PID控制器 31: PID controller

32:震動抑制補償器 32: Vibration suppression compensator

41:速度訊號 41: Speed signal

42:馬達轉速 42: Motor speed

43:輸入速度誤差訊號 43: Input speed error signal

44:基礎轉矩命令 44: Basic torque command

45:補償轉矩命令 45: Compensation torque command

46:輸出轉矩命令 46: Output torque command

5:電機構件 5: Motor components

Claims (9)

一種電機控制系統,應用於一電動載具,包括: 一比例積分微分(Proportional-Integral-Derivative, PID)控制器,接收該電動載具的一輸入速度誤差訊號,對該輸入速度誤差訊號進行計算以產生一基礎轉矩命令;以及 一震動抑制補償器,與該PID控制器並聯設置,接收該輸入速度誤差訊號及該電動載具的一馬達轉速,對該輸入速度誤差訊號進行補償增益以產生一補償轉矩命令; 其中,該震動抑制補償器於判斷該馬達轉速不小於預設的一致能準位時設定一輸出量為0,於判斷該馬達轉速小於該致能準位時設定該輸出量為該補償轉矩命令; 其中,該電機控制系統將該基礎轉矩命令與該震動抑制補償器的該輸出量相加以產生一輸出轉矩命令,並依據該輸出轉矩命令控制該電動載具的一電機構件的運轉。 A motor control system applied to an electric vehicle, including: A Proportional-Integral-Derivative (PID) controller receives an input speed error signal of the electric vehicle, and calculates the input speed error signal to generate a basic torque command; and A vibration suppression compensator, arranged in parallel with the PID controller, receives the input speed error signal and a motor speed of the electric vehicle, and compensates the input speed error signal to generate a compensation torque command; Wherein, the vibration suppression compensator sets an output value to 0 when judging that the motor speed is not less than the preset consistent energy level, and sets the output value as the compensation torque when judging that the motor speed is less than the enable level command; Wherein, the motor control system adds the basic torque command and the output of the vibration suppression compensator to generate an output torque command, and controls the operation of a motor component of the electric vehicle according to the output torque command. 如請求項1所述的電機控制系統,其中該震動抑制補償器包括: 一低通濾波器,對該輸入速度誤差訊號進行濾波處理以取出該輸入速度誤差訊號的一訊號低頻部分; 一處理器,將該輸入速度誤差訊號與該訊號低頻部分相減以取出該輸入速度誤差訊號的一訊號高頻部分; 一增益器,對該訊號高頻部分進行補償增益以產生該補償轉矩命令;以及 一比較器,比較該馬達轉速與該致能準位。 The motor control system according to claim 1, wherein the vibration suppression compensator includes: A low-pass filter for filtering the input speed error signal to extract a low frequency part of the input speed error signal; A processor, subtracting the input speed error signal from the low frequency part of the signal to extract a high frequency part of the input speed error signal; A gainer to compensate the high frequency part of the signal to generate the compensation torque command; and A comparator compares the rotation speed of the motor with the enable level. 如請求項1所述的電機控制系統,其中該震動抑制補償器包括: 一高通濾波器,對該輸入速度誤差訊號進行濾波處理以取出該輸入速度誤差訊號的一訊號高頻部分; 一增益器,對該訊號高頻部分進行補償增益以產生該補償轉矩命令;以及 一比較器,比較該馬達轉速與該致能準位。 The motor control system according to claim 1, wherein the vibration suppression compensator includes: A high-pass filter for filtering the input speed error signal to extract a high frequency part of the input speed error signal; A gainer to compensate the high frequency part of the signal to generate the compensation torque command; and A comparator compares the rotation speed of the motor with the enable level. 如請求項1所述的電機控制系統,其中該PID控制器為將一微分單元的參數設定為零的一PI控制器。The motor control system according to claim 1, wherein the PID controller is a PI controller that sets a parameter of a differential unit to zero. 一種電機控制系統的震動抑制方法,應用於一電動載具中的一電機控制系統,並且包括下列步驟: a)由該電機控制系統中的一比例積分微分(Proportional-Integral-Derivative, PID)控制器接收該電動載具的一輸入速度誤差訊號; b)由該PID控制器對該輸入速度誤差訊號進行計算以產生一基礎轉矩命令; c)由該電機控制系統中的一震動抑制補償器接收該輸入速度誤差訊號及該電動載具的一馬達轉速; d)由該震動抑制補償器對該輸入速度誤差訊號進行補償增益以產生一補償轉矩命令; e)該震動抑制補償器於判斷該馬達轉速不小於預設的一致能準位時設定一輸出量為0,於判斷該馬達轉速小於該致能準位時設定該輸出量為該補償轉矩命令; f)由該電機控制系統將該基礎轉矩命令與該震動抑制補償器的該輸出量相加以產生一輸出轉矩命令; g)由該電機控制系統將該輸出轉矩命令傳送至該電動載具的一電機構件以控制該電機構件的運轉;以及 h)由該電機控制系統持續判斷該電動載具是否關閉,並於該電動載具關閉前持續執行該步驟a)至該步驟g)。 A vibration suppression method for a motor control system is applied to a motor control system in an electric vehicle, and includes the following steps: a) A Proportional-Integral-Derivative (PID) controller in the motor control system receives an input speed error signal of the electric vehicle; b) The PID controller calculates the input speed error signal to generate a basic torque command; c) A vibration suppression compensator in the motor control system receives the input speed error signal and a motor speed of the electric vehicle; d) The input speed error signal is compensated by the vibration suppression compensator to generate a compensation torque command; e) The vibration suppression compensator sets an output value to 0 when judging that the motor speed is not less than the preset consistent energy level, and sets the output value as the compensation torque when judging that the motor speed is less than the enable level command; f) The motor control system adds the basic torque command and the output of the vibration suppression compensator to generate an output torque command; g) The motor control system transmits the output torque command to a motor component of the electric vehicle to control the operation of the motor component; and h) The motor control system continuously determines whether the electric vehicle is closed, and continues to execute the steps a) to g) before the electric vehicle is closed. 如請求項5所述的電機控制系統的震動抑制方法,其中該步驟a)是由該電機控制系統接收該電動載具的一速度訊號及該馬達轉速,並將該速度訊號與該馬達轉速相減以取得該輸入速度誤差訊號。The vibration suppression method of a motor control system according to claim 5, wherein the step a) is that the motor control system receives a speed signal of the electric vehicle and the motor speed, and compares the speed signal with the motor speed Subtract to obtain the input speed error signal. 如請求項5所述的電機控制系統的震動抑制方法,其中該步驟d)包括下列步驟: d11)通過該震動抑制補償器的一低通濾波器對該輸入速度誤差訊號進行濾波處理,以取出該輸入速度誤差訊號的一訊號低頻部分; d12)通過該震動抑制補償器的一處理器將該輸入速度誤差訊號與該訊號低頻部分相減,以取出該輸入速度誤差訊號的一訊號高頻部分;以及 d13)通過該震動抑制補償器的一增益器對該訊號高頻部分進行補償增益以產生該補償轉矩命令; 其中,該步驟e)是通過該震動抑制補償器的一比較器比較該馬達轉速與該致能準位。 The vibration suppression method of the motor control system according to claim 5, wherein the step d) includes the following steps: d11) filtering the input speed error signal through a low-pass filter of the vibration suppression compensator to extract a low-frequency part of the input speed error signal; d12) Subtracting the input speed error signal from the low-frequency part of the signal by a processor of the vibration suppression compensator to extract a high-frequency part of the input speed error signal; and d13) Compensating the high frequency part of the signal through a gainer of the vibration suppression compensator to generate the compensation torque command; Wherein, the step e) is to compare the rotation speed of the motor with the enable level by a comparator of the vibration suppression compensator. 如請求項5所述的電機控制系統的震動抑制方法,其中該步驟d)包括下列步驟: d21)通過該震動抑制補償器的一高通濾波器對該輸入速度誤差訊號進行濾波處理,以取出該輸入速度誤差訊號的一訊號高頻部分;以及 d23)通過該震動抑制補償器的一增益器對該訊號高頻部分進行補償增益,以產生該補償轉矩命令; 其中,該步驟e)是通過該震動抑制補償器的一比較器比較該馬達轉速與該致能準位。 The vibration suppression method of the motor control system according to claim 5, wherein the step d) includes the following steps: d21) filtering the input speed error signal through a high-pass filter of the vibration suppression compensator to extract a high frequency part of the input speed error signal; and d23) Compensating the high-frequency part of the signal through a gainer of the vibration suppression compensator to generate the compensation torque command; Wherein, the step e) is to compare the rotation speed of the motor with the enable level by a comparator of the vibration suppression compensator. 如請求項5所述的電機控制系統的震動抑制方法,其中該致能準位為該電動載具的一特定速度或一速度區間。The vibration suppression method of the motor control system according to claim 5, wherein the enable level is a specific speed or a speed range of the electric vehicle.
TW109105406A 2020-02-20 2020-02-20 Electric motor controlling system and vibration restraining method for using the same TWI703808B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
TW109105406A TWI703808B (en) 2020-02-20 2020-02-20 Electric motor controlling system and vibration restraining method for using the same

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
TW109105406A TWI703808B (en) 2020-02-20 2020-02-20 Electric motor controlling system and vibration restraining method for using the same

Publications (2)

Publication Number Publication Date
TWI703808B true TWI703808B (en) 2020-09-01
TW202133542A TW202133542A (en) 2021-09-01

Family

ID=73644077

Family Applications (1)

Application Number Title Priority Date Filing Date
TW109105406A TWI703808B (en) 2020-02-20 2020-02-20 Electric motor controlling system and vibration restraining method for using the same

Country Status (1)

Country Link
TW (1) TWI703808B (en)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW516263B (en) * 1998-07-16 2003-01-01 Seiko Epson Corp Method for controlling a position sensorless motor and its control device, and method and device for frequency-to-voltage conversion which is mainly used for position sensorless motor
CN105490603A (en) * 2015-12-28 2016-04-13 浙江科技学院 Electromagnetic vibration control method for wheel hub side of electric car driven by wheel hub motor
TW201830846A (en) * 2016-11-09 2018-08-16 美商微晶片科技公司 System and method for starting synchronous motors
CN109120189A (en) * 2018-09-05 2019-01-01 固高科技(深圳)有限公司 A kind of more motor intersection synchronous control systems
US20200052636A1 (en) * 2018-08-09 2020-02-13 AAC Technologies Pte. Ltd. Motor control system and method based on current feedback signal

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TW516263B (en) * 1998-07-16 2003-01-01 Seiko Epson Corp Method for controlling a position sensorless motor and its control device, and method and device for frequency-to-voltage conversion which is mainly used for position sensorless motor
CN105490603A (en) * 2015-12-28 2016-04-13 浙江科技学院 Electromagnetic vibration control method for wheel hub side of electric car driven by wheel hub motor
CN107565864A (en) * 2015-12-28 2018-01-09 浙江科技学院 A kind of method that electric automobile eliminates the pulsation of wheel hub motor electromagnetic torque
TW201830846A (en) * 2016-11-09 2018-08-16 美商微晶片科技公司 System and method for starting synchronous motors
US20200052636A1 (en) * 2018-08-09 2020-02-13 AAC Technologies Pte. Ltd. Motor control system and method based on current feedback signal
CN109120189A (en) * 2018-09-05 2019-01-01 固高科技(深圳)有限公司 A kind of more motor intersection synchronous control systems

Also Published As

Publication number Publication date
TW202133542A (en) 2021-09-01

Similar Documents

Publication Publication Date Title
JP4270079B2 (en) Driving force control device
JP5861554B2 (en) Vibration suppression control device for vehicle
JP5900609B2 (en) Electric vehicle control device and electric vehicle control method
US20170183031A1 (en) Steering control apparatus and steering control method
JP6229821B2 (en) Control device for electric power steering device
CN112208349B (en) Control method and device of electric automobile, control equipment and automobile
CN114248841B (en) Steering angle control method and system for automatic driving of vehicle
JP4419625B2 (en) Vehicle damping control device and vehicle damping control method
JP6364832B2 (en) Vibration suppression control device for vehicle
JP4935860B2 (en) Control device for electric vehicle
TWI703808B (en) Electric motor controlling system and vibration restraining method for using the same
JP2001037006A (en) Damping device for vehicle equipped with plural driving force sources
CN113364391B (en) Motor control system and vibration suppression method thereof
JP6877873B2 (en) Systems for controlling the rotational speed of electric motors in automobiles and corresponding methods
JP5880048B2 (en) Electric vehicle control method and electric vehicle control apparatus
JP6720714B2 (en) Electric vehicle control method and electric vehicle control device
JP3333477B2 (en) Throttle control device
JP5387138B2 (en) Control device for electric vehicle
US10352255B2 (en) System for controlling engine operating speed based on operating load
JP5262754B2 (en) Steering device and steering control method
JPH05252779A (en) Robot servo controller
KR20220048144A (en) Method for controlling driving force of vehicle
Naibiao et al. Electric power steering system controller design using induction machine
JPH06217579A (en) Motor controller
CN116691362A (en) Vehicle, active vibration damping control method thereof and vehicle controller