WO1992021075A1 - Method of controlling backlash acceleration - Google Patents
Method of controlling backlash acceleration Download PDFInfo
- Publication number
- WO1992021075A1 WO1992021075A1 PCT/JP1992/000666 JP9200666W WO9221075A1 WO 1992021075 A1 WO1992021075 A1 WO 1992021075A1 JP 9200666 W JP9200666 W JP 9200666W WO 9221075 A1 WO9221075 A1 WO 9221075A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- feed
- amount
- speed
- value
- period
- Prior art date
Links
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/416—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 of velocity, acceleration or deceleration
-
- 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
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41078—Backlash acceleration compensation when inversing, reversing direction
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41084—Compensation speed axis with changing, reversing direction, quadrant circle
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41429—Mean value of previous feedforward values
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41439—Position error ffw for compensation of speed
Definitions
- the present invention relates to a control method of a servomotor that drives a feed shaft such as a table of a machine tool, and in particular, a moving direction of a feed shaft. This is related to the backlash acceleration correction when the motor reverses direction.
- feed-forward control has been performed to reduce the amount of positional deviation.
- a shape error due to the delay in following the servo system occurs.
- a numerical system is used.
- the smoothing process is not performed on the movement command output from the controller.
- the feed-forward amount is calculated, and the feed-forward amount is calculated.
- the power position is added to the speed command, which is the output of the position loop obtained by multiplying the position deviation by the position gain, and corrected.
- a feed-through control has also been developed to request a speed instruction and process the speed loop with this speed command.
- the DDA (Digital Differential Analyzer) 10 is a movement command M sent from the CNC (a numerical control device built in the combination unit) for each distribution cycle.
- the crnd is divided into move commands for each position / speed loop processing cycle.
- Error counter 11 is output from DDA 10.
- the position deviation is obtained by adding the value obtained by subtracting the position feedback amount P fb from the transfer instruction given.
- the element 12 obtains a speed command by multiplying the positional deviation stored in the error counter 11 by the position gain Kp.
- 13 is the speed loop term
- 14 is the integration term, which calculates the position by integrating the speed of the servomotor.
- the element 15 for performing the feedforward control is a method for locating and moving a movement instruction output from the DDA 10. This is a term that advances only in the d period of the loop processing period.
- the smoothing circuit 16 performs a process for obtaining an average value.
- 17 is a term to find the feed-forward position by multiplying the value output by the smoothing process by the feed-forward count ⁇ . It is.
- the above feed-forward amount is added to the speed command obtained by multiplying the positional deviation by the position gain ⁇ , and the feed-back amount is added.
- the speed command Vcrad corrected by the mode control is obtained, and the speed loop performs processing with the speed command Vend.
- FIGS. 5a and 5b show an example in which arc cutting is performed, and the positions according to the respective movement instructions for each division cycle are a1 and a2, respectively.
- a3 and a4 depending on the situation of the edict for transfer in the S2 cycle, the arc to be actually machined as shown in Fig. 5a
- the transfer instruction is reversed at the position of a3 after the all positions.
- Disclosure of the invention is to more accurately capture the position where the direction of movement changes even when the feedforward coefficient is close to “1”.
- the backlash acceleration correction is started to improve the processing accuracy.
- the backlash acceleration control method of the present invention is based on the average value of the position and speed loop processing cycle and the movement command for several cycles before and after the cycle.
- the smoothing process is performed to obtain the feed amount, and the feed amount is used by using the above-mentioned feed amount.
- the feedback control is not performed and the above-mentioned feedback amount is reversed in the positive or negative direction, or when the positional deviation is determined, Backlash acceleration correction at the time of positive / negative reversal of the speed command obtained by adding the above-mentioned feedforward amount to the value multiplied by Prepare each step to start the process.
- the feed-forward command V cmd is used. If the code inversion position of the load amount is the time when the backlash acceleration / compensation start is started, the backlash acceleration / acceleration compensation should be performed more accurately. Can be obtained. In addition, the time when the sign of the speed command Vcmd corrected by the feedforward amount is reversed is the time when the backlash acceleration correction starts. You may.
- Fig. 1 shows the feedforward and backlash acceleration correction according to the present invention.
- FIG. 2 shows the feed-forward and the buffer that the processor of the digital servo circuit performs every position and speed loop processing cycle.
- FIG. 3 is a part of a flowchart of the acceleration / acceleration correction processing, and FIG. 3 is a continuation of FIG.
- FIG. 4 is a block diagram of a servo system for performing feedforward control.
- FIG. 5 is an explanatory diagram for explaining the variation of the movement direction inversion
- FIG. 6 is an illustration for explaining the relationship between the movement instruction and the feedforward amount. Description diagram
- FIG. 7 is a block diagram of a digital servo system for implementing the present invention.
- FIG. 8 is an explanatory diagram showing an example of a variation in the direction reversal in an example of arc processing.
- DDA data (DDA data) / N (1)
- N (minute E period / position / speed loop processing period)
- DDA data position / speed loop. Transfer in the processing cycle This is a moving instruction.
- equation (1) becomes the following equation (2).
- the feedforward amount FFO is determined by moving the movement command (DDA data) in the position's speed loop processing cycle. This is a value obtained by multiplying the average of N movement instructions (DDA data) by the coefficient ⁇ . The result is that the feed-forward amount FFO is not significant. This includes the element of the transfer instruction that precedes the transfer instruction of the position and speed loop processing.
- a movement instruction of “8 ⁇ 8” is output from the CNC, and in the next division period, the movement instruction of “16 ⁇ 8” is outputted. If it is output, the move command for each position / speed loop processing cycle is “8” for the first division cycle, and the next division cycle. The distance between them is "1-16", which is indicated by ⁇ in FIG.
- the feedforward amount FFO obtained by the above equation (2) is as shown by the hatched portion Q in FIG. .
- the positive and negative of the move instruction in the distribution cycle Is Tn when the sign indicating is inverted, and is Ts when the sign indicating the positive or negative of the feedforward amount FFO is inverted.
- the code reversal time (direction reversal time) at that time is Tc, and the feedforward amount FFO code
- the reversal time T s is closer to the reversal time code than the sign reversal time ⁇ of the transfer command of the movement command in the K-period, and is more precisely the reversal direction. It represents the turning time.
- FIG. 7 is a block diagram of the main part of the control of the servomotor of the machine that implements the method of the present invention.
- the shared memory 21 receives various instructions to the servo motor 24 output from the CNC 20 that controls the machine tool, and outputs the data. Delivered to the processor of the digital servo circuit 22.
- the digital servo circuit 22 is provided with a processor, ROM, and RAM, and the position, speed, and the like of the servo motor 24 are determined by the processor. Perform current control and so on.
- the servo amplifier 23 is composed of a transistor chain * overnight, etc., and the servo motor 24 drives the feed axis of the machine tool.
- the pulse coder 25 which functions as a position detector, detects the tilling position of the servo motor 24, and outputs a signal from the digital servo circuit 2. Feed 2 and 'Fook. Note that FIG. 7 shows only a single-axis servo motor, a servo amplifier, and the like.
- FIG. 1, FIG. 2 and FIG. 3 show the flow chart of the feedforward processing executed by the CPU of the digital servo circuit 22.
- Fig. 1 shows the processing for each E-period
- Figs. 2 and 3 show the feed-forward processing and the power for each position / speed loop processing cycle. This is a flow chart for the acceleration acceleration correction. Since the processing other than the feed-forward processing is the same as the conventional processing, the explanation is omitted.
- the CPU of the digital servo circuit 22 executes the processing shown in FIG. 1 for each E-period.
- step S1 the movement instruction M end (position
- step S6 From the shared memory 21, read the movement instruction supplied in the S minute following the movement instruction in the division cycle that performs the speed loop processing. Then, it is determined whether or not the transfer instruction Mcmd is "0", and if "0", the process proceeds to step S6. If it is not “0”, proceed to step S3, and read the previous time (one cycle before) recorded in register Rz by the above transfer instruction Mend. Multiply the obtained transfer instruction to determine whether the value is negative. Immediately, it is determined whether or not the sign of the transfer instruction read the previous time and the sign of the transfer instruction read this time are reversed. The value of the register Rz is set to "0" in the initial setting.
- step S4 the flag F1, which indicates that the polarity of the next transfer command is reversed, is set to "1". Then, the moving instruction Mcmd read this time in step S5 is stored in the register Rz. If it is not negative (unless the transfer command is reversed), the flag F1 is not set to "1", and step S5 is executed. Proceed to.
- step S6 the value stored in register R2 is stored in register R3, and the value stored in register R2 is stored in register R2.
- the value stored in R 1 is stored in the register R 1, respectively, in the transfer instruction M cmd read in step S 1.
- the position loop speed processing is performed by performing the DDA processing based on the transfer command Mcud recorded in the register R2. Request a move instruction for the position / speed loop process, and execute the position / speed loop process for this move command.
- the next transfer instruction Mc weight d is stored in the register R1, and the position 'speed loop processing is performed in the register R2.
- the move instruction Mend and the register R3 in the distribution cycle for performing the processing will sequentially store the previous move instruction Mead.
- "0" is stored in the registers R1 to R3 by default.
- step S7 the counter C is set to "0", and the processing of the dividing / circulating period is completed.
- the CPU of the digital servo circuit executes the above process every 82 cycles, and when the sign of the transfer instruction Mend is inverted, the flag is turned on. F1 is set to "1".
- the CPU of the digital servo circuit executes the processing shown in FIGS. 2 and 3 for each cycle. .
- step S14 the feedforward coefficient ⁇ is calculated as the value obtained by dividing the value of the above-mentioned accumulator SUM by the above-mentioned division number N squared.
- the feed-forward amount FFO is calculated as the value obtained by dividing the value of the above-mentioned accumulator SUM by the above-mentioned division number N squared.
- the DDA processing is performed based on the transfer instruction M cmd of the distribution period stored in the register R 2. Requests a move command for the position / speed loop processing cycle, and issues a speed command for performing the position loop process based on the move command. Ask . Then, the above-mentioned feedforward amount FFO is added to the obtained speed command, and the speed command is corrected by the feedforward amount FFO.
- the speed command Vend is obtained, and the same speed loop processing as that in the past is executed by the speed command Vcmd. Next, "1" is added to the counter in step S15.
- the description of the DDA processing, the position loop processing, and the speed loop processing is omitted because they are the same as the conventional processing.
- the processing in steps S11 to S15 is a processing for obtaining the feedforward amount FFO, which is described above.
- the feedforward amount FFO is not obtained by the operation of the above equation (1), and the transfer command Mcrod for each E-period input to the DDA is obtained. I am looking for. However, they are practically the same. The reason is described below.
- step S15 the 1-minute E period ends, and step S7 is executed. Is set to "0" again.
- step S7 the value “16 ⁇ 8” of the next movement instruction Mend is read in step S1, and “0” and R are stored in the register R3. “2 ⁇ 8” is stored in “2”, and “16 ⁇ 8” is stored in R1.
- step S15 the process proceeds to step S16, and it is determined whether or not the flag F1 is "1". Unless flag F1 is set to "1" in step S4 (if there is no positive or negative reversal of the movement instruction), step S1 From step 6, the process proceeds to step S21, and it is determined whether or not the flag F2 set to "1" during the acceleration of the crash is "1". If the flag F2 is not "1” (as will be described later, the flag F2 is set to "1" as long as no direction reversal occurs).
- step S26 proceed to step S26, and judge whether the counter D for counting the acceleration time is less than or equal to "0". If the counter D is "0" (unless the backlash acceleration command is output as described later, this counter D is "0"). 0 "), end the feed-forward processing and * the flash-lash processing.
- step S1 The polarity of the next move command Mend read in step S1 and the move command memorized in register Rz are reversed.
- step S16 the process moves from step S16 to step S17.
- step S17 it is determined whether the direction inversion has changed from positive to negative depending on whether the movement command stored in register R1 is positive or negative. It is determined whether the state has changed from negative to positive, and if the value of the register R1 is negative, it is assumed that the state has changed from positive to negative. Go to 18. If the value of the register R1 is positive, the process proceeds to step S19. Then, in step S 18, the feedforward calculated in step S 14 is used.
- step S 21 It is determined whether or not the code amount FF 0 is equal to or less than “0”, and if it is not equal to or less than “0”, the process proceeds to step S 21 and the above-described processing is performed. No backlash Acceleration correction is not started. Also, in step S19, if the feedforward amount FFO is not greater than or equal to "0", the flow advances to step S21, as described above. Do not start backlash acceleration correction.
- the feedforward amount FF is obtained.
- a value of 0 does not immediately reverse, and the backlash acceleration correction is not started.
- the number of the position / speed loop processing cycles corresponding to the half cycle of the minute B2 cycle Up to NZ 2
- the reversed move command does not affect the calculation of the feed-forward amount FFO, so at least the NZ 2 times
- the sign of the feedforward amount FF0 does not reverse.
- the sign of the feedforward amount FF0 does not reverse.
- the feed-forward amount FFO sign is not inverted.
- step S20 the flag F2 is set to "1". Since the flag F2 is set to "1", the process moves from step S21 to step S22, and the counter D is set. Set the value A corresponding to the backlash acceleration / compensation time that has been set, and set the flag F2 in step S23. Set to “0J”.
- step S24 the set acceleration acceleration correction amount is output, and the correction is performed by the feedforward amount FFO.
- This speed command V cad is added with this amount of acceleration correction of the cushion, and in step S25, "1" is subtracted from counter D in step S25. This completes the feedforward control and the backlash acceleration correction control.
- step S11 is executed. ⁇ S 15, S 16, and S 21
- the processing proceeds to step S 26 where the processing is not performed, and the settings are made immediately until the counter D becomes “0”. Steps S24 and S25 are not performed until the backlash acceleration compensation time that has passed is exceeded. Is performed. Then, when the counter D becomes “0”, no further acceleration / acceleration correction is performed thereafter.
- the start of the buffer acceleration correction is indicated by the sign indicating the positive or negative of the feed-forward amount FFO. Since it is performed at the time of reversal, the backlash acceleration / acquisition is executed at the optimal position.
- the speed command Vc ind input to the speed loop processing is equal to the command value in the feed-forward mode. Since it occupies a large part, the above speed command V cad is used instead of the sign inversion indicating the positive or negative of the feedforward child FFO. Detects the inversion of the sign indicating positive / negative.
- the backlash acceleration correction may be performed at the start of the operation.In this case, the judgment of steps S18 and S19 is based on the value of the above speed command Vcind. And "0" will be compared.
- Fig. 8 shows an example for comparing the movement command output from the CNC with the positive and negative reversal of the value of the feedforward value.
- This is an example of processing a 6 mm circle with a speed of 400 mmmm and a divisional period of 8 mse (:, position.speed loop processing period lmses).
- move 0.53 mm with a transfer command every E minutes and move 1.9 degrees to the center angle, as a result, as indicated by R in Fig. 8.
- the position at which the moving direction is reversed is within 1.9 degrees.
- the feedforward amount is more accurate, as shown by S in FIG. 8, without a fluctuation of about 0.2 degrees.
- the backlash acceleration start position can be obtained.
- This invention uses a servo system that performs feedforward control for controlling the servomotor that controls the feed axis of a machine tool.
- feedforward amount reverses
- the positive or negative of the speed command detected by the feedforward amount is reversed.
Landscapes
- Engineering & Computer Science (AREA)
- Human Computer Interaction (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Numerical Control (AREA)
- Control Of Position Or Direction (AREA)
Description
明 細 書
バ ッ ク ラ ッ シ 加 速 制 御 方 法
技 術 分 野
本 発 明 は 、 工 作 機 械 の テ ー ブ ル 等 の 送 り 軸 を 駆 動 す る サ ー ポ モ ー タ の 制 御 方 法 に 関 し 、 特 に 、 送 り 軸 の 移 動 方 向 が 反 転 す る と き の バ ッ ク ラ ッ シ ュ 加 速 補 正 に 関 す る 。
背 景 技 術
ェ 作 機 械 に お い て 、 テ ー ブ ル 等 を 駆 動 す る サ ー ポ モ ー タ の 駆 動 方 向 を 反 転 さ せ る と き 、 送 り ね じ の バ ッ ク ラ ッ シ や 摩 擦 の 影 響 の た め 、 機 械 の 被 駆 動 部 は 即 座 に 反 転 す る こ と が で き な い 。 そ © た め 、 工 作 機 械 で 輪 郭 加 工 を 行 な つ て い る と き 、 送 り 軸 の 移 動 方 向 が 反 転 す る と ヮ ー ク の 加 工 面 に 突 起 が 生 じ る 。 例 え ば 、 X , Y 2 軸 平 面 上 で ヮ ー ク に 対 し 円 弧 切 削 を 行 な い っ て い る と き 、 X 軸 を プ ラ ス 方 向 、 Y 軸 を マ イ ナ ス 方 向 に 移 動 さ せ て い る と き 象 限 が 変 わ り 、 Y 軸 は そ の ま ま マ イ ナ ス 方 向 に 駆 動 し X 軸 を マ ィ ナ ス 方 向 に 駆 動 す る よ う に 切 換 え た 場 合 、 Y 軸 に 対 し て は 今 ま で と 同 一 速 度 で 切 削 が 行 わ れ る が 、 X 軸 は 位 置 偏 差 が 「 0 」 に な る こ と か ら ト ル ク 指 令 値 が 小 さ く な り 、 摩 擦 に よ り サ ー ボ モ ー タ は 即 座 に 反 転 で き な い こ と 、 及 び 、 テ ー ブ ル を 送 る 送 り ね じ の ノ、' ッ ク ラ ッ シ ュ に よ り テ ー プ ル の 移 動 も 即 座 に 反 転 で き な い こ と か ら 、 X 軸 方 向 の ヮ ー ク の 移 動 は 移 動 指 令 に 対 し 追 従 で き な く 遅 れ る こ と と な る 。 そ の 結 果 、 切 削 円 弧 面 に 突 起 が 生 じ る o
こ の 突 起 を な く す た め 、 あ る い は 減 ら す た め 、 例 え ば、 特 開 平 4 一 8 4 5 1 号 に 開 示 さ れ る 如 く 、 移 動方 向 の 反 転 時 に 位 置 偏 差 に 位 置 の パ ッ ク ラ ッ シ ュ 捕 正 を 行 う と 共 に 、 位 置 偏 差 が反 転 す る 時 、 速 度 指 令 に 適 当 な 値 ( 加 速 量) を 加 え て サ ー ボ モ ー タ の 反 転 方 向 に 加 速 を 行 い 象 限 突 起 を 減 ら す 、 い わ ゆ る バ ッ ク ラ ッ シ ュ 加 速 が 行 な わ れ て い る 。
更 に 、 工 作 機械 の サ ー ボ モ ー タ 系 に 於 い て 位 置 偏 差量 を 低 減 さ せ る た め に フ ィ ー ド フ ォ ヮ ー ド 制 御 が行 な わ れ て い る 。 特 に 、 工 作 機 械 で 高 速 切 削 を 行 な う 場 合 、 サ ー ボ 系 の 追 従 遅 れ に よ る 形 状 誤 差 が 生 じ る 。 こ の 形 状 誤 差 を 少 く す る た め 、 本 出 願 人 が 先 に 出 願 し た 特 願平 2 - 3 0 1 1 5 4 号 に 示 さ れ て い る 如 く 、 数 値 制 御 装 置 か ら 出 力 さ れ る 移 動 指 令 に 対 し ス ム ー ジ ン グ 処 理 を 行 な い フ ィ — ド フ ォ ワ ー ド量 を 求 め 、 こ の フ ィ ー ド フ ォ ワ ー ド 置 を、 位 置 偏 差 に ポ ジ シ ョ ン ゲ イ ン を 乗 じ て 得 ら れ る 位 置 ル ー プ の 出 力 で あ る 速 度 指 令 に 加 算 し 、 補 正 さ れ た 速 度 指 令 を 求 め こ の 速 度指 令 で 速 度 ル ー プ の 処 理 を 行 な う フ ィ 一 ド フ ォ ヮ 一 ド 制 御 も 開 発 さ れ て い る 。
こ の フ ィ ー ド フ ォ ワ ー ド 制 御 を 図 4 を 参 照 し て 説 明 す る 。 D D A ( D i g i t a l D i f f e r e n t i a l A n a l y z e r ) 1 0 は 、 C N C ( コ ン ビ ユ ー 夕 内 蔵 の 数 値 制 御 装 置 ) か ら 分 配 周 斯 毎 に 送 ら れ て く る 移 動 指 令 M crndを 位 置 · 速 度 ル ー プ 処理 周 期 毎 の 移 動 指 令 に 分 割 す る 。 エ ラ 一 カ ウ ン タ 1 1 は 、 D D A 1 0 か ら 出 力 さ
れ る 移 動 指 令 か ら 位 置 の フ ィ ー ド バ ッ ク 量 P f bを 減 じ た 値 を 加 算 し 位 置 偏 差 を 求 め る 。 要 素 1 2 は エ ラ ー カ ウ ン タ 1 1 に 記 憶 さ れ た 位 置 偏 差 に ポ ジ シ ョ ン ゲ イ ン K pを 乗 じ て 速 度 指 令 を 求 め る 。 1 3 は 速 度 ル ー プ の 項 、 1 4 は 積 分 の 項 で 、 サ ー ポ モ ー タ の 速 度 を 積 分 し 、 位 置 を 求 め る 。 ま た 、 フ ィ ー ド フ ォ ワ ー ド 制 御 を 行 な う た め の 進 め 要 素 1 5 は 、 D D A 1 0 か ら 出 力 さ れ る 移 動 指 令 を 位 置 · 速 度 ル ー プ 処 理 周 期 の d 周 期 だ け 進 め る 項 で あ る 。 ス ム ー ジ ン グ 回 路 1 6 は 、 平 均 値 を 求 め る 処 理 を 行 な う。
1 7 は ス ム ー ジ ン グ 処 理 で 出 力 さ れ る 値 に フ ィ ー ド フ ォ ヮ ー ド 計 数 α を 乗 じ て フ ィ ー ド フ ォ ヮ ー ド 置 を 求 め る 項 で あ る 。
上 記 フ ィ ー ド フ ォ ヮ ー ド 量 を 、 位 置 偏 差 に ポ ジ シ ョ ン ゲ イ ン Κ ρを 乗 じ て 得 ら れ た 速 度 指 令 に 加 算 し 、 フ ィ ー ド フ ォ ヮ ー ド 制 御 に よ り 補 正 さ れ た 速 度 指 令 V cradを 求 め こ の 速 度 指 令 V endで 速 度 ル ー プ は 処 理 を 行 な う 。
上 述 の よ う な サ ー ポ 系 で サ ー ポ モ ー タ を 制 御 す る 場 合、 フ ィ ー ド フ ォ ワ ー ド 係 数 α が 「 1 」 に 近 い 値 で あ る と 、 速 度 指 令 V endは フ ィ ー ド フ * ヮ ー ド 制 御 に よ り 作 成 さ れ る 指 令 が 大 部 分 を 占 め 、 位 置 偏 差 は ほ と ん ど 「 0 」 に な る 。 し か も 、 フ ィ ー ド フ ォ ワ ー ド に よ る 指 令 の 方 が 位 相 が 進 ん で い る の で 、 位 置 偏 差 の 位 相 は 遅 れ る こ と に な る 。 ま た 、 フ ィ ー ド フ ォ ワ ー ド 計 数 α が 「 1 」 に 近 い 値 で あ る と 、 移 動 指 令 に 対 し モ ー タ の 位 置 は ほ と ん ど 遅 れ が な く な る 。 そ の 結 果 、 位 置 偏 差 が ほ と ん ど 「 0 」 に 近
い こ と 、 及 び 位 相 遅 れ が あ る こ と か ら 移 動 方 向 反 転 時 の バ ッ ク ラ ッ シ 加 速 補 正 の タ イ ミ ン グ を 位 置 偏 差 か ら 判 断 す る こ と が 難 し い 。 更 に 、 移 動 指 令 に 対 し モ ー タ の 実 際 の 位 置 は 遅 れ が な く な る こ と か ら 、 C N C の 分 E 周 期 が 長 い と ( 通 常 、 位 置 · 速 度 ル ー プ 処 理 周 期 よ り 分 E 周 斯 は 長 い ) 、 加 工 の プ ロ グ ラ ム 開 始 位 置 ( 図 5 a 図 5 b に 例 示 す る 位 置 a 1 ) に よ っ て 、 バ ッ ク ラ ッ シ 加 速 補 正 の 開 始 タ イ ミ ン グ に ば ら つ き が 生 じ る 。
図 5 a 及 び 図 5 b は 、 円 弧 切 削 を 行 な う 場 合 の 例 を 示 し 、 分 £ 周 斯 毎 の 各 移 動 指 令 に よ る 位 置 が 夫 々 a 1 、 a 2 、 a 3 、 a 4 で あ る 場 合 、 分 S2 周 期 の 移 勅 指 令 の 状 況 に 応 じ て 、 図 5 a に 示 す 如 く 実 際 に 加 工 し ょ う と す る 円 弧 に 対 し Y 軸 の 移 動 方 向 が 反 転 す る 位 置 が 反 転 す べ き 位 置 よ り 前 の 位 置 a 2 に な る 場 合 と 、 図 5 b に 示 す 如 く 反 転 す べ き 位 置 よ り 後 の a 3 の 位 置 で 移 動 指 令 が 反 転 す る 場 合 と が 生 じ る 。 フ ィ ー ド フ ォ ワ ー ド 計 数 な が 「 0 」 に 近 い 値 で あ り 、 フ ィ ー ド フ ォ ヮ ー ド に よ る 影 響 が 少 な い 場 合 に は 、 位 置偏 差 は 数 1 0 m s e c ( 約 1 K p に 対 応 す る 値 ) 遅 れ る の で 、 上 記 ば ら つ き は 、 こ の 遅 れ に よ り 吸収 さ れ 問 題 な い が 、 フ ィ ー ド フ ォ ワ ー ド 係 数 α が
「 1 」 に 近 い 値 で あ る と 、 指 令 に 対 し て 実 際 の 位 置 の 遅 れ が ほ と ん ど な く な る た め 、 上 記 位 置 偃 差 の 反 転 時 に パ ッ ク ラ ッ シ 加 速 補 正 を 行 な う と 誤 差 を 増 大 さ せ る こ と に な る 。
発 明 の 開 示
本 発 明 の 目 的 は 、 フ ィ ー ド フ ォ ワ ー ド 係 数 が 「 1 」 に 近 い 場 合 で も 、 移 動 方 向 が 変 わ る 位 置 を よ り 正 確 に 捉 え て バ ッ ク ラ ッ シ 加 速 補 正 を 開 始 し て 加 工 精 度 を 向 上 さ せ る し と し め る 。
本 発 明 の バ ッ ク ラ ッ シ 加 速 制 御 方 法 は 、 位 置 · 速 度 ル ー プ 処 理 周 期 と 該 周 期 の 前 後 の 数 周 期 の 移 動 指 令 の 平 均 値 を 求 め る ス ム ー ジ ン グ 処 理 を 行 な っ て フ ィ ー ド フ ォ ヮ 一 ド 量 を 求 め 、 上 記 フ ィ ー ド フ ォ ヮ ー ド 量 を 用 い て フ ィ 一 ド フ ォ ヮ ー ド 制 御 を 行 な い 、 上 記 フ ィ ー ド フ ォ ヮ ー ド 量 の 正 負 の 反 転 時 、 若 し く は 、 位 置 偏 差 に ポ ジ シ ョ ン ゲ ィ ン を 乗 じ た 値 に 上 記 フ ィ ー ド フ ォ ヮ ー ド 量 を 加 算 し て 得 ら れ る 速 度 指 令 の 正 負 の 反 転 時 に バ ッ ク ラ ッ シ 加 速 補 正 を 開 始 す る 、 各 ス テ ッ プ を 備 え る 。
フ ィ ー ド フ ォ ワ ー ド 係 数 α の 値 が 「 1 」 に 近 づ く と 、 位 置 偏 差 は ほ と ん ど 「 0 」 と な り 、 フ ィ ー ド フ ォ ワ ー ド 量 で 補 正 さ れ た 速 度 指 令 V c m dは フ ィ 一 ド フ ォ ヮ ー ド 量 に よ る も の が 殆 ど を 占 め る こ と に な る た め 、 フ ィ ー ド フ ォ ヮ ー ド 量 の 符 号 反 転 位 置 を バ ッ ク ラ ッ シ 加 速 補 正 開 始 時 と す れ ば 、 よ り 正 確 に バ ッ ク ラ ッ シ 加 速 補 正 を 行 な う こ と が で き る 。 ま た 、 フ ィ ー ド フ ォ ワ ー ド 量 に よ り 補 正 さ れ た 速 度 指 令 V c m dの 符 号 の 反 転 時 を バ ッ ク ラ ッ シ 加 速 補 正 開 始 時 と し て も よ い 。
図 面 の 簡 単 な 説 明
図 1 は 、 本 発 明 方 法 に よ る フ ィ ー ド フ ォ ヮ ー ド 及 び バ ッ ク ラ ッ シ 加 速 補 正 を 行 な う た め 、 分 配 周 期 毎 に デ ィ ジ
タ ル サ ー ボ 回 路 の プ ロ セ ッ サ が 実 施 す る 処 理 の フ ロ ー チ ヤ ー 卜 、
図 2 は 、 デ ィ ジ タ ル サ ー ボ 回 路 の プ ロ セ ッ サ が 位 置 · 速 度 ル ー プ 処 理周 期 毎 に 実施 す る フ ィ ー ド フ ォ ヮ ー ド 及 び バ ッ ク ラ ッ シ 加 速 補 正 処 理 の フ ロ ー チ ヤ 一 ト の 一 部 、 図 3 は 、 図 2 の 続 き 、
図 4 は 、 フ ィ ー ド フ ォ ワ ー ド 制 御 を 行 な う サ ー ボ 系 の ブ ロ ッ ク 図 、
図 5 は 、 移 動 方 向 反 転 の バ ラ ツ キ を 説 明 す る 説 明 図 、 図 6 は 、 移 動 指 令 と フ ィ ー ド フ ォ ワ ー ド 量 と の 関 係 を 説 明 す る 説 明 図 、
図 7 は 、 本 発 明 方 法 を 実 施 す る デ ィ ジ タ ル サ ー ボ 系 の ブ ロ ッ ク 図 、
図 8 は 、 円 弧加 工 の 一 例 に お け る 方 向 反 転 の バ ラ ツ キ の 例 を 示 す 説 明図 で あ る 。
発 明 を 実施 す る た め の 最 良 の 形 態 図 4 に 示 す サ ー ポ 系 の フ ィ ー ド フ ォ ヮ ー ド 制 御 に 於 い て 、 進 め 要 素 1 5 、 ス ム ー ジ ン グ 処 理 要 素 1 6 、 フ ィ ー ド フ ォ ヮ ー ド 係 数 α の 項 1 7 に よ っ て 求 め ら れ る フ ィ ー ド フ ォ ワ ー ド 量 F F O は 、 次 の 式 ( 1 ) に よ っ て 求 め ら れ る 。
F F 0 = α · Z d - ( 1 + Z -l + Z -2 + - + Z - l l,- % i ) -
( D D A デ ー タ ) / N ( 1 ) こ こ で 、 N = ( 分 E周 期 / 位 置 · 速 度 ル ー プ 処 理 周 期) 、 D D A デ ー タ は 位 置 . 速 度 ル ー プ 処 理 周 期 に お け る 移
動 指 令 で あ る 。
例 え ば 、 フ ィ ー ド フ ヱ ワ ー ド 係 数 α を 「 1 」 、 分 Ε周 期 を 8 m s e c 、 位 置 . 速 度 ル ー プ 周 期 を l m s e c と す る と 、 ま た 、 進 め 要 素 1 5 に よ る 進 め 量 は 分 配 周 期 の 約 1 / 2 周 期 が と ら れ る の で 、 上 記 進 め 要 素 1 5 の d は 4 ま た は 3 の 値 で あ り 、 例 え ば 、 d = 3 と す る と 、 式 ( 1 ) は 次 の 式 ( 2 ) と な る 。
F F 0 = ( Z » + Z 2 + Z 1 + 1 + Z - 1 + Z - 2 + Z —,十 Z -*)
• ( D D A デ ー タ ) 8
( 2 ) 即 ち 、 フ ィ ー ド フ ォ ワ ー ド 量 F F O は 、 当 該 位 置 ' 速 度 ル ー プ 処 理 周 期 の 移 動 指 令 ( D D A デ ー タ 〉 を 中 心 に 前 後 合 せ て N 個 の 移 動 指 令 ( D D A デ ー タ ) の 平 均 に 係 数 α を 乗 じ た 値 で あ る 。 そ の 結 果 フ ィ ー ド フ ォ ヮ ー ド 量 F F O に は 位 置 , 速 度 ル ー プ 処 理 の 移 動 指 令 よ り も 先 行 し た 移 動 指 令 の 要 素 を 含 む こ と に な る 。
そ し て 、 始 め の 分 Ε周 期 で 「 8 X 8 」 の 移 動 指 令 が C N C か ら 出 力 さ れ 次 の 分 Κ周 期 で 「 一 1 6 X 8 」 の 移 動 指 令 が 出 力 さ れ た と す れ ば 、 位 置 · 速 度 ル ー プ 処 理 周 期 毎 の 移 動 指 令 は 、 始 め の 分 Ε周 期 間 で は 「 8 」 、 次 の 分 Ε周 期 間 で は 「 一 1 6 」 と な り 、 こ れ は 図 6 中 に Ρ で 示 さ れ て い る 。
一 方 、 上 記 式 ( 2 ) で 求 め ら れ た フ ィ ー ド フ ォ ヮ ー ド 量 F F O は 、 図 6 中 で 斜 線 を 施 し て 示 し た 部 分 Q の よ う に な る 。 図 6 に 示 す よ う に 、 分 配 周 期 の 移 動 指 令 の 正 負
を 示 す 符 号 の 反転 時 は T nで あ り 、 フ ィ ー ド フ ォ ワ ー ド 量 F F O の 正 負 を 示 す 符 号 の 反 転 時 は T sで あ る 。 そ し て 、 連 铳 系 で 考 え る と 、 そ の 時 の 符 号 反 転 時 ( 方 向 反 転 時 ) は T cで あ り 、 フ ィ ー ド フ ォ ワ ー ド 量 F F O の 符 号 反 転 時 T sの 方 が 、 分 K周 期 の 移 動 指 令 の 符 号 反 転 時 Τιι よ り 連 铳 系 の 符号 反 転 時 に 近 く 、 よ り 正 確 に 移 動 方 向 の 反 転 時 を 表 わ し て い る 。
図 7 は 本 発 明 方 法 を 実 施 す る 工 作 機 械 の サ ー ポ モ ー タ 制 御 の 要 部 ブ ロ ッ ク 図 で あ る 。 図 7 中 、 共 有 メ モ リ 2 1 は 工作 機 械 を 制御 す る C N C 2 0 か ら 出 力 さ れ る サ ー ボ モ ー タ 2 4 へ の 各 種 指 令 等 を 受 信 し 、 デ ジ タ ル サ ー ボ 回 路 2 2 の プ ロ セ ッ サ に 受 け 渡 す 。 デ ジ タ ル サ ー ボ 回 路 2 2 は 、 プ ロ セ ッ サ 、 R O M 、 R A M を 備 え 、 プ ロ セ ッ サ に よ っ て サ ー ボ モ ー タ 2 4 の 位 置 、 速 度 、 電 流 制 御 な ど を 行 な う 。 サ ー ボ ア ン プ 2 3 は ト ラ ン ジ ス タ イ ン * 一 夕 等 で 構 成 さ れ 、 サ ー ボ モ ー タ 2 4 は 工 作 機 械 の 送 り 軸 を 駆 動 す る 。 位 置 検 出 器 と し て 機 能 す る パ ル ス コ ー ダ 2 5 は 、 サ ー ボ モ ー タ 2 4 の 回 耘 位 置 を 検 出 し 、 デ ジ タ ル サ ー ポ 回 路 2 2 に フ ィ ー ド 、' フ ク す る 。 な お 、 図 7 に は 1 軸 の サ ー ボ モ ー タ 、 サ ー ボ ア ン プ 等 の み が 示 さ れ て い る。
図 1 、 図 2 及 び 図 3 は 上記 デ ィ ジ タ ル サ ー ボ 回 路 2 2 の C P U が 実施 す る フ ィ ー ド フ ォ ヮ ー ド 処 理 の フ ロ ー チ ヤ ー ト を 示 し 、 図 1 は 各 分 E周 斯 毎 の 処 理 、 図 2 、 図 3 は 各 位 置 · 速 度 ル ー プ 処 理 周 期 毎 の フ ィ 一 ド フ ォ ヮ ー ド 処 理及 び パ ッ ク ラ ッ シ 加 速 補 正 の フ ロ ー チ ヤ 一 ト で あ る。
な お 、 フ ィ 一 ド フ ォ ヮ ー ド 処 理 '以 外 の 処 理 に つ い て は 従 来 と 同 様 で あ る の で 説 明 を 省 略 す る 。
デ ジ タ ル サ ー ボ 回 路 2 2 の C P U は 各 分 E周 期 毎 、 図 1 の 処 理 を 実 行 す る 。
先 ず 、 ス テ ッ プ S 1 に 於 い て 、 移 動 指 令 M end ( 位 置
• 速 度 ル ー プ 処 理 を 行 な う 分 配 周 期 の 移 動 指 令 の 次 の 分 S周 期 で 供 給 さ れ る 移 動 指 令 ) を 共 有 メ モ リ 2 1 か ら 読 み 取 り 、 こ の 移 動 指 令 M cmdが 「 0 」 か 否 か 判 断 し 、 「 0 」 な ら ば ス テ ッ プ S 6 に 移 行 す る 。 「 0 」 で な け れ ば 、 ス テ ッ プ S 3 に 進 み 、 上 記 移 動 指 令 M endに レ ジ ス タ R z に 記 億 さ れ た 前 回 ( 1 周 期 前 に ) 読 み 取 っ た 移 動 指 令 を 乗 じ て そ の 値 が 負 で あ る か 否 か を 判 断 す る 。 即 ち 、 前 回 読 み 取 っ た 移 動 指 令 と 今 回 読 み 取 っ た 移 動 指 令 の 正 負 が 反 転 し て い る か 否 か を 判 断 す る 。 な お 、 レ ジ ス タ R zの 値 は 初 期 設 定 で 「 0 」 に 設 定 さ れ て い る 。
上 記 の 値 が 負 で あ れ ば ス テ ッ プ S 4 で 、 次 の 移 動 指 令 の 正 負 が 反 転 す る こ と を 示 す フ ラ グ F 1 を 「 1 」 に セ ッ ト し 、 ス テ ッ プ S 5 で 今 回 読 み 取 っ た 移 動 指 令 M cmdを レ ジ ス タ R z に 格 納 す る 。 ま た 、 負 で な け れ ば ( 移 動 指 令 が 反 転 し て な け れ ば ) フ ラ グ F 1 を 「 1 」 に セ ッ ト す る こ と な く 、 ス テ ッ プ S 5 に 進 む 。
次 に ス テ ッ プ S 6 に 於 い て 、 レ ジ ス タ R 3 に 、 レ ジ ス タ R 2 に 記 億 さ れ て い る 値 を 、 レ ジ ス タ R 2 に 、 レ ジ ス タ R 1 に 記 憶 さ れ て い る 値 を 、 レ ジ ス タ R 1 に 、 ス テ ツ プ S 1 で 読 み 取 っ た 移 動 指 令 M cmdを 夫 々 格 納 す る 。
後述 す る よ う に 、 位 置 ' 速 度 ル ー プ 処 理 は レ ジ ス タ R 2 に 記 億 さ れ た 移 動 指 令 M cudに 基 づ い て D D A 処 理 を 行 な っ て 各 位 置 . 速 度 ル ー プ 処 理 の 移 動 指 令 を 求 め 、 こ の 移動 指 令 に 位 置 ' 速 度 ル ー プ 処 理 を 実 行 す る 。 ス テ ツ ブ S 6 の 処 理 に よ り 、 レ ジ ス タ R 1 に は 次 回 の 移 動 指 令 M c重 d、 レ ジ ス タ R 2 に は 位 置 ' 速 度 ル ー プ 処 理 を 行 な う 分 配 周 期 の 移動 指 令 M end、 レ ジ ス タ R 3 に は 前 回 の 移 動指 令 M eadが 順 次記 憶 さ れ る こ と に な る 。 な お 、 レ ジ ス タ R 1 〜 R 3 に は 初 期 設 定 で 「 0 」 が 格 納 さ れ て い る 。 最 後 に 、 ス テ ッ プ S 7 で カ ウ ン タ C を 「 0 」 に セ ッ ト し 、 当 該 分 配周 期 の 処 理 を 終 了 す る 。
以 下 、 各 分 82周 期 毎 に デ ジ タ ル サ ー ボ 回 路 の C P U は 上 記処 理 を 実 行 し 、 移 動 指 令 M endの 符 号 が 反 転 し た 時 に フ ラ グ F 1 が 「 1 」 に セ ッ 卜 さ れ る 。
— 方 、 位 置 · 速 度 ル ー プ処 理 で は そ の 各 周 期 毎 に デ ィ ジ タ ル サ ー ボ 回 路 の C P U は 図 2 及 び 図 3 に 示 す 処 理 を 実 行 す る 。
先 ず 、 ス テ ッ プ S 1 1 で カ ウ ン タ C の 値 が 、 分 £ 周 期 を 位 置 · 速 度 ル ー プ 処 理 周 期 で 除 し た 前 述 の 値 N ( = 分 E周 期ノ 位 置 · 速 度 ル ー プ 処 理 周 期 ) の 1 / 2 以 下 か 否 か を 判 断 す る 。 カ ウ ン タ C の 値 が N Z 2 以 下 な ら ば 、 ス テ ツ プ S 1 2 で ア キ ュ ム レ ー タ S U M に レ ジ ス タ R 2 の 値 か ら レ ジ ス タ R 3 の 値 を 减 じ た 値 を 加 算 し 、 カ ウ ン タ C の 値 が N Z 2 を 越 え て い れ ば 、 ス テ ッ プ S 1 3 で ア キ ュ ム レ 一 タ S U M に レ ジ ス タ R 1 の 値 か ら レ ジ ス タ R 2
の 値 を 減 じ た 値 を 加 算 し 、 ス テ ッ プ S 1 4 に 移 行 す る 。 な お 、 ア キ ュ ム レ ー タ S U M は 初 期 設 定 で 始 め は 「 0 」 が 格 納 さ れ て い る 。
ス テ ッ プ S 1 4 で は 上 記 ア キ ュ ム レ ー タ S U M の 値 を 上 記 分 割 数 N の 2 乗 で 除 算 し た 値 に フ ィ ー ド フ ォ ワ ー ド 係 数 α を 乗 じ て フ ィ ー ド フ ォ ヮ ー ド 量 F F O を 求 め る 。 こ こ で 、 図 2 で は 省 略 し た が 、 レ ジ ス タ R 2 に 記 憶 さ れ た 分 配 周 期 の 移 動 指 令 M cmdに 基 づ い て D D A 処 理 を 行 な っ て 位 置 · 速 度 ル ー プ 処 理 周 期 に 対 す る 移 動 指 令 を 求 め 、 該 移 動 指 令 に 基 づ い て 位 置 ル ー プ 処 理 を 行 な う 速 度 指 令 を 求 め る 。 そ し て 、 求 め ら れ た 速 度 指 令 に 上 記 フ ィ ー ド フ ォ ワ ー ド 量 F F O を 加 算 し 、 フ ィ ー ド フ ォ ワ ー ド 量 F F O に よ り 補 正 さ れ た 速 度 指 令 V endを 求 め 、 こ の 速 度 指 令 V cmdに よ り 従 来 と 同 様 の 速 度 ル ー プ 処 理 が 実 行 さ れ る こ と に な る 。 次 に 、 ス テ ッ プ S 1 5 で カ ウ ン タ じ に 「 1 」 を 加 算 す る 。 な お 、 D D A 処 理 、 位 置 ル ー プ 処 理 、 速 度 ル ー プ 処 理 は 従 来 と 同 様 で あ る こ と か ら 説 明 を 省 略 す る 。
上 記 ス テ ッ プ S 1 1 〜 ス テ ッ プ S 1 5 の 処 理 が フ ィ ー ド フ ォ ワ ー ド 量 F F O を 求 め る 処 理 で あ り 、 こ こ で は 、 前 述 し た 式 ( 1 ) の 演 算 に よ っ て フ ィ ー ド フ ォ ワ ー ド 量 F F O を 求 め ず 、 D D A に 入 力 さ れ る 各 分 E周 期 の 移 動 指 令 M c rodに よ っ て 求 め て い る 。 し か し 、 両 者 は 実 質 的 に は 同 一 で あ る 。 そ の 理 由 を 以 下 説 明 す る 。
説 明 を 簡 単 に す る た め に 、 先 に 示 し た 例 を と つ て 説 明
す る 。 分 E周 期 を 8 m s e c , 位 置 ' 速 度 ル ー プ 処 理 周 期 を l m s e c , フ ィ ー ド ォ ワ ー ド 係 数 α を 「 1 」 と し、 C N C か ら 分 Ε周 期 毎 に 出 力 さ れ る 移 動 指 令 M eadが 、 「 0 」 , 「 0 」 , 「 8 X 8 」 , 「 一 1 6 X 8 」 で あ っ た と す る 。 ス テ ッ プ S 1 で 読 み 取 っ た 移 動 指 令 M eadの 值 が 「 8 X 8 」 の と き 、 レ ジ ス タ R 3 に は 「 0 」 、 R 2 に は 「 0 」 、 R 1 に は 「 8 X 8 」 が 記 憶 さ れ る こ と に な る。
そ し て 、 カ ウ ン タ C の 値 が 以 下 の と き に は、 ア キ ュ ム レ ー タ S U M に は レ ジ ス タ R 2 の 値 か ら レ ジ ス タ R 3 の 値 を 減 じ た 値 が 加 算 さ れ ( ア キ ュ ム レ ー タ S U N は 初 期 設 定 で 始 め は 「 0 」 で あ る と す る ) 、 R 2 = R 3 = 0 で あ る の で ア キ ュ ム レ ー タ S U N の 値 は 「 0 」 で あ り 、 フ ィ ー ド フ ォ ワ ー ド 量 F F O は 「 0 」 と な る 。
そ の 結 果 カ ウ ン タ C の 値 が 0 、 1 、 2 、 3 、 4 ま で は、 フ ィ ー ド フ ォ ワ ー ド 量 F F O は 「 0 」 と な る 。 し か し 、 カ ウ ン タ C の 値 が 「 5 」 に な っ た と き は ス テ ッ プ S I 1 か ら ス テ ッ プ S 1 3 に 移 行 し 、 ア キ ュ ム レ ー タ S U M に は レ ジ ス タ R 1 の 値 か ら レ ジ ス タ R 2 の 値 を 減 じ た 値 が 加 算 さ れ 、 レ ジ ス タ R 1 は 「 8 X 8 」 の 値 、 レ ジ ス タ R 2 は 「 0 」 を 記億 し て い る の で 、 ア キ ュ ム レ ー タ S U M に は 「 8 X 8 」 の 値 が 記 憶 さ れ 、 ス テ ッ プ S 1 4 で 求 め ら れ る フ ィ ー ド フ ォ ワ ー ド 量 F F O は 「 1 」 と な る ( 図 6 参照 ) 。
以下 カ ウ ン タ C が 歩 進 し 、 カ ウ ン タ C の 値 が 「 6 」 、 「 7 I の と き に は フ ィ ー ド フ ォ ワ ー ド 量 F F O は そ れ ぞ
れ 「 2 」 、 「 3 」 と な る 。 そ し て 、 カ ウ ン タ C の 値 が ス テ ツ プ S 1 5 で 「 8 」 に な っ た と き に は 、 1 分 E周 期 が 終 了 す る の で ス テ ッ プ S 7 で 再 び 「 0 」 に セ ッ ト さ れ る。 ま た こ の と き は ス テ ッ プ S 1 で 次 の 移動 指 令 M endの 値 「 一 1 6 X 8 」 が 読 み 込 ま れ 、 レ ジ ス タ R 3 に は 「 0 」, R 2 に は 「 8 X 8 」 、 R 1 に は 「 一 1 6 X 8 」 が 記 憶 さ れ る こ と に な る 。 そ し て 、 カ ウ ン タ C の 値 が 「 4 」 に な る ま で ア キ ュ ム レ ー タ S U M に は レ ジ ス タ R 2 の 値 「 8 X 8 」 が 加 算 さ れ ( R 3 = 0 ) ) 、 C = 0 、 1 、 2 、 3、 4 の と き フ ィ ー ド フ ォ ワ ー ド 量 F F O は そ れ ぞ れ 4 、 5、 6 、 7 、 8 と な る 。 ま た 、 カ ウ ン タ C の 値 が 4 の と き ァ キ ュ ム レ ー タ S U M に は 「 8 X 8 」 X 8 の 値 が 記 憶 さ れ て お り 、 カ ウ ン タ C が 「 5 」 に な り ス テ ッ プ S 1 1 か ら ス テ ッ プ S 1 3 に 進 ん だ と き に は ア キ ュ ム レ ー タ S U M に は こ の 値 「 8 X 8 」 X 8 に レ ジ ス タ R 1 に 記 憶 さ れ た 「 一 1 6 X 8 」 の 値 が 加 算 さ れ 、 レ ジ ス タ R 2 の 値 「 8 X 8 」 が 減 算 さ れ る 。 そ の 結 果 、 ス テ ッ プ S 1 4 で フ ィ ー ド フ ォ ワ ー ド 量 F F O は 、
F F 0 = ( 8 X 8 X 8 - 1 6 X 8 - 8 X 8 ) / 8 X 8
= 5
と な る 。 以 下 カ ウ ン タ C の 値 が 「 6 」 、 「 7 」 の と き に は フ ィ ー ド フ ォ ワ ー ド 量 F F O は 夫 々 2 、 一 1 と な る 。
以 下 上 述 し た 処 理 を 行 な う こ と に よ っ て 図 2 に 示 す 状 態 と 同 一 の 状 態 が 生 じ 、 式 ( 2 ) の 演 算 を 行 な っ た と き と 同 一 と な る 。
再 び 図 2 に 示 す 処 理 の 説 明 に 戻 る 。 ス テ ッ プ S 1 5 か ら 、 ス テ ッ プ S 1 6 に 進 み 、 フ ラ グ F 1 が 「 1 」 か 否 か を 判 断 す る 。 ス テ ッ プ S 4 で フ ラ グ F 1 が 「 1 」 に 設 定 さ れ て な け れ ば ( 移 動 指 令 の 正 負 の 反 転 が な け れ ば ) 、 ス テ ッ プ S 1 6 か ら ス テ ッ プ S 2 1 に 進 み 、 ッ ク ラ ッ シ 加速 時 に 「 1 」 に セ ッ ト さ れ る フ ラ グ F 2 が 「 1 」 か 否 か 判 断 す る 。 フ ラ グ F 2 が 「 1 」 で な け れ ば ( 後 述 す る よ う に 、 方 向 反 転 が 生 じ な い 限 り 該 フ ラ グ F 2 は 「 1」 に セ ッ ト さ れ な い ) 、 ス テ ッ プ S 2 6 に 進 み 、 ' ッ ク ラ ッ シ 加 速 時 間 を 計 数 す る カ ウ ン タ D が 「 0 」 以 下 か 否 か 判 断 し 、 こ の カ ウ ン タ D が 「 0 」 な ら ば ( 後 述 す る よ う に バ ッ ク ラ ッ シ 加 速 指 令 が 出 力 さ れ て な け れ ば 、 こ の 力 ゥ ン タ D は 「 0 」 で あ る ) 、 フ ィ ー ド フ ォ ー ド 処 理 及 び * ッ ク ラ ッ シ 処 理 を 終 了 す る 。
—方 、 ス テ ッ プ S 1 に 於 い て 読 み 取 っ た 次 回 の 移 動 指 令 M endと レ ジ ス タ R zに 記 憶 さ れ た 移 動 指 令 の 正 負 が 反 転 し 、 ス テ ッ プ S 4 で フ ラ グ F 1 が 「 1 」 に セ ッ ト さ れ た と き に は 、 ス テ ッ プ S 1 6 か ら 、 ス テ ッ プ S 1 7 に 移 行 す る 。 ス テ ッ プ S 1 7 で は 、 レ ジ ス タ R 1 に 記 億 さ れ た 移動 指 令 が正 か 負 か に よ り 方 向 反 転 が 正 か ら 負 に 変 化 し た の か 、 負 か ら 正 に 変 化 し た の か を 判 断 し 、 レ ジ ス タ R 1 の 値 が 負 で あ れ ば 、 正 か ら 負 に 変 化 し た も の と し て ス テ ッ プ S 1 8 に 移 行 す る 。 ま た 、 レ ジ ス タ R 1 の 値 が 正 で あ れ ば ス テ ッ プ S 1 9 に 移 行 す る 。 そ し て 、 ス テ ツ プ S 1 8 で は ス テ ッ プ S 1 4 で 算 出 さ れ た フ ィ ー ド フ ォ
ヮ ー ド 量 F F 0 が 「 0 」 以 下 か 否 か を 判 断 し 、 「 0 」 以 下 で な け れ ば 、 ス テ ッ プ S 2 1 に 移 行 し 前 述 し た 処 理 を 行 な い バ ッ ク ラ ッ シ 加 速 補 正 を 開 始 し な い 。 ま た 、 ス テ ッ プ S 1 9 で は フ ィ ー ド フ ォ ワ ー ド 量 F F O が 「 0 」 以 上 で な け れ ば 、 ス テ ッ プ S 2 1 に 進 み 前 述 同 様 に バ ッ ク ラ ッ シ 加 速 補 正 を 開 始 し な い 。
す な わ ち 、 図 6 に 示 す よ う に 、 読 み 取 っ た 次 回 の 移 動 指 令 の 符 号 が 反 転 し た と し て も 、 フ ィ ー ド フ ォ ワ ー ド 量 F F 0 は 直 ち に 反 転 す せ ず 、 バ ッ ク ラ ッ シ 加 速 補 正 は 開 始 さ れ な い 。 ス テ ッ プ S 1 2 の 処 理 で か ら も 明 ら か の よ う に 、 分 B2周 期 の 半 周 期 に 対 応 す る 位 置 · 速 度 ル ー プ 処 理 周 期 の 数 ( N Z 2 ) ま で は 、 反 転 し た 移 動 指 令 は フ ィ 一 ド フ ォ ヮ ー ド 量 F F O の 算 出 に は 影 響 し な い の で 、 少 な く と も N Z 2 回 の 位 置 ' 速 度 ル ー プ 処 理 周 期 間 で は フ イ ー ド フ ォ ワ ー ド 量 F F 0 の 符 号 は 反 転 し な い 。 例 え ば、 図 6 に 示 す よ う に 、 次 回 の 移 動 指 令 M cmdの 符 号 が 負 に 反 転 し て も 、 始 め の 位 置 . 速 度 ル ー プ 処 理 の 数 周 期 は フ ィ ー ド フ ォ ヮ ー ド 量 F F O の 符 号 は 反 転 し な い 。
し か し 、 ス テ ッ プ S 1 8 、 S I 9 で フ ィ ー ド フ ォ ヮ 一 ド 量 F F 0 が 「 0 」 、 若 し く は 正 負 が 反 転 し た と 判 断 さ れ る と 、 ス テ ッ プ S 2 0 で フ ラ グ F 2 を 「 1 」 に セ ッ ト す る 。 フ ラ グ F 2 が 「 1 」 に セ ッ 卜 さ れ た こ と か ら 、 ス テ ツ プ S 2 1 か ら ス テ ッ プ S 2 2 に 移 行 し 、 カ ウ ン タ D に 設 定 さ れ て い る バ ッ ク ラ ッ シ 加 速 補 正 時 間 に 対 応 す る 値 A を セ ッ 卜 す る と 共 に 、 ス テ ッ プ S 2 3 で フ ラ グ F 2
を 「 0 J に セ ッ ト す る 。
次 の ス テ ッ プ S 2 4 で は 、 設 定 さ れ て い る ノ、' ッ ク ラ ヅ シ 加速 補 正 量 を 出 力 し 、 フ ィ ー ド フ ォ ワ ー ド 量 F F O で 補正 さ れ た 速 度指 令 V cadに こ の パ ッ ク ラ ッ シ 加 速 補 正 量 を 加算 し 、 ス テ ッ プ S 2 5 で カ ウ ン タ D か ら 「 1 」 を 減算 し て 当 該 周 斯 の こ の フ ィ ー ド フ ォ ヮ ー ド 制御 及 び バ ッ ク ラ ッ シ 加 速 補 正 制 御 を 終 了 す る 。
次 の 位 置 . 速 度 ル ー プ 処理 周 期 か ら は 、 フ ラ グ F 1 、 F 2 が 「 0 」 に セ ッ ト さ れ て い る こ と か ら 、 ス テ ッ プ S 1 1 〜 S 1 5 、 S 1 6 、 S 2 1 の 処 理 を 行 な い ス テ ッ プ S 2 6 に 進 み 、 カ ウ ン タ D が 「 0 」 に な る ま で 、 即 ち 、 設定 さ れ た バ ッ ク ラ ッ シ 加速 補 正 時 間 が 絰 過 す る ま で 、 ス テ ッ プ S 2 4 、 S 2 5 の 処 理 を 行 な い 、 ノ ッ ク ラ ッ シ 加 速 浦 正 を 行 な う 。 そ し て 、 カ ウ ン タ D が 「 0 」 に な る と 、 以 後 は パ ッ ク ラ ッ シ 加 速 捕 正 を 行 な わ な い 。
以上 の 処 理 を 繰 り 返 す こ と に よ っ て 、 バ ' y ク ラ ッ シ 加 速 補正 の 開 始 は フ ィ ー ド フ ォ ヮ ー ド 量 F F O の 正 負 を 示 す 符 号 が 反 転 し た 時 に 行 わ れ る の で 、 最 適 な 位 置 で バ ッ ク ラ ッ シ 加 速 捕正 が 実 行 さ れ る 。
ま た 前 述 し た よ う に 、 フ ィ ー ド フ ォ ワ ー ド 係 数 な が
「 1 」 に 近 い 値 の と き は 、 速 度 ル ー プ 処 理 に 入 力 さ れ る 速 度指 令 V c in dは フ ィ 一 ド フ ォ ヮ ー ド に よ る 指 令 値 が 大 部 分 を 占 め る こ と に な る の で 、 フ ィ ー ド フ ォ ワ ー ド 童 F F O の 正 負 を 示 す 符 号 反転 の 代 わ り に 、 上 記 速 度 指 令 V cadの 正 負 を 示 す 符 号 の 反 転 を 検 出 し 、 反 転 し た 時 を
バ ッ ク ラ ッ シ 加 速 補 正 開 始 時 に し て も よ い 、 こ の 場 合 、 ス テ ッ プ S 1 8 、 S 1 9 の 判 断 は 上 記 速 度 指 令 V cindの 値 と 「 0 」 が 比 較 さ れ る こ と に な る 。
図 8 は C N C か ら 出 力 さ れ る 移 動 指 令 と フ ィ ー ド フ ォ ワ ー ド 量 の 値 の 正 負 反 転 時 を 比 較 す る た め の 例 を 示 し 、 半 径 1 6 m m の 円 を 、 速 度 4 0 0 O m m m i n 、 分 配 周 期 8 m s e (: 、 位 置 . 速 度 ル ー プ 処 理 周 期 l m s e s で 加 工 す る 場 合 の 例 で あ る 。 こ の 場 合 、 分 E周 期 毎 の 移 動 指 令 で 0 . 5 3 m m 、 中 心 角 に し て 1 . 9 度 移 動 す る。 そ の 結 果 、 図 8 中 に R で 示 す よ う に 、 該 円 を 加 工 す る プ ロ グ ラ ム 開 始 位 置 に よ っ て 、 移 動 方 向 が 反 転 す る 位 置 は 1 . 9 度 の 間 に バ ラ ッ ク こ と に な る 。
こ れ に 対 し て 、 フ ィ ー ド フ ォ ワ ー ド 量 は 図 8 中 に S で 示 す よ う に 約 0 . 2 度 の バ ラ ツ キ し か な く 、 よ り に 正 確 に バ ッ ク ラ ッ シ 加 速 開 始 位 置 を 求 め る こ と が で き る 。
本 発 明 は 、 工 作 機 械 の 送 り 軸 を 制 御 す る サ ー ボ モ ー タ の 制 御 に フ ィ ー ド フ ォ ワ ー ド 制 御 を 行 な う サ ー ボ 系 を 用 い た 場 合 、 フ ィ ー ド フ ォ ワ ー ド 量 の 正 負 反 転 時 、 若 し く は 該 フ ィ ー ド フ ォ ヮ ー ド 量 で 捕 正 さ れ た 速 度 指 令 の 正 負 反 転 時 を バ ッ ク ラ ッ シ 加 速 補 正 開 始 時 と す る こ と に よ つ て 、 分 記 さ れ た 移 動 指 令 の 方 向 反 転 の 変 動 を 吸 収 し て よ り 正 確 な 位 置 か ら バ ッ ク ラ ッ シ 加 速 補 正 を 実 施 す る こ と が で き る 。
Claims
1 . サ ー ポ モ ー タ で 駆 動 さ れ る 工 作機 械 の 送 り 軸 の 移 動 方 向 が 反 耘 す る と き に 行 な う バ ッ ク ラ ッ シ 加 速 制 御 方 法 で あ っ て 、
位 置 · 速 度 ル ー プ 処 理 周 期 と 該 周 期 の 前 後 の 数 周 期 の 移 勖指 令 の 平 均值 を 求 め る ス ム ー ジ ン グ 処 理 を 行 な っ て フ ィ ー ド フ ォ ヮ ー ド 量 を 求 め 、
上 記 フ ィ ー ド フ ォ ヮ ー ド 量 を 用 い て フ ィ ー ド フ ォ ヮ ー ド 制 御 を 行 な い 、
上 記 フ ィ 一 ド フ ォ ヮ ー ド 量 の 値 の 正 負 が 反 転 し た と き に パ ッ ク ラ ヅ シ 加 速 補 正 を 開 始 す る 、 バ ッ ク ラ ヅ シ 加 速 制 御 方 法 。
2 . 上記 ス ム ー ジ ン グ 処 理 は 、 位 置 ' 速 度 ル ー プ 処 理 を 行 な う 周 期 の 移動 指 令 を 中心 と し た そ の 前 後 の 位 置 · 速 度 ル ー プ 周 期 の 移 動 指 令 の う ち 分 E 周 期 に 対 応 す る 数 の 位 置 · 速 度 ル ー プ 周 期 の 移 動 指 令 の 平 均 を 求 め る こ と か ら 成 り 、
上記 フ ィ ー ド フ ォ ワ ー ド 量 は 、 上 記 ス ム ー ジ ン グ 処 理 で 求 め ら れ た 移動 指 令 の 平 均 値 に フ ィ ー ド フ ォ ヮ ー ド 係 数 を 乗 じ て 求 め ら れ る 、 請 求 の 範 囲 第 1 項 に 記載 の バ ッ ク ラ ッ シ 加 速 制 御 方 法 。
3 . 上 記 フ ィ ー ド フ ォ ワ ー ド 量 は 、 位 置 · 速 度 ル ー プ 処 理 を 行 な う 分 E 周 期 の 移 動 指 令 、 次 回 の 分 E 周 期 で 供 耠 さ れ る 移 動 指 令 、 及 び 前 回 の 分 配 周 斯 で 供 給 さ れ た 移 動 指 令 を 用 い て 求 め ら れ る 、 請 求 の 範 囲 第 1 項 に 記 載 の バ
ッ ク ラ ッ シ 加 速 制 御 方 法 。
4 . サ ー ボ モ ー タ で 駆 動 さ れ る 工 作 機 械 の 送 り 軸 の 移 動 方 向 が 反 転 す る と き に 行 な わ れ る バ ッ ク ラ ッ シ 加 速 制 御 方 法 で あ っ て 、
数 値 制 御 装 置 か ら の 移 動 指 令 に ス ム ー ジ ン グ 処 理 を 行 な っ て フ ィ ー ド フ ォ ヮ ー ド 量 を 求 め 、
上 記 フ ィ 一 ド フ ォ ヮ 一 ド 量 を 用 い て フ ィ 一 ド フ ォ ヮ ー ド 制 御 を 行 な い 、
位 置 偏 差 に ポ ジ シ ョ ン ゲ イ ン を 乗 じ た 値 に 上 記 フ ィ ー ド フ ォ ヮ ー ド 量 を 加 算 し て 速 度 指 令 を 求 め 、
上 記 速 度 指 令 の 値 の 正 負 が 反 転 し た と き に バ ッ ク ラ ッ シ 加 速 補 正 を 開 始 す る 、 バ ッ ク ラ ッ シ 加 速 制 御 方 法 。
5 . 上 記 ス ム ー ジ ン グ 処 理 は 、 位 置 ' 速 度 ル ー プ 処 理 を 行 な う 周 期 の 移 動 指 令 を 中 心 と し た そ の 前 後 の 位 置 · 速 度 ル ー プ 周 期 の 移 動 指 令 の う ち 分 配 周 期 に 対 応 す る 数 の 位 置 · 速 度 ル ー プ 周 期 の 移 動 指 令 の 平 均 を 求 め る こ と か ら 成 り 、
上 記 フ ィ ー ド フ ォ ヮ ー ド 量 は 、 上 記 ス ム ー ジ ン グ 処 理 で 求 め ら れ た 移 動 指 令 の 平 均 値 に フ ィ 一 ド フ ォ ヮ ー ド 係 数 を 乗 じ て 求 め ら れ る 、 請 求 の 範 囲 第 4 項 に 記 載 の バ ッ ク ラ ッ シ 加 速 制 御 方 法 。
6 . 上 記 フ ィ ー ド フ ォ ワ ー ド 量 は 、 位 置 ' 速 度 ル ー プ 処 理 を 行 な う 分 配 周 期 の 移 動 指 令 、 次 回 の 分 配 周 期 で 供 給 さ れ る 移 動 指 令 、 及 び 前 回 の 分 E 周 期 で 供 給 さ れ た 移 動 指 令 を 用 い て 求 め ら れ る 、 請 求 の 範 囲 第 4 項 に 記 載 の バ
ッ ク ラ ッ シ 加 速制 御 方 法 。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
KR1019920703015A KR970005566B1 (ko) | 1991-05-24 | 1992-05-22 | 백클래시(Backlash) 가속 제어 방법 |
DE69223927T DE69223927T2 (de) | 1991-05-24 | 1992-05-22 | Verfahren zur regelung des beschleunigungsspiels |
US07/934,662 US5367238A (en) | 1991-05-24 | 1992-05-22 | Backlash acceleration control method |
EP92910677A EP0540761B1 (en) | 1991-05-24 | 1992-05-22 | Method of controlling backlash acceleration |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP3/149614 | 1991-05-24 | ||
JP3149614A JP2826391B2 (ja) | 1991-05-24 | 1991-05-24 | バックラッシ加速制御方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO1992021075A1 true WO1992021075A1 (en) | 1992-11-26 |
Family
ID=15479062
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP1992/000666 WO1992021075A1 (en) | 1991-05-24 | 1992-05-22 | Method of controlling backlash acceleration |
Country Status (6)
Country | Link |
---|---|
US (1) | US5367238A (ja) |
EP (1) | EP0540761B1 (ja) |
JP (1) | JP2826391B2 (ja) |
KR (1) | KR970005566B1 (ja) |
DE (1) | DE69223927T2 (ja) |
WO (1) | WO1992021075A1 (ja) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3805309B2 (ja) * | 2003-01-30 | 2006-08-02 | ファナック株式会社 | サーボモータ駆動制御装置 |
US7141946B2 (en) * | 2003-09-15 | 2006-11-28 | Rockwell Automation Technologies, Inc. | Method and apparatus for providing optimal acceleration feedback |
JP2006039807A (ja) * | 2004-07-26 | 2006-02-09 | Fanuc Ltd | 数値制御装置 |
KR101330660B1 (ko) | 2006-09-08 | 2013-11-15 | 삼성전자주식회사 | 스캐닝 유닛의 제어가 가능한 화상형성장치, 그의 스캐닝 유닛 제어 방법 및 모터 제어 장치 |
US7614626B1 (en) | 2007-07-20 | 2009-11-10 | Aanerud Richard R | Moving target system |
JP5111589B2 (ja) * | 2010-10-27 | 2013-01-09 | 株式会社牧野フライス製作所 | 送り軸反転時の補正方法 |
JP6203780B2 (ja) * | 2015-04-21 | 2017-09-27 | ファナック株式会社 | テーブル形式データによる運転を行う数値制御装置 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6375907A (ja) * | 1986-09-19 | 1988-04-06 | Fanuc Ltd | フルクロ−ズフイ−ドバツクncシステムにおける追従遅れの除去方法 |
JPS63308613A (ja) * | 1987-06-10 | 1988-12-16 | Fanuc Ltd | サ−ボモ−タの制御方式 |
JPH02143605U (ja) * | 1989-05-01 | 1990-12-05 | ||
JPH02309402A (ja) * | 1989-05-25 | 1990-12-25 | Yaskawa Electric Mfg Co Ltd | サーボシステム |
JPH0384603A (ja) * | 1989-08-29 | 1991-04-10 | Fanuc Ltd | バックラッシュ加速量自動調整方式 |
JPH03110603A (ja) * | 1989-09-26 | 1991-05-10 | Fanuc Ltd | サーボモータのバックラッシュ補正制御方法 |
Family Cites Families (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS5221674B2 (ja) * | 1972-08-08 | 1977-06-11 | ||
JPS6140616A (ja) * | 1984-07-31 | 1986-02-26 | Fanuc Ltd | 位置制御方式 |
JPS63100505A (ja) * | 1986-10-17 | 1988-05-02 | Mitsubishi Heavy Ind Ltd | 多自由度可動機械のフイ−ドフオワ−ド制御装置 |
JP2703575B2 (ja) * | 1988-09-30 | 1998-01-26 | ファナック株式会社 | サーボ制御装置 |
JPH02143605A (ja) * | 1988-11-25 | 1990-06-01 | Toshiba Corp | 可変インピーダンス回路 |
US5157597A (en) * | 1988-12-23 | 1992-10-20 | Fanuc Ltd. | Method of detecting oscillation of a servo system and automatically adjusting speed loop gain thereof |
JPH02235105A (ja) * | 1989-03-09 | 1990-09-18 | Fanuc Ltd | サーボモータのバックラッシュ補正方式 |
US5134354A (en) * | 1989-04-10 | 1992-07-28 | Kabushiki Kaisha Yaskawa Denki Seisakusho | Servo motor control apparatus |
JPH02275508A (ja) * | 1989-04-18 | 1990-11-09 | Fanuc Ltd | フィードフォワード制御方式 |
JP2709969B2 (ja) * | 1989-12-12 | 1998-02-04 | ファナック株式会社 | サーボモータの制御方法 |
JP2813909B2 (ja) * | 1989-12-28 | 1998-10-22 | 東芝機械株式会社 | 数値制御装置のバックラッシュ補正方式 |
-
1991
- 1991-05-24 JP JP3149614A patent/JP2826391B2/ja not_active Expired - Fee Related
-
1992
- 1992-05-22 DE DE69223927T patent/DE69223927T2/de not_active Expired - Fee Related
- 1992-05-22 WO PCT/JP1992/000666 patent/WO1992021075A1/ja active IP Right Grant
- 1992-05-22 EP EP92910677A patent/EP0540761B1/en not_active Expired - Lifetime
- 1992-05-22 KR KR1019920703015A patent/KR970005566B1/ko active IP Right Grant
- 1992-05-22 US US07/934,662 patent/US5367238A/en not_active Expired - Lifetime
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPS6375907A (ja) * | 1986-09-19 | 1988-04-06 | Fanuc Ltd | フルクロ−ズフイ−ドバツクncシステムにおける追従遅れの除去方法 |
JPS63308613A (ja) * | 1987-06-10 | 1988-12-16 | Fanuc Ltd | サ−ボモ−タの制御方式 |
JPH02143605U (ja) * | 1989-05-01 | 1990-12-05 | ||
JPH02309402A (ja) * | 1989-05-25 | 1990-12-25 | Yaskawa Electric Mfg Co Ltd | サーボシステム |
JPH0384603A (ja) * | 1989-08-29 | 1991-04-10 | Fanuc Ltd | バックラッシュ加速量自動調整方式 |
JPH03110603A (ja) * | 1989-09-26 | 1991-05-10 | Fanuc Ltd | サーボモータのバックラッシュ補正制御方法 |
Non-Patent Citations (1)
Title |
---|
See also references of EP0540761A4 * |
Also Published As
Publication number | Publication date |
---|---|
DE69223927T2 (de) | 1998-04-30 |
KR930700252A (ko) | 1993-03-13 |
JP2826391B2 (ja) | 1998-11-18 |
EP0540761A4 (ja) | 1995-03-08 |
EP0540761A1 (en) | 1993-05-12 |
EP0540761B1 (en) | 1998-01-07 |
US5367238A (en) | 1994-11-22 |
KR970005566B1 (ko) | 1997-04-17 |
DE69223927D1 (de) | 1998-02-12 |
JPH04347706A (ja) | 1992-12-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP2709969B2 (ja) | サーボモータの制御方法 | |
US5331264A (en) | Method and device for generating an input command for a motion control system | |
JP3129622B2 (ja) | フルクローズド・ループ方式における象限突起補正方法 | |
WO1995005703A1 (fr) | Appareil et procede pour commander un servomoteur | |
JP2875646B2 (ja) | バックラッシ加速補正装置 | |
JPH0683403A (ja) | 適応pi制御方式 | |
JP2000250614A (ja) | バックラッシ補正装置および数値制御システム | |
JPH0969013A (ja) | サーボモータを用いたサーボ系の制御モード切り換え方法 | |
JP2000322105A (ja) | サーボ制御装置およびサーボ制御装置の安定化調整方法 | |
US5517100A (en) | Method of controlling a servo motor | |
WO1992021075A1 (en) | Method of controlling backlash acceleration | |
JP3749222B2 (ja) | 数値制御装置 | |
KR970002259B1 (ko) | 서보모터의 제어방법 | |
JP2002091570A (ja) | サーボ制御方法 | |
JP3226413B2 (ja) | 数値制御装置 | |
JP3253022B2 (ja) | サーボモータのバックラッシュ補正制御方法 | |
JPH10105247A (ja) | サーボモータのオーバーシュート防止方法 | |
JPH0580805A (ja) | Pi制御ループをベースにした適応スライデイングモード制御方式 | |
JP3308656B2 (ja) | サーボモータの制御方法 | |
JP2003047269A (ja) | サーボ制御装置 | |
JPS6378206A (ja) | フルクロ−ズフイ−ドバツクncシステムにおけるデジタルサ−ボシステムを用いた追従遅れを除去する方法 | |
JPH08286759A (ja) | 静摩擦を補償するロボット駆動制御方法 | |
JPH0421101A (ja) | 学習コントローラの飽和処理方式 | |
JP2001100819A (ja) | 位置駆動制御システムおよび同期・同調位置駆動制御方法 | |
JPH0540521A (ja) | サーボモータの制御装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
AK | Designated states |
Kind code of ref document: A1 Designated state(s): KR US |
|
AL | Designated countries for regional patents |
Kind code of ref document: A1 Designated state(s): AT BE CH DE DK ES FR GB GR IT LU MC NL SE |
|
WWE | Wipo information: entry into national phase |
Ref document number: 1992910677 Country of ref document: EP |
|
WWP | Wipo information: published in national office |
Ref document number: 1992910677 Country of ref document: EP |
|
WWG | Wipo information: grant in national office |
Ref document number: 1992910677 Country of ref document: EP |