WO2021124603A1 - モータ制御装置、モータ制御方法 - Google Patents
モータ制御装置、モータ制御方法 Download PDFInfo
- Publication number
- WO2021124603A1 WO2021124603A1 PCT/JP2020/026988 JP2020026988W WO2021124603A1 WO 2021124603 A1 WO2021124603 A1 WO 2021124603A1 JP 2020026988 W JP2020026988 W JP 2020026988W WO 2021124603 A1 WO2021124603 A1 WO 2021124603A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- correction
- motor control
- control device
- data
- motor
- Prior art date
Links
- 238000000034 method Methods 0.000 title claims description 21
- 238000012937 correction Methods 0.000 claims abstract description 175
- 238000005259 measurement Methods 0.000 description 10
- 230000010365 information processing Effects 0.000 description 9
- 238000012545 processing Methods 0.000 description 8
- 238000006243 chemical reaction Methods 0.000 description 7
- NJPPVKZQTLUDBO-UHFFFAOYSA-N novaluron Chemical compound C1=C(Cl)C(OC(F)(F)C(OC(F)(F)F)F)=CC=C1NC(=O)NC(=O)C1=C(F)C=CC=C1F NJPPVKZQTLUDBO-UHFFFAOYSA-N 0.000 description 7
- 238000001514 detection method Methods 0.000 description 6
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000010586 diagram Methods 0.000 description 3
- 238000004519 manufacturing process Methods 0.000 description 2
- 239000004065 semiconductor Substances 0.000 description 2
- 102100036467 Protein delta homolog 1 Human genes 0.000 description 1
- 238000007796 conventional method Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 101150102995 dlk-1 gene Proteins 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000002184 metal Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
- G05B19/404—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form characterised by control arrangements for compensation, e.g. for backlash, overshoot, tool offset, tool wear, temperature, machine construction errors, load, inertia
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/14—Electronic commutators
- H02P6/16—Circuit arrangements for detecting position
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/0004—Control strategies in general, e.g. linear type, e.g. P, PI, PID, using robust control
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/14—Estimation or adaptation of motor parameters, e.g. rotor time constant, flux, speed, current or voltage
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/33—Director till display
- G05B2219/33218—Motor encoders, resolvers on common bus with drives, servo controllers
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P2203/00—Indexing scheme relating to controlling arrangements characterised by the means for detecting the position of the rotor
- H02P2203/03—Determination of the rotor position, e.g. initial rotor position, during standstill or low speed operation
Definitions
- the present invention relates to a motor control device and a motor control method.
- the present invention relates to a motor control device and a motor control method for controlling a motor using position information from an encoder.
- Servo motors are used, for example, in driving robots, metal processing machines, semiconductor manufacturing equipment, etc., and are required to operate more freely than ordinary motors. In particular, it is required to follow the user's command with high accuracy regarding the rotation speed, torque, and positioning.
- a servomotor is equipped with an encoder for monitoring the motor position, and the motor control device controls the position of the motor using the position information from the encoder.
- the user The position may be different from the intended position.
- Patent Document 1 is a conventional technique for improving the accuracy of positioning.
- Patent Document 1 discloses a system that enables highly accurate position control by a servomotor and a servomotor control device.
- Patent Document 1 in addition to the normal encoder attached to the servomotor, an expensive high-resolution encoder for absolute position measurement is used at the same time, and the position is utilized by utilizing the difference in the number of pulses between the encoder and the high-resolution encoder. It is disclosed that it is used for correction at the time of control.
- Patent Document 1 correction is performed on the premise that the value of the high-resolution encoder is absolutely correct, but in an actual device, the situation where the assembly error is completely 0 is extremely rare. , Correction using a high resolution encoder is not realistic. Further, since the high resolution encoder is expensive, there is a need to substitute another position measuring means. Further, in the actual use of the servomotor, there are many cases where the section requiring advanced position control does not start from the machine origin position, and the positioning control by the technique of Patent Document 1 is such. It is difficult to deal with the device.
- a motor control device that supplies power to a motor
- the motor control device includes a storage unit that stores position correction data and information on the machine origin position of the motor
- the motor control device is a motor control device.
- a position command input from the outside and the position correction data are used to generate a corrected position command, and the power supplied to the motor is converted based on the corrected position command and the position information input from the encoder.
- the position correction data is recorded in association with the correction position and the correction amount, and the start position of the correction position is different from the machine origin position.
- Example 1 It is a figure which shows the whole structure in Example 1 to which this invention was applied. It is a figure which shows the structure of the motor and the load in Example 1 to which this invention was applied. It is a figure which shows an example of the position correction data in Example 1 to which this invention is applied. It is a figure which shows the structure in the motor control apparatus in Example 1 to which this invention was applied. It is a figure which shows the structure of the position command generator in Example 1 to which this invention was applied. It is a figure which shows the processing flow of the position command generator in Example 1 to which this invention was applied. It is a figure which shows an example of the position correction data in Example 1 to which this invention is applied. It is a conceptual diagram explaining the amount of displacement of the position in Example 1 to which this invention is applied.
- FIG. 1 shows a configuration example of an entire system including a servomotor control device to which the present invention is applied.
- the system for position correction includes a servomotor 1 for position measurement, an encoder 2 for acquiring rotational position information of the servomotor 1, and a servo for controlling the servomotor 1 (hereinafter, simply referred to as "motor").
- the motor control device 5 such as an amplifier
- the absolute position measuring means 3 the information processing device 6
- the information processing device 6 such as a personal computer in which a program for measuring and processing the error between the absolute position measuring means 3 and the servo motor 1 is installed, and the servo motor 1.
- the absolute position measuring means 3 is, for example, a laser length measuring device
- the load 8 is a means for transmitting the power of a servomotor such as a ball screw, a belt, a gear, or a chain to a work target 9.
- a servomotor such as a ball screw, a belt, a gear, or a chain
- the motor 1 is described by taking a rotary motor as an example in FIG. 1, the present invention is also applied to a motor fixed by a stator and a mover and driven linearly, such as a linear motor. Is possible.
- FIG. 2 shows a configuration example of the motor and the load portion. It is a figure which shows the structural example of the ball screw 8 which is a load attached to the motor 1 and the pedestal 9 which is a work target.
- the ball screw 8 assembled with the motor 1 by the coupling 7 rotates according to the rotational operation of the motor 1, and the work object 9 attached to the ball screw 8 (here, a pedestal will be described as an example) 9. It is configured to move to the same position as the work target device 20.
- Such a configuration is applied to, for example, a semiconductor manufacturing apparatus or the like.
- the pedestal 9 is moved by 10 mm from the machine origin position Homeposition to the work position Workpoint 1.
- the amount of movement of the motor 1 required to move the pedestal 9 by 10 mm is 100,000 pulses, if all the parts are ideally assembled, the pedestal 9 is the machine origin when the number of pulses fed back from the encoder is 100,000. It should have moved to a position 10 mm from the position.
- the position measurement for generating the position correction data 400 is carried out by the following method.
- the user determines the physical position of the work target 9 as the origin. Usually, it is often set at the end of the movable range of the load 8.
- the rotor position of the servomotor 1 corresponding to this origin is stored in the motor control device 5 as the machine origin. Specifically, the position corresponding to the origin is specified visually by the user or by a sensor, and the pulse information of the encoder at that time is stored in the motor control device 5 as the machine origin position.
- the work target 9 is moved by rotating the motor 1 from the machine origin position determined in this way to an arbitrary correction start position.
- the information processing device 6 moves from the correction start position to an arbitrary position, measures the absolute position at that time by the absolute position measuring means 3, and compares it with the position measured by the encoder 2.
- the data is measured, for example, the number of pulses and absolute position of the encoder when the motor is moved by 1 ° from the correction start position, the number of pulses and absolute position moved by 2 ° from the correction start position, and so on. Measure a total of X data moved from the start position to the correction end position X °. For each of these data, the deviation between the absolute position and the pulse information of the encoder is calculated and stored in the motor control device 5 as position correction data 400. These data are output as, for example, a tabular data file.
- the information processing device 6 generates position correction data using the distance conversion data for converting the number of pulses output from the encoder into the actual distance.
- the distance conversion data is, for example, data on how many ⁇ m one pulse of the encoder actually is.
- the information processing device 6 obtains the distance specified by the motor control device 5 from the number of pulses input from the encoder, measures the error by comparing with the distance measured by the absolute position measuring means 3, and how many pulses. Generate data as to whether the minute correction should be performed.
- the correction start position does not necessarily have to be the same as the machine origin position.
- the section that needs to be positioned with high accuracy is the section facing the work target device 20, and the Work range (work) in the figure. It will be within the range).
- the Move range which is a section that does not face the work target device 20, is a section used for movement, and positioning accuracy within this range is not required. Therefore, even if the machine origin position is Home position, by setting the correction start position Pstart and the correction end position Pend to be the same as the start / end position of Workrange, only within the required range of the device in which the motor is incorporated.
- the position correction data 400 can be created. In this way, by setting the range in which positioning correction is possible to an arbitrary start position and section, the limited capacity in the motor control device 5 can be effectively utilized without generating position correction data 400 in an unnecessary range. It becomes possible to do.
- the interval N of the data measurement positions is not limited to 1 °, and may be any interval of 0.01 ° or 3 °, and the data range may be any range up to 360 ° or 720 °.
- the finer the interval between measurement positions the more precise the position correction becomes possible.
- the processing by the information processing device 6 takes time, and the motor control device that stores the position correction data 400.
- the storage capacity in 5 also increases.
- the data interval N and the number of data X can be arbitrarily set by the user according to the movable range of the work target 9.
- FIG. 3 is an example of saving the position correction data 400 in a table format.
- the correction position N (x) for correction is stored in the first column, N (0) is at the correction start position Pstart position in FIG. 2, and N (X) is at the correction end position Pend position. Corresponds to each.
- the value of the correction pulse Pofst (X) applied to the position saved in the first column is saved in the second column.
- This position correction data is generated by the information processing device 6, stored in a storage unit in the motor control device 5, and is read out and used by the position correction device 30 when performing position correction.
- FIG. 4 shows an overall schematic configuration diagram of the motor control device 5 according to an embodiment to which the present invention is applied.
- the motor 1 includes a stator and a mover (not shown), and the load 8 is a drive target load driven by the motor 1.
- the motor control device 5 is a device that supplies electric power to the motor 1 to control the motor. Examples of the motor control device 5 include an inverter and a servo amplifier.
- the electric power coming from the power source is converted by the electric power converter 505 and supplied to the stator of the motor.
- the power converter 505 is a switching element such as a transistor.
- the current controller 504 controls this switching element so that a desired current is output from the power converter 505.
- the current controller 504 controls the power converter 505 by supplying a voltage to the gate of the transistor constituting the power converter 505 and switching ON / OFF of the switching element, for example.
- the position command generator 501 acquires the position command Pref input to the motor control device 5 from the upper motor control device (not shown) and the correction data from the storage unit 507 in which the position correction data is stored in advance. , Outputs the corrected position command Pcrct.
- the subtractor 508 is a subtractor that calculates the position deviation Perr by subtracting the corrected position command Pcrct, which is the output value of the position command generator 501, and the position detection value Pfb, which is the output value of the encoder 2.
- the position controller 502 is a position controller that outputs a speed command value Nref according to the position deviation Perr.
- the speed detector 511 is a speed calculator that calculates and outputs the speed detection value Nfb of the motor 1 from the position detection value Pfb which is the output of the encoder 2.
- the subtractor 509 is a subtractor that calculates the speed deviation Nerr between the speed command value Nref and the speed detection value Nfb of the servomotor 1.
- the speed controller 503 is a speed controller that outputs a torque current command value iqref according to the speed deviation Nerr.
- the current detector 506 is a current detector that detects the torque current detection value iq supplied to the motor 1, and is a current deviation that is an amount of deviation between the torque current command value iqref and the torque current detection iq supplied to the motor 1.
- the iqerr operation is performed by the subtractor 510.
- the current controller 504 is a current controller that adjusts the output current of the power converter according to the torque current deviation equalr.
- FIG. 5 shows a detailed configuration of the position command generator 501 in this embodiment.
- the position command generator 501 includes a position corrector 30 that calculates the correction pulse Pofst corresponding to the position command Pref, and an adder 31 that adds the correction pulse Pofst to the position command Pref.
- FIG. 6 shows an example of the processing flow in the position corrector 30.
- the position corrector 30 calculates where the target position N (M) for which the motor is to be moved corresponds to the correction position N (x) according to the position command Pref input in STEP 301 (STEP 302).
- the distance from the correction start position is calculated from the difference between the position command Pref and the correction start position Pstart by the following equation (1).
- the data number M for calculating the correction pulse can be obtained.
- STEP303 determines whether the target position N (M) is within the range from the correction start position to the correction end position. Specifically, it is determined whether the data number M obtained by (Equation 1) is 0 ⁇ M ⁇ X.
- the position corrector 30 When M is out of the range from the correction start position to the correction end position, the position corrector 30 outputs the correction pulse Pofsto as 0, and as a result, the position command Pref is output from the position command generator 501 without being corrected. (STEP304).
- the target position N (M) specified by the position command Pref matches any of the correction positions N (x) in which the correction pulse amount is saved. Correction may be performed using the correction pulse Pofst [M] corresponding to the saved correction position N (M).
- FIG. 7 shows the relationship between the position command Pref and the correction pulse Pofst.
- the horizontal axis is the position command Pref
- the vertical axis is the correction pulse Post.
- the data interval N is a value obtained by dividing the position correction area from the correction start position Pstart to the correction end position Pend at equal intervals by the saved correction pulses.
- the target position N (M) specified by the position command Pref does not match the correction position where the correction pulse amount is saved because M is not an integer, and it is necessary to interpolate the position correction data to obtain Pofst. ..
- an interpolation method for example, linear interpolation using the following equation (2) can be considered.
- M is m ⁇ M ⁇ m + 1 (m is an integer) and the following processing is performed.
- the distance from the correction position N (m) to N (M) is calculated by calculating the difference between the values obtained by multiplying the data table number M and the data interval N with respect to the position command Pref. Next, the data interval N is divided, and the difference between the correction pulse Pofst [m + 1] and the correction pulse Pofst [m] is multiplied. By adding the correction pulse Pofst [m] to the obtained value, the linearly interpolated correction pulse Pofst (M) can be obtained.
- the position command Pref is generated by using the distance conversion data in the host device that has been designated by the user, and is input from the host device to the motor control device.
- the distance conversion data may be stored in the storage unit 507 and generated in the motor control device 5.
- the target position information is input from the host device to the motor control device 5, and the position information is converted into the number of pulses of the encoder in the motor control device 5 using the distance conversion data.
- the position command Pref is generated by using the distance conversion data in the host device that has been designated by the user, and is input from the host device to the motor control device.
- the distance conversion data may be stored in the storage unit 507 and generated in the motor control device 5.
- the target position information is input from the host device to the motor control device 5, and the position information is converted into the number of pulses of the encoder in the motor control device 5 using the distance conversion data.
- the position correction data when converting from the position information to the number of pulses of the encoder, by using the same distance conversion data as that used in the information processing
- FIG. 8 is a diagram showing the effect of the present invention. With the horizontal axis as the position command and the vertical axis as the actual machine position of the rotor, if it moves without misalignment, it will be positioned as shown in the ideal position graph 60, but since misalignment actually occurs, the actual position graph An example of operating as in 61 is shown.
- the ideal machine position is Pm1, but when the actual positioning is completed, it will be the position of the machine position Prereal1.
- the error angle between the machine position Preal1 and the correction position Pm1 is the correction pulse Pofst measured in advance by the difference between the encoder 2 and the absolute position measuring means 3.
- the position is controlled based on the corrected position command Pcrct obtained by adding the correction pulse Pofst to the position command Pref, the position becomes the machine position Pm1 when the positioning is completed.
- the position commands Pref2 to Pref5 can also be positioned at the ideal positions Pm2 to Pm5 by using the correction pulse Pofst.
- the position correction data generated in advance can be set to an arbitrary area regardless of the machine origin position, so that the amount of data can be set to an appropriate amount according to the size of the correction area and the application, and the motor control can be performed. It is possible to reduce the processing load of the device.
- Example 2 a plurality of application ranges of error angles can be applied. Hereinafter, it will be described with reference to FIG.
- the position correction data in the case of Workrange1 is measured from the correction position N (0) to N (x), and then the position in the case of Worlrage2.
- the correction data is measured from the correction position N'(0) to N'(x).
- 10A and 10B describe a method of performing position correction without re-measuring the error angle even when the motor control device 5 which has obtained the position correction data from the information processing device 6 in advance changes the machine origin position. There is.
- position correction data for position correction is generated in the work range Workrange from the correction start position Pstart to the correction end position Pend based on the initial machine origin position Homeposition1.
- the determination of whether the position correction process is performed or not is performed from the correction start position Pstart to the correction end position with the position command Pref using the first machine origin position Homeposition1 as a reference position. It is determined whether it is within the correction range of Pend, and the position correction process is executed when the equations (3) and (4) are satisfied.
- the machine origin position Sethome at the time of generation is a value set as in Eq. (5) every time the machine origin is reset.
- HomepositionA is the origin return position data of the machine origin position
- Homeposition_err is the distance to the first machine origin position with the machine origin position as the reference position.
- Sethome HomepositonA - Homepositon_err... Expression (5) For example, if the initial machine origin position Homeposition1 is the machine origin position and the origin position is set to 0, the machine origin position at the time of generation is set to 0 because the machine origin position is the machine origin position when the position correction data is generated.
- the machine origin position is reset to the machine origin position Homeposition2 and the origin position is set to 30, the first machine origin position Homeposition1 will be -60 with respect to the machine origin position Homeposition2, so it will be generated.
- the machine origin position Sethome is -30.
- the machine origin position Sethome at the time of generation is added to the correction start position Pstart and the correction end position Pend as shown in equations (6) and (7), respectively.
- Pref-Homeposition When changing the machine origin from the servomotor control device to another origin position, the difference between the machine origin position when the error angle is measured and the machine origin position to be set next is output, and the difference from the servomotor control device is output.
- the servomotor is moved to the machine origin by the machine origin return operation command. By this operation, the servomotor, the encoder, and the high-resolution encoder for absolute position measurement are aligned with the origin of the mechanical absolute position.
- the servomotor is moved to an arbitrary correction start position by the servomotor control device, positioned every time, for example, from the correction start position, and the position of the high-resolution encoder for absolute position measurement and the servomotor at that position is detected.
- Both position data of the encoder are captured by a personal computer, and the error angle data obtained by subtracting the position data of the encoder from the absolute angle of the high resolution encoder for absolute position measurement and the position data of the high resolution encoder for absolute position measurement is obtained.
- the absolute angle and error angle data of the servomotor are acquired by repeatedly executing the positioning, the absolute angle and error angle data are output as a tabular data file.
- the number of output data can be set arbitrarily, and the error angle is obtained by positioning each equally divided angle of the high resolution encoder for absolute position measurement.
- Servo motor correction measures the correction position from the machine origin.
- the machine origin changes due to a change in the mechanism, etc., it is possible to correct using the same correction data by setting the correction amount from the machine origin.
- Servo motor 2 Encoder 3: Absolute position measuring means 5: Motor control device 6: Information processing device 7: Coupling 8: Load 9: Work target 30: Position corrector 400: Position correction data 501: Position command generator 502: Position controller 503: Speed controller 504: Current controller 505: Power converter
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position Or Direction (AREA)
Abstract
Description
図7には、位置指令Prefと補正パルスPofstの関係を示す。横軸は位置指令Pref、縦軸は補正パルスPostである。データ間隔Nは、補正開始位置Pstartから、補正終了位置Pendまでの位置補正領域を、保存した補正パルス分だけ等間隔で分割した値である。位置指令Prefによって指定される目標位置N(M)は、Mが整数ではないため、補正パルス量を保存した補正位置と一致せず、Pofstを求めるのに位置補正データの補間を行う必要がある。補間の方法としては、例えば以下の式(2)を用いた直線補間が考えられる。
このとき、Mはm<M<m+1(mは整数)として以下の処理を行う。
Pref + Homeposition1 ≦ Pend … 式(4)
補正開始位置Pstartと補正終了位置Pendは、初回機械原点位置Homeposition1からの移動距離を保存しているため、機械原点位置を再設定し、初回機械原点位置Homeposition1の情報が消失した場合、位置補正処理が正常に行えなくなる。
例えば、初回機械原点位置Homeposition1が機械原点位置で、その原点位置を0と設定した場合、位置補正データを生成した時の機械原点位置となるため、生成時機械原点位置Sethomeは0となる。
Pref + Homeposition2 ≧ Pstart + Sethome … (式6)
Pref + Homeposition2 ≦ Pend + Sethome … (式7)
例えば、機械原点位置Homeposition2の場合、補正開始位置Pstart=120 - 30=90、補正開始位置Pend=160 - 30=120、機械原点位置Homepositon2=30であるため、機械原点位置を変更しても、初回原点復帰位置の情報が失われず、位置補正を正常に行うことが可能となる。
サーボモータ制御装置からの機械原点を別の原点位置に変更する場合、誤差角度を測定した際の機械原点位置と、次に設定する機械原点位置との差分を出力し、サーボモータ制御装置からの機械原点復帰運転指令により、機械原点へサーボモータを移動させる。この動作により、サーボモータとエンコーダ及び絶対位置計測用高分解能エンコーダを機械的な絶対位置の原点に位置合わせする。
2:エンコーダ
3:絶対位置測定手段
5:モータ制御装置
6:情報処理装置
7:カップリング
8:負荷
9:仕事対象
30:位置補正器
400:位置補正データ
501:位置指令生成器
502:位置制御器
503:速度制御器
504:電流制御器
505:電力変換器
Claims (8)
- モータへ電力を供給するモータ制御装置であって、
前記モータ制御装置が、位置補正データ及びモータの機械原点位置の情報を格納する記憶部を備え、
前記モータ制御装置が、外部から入力された位置指令と前記位置補正データを用いて補正後位置指令を生成し、前記補正後位置指令及びエンコーダから入力される位置情報に基づいて前記モータへ供給する電力を変換するものであり、
前記位置補正データが、補正位置及び補正量を対応付けて記録されたものであり、
前記補正位置の開始位置が前記機械原点位置とは異なるものである、
ことを特徴とするモータ制御装置。 - 請求項1に記載のモータ制御装置であって、
前記モータ制御装置は、前記位置指令に対応した補正位置を特定し、前記補正位置及び前記位置補正データから補正量を算出し、前記位置指令に前記補正量を加算することで前記補正後位置指令を生成するものである、
ことを特徴とするモータ制御装置。 - 請求項2に記載のモータ制御装置であって、
前記モータ制御装置は、前記位置指令に対応した補正位置が前記位置補正データの範囲内に存在しなかった場合、前記補正量を0として前記補正後位置指令を生成するものである、
ことを特徴とするモータ制御装置。 - 請求項2に記載のモータ制御装置であって、
前記モータ制御装置は、前記位置指令に対応した補正位置が、前記位置補正データの範囲内に存在し、かつ一致する補正位置データが存在しなかった場合、前記位置補正データを補間して得られた補間データを用いて、前記補正量を算出するものである、
ことを特徴とするモータ制御装置。 - モータへ電力を供給するモータ制御装置で行われるモータ制御方法であって、
外部から入力された位置指令と位置補正データを用いて補正後位置指令を生成し、
前記補正後位置指令及びエンコーダから入力される位置情報に基づいて前記モータへ供給する電力を変換し、
前記位置補正データとして、前記モータの機械原点位置とは異なる補正位置の開始位置及び補正量を対応付けて記録する、
ことを特徴とするモータ制御方法。 - 請求項5に記載のモータ制御方法であって、
前記位置指令に対応した補正位置を特定し、前記補正位置及び前記位置補正データから補正量を算出し、前記位置指令に前記補正量を加算することで前記補正後位置指令を生成する、
ことを特徴とするモータ制御方法。 - 請求項6に記載のモータ制御方法であって、
前記位置指令に対応した補正位置が前記位置補正データの範囲内に存在しなかった場合、前記補正量を0として前記補正後位置指令を生成する、
ことを特徴とするモータ制御方法。 - 請求項6に記載のモータ制御方法であって、
前記位置指令に対応した補正位置が、前記位置補正データの範囲内に存在し、かつ一致する補正位置データが存在しなかった場合、前記位置補正データを補間して得られた補間データを用いて、前記補正量を算出する、
ことを特徴とするモータ制御方法。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US17/766,628 US20240053724A1 (en) | 2019-12-16 | 2020-07-10 | Motor Control Device and Motor Control Method |
CN202080070655.XA CN114503425A (zh) | 2019-12-16 | 2020-07-10 | 电动机控制装置和电动机控制方法 |
EP20903200.2A EP4080755A1 (en) | 2019-12-16 | 2020-07-10 | Motor control device and motor control method |
JP2021565324A JPWO2021124603A1 (ja) | 2019-12-16 | 2020-07-10 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2019-226086 | 2019-12-16 | ||
JP2019226086 | 2019-12-16 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2021124603A1 true WO2021124603A1 (ja) | 2021-06-24 |
Family
ID=76478745
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2020/026988 WO2021124603A1 (ja) | 2019-12-16 | 2020-07-10 | モータ制御装置、モータ制御方法 |
Country Status (6)
Country | Link |
---|---|
US (1) | US20240053724A1 (ja) |
EP (1) | EP4080755A1 (ja) |
JP (1) | JPWO2021124603A1 (ja) |
CN (1) | CN114503425A (ja) |
TW (1) | TWI748586B (ja) |
WO (1) | WO2021124603A1 (ja) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116490296A (zh) * | 2021-07-28 | 2023-07-25 | 东芝三菱电机产业系统株式会社 | 电动机的速度控制装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04123205A (ja) * | 1990-09-14 | 1992-04-23 | Matsushita Electric Ind Co Ltd | 制御対象物の初期位置検出装置 |
JPH095112A (ja) * | 1995-06-23 | 1997-01-10 | Nikon Corp | アブソリュートエンコーダ |
JP2001232585A (ja) * | 2000-02-24 | 2001-08-28 | Ckd Corp | ロボットの制御装置 |
JP2003140749A (ja) * | 2001-10-30 | 2003-05-16 | Juki Corp | Xy位置決め制御装置及び電子部品搭載装置 |
JP2005292898A (ja) | 2004-03-31 | 2005-10-20 | Nikki Denso Kk | サーボモータによる絶対位置決め装置 |
JP2009284662A (ja) * | 2008-05-22 | 2009-12-03 | Jtekt Corp | 位置決め装置及び工作機械装置 |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4447891B2 (ja) * | 2003-10-31 | 2010-04-07 | キヤノン株式会社 | Dcモータ制御装置および記録装置 |
JP2007127560A (ja) * | 2005-11-04 | 2007-05-24 | Seiko Epson Corp | 位置検出装置、スケールおよび位置検出装置の原点復帰方法 |
JP2008083758A (ja) * | 2006-09-26 | 2008-04-10 | Yaskawa Electric Corp | 機械装置のコントローラおよび可動範囲判定方法 |
JP2009303358A (ja) * | 2008-06-12 | 2009-12-24 | Canon Inc | 変位検出方法、補正テーブル作成方法、モータ制御装置及び工作機械装置 |
TWI362037B (en) * | 2008-07-29 | 2012-04-11 | Micro Star Int Co Ltd | Calibration method for servo |
TWI397792B (zh) * | 2010-07-06 | 2013-06-01 | Delta Electronics Inc | 編碼器回授位置之動態補償裝置及其操作方法 |
WO2014141515A1 (ja) * | 2013-03-14 | 2014-09-18 | 三菱電機株式会社 | サーボ制御装置 |
DE112014001613B4 (de) * | 2014-06-26 | 2019-09-05 | Mitsubishi Electric Corporation | Positionierungssteuerungsvorrichtung |
-
2020
- 2020-07-10 EP EP20903200.2A patent/EP4080755A1/en not_active Withdrawn
- 2020-07-10 JP JP2021565324A patent/JPWO2021124603A1/ja active Pending
- 2020-07-10 CN CN202080070655.XA patent/CN114503425A/zh active Pending
- 2020-07-10 WO PCT/JP2020/026988 patent/WO2021124603A1/ja active Application Filing
- 2020-07-10 US US17/766,628 patent/US20240053724A1/en active Pending
- 2020-08-03 TW TW109126178A patent/TWI748586B/zh active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH04123205A (ja) * | 1990-09-14 | 1992-04-23 | Matsushita Electric Ind Co Ltd | 制御対象物の初期位置検出装置 |
JPH095112A (ja) * | 1995-06-23 | 1997-01-10 | Nikon Corp | アブソリュートエンコーダ |
JP2001232585A (ja) * | 2000-02-24 | 2001-08-28 | Ckd Corp | ロボットの制御装置 |
JP2003140749A (ja) * | 2001-10-30 | 2003-05-16 | Juki Corp | Xy位置決め制御装置及び電子部品搭載装置 |
JP2005292898A (ja) | 2004-03-31 | 2005-10-20 | Nikki Denso Kk | サーボモータによる絶対位置決め装置 |
JP2009284662A (ja) * | 2008-05-22 | 2009-12-03 | Jtekt Corp | 位置決め装置及び工作機械装置 |
Also Published As
Publication number | Publication date |
---|---|
EP4080755A1 (en) | 2022-10-26 |
TW202125134A (zh) | 2021-07-01 |
US20240053724A1 (en) | 2024-02-15 |
TWI748586B (zh) | 2021-12-01 |
JPWO2021124603A1 (ja) | 2021-06-24 |
CN114503425A (zh) | 2022-05-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US7183739B2 (en) | Synchronous control device | |
JP5657633B2 (ja) | 移動体が反転するときの位置誤差を補正するサーボ制御装置 | |
US20150051846A1 (en) | Bearing life determination device | |
US7366576B2 (en) | Position control device and position control method for machine tools | |
WO2021004218A1 (zh) | 机床运动轨迹的控制方法及装置、存储介质、处理器 | |
US6979971B2 (en) | Control device-built-in cylinder servo motor | |
JP2012115044A (ja) | モータの磁極位置補正方法 | |
EP2899874B1 (en) | Motor control device and correction data generation method in same | |
WO2021124603A1 (ja) | モータ制御装置、モータ制御方法 | |
JP6377506B2 (ja) | モータ制御装置および同装置における補正データ作成方法 | |
JP4361285B2 (ja) | 数値制御装置 | |
JPH11237920A (ja) | Nc工作機械の制御装置および位置決め制御方法 | |
JPH0722873B2 (ja) | 送り軸の位置制御装置 | |
CN115373433B (zh) | 转台运动补偿方法、装置、设备及存储介质 | |
JP2008041011A (ja) | 工作機械における位置補正方法 | |
JP2019221032A (ja) | 電動機の制御装置 | |
JP6349093B2 (ja) | モータ制御装置および同装置における補正データ作成方法 | |
JP2003047269A (ja) | サーボ制御装置 | |
JP6138995B2 (ja) | モータの磁極位置補正方法 | |
JP4507071B2 (ja) | モータ制御装置 | |
JP2005292898A (ja) | サーボモータによる絶対位置決め装置 | |
CN117724397A (zh) | 谐波数控转台全闭环高精绝对值编码器位置校正方法 | |
KR20210116464A (ko) | 모터 제어 장치 | |
JP4363111B2 (ja) | モータ制御装置及びその位置検出方法 | |
JP2005018670A (ja) | モータ制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 20903200 Country of ref document: EP Kind code of ref document: A1 |
|
ENP | Entry into the national phase |
Ref document number: 2021565324 Country of ref document: JP Kind code of ref document: A |
|
WWE | Wipo information: entry into national phase |
Ref document number: 17766628 Country of ref document: US |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 2020903200 Country of ref document: EP Effective date: 20220718 |