SIGNAL PROCESSING DEVICE, VELOCITY DETECTING DEVICE AND SERVO MECHANISM

Abstract

A driving velocity of a motor is detected by processing a position information signal output from a sensor in accordance with a driving position of a motor. The signal processing device includes a position information signal processor (410) that processes the position information signal and calculates driving velocity information of the motor, and an internal position information generator (460) that reflects a latest driving velocity information (ωn) calculated by the position information signal processor (410) and generates a latest presumed position of the motor as internal position information. An amplitude correcting unit (465) detects the amplitude of the position information signal from the sensor and corrects the amplitude of the internal position information signal based on the detected amplitude.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

FIG. 1 is a block diagram of a first embodiment drawn to a servomechanism of the present invention;

FIG. 2 is an illustration of a two-phase signal output from an encoder in the first embodiment;

FIG. 3 is a block diagram showing the configuration of a velocity calculator in the first embodiment;

FIG. 4 is an illustration showing a relationship between a sine wave signal (A_i sin θ) input from the encoder and an internal position information (A_i sin θ_n) generated by an internal position information generator;

FIG. 5 is an illustration showing a relationship between an amplitude of sine wave and an amplitude of cosine wave;

FIG. 6 is a block diagram showing the configuration of a velocity calculator (a signal processing device) according to a second embodiment of the present invention;

FIG. 7 is a block diagram showing the configuration of a third embodiment;

FIG. 8 is a block diagram showing a modification of the present invention;

FIG. 9 is a block diagram showing the configuration of a conventional servomechanism; and

FIG. 10 is a timing chart of rotation velocity control of a motor in the conventional servomechanism.

DETAILED DESCRIPTION OF PREFERRED EMBODIMENT(S)

Embodiments of the present invention will be illustrated and described with reference to reference characters given to respective elements in the drawings.

First Embodiment

A first embodiment of a servomechanism of the present invention will be described below.

FIG. 1 is a block diagram of the servomechanism.

A servomechanism 100 includes a motor (driver) 110 as an object to be controlled, an encoder 120 as a sensor that outputs a position information signals (a periodic function signal) of both a sine wave (Asin θ) and a cosine wave (Acos θ) in accordance with rotation of the motor 110, and a controller 300 that calculates a motor rotation velocity (driving velocity information) based on the position information signal from the encoder 120 and controls the motor rotation velocity to achieve a target velocity input from the outside.

Though not described in detail, the encoder 120 is the known rotary encoder 120, which has a rotor integrally rotating with a rotator of the motor 110 and outputs the position information signal (Asin θ, Acos θ), i.e., a periodic function periodically changing in accordance with the rotation of the rotor. As shown in FIG. 2, the position information signal is a two-phase signal containing a sine wave (Asin θ) and a cosine wave (Acos θ) having 90° phase difference with each other. The rotary encoder 120 may be a photoelectric encoder, a capacitance encoder, a magnetic encoder or the like.

The controller 300 includes a velocity calculator 400 as a signal processing device that processes the position information signal from the encoder 120 and calculates the motor rotation velocity, and a CPU 31.0 as a central processing unit that compares the motor rotation velocity calculated by the velocity calculator 400 with the target velocity Input from the outside and controls the motor rotation velocity to achieve the target velocity.

The configuration of the velocity calculator 400 will be described below.

FIG. 3 is a block diagram showing the configuration of the velocity calculator 400.

The velocity calculator 400 includes a position information signal processor 410 that processes the two-phase signal (A_i sin θ, A_i cos θ) output from the encoder 120 and calculates the motor rotation velocity (ω_a), a signal switching section 450 that selects the motor rotation velocity information based on either one of the two-phase signal by comparing with a predetermined condition, an internal position information generator 460 that generates motor driving position information (ω_n) reflecting a latest motor rotation velocity as internal, position information based on the motor rotation velocity (ω_n) from the position information signal processor 410, and an output unit 480 that outputs the motor rotation velocity information (ω_n) and the motor driving position information (ω_n) of the motor 110.

The position information signal processor 410 includes a sine signal processor (a first signal processor) 420 that processes the sine wave signal (A_i sin θ) contained in the two-phase signal output from the encoder 120 and calculates a rotation changing amount (Δθ₁) of the motor 110, a cosine signal processor (a second signal processor) 430 that processes the cosine wave signal (A_i cos θ) contained in the two-phase signal output from the encoder 120 and calculates a rotation changing amount (Δθ₂) of the motor 110, and a sign converter 440 that converts the rotation changing amounts (Δθ₁, Δθ₂) respectively from the sine signal processor 420 and the cosine signal processor 430 into rotation angular velocities (ω₁, ω₂ (rad/s)) of the motor 110 according to a normal rotation direction.

The sine signal processor 420 includes a first subtracter (a difference calculator) 421 that subtracts the internal position information (Δ_i sin θ) generated by the internal position information generator 460 from the sine wave signal (Δ_i sin θ) input by the encoder 120 to output a difference signal, and a first gain multiplier (a driving velocity calculator) 422 that multiplies the difference signal output from the first subtracter 421 by a predetermined gain (K) to calculate the motor rotation changing amount (Δθ₁).

The first subtracter 421 subtracts the motor driving position information (the internal position Information A_i sin θ_n) generated by the internal position information generator 460 from the sine wave signal (A_i sin θ) input from the encoder 120.

The difference calculated by the first subtracter 421 is a difference of a function value (A_i sin θ-A_i sin θ_n), and then, the first gain multiplier 422 multiplies the difference signal output from the first subtracter 421 by the predetermined gain (K) to output the rotation changing amount (Δθ₁) of the motor 110.

The cosine signal processor 430 includes a second subtracter (a difference calculator) 431 that subtracts the cosine wave signal (B_i cos θ) input by the encoder 120 from the internal position information (B_i cos θ_n) generated by the internal position information generator 460 to output a difference signal, and a second gain multiplier (a driving velocity calculator) 432 that multiplies the difference signal output from the second subtracter 431 by the predetermined gain (K) to calculate the motor rotation changing amount (Δθ₂).

The sign, converter 440 includes a first sign converter 441 that converts the motor rotation changing amount (Δθ₁) output from the sine signal processor 420 based on a sign of the cosine wave signal (B_i cos θ), and a second sign converter 442 that converts the motor rotation changing amount (Δθ₂) output from the cosine signal processor 430 based on a sign of the sine wave signal (Asin θ).

The first sign converter 441 multiplies the motor rotation changing amount (Δθ₁) from the first gain multiplier 422 by −1 (minus 1) when the cosine wave signal (Acos θ) is minus (a negative value), and multiplies the motor rotation changing amount (Δθ₁) from the first gain multiplier 422 by +1 (plus 1) when the cosine wave signal (Acos θ) is plus (a positive value).

Similarly, the second sign converter 442 multiplies the motor rotation changing amount (Δθ₂) from die second gain multiplier by −1 (minus 1) when the sine wave signal (Asin θ) is minus (a negative value), and multiplies the motor rotation changing amount (Δθ₂) from the second gain multiplier by +1 (plus 1) when the sine wave signal (Asin θ) is plus (a positive value).

In a ease where the sine wave signal (Asin θ) input from the encoder 120 repeatedly increases/decreases periodically in accordance with the rotation of the motor 110 as shown in FIG. 2, there is a region where the sine wave signal (Asin θ) decreases even when the rotation phase angle increases along with the rotation of the motor 110. Therefore, if the internal position information (Asin θ_n) generated by the internal position information generator 460 is simply subtracted from the input sine wave signal (Asin θ), the rotation changing amount of the motor 110 may possibly be minus although the phase increases along with the normal rotation of the motor 110. To avoid this, the first sign converter 441 converts the sign of the output signal from the first gain multiplier 422 in an increasing direction of the rotation changing amount (Δθ₁) of the motor 110, based on the sign of the cosine wave signal (Acos θ), i.e., the other signal contained in the two-phase signal input from the encoder 120. Accordingly, the motor rotation changing amount (Δθ₁) output from the first gain multiplier 422 is constantly converted in the increasing direction, so that the rotation angular velocity (ω₁) of the motor 110 can be obtained.

Similarly, the second sign converter 442 converts the sign of the signal output from the second gain multiplier 432 in the increasing direction of the rotation changing amount (Δθ₂) of the motor 110, based on the sign of the sine wave signal (Asin θ), i.e. the other signal contained in the two-phase signal input from the encoder 120. Accordingly, the motor rotation changing amount (Δθ₂) output from the second gain multiplier 432 is constantly converted in the increasing direction, so that the rotation angular velocity (ω₂) of the motor 110 can be obtained.

The signal switching section 450 includes a determiner 451 that compares the sine wave signal (Asin θ) input from the encoder 120 with a predetermined threshold and determines whether the sine wave signal is greater or smaller than the threshold, and a switcher 452 that switches the input to the output unit and the internal position information generator 460 to/from the output signal of the sine signal processor 420 from/to the output signal of the cosine signal processor 430.

In a case where the position information signal (Asin θ, Acos θ) input from the encoder 120 increases/decreases periodically in accordance with the rotation of the motor 110, as exemplary shown in FIG. 2, there is a region where the signal value change of the sine wave signal (Asin θ) (or the cosine wave signal (Acos θ)) is small relative to the phase changing amount, for instance, the changing amount of the signal value becomes small relative to the changing amount of the phase (θ) when the phase is around 90° (π/2) or around 270°(3π/2) as for the sine wave signal (Asin θ).

To solve this, the signal switching section 450 switches between the sine wave signal (Asin θ) and the cosine wave signal (Acos θ) to utilize the region where the change in the signal value is great relative to the phase changing amount.

The determiner 451 compares the absolute value |Asin θ| of the sine wave signal with 0.7 A as a predetermined threshold, and determines whether the value is greater or smaller than the threshold. Here, ±0.7 substantially corresponds to ±√2/2, and as for the sine wave signal ±0.7 corresponds to 45° (π/4), 135° (3π/4), 225° (5π/4) and 315° (9π/4).

The switcher 452 includes a sine terminal 453 to which the signal from the sine signal processor 420 is input, and a cosine terminal 454 to which the signal from the cosine signal processor 430 is input, the switcher 452 being formed of a switching unit that switches the input to the internal position information generator 460 and the output unit 480 to/from the sine terminal 453 from/to the cosine terminal 454.

The signal switching section 450 selects the sine terminal 453 if |Asin θ| is smaller than 0.7 A (|Asin θ<0.7 A|), and selects the cosine terminal 454 if |Asin θ| is or greater than 0.7 A, based on the determination by the determiner 451.

Owing to this, as shown in FIG. 2, the sine wave signal (Asin θ) or the cosine wave signal (Acos θ) with the region where the signal value change is greater than that of the other signal is sequentially selected.

The internal position Information generator 460 includes an integrator 461 that integrates the motor rotation angular velocity (ω₁, ω₂) from the position information signal processor 410 to calculate the rotation phase (θ_n) of the motor 110, and an internal position information converter 462 calculates the internal position information (Asin θ_n, Acos θ_n) by converting into a trigonometric function value applying the rotation phase (θ_n) of the motor 110 calculated by the integrator 461 as a parameter.

The integrator 461 integrates the motor rotation angular velocity (ω₁ orω₂) which is the output signal selected by the switcher 452 to calculate the rotation phase (θ_n) of the motor 110. Namely, the integrator 461 calculates the motor rotation phase (θ_n) reflecting a latest motor rotation angular velocity (ω₁, ω₂). Then, the integrator 461 outputs the calculated motor rotation phase (θ_n) to the infernal position information converter 462.

The internal position information converter 462 includes: a first internal position information converter 463 for outputting the internal position information (A_i sin θ_n) to the first subtracter 421 of the sine signal processor 420; a second internal position information converter 464 for outputting the internal position information (B_i cos θ_n) to the second subtracter 431 of the cosine signal processor 430; and an amplitude corrector 465 for detecting respective amplitude (A_i, B_i) of the sine wave signal (A_i sin θ) output by the encoder 120 and the cosine wave signal (B_i cos θ) and correcting the amplitude (A_i, B_i) of the first and the second internal position information converter 463 and 464.

The first internal position information converter 463 calculates a sine function value (A_i sin θ_n) applying the phase (θ_n) calculated by the integrator 461 as a parameter to obtain as the internal position information, corresponding to the sine wave signal (A_i sin θ) as the position Information signal input from the encoder 120.

The second internal position information converter 464 calculates a cosine function value (B_i cos θ_n) applying the phase (θ_n) calculated by the integrator 461 as a parameter to obtain as the internal position information, corresponding to the cosine wave signal (B_i cos θ_n) as the position information signal input from the encoder 120.

The first and die second internal position information converters 463 and 464 have function value calculators 466 and 468 for calculating a function value (sin θ_n, cos θ_n) taking the phase (θ_n) calculated by the integrator 461 as a parameter, and amplitude multipliers 467 and 469 for calculating trigonometric function value (A_i sin θ, B_i cos θ) multiplied by the amplitude output by the amplitude corrector 465.

The first internal position information converter 463 includes a first function value calculator 466 and a first amplitude multiplier 467. The second internal position information converter 464 includes a second function value calculator 468 and a second amplitude multiplier 469.

The motor rotation phase (θn) calculated by the integrator 461 is initially input to the function value calculators 466 and 468. Then, the trigonometric function value (sin θ_n, cos θ_n) taking the rotation phase (θ_n) as a parameter is calculated by the function value calculators 466 and 468. At this time, the amplitude of the trigonometric function value is “1”. The function value (sin θ_n, cos θ_n) calculated by the function value calculators 466 and 468 is input into the amplitude multipliers 467 and 469.

The amplitude of the trigonometric function value (A_i, B_i) is output to the amplitude multipliers 467 and 469 from, the amplitude corrector 465. The amplitude multipliers 467 and 469 multiply the function value (sin θ_n, cos θ_n) input from the amplitude corrector 465 by the amplitude (A_i, B_i) input by the amplitude corrector 465.

In a case where die integrator 461 integrates the motor rotation angular velocity (ω₁, ω₂) output from the position information signal processor 410 and calculates the rotation phase (θ_n) of the motor 110, the integrator 461 sequentially integrates even the latest motor rotation angular velocity (ω₁, ω₂) output from the position information signal processor 410, and then calculates the motor rotation phase (θ₁) as the latest as presumable. Accordingly, the first and second internal position information converters 463, 464 calculate the trigonometric function values (A_i sin θ_n, B_i cos θ_n) of the latest motor rotation phase (θ_n) calculated by the integrator 461, thereby obtaining the trigonometric function values (A_i sin θ_n, B_i cos θ_n) for the motor rotation phase (θ_n) as latest as presumable.

FIG. 4 is an illustration showing the relationship between the sine wave signal (A_i sin θ) input from the encoder and the internal position information (A_i sin θ_n) generated by the internal position information generator.

The amplitude corrector 465 has an amplitude detector 470 for detecting the magnitude of the respective amplitudes of the sine wave signal and the cosine wave signal, and an amplitude data, storage 471 for storing the detected magnitude of the respective amplitudes.

The amplitude detector 470 detects respective amplitudes of the sine wave signal and the cosine wave signal of the two-phase signal output by the encoder.

In order to detect the amplitude, the amplitudes of the sine wave signal and the amplitude of the cosine wave signal are detected, where the amplitude A_i of the sine wave signal is detected as the magnitude |A_i sin θ| when the value of the cosine wave signal is “0”.

Similarly, the amplitude B_i of the cosine wave signal is detected as the magnitude |B_i sin θ| when the value of the sine wave signal is “0” (see FIG. 5).

The amplitude data storage 471 includes an A_i storage for storing the amplitude A_i of the sine wave signal detected by the amplitude detector 470 and a B_i storage 473 for storing the amplitude B, of the cosine wave signal.

The amplitude data storage 471 updates the stored data by the latest amplitude data detected by the amplitude detector 470. The A_i storage 472 outputs the amplitude A_i of the stored sine wave to the first amplitude multiplier 467.

The B_i storage 473 outputs the amplitude B_i of the stored cosine wave to the second amplitude multiplier 469.

The output unit 480 outputs the motor rotation angular velocity which is the output signal selected by the switcher 452 to the CPU 310 (a central processing unit) via a filter 481.

The filter 481 may be a low-pass filter.

And, the output unit 480 outputs the motor rotation phase (θ_n) calculated by the Integrator 461, as motor driving position information.

The CPU 310 (the central processing unit) compares the motor rotation angular velocity from the velocity calculator 400 with the target velocity input from the outside, calculates a duty ratio of current (i) to be applied to the motor 110 so that the motor rotation angular velocity (ω) achieves the target velocity, and performs PWM (pulse width modulation) control for the motor 110.

Now, operation of the servomechanism with such configuration will be described below.

When the motor 110 rotates, the encoder 120 detects the rotation of the motor 110 and outputs the two-phase signal (A_i sin θ, B_i cos θ) periodically changing in accordance with the rotation of the motor 110.

The two-phase signal (A_i sin θ, B_i cos θ) from the encoder 120 is input to the sine signal processor 420 and the cosine signal processor 430.

In the following description, since the processing of the sine wave signal (A_i sin θ) is similar to that of the cosine wave signal (A_i cos θ), the processing of the sine wave signal (A_i sin θ) is exemplified for explaining the operation.

The first subtracter 421 compares the sine wave single (A_i sin θ) input to the sine signal processor 420 with the internal position information (A_i sin θ_n) generated by the first internal position information converter 463, and outputs the difference between them to the first gain multiplier 422.

The first gain multiplier 422 multiplies the difference signal from the first subtracter 421 by the predetermined gain (K), and outputs the motor rotation changing amount (Δθ₁).

Then the first sign converter 441 multiplies the motor rotation changing amount (Δθ₁) front the first gain multiplier 422 by +1 or −1 based, on the sign of the cosine wave signal (B_i cos θ) which is the other signal contained in the two-phase signal to convert the motor rotation changing amount (Δθ₁) in the increasing direction, and generates the motor rotation angular velocity (ω₁).

Similarly, the motor rotation angular velocity (ω₂) is generated based on the cosine wave signal (B_i cos θ) input to the cosine signal processor 436.

As the motor rotation angular velocity (ω₁) from the sine signal processor 420 and the motor rotation angular velocity (ω₂) from the cosine signal processor 430 are generated, the determiner 451 determines whether the sine wave (A_i sin θ) is greater or smaller relative to the predetermined threshold 0.7 A, so that, based on the determination, the switcher 452 selects the motor rotation angular velocity (ω₁ or ω₂) of the sine wave signal or that of the cosine wave signal having the region with the greater signal value change.

Then, the motor rotation angular velocity (ω_n) selected by the switcher 452 is split into two, die one being input to the integrator 461 so that the integrator 461 calculates the motor rotation phase (θ_n), reflects the latest motor rotation angular velocity (ω_n) and updates the rotation phase (ω_n) of the motor 110.

And besides, the other one of the split motor rotation angular velocity (ω_n) is output from the output unit 480 to the CPU 310 via the filter 481.

The motor rotation phase (θ_n) calculated by the integrator 461 is output to the first and the second position information converters 463 and 464.

Then, in the first function value calculator 466, a function value sin θ_n taking the motor rotation phase (θ_n) as a parameter is calculated.

In the second function value calculator 468, a function value cos θ_n taking the motor rotation phase (θ_n) as a parameter is calculated.

The two-phase signal (A_i sin θ, B_i cos θ) from the encoder 120 is input to the sine signal processor 420 and the cosine signal processor 430 and, simultaneously, input to the amplitude detector 470.

The amplitude of the sine wave signal and the cosine wave signal is detected by the amplitude detector 470 by a predetermined timing cycle.

Specifically, the magnitude of the sine wave signal (|A_i sin θ|) when the value of the cosine wave signal is zero is stored as the amplitude A_i of the sine wave signal and the detected amplitude A_i is stored in the A_i storage 472 of the amplitude data storage 471.

Specifically, the magnitude of the cosine wave signal (|B_i cos θ|) when the value of the sine wave signal is zero is stored as the amplitude B_i of the cosine wave signal and the detected amplitude B_i is stored in the B_i storage 473 of the amplitude data storage 471.

The amplitude A_i stored in the A_i storage 472 is input into the first amplitude multiplier 467.

The sine function, value (sin θ_n) calculated by the first function value calculator 466 is input into the first amplitude multiplier 467. The function value (sin θ_n) and the amplitude data A_i is multiplied in the first amplitude multiplier 467 to calculate the sine function value (A_i sin θ_n) as the internal position information.

The internal position information is output to the first subtracter 421 to be subtracted from the sine wave signal A_i sin θ input from the encoder 120 to generate a difference signal.

The CPU 310 compares the motor rotation angular velocity (ω_n) from the velocity calculator 400 with the target velocity and calculates the duty ratio of the current (i) to be applied to the motor 110 so that the motor rotation angular velocity (ω) achieves the target value. The duty ratio allows the PWM (pulse width modulation) control to be performed on the motor 110, so that the motor 110 is rotated at the predetermined target velocity.

According to the first embodiment with the above-described configuration, the following advantages can be attained.

(1) Since the internal position information generator 460 generates the position information (A_i sin θ_n, B_i cos θ_n) of the motor 110 constantly reflecting the latest motor velocity information (ω_n), the position information of the motor 110 as the latest as presumable can be obtained.

Accordingly, the difference between the position information signal (A_i sin θ, B_i cos θ) from the encoder 120 and the internal position information (A_i sin θ_n, B_i cos θ_n) generated by the internal position information generator 460 becomes a derivative value of the position information signal (A_i sin θ, B_i cos θ) from the encoder 120, and is namely the driving velocity (ω) of the motor 110. Thus, when the position information signal (A_i sin θ, B_i cos θ) is input from the encoder 120, the difference of the both is instantly calculated to obtain the motor driving velocity (ω), thereby attaining a significant effect of remarkably recovering the time-lag in the conventional ways.

(2) The velocity calculator 400 provides the motor driving velocity (ω_n) without the time-lag, the central processing unit (CPU) 310 controls the motor 110 with the application of the motor driving velocity information (ω_n) as the feedback signal, thereby providing extremely stable control system.(3) Provision of the internal position information converter 463, 464 that calculates the function value applying the phase as the parameter allows the position information signal input from the encoder 120 to be merely the sine wave signal, and need not be the phase information itself. Accordingly, the encoder 120 (a photoelectric encoder, a capacitance encoder, a magnetic encoder etc.), which is typically used as a sensor, can directly be used as the sensor, and therefore, there is no need of special design change just for the servomechanism 100 of the present embodiment, and cost increase can be avoided.(4) Since the signal switching section 450 selects the phase changing amount (the driving velocity information) calculated based on the signal having the signal value change being greater relative to the phase changing amount contained in the two-phase signal (A_i sin θ, B_i cos θ) from the encoder 120, the phase changing amount (ω) can accurately be obtained as the motor velocity information in the entire region.

Additionally, the determination for the greater signal changing amount relative to the phase change does not require complicated arithmetical processing, but just requires simple comparison of the one signal value (the sine wave signal) with the threshold (0.7 A).

(5) Since the sign converter 440 is provided, the sign converter can convert the sign of the phase changing amount (Δθ) in the increasing/decreasing direction in accordance with the rotation direction of the motor even if the phase changing amount is calculated as a minus value when the motor 110 is displaced in the plus direction, and obtain the driving velocity (the phase changing amount ω) with the proper increasing/decreasing direction.(6) The amplitude corrector 465 is provided and the amplitude of the signal (sine wave signal, cosine wave signal) input from the encoder 120 is detected by a predetermined timing. The detected amplitude is set as the amplitude of the sine wave signal and the cosine wave signal of the internal position information, so that the amplitude of the signal from the encoder 120 and the internally generated position information can be conformed to each other. When the amplitude of the two-phase signal from the encoder 120 is fluctuated, error on account of the fluctuation of the amplitude is not caused in calculating the velocity in the velocity calculator 400.

Consequently, the velocity detecting accuracy can be stabilized to stabilize the rotation velocity control of the motor 110.

Incidentally, though the amplitudes of the internal sine wave and cosine wave are corrected in the present embodiment, the amplitude of input sine wave and cosine wave may be corrected.

Second Embodiment

Next, a second embodiment of the present invention will be described below with reference to FIG. 6.

The basic configuration of the second embodiment is the same as the first embodiment, except for the configuration of an internal position information generator in the third embodiment.

FIG. 6 is a block, diagram showing the configuration of a velocity calculator in the second embodiment.

In FIG. 6, the internal position information generator 460 includes the first internal position information converter 463 for the sine signal processor 420, and includes the second internal position information converter 464 for the cosine signal processor 430, which is the same as the first embodiment.

Meanwhile, in the first embodiment (FIG. 3), the provision of the integrator 461 was one. When the sine signal processor 420 and the cosine signal processor 430 respectively output the motor rotation angular velocities (ω₁, ω₂), the signal switching section 450 selects and inputs the one of motor rotation angular velocities (ω₁ or ω₂) to the integrator 461, and the integrator 461 integrated the motor rotation angular velocity (ω₁ or ω₂) to calculate the motor rotation phase. The motor rotation phase (ω_n) calculated by the integrator 461 is output to the first Internal position information converter 463 and the second internal position information converter 464, so that these Internal position information converters respectively calculate the two pieces of internal position information (A_i sin θ_n, B_i cos θ_n).

On the other hand, a first integrator 461A and a second integrator 461B are provided in the second embodiment. To be more specific, as shown in FIG. 6, there are provided the first integrator 461A that integrates a motor rotation changing amount (Δθ₁) output from the sine signal processor 420 based on the sine wave signal to calculate the motor rotation phase (θ₁) based on the sine wave signal, and the second integrator 461B that integrates a motor rotation changing amount (Δθ₂) output from the cosine signal processor 430 based on the cosine wave signal to calculate a motor rotation phase (θ₂) based on the cosine wave signal.

The first integrator 461A integrates the rotation changing amount (Δθ₂) of the motor 110 output from the first gain multiplier 422 and calculates the motor rotation phase (θ₁). Then the first integrator 461A outputs the calculated motor rotation phase (θ₁) to the first internal position information converter 463.

The second integrator 461B Integrates the rotation changing amount (Δθ₂) of the motor 110 output from the second gain multiplier 432 and calculates the motor rotation phase (θ₂). Then the second integrator 461B outputs the calculated motor rotation phase (θ₂) to the second internal position information converter 464.

While the signal switching section 450 includes the determiner 451 and the switcher 452, so that the switcher 452 switches between the sine terminal 453 and the cosine terminal 454 with the switching unit in the same manner as the first embodiment, the switcher of the third embodiment includes a first switcher 452A for outputting velocity information and a second switcher 45213 for outputting position information.

The configuration of the first switcher 452A is the same as the switcher described in the first embodiment, the first switcher 452A switching between the sine terminal 453 and the cosine terminal 454 based on the determination of the determiner 451 and outputting the motor rotation angular velocity ω_n. The motor rotation angular velocity ω_n (ω₁ or ω₂) is output to the CPU 310 (the central processing unit) via the filter 481.

Although the output signal ω_n (the motor rotation angular velocity ω₁, ω₂) from the switcher 452 is input to the integrator 461 in the first embodiment, in the third embodiment, the output signal ω_n from the first switcher 452A is not input to the integrators (461A, 461B).

The second switcher 452B switches between the sine terminal 453 and the cosine terminal 454 based on the determination of the determiner 451 with the switching unit.

Here, the signal in which the sign of the motor rotation phase (θ₁) calculated by the first integrator 461A is converted by the first sign converter 441 is input to the sine terminal 453. And, the signal in which the sign of the motor rotation phase (θ₂) calculated by the second integrator 461B is converted by the second sign converter 442 is input to the cosine terminal 454. The output from the second switcher 452B is output as the position information θ_n (θ₁ or θ₂) via a filter 481.

According to the second embodiment with the above-described configuration, the following advantage can be attained in addition to the advantage of the first embodiment.

In a case where the two-phase signal containing the sine wave signal and the cosine wave signal is output from the encoder 12, the velocity calculator 400 of the third embodiment includes the first integrator 461A and the first internal position information converter 463 corresponding to the sine signal processor 420 for processing the sine wave signal, and includes the second integrator 461B and the second internal position information converter 464 corresponding to the cosine signal processor 430 for processing the cosine wave signal.

Accordingly, the motor rotation angular velocity ω₁ based on the sine wave signal can be calculated with the arithmetic processing merely based on the sine wave signal in the loop of the first integrator 461A and the first internal position information converter 463 applying the motor rotation changing amount Δθ₁ based on the sine wave signal as the feedback information.

Similarly, the motor rotation angular velocity ω₂ based on the cosine wave signal can be calculated with the arithmetic processing merely based on the cosine wave signal in the loop of the second integrator 461B and the second internal position information converter 464 applying the motor rotation changing amount Δθ₂ based on the cosine wave signal as the feedback information.

Since the sine wave signal and the cosine wave signal are independently processed to separately calculate the phases (internal position information) by the first multiplier 461A and the second multiplier 461B, the internal position information can be accurately calculated by processing respective components while avoiding mixing of the phase information between the sine wave and the cosine wave.

As a result, driving velocity information can be accurately obtained.

Third Embodiment

Next, a third embodiment of the present invention will be described below with reference to FIG. 7.

The basic structure of the third embodiment is the same as the first embodiment, except that the motor rotation velocity is obtained based on a digital signal in which the signal from the encoder 120 is converted with an A/D converter are provided in the third embodiment.

To be more specific, in FIG. 7, a first A/D converter 710 that performs A/D conversion on the sine wave signal from, the encoder 120, and a second A/D converter 720 that performs A/D conversion on the cosine wave signal from the encoder 120.

The velocity calculator (the signal processor) 400 includes the functions of the position information signal processor, the signal switching section, the internal position information generator etc., but these functions are achieved by a predetermined signal-processing program.

Note that the present invention is not limited to the above-described, embodiments, and modifications, improvements etc. are included in the present invention as long as the object of the present invention can be achieved.

For example, although the sine signal processor 420 and the cosine signal processor 430 respectively processing the two-phase signal (Asin θ, Acos θ) output from the encoder 120 are provided, and the output signal from the sine signal processor 420 and the output signal from the cosine signal processor 430 are switched in the first embodiment, as shown in FIG. 8, the position information signal processor 410 may only include the sine signal processor 420 for processing the sine wave signal (Asin θ) to output the motor rotation velocity (on) just based on the sine wave signal (Asin θ). Incidentally, it is necessary to correct the amplitude of the sine wave signal (Asin θ), where it is required to obtain the amplitude of the sine wave by detecting |A_i sin θ| when the value of B_i sin θ reaches “0” while monitoring the amplitude of B_i sin θ by the amplitude corrector.

Although the object to be controlled is the motor 110 having the rotator, and the velocity calculator (the signal processor) 400 calculates the rotation velocity (the rotation phase) of the motor 110 based on the two-phase signal from the encoder 120, the driving body is not limited to the motor having the rotator, and may be a linear motor or the like. Particularly in the control of the linear motor, since the time-lag largely influences the control performance, the driving velocity is calculated promptly by the signal processing device (the velocity calculator) of the present invention, so that the velocity is controlled based on the calculated driving velocity, thus stably controlling the velocity without the time-lag.

Though the function value (sin θ_n, cos θ_n) taking the phase θn as a parameter is calculated by the function value calculator while setting the amplitude of the function value as “1” and the amplitude (A_i, B_i) detected by the amplitude detector is multiplied by the amplitude multipliers 467 and 469 to bring the amplitude of the internal position information and the amplitude of the position information from the sensor into conformity with each other, other arrangement is possible. For instance, functions value A_i-1 sin θn using the amplitude A_i-1 stored in the function value calculators 466 and 468 is calculated and A_i/A_i-1 is multiplied in the amplitude multiplier to be adjusted to the detected amplitude.

The priority application Number IP 2006-179186 upon which this patent application is based is hereby incorporated by reference.

Claims

1. A signal processing device for processing a position information signal output from a sensor in accordance with a driving position of a driver and detecting a driving velocity of the driver, comprising: a position information signal processor that processes the position information signal to calculate the driving velocity information of the driver;and an internal position information generator that reflects a latest driving velocity information calculated by the position information signal, processor to generate a latest presumed position of the driver as the internal position information,wherein the position information signal output from the sensor is a periodic function signal periodically changing in accordance with drive of the driver,the position information signal, processor calculates the driving velocity information of the driver based on a difference between the position information signal from the sensor and the internal position information generated by the internal position information and outputs a phase change amount of the periodic function signal as the driving velocity information of the driver,the internal position information generator includes an integrator that integrates the phase change amount from the position information signal processor to calculate the phase corresponding to the position information of the driver and an internal position information converter that calculates the function value based on the phase calculated by the integrator and converts the phase into the internal position information, andthe internal position information converter includes an amplitude detector mat detects the amplitude of the position information signal output by the sensor, a function value calculator that calculates the function value of the periodic function taking the phase calculated by the integrator as a parameter, and an amplitude multiplier that multiplies the function value calculated by the function value calculator by the amplitude detected by the amplitude detector to calculate the internal position information.

2. The signal processing device according to claim 1, wherein. the periodic function signal is trigonometric functions having phase difference of ninety degrees including a first signal as a sine wave signal and a second signal as a cosine wave signal,the amplitude detector detects the magnitude of the first signal when the value of the second signal is zero as the amplitude of the first signal and detects the magnitude of the second signal when the value of the first signal is zero as the amplitude of the second signal.

3. A velocity detector, comprising: a sensor that outputs a position information signal corresponding to a driving position of a driver; and a signal-processing device that processes the position information signal to detect a driving velocity of the driver, the signal-processing device including: a position information signal processor that processes the position information signal to calculate the driving velocity information of the driver;and an internal position information generator that reflects a latest driving velocity information calculated by the position information signal processor to generate a latest presumed position of the driver as the internal position information,wherein the position information signal output from the sensor is a periodic function signal periodically changing in accordance with drive of the driver,the position information signal processor calculates the driving velocity information of the driver based on a difference between the position information signal from the sensor and the internal position information generated by the internal position information and outputs a phase change amount of the periodic function signal as the driving velocity information of the driver,the internal position information generator includes an integrator that integrates the phase change amount from the position information signal processor to calculate the phase corresponding to the position information of the driver and an internal position information converter that calculates the function value based on the phase calculated by the integrator and converts the phase into the internal position information, andthe internal position information converter includes an amplitude detector that defects the amplitude of the position information signal output by the sensor, a function value calculator that calculates the function value of the periodic function taking the phase calculated by the integrator as a parameter, and an amplitude multiplier that multiplies the function value calculated by the function value calculator by the amplitude detected by the amplitude detector to calculate the internal position information.

4. A servomechanism, comprising a driver;a sensor that outputs a position information signal corresponding to a driving position of a driver;a signal-processing device that processes the position information signal to detect a driving velocity of the driver; and a central controller that compares the driving velocity of the driver detected by the signal-processing device with a predetermined target velocity that is set in advance from an outside, the central controller controlling the driving velocity of the driver at the target velocity,the signal-processing device comprising: a position information signal, processor that processes the position information signal to calculate the driving velocity information of the driver;and an internal position information generator that reflects a latest driving velocity information calculated by the position information signal processor to generate a latest presumed position of the driver as the internal position information,wherein the position information signal output from the sensor is a periodic function signal periodically changing in accordance with drive of the driver,the position information signal processor calculates the driving velocity information of the driver based on a difference between the position information signal from the sensor and the internal position information generated by the internal position information and outputs a phase change amount of the periodic function signal as the driving velocity information of the driver,the internal position information generator includes an integrator that integrates the phase change amount from the position information signal processor to calculate the phase corresponding to the position information of the driver and an internal position information converter that calculates the function value based on the phase calculated by the integrator and converts the phase into the internal position information, andthe internal, position information converter includes an amplitude detector that detects the amplitude of the position information signal output by the sensor, a function value calculator that calculates the function value of the periodic function taking the phase calculated by the integrator as a parameter, and an amplitude multiplier that multiplies the function value calculated by the function value calculator by the amplitude detected by the amplitude detector to calculate the internal position information.