WO2018229842A1 - ブラシレスdcサーボモータの制御装置 - Google Patents
ブラシレスdcサーボモータの制御装置 Download PDFInfo
- Publication number
- WO2018229842A1 WO2018229842A1 PCT/JP2017/021703 JP2017021703W WO2018229842A1 WO 2018229842 A1 WO2018229842 A1 WO 2018229842A1 JP 2017021703 W JP2017021703 W JP 2017021703W WO 2018229842 A1 WO2018229842 A1 WO 2018229842A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- phase
- signal
- brushless
- magnet
- servo motor
- Prior art date
Links
Images
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/14—Electronic commutators
- H02P6/16—Circuit arrangements for detecting position
- H02P6/17—Circuit arrangements for detecting position and for generating speed information
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K11/00—Structural association of dynamo-electric machines with electric components or with devices for shielding, monitoring or protection
- H02K11/20—Structural association of dynamo-electric machines with electric components or with devices for shielding, monitoring or protection for measuring, monitoring, testing, protecting or switching
- H02K11/21—Devices for sensing speed or position, or actuated thereby
- H02K11/215—Magnetic effect devices, e.g. Hall-effect or magneto-resistive elements
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K11/00—Structural association of dynamo-electric machines with electric components or with devices for shielding, monitoring or protection
- H02K11/30—Structural association with control circuits or drive circuits
- H02K11/33—Drive circuits, e.g. power electronics
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K11/00—Structural association of dynamo-electric machines with electric components or with devices for shielding, monitoring or protection
- H02K11/30—Structural association with control circuits or drive circuits
- H02K11/35—Devices for recording or transmitting machine parameters, e.g. memory chips or radio transmitters for diagnosis
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K29/00—Motors or generators having non-mechanical commutating devices, e.g. discharge tubes or semiconductor devices
- H02K29/06—Motors or generators having non-mechanical commutating devices, e.g. discharge tubes or semiconductor devices with position sensing devices
- H02K29/08—Motors or generators having non-mechanical commutating devices, e.g. discharge tubes or semiconductor devices with position sensing devices using magnetic effect devices, e.g. Hall-plates, magneto-resistors
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/14—Electronic commutators
- H02P6/16—Circuit arrangements for detecting position
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/28—Arrangements for controlling current
Definitions
- the present invention relates to a brushless DC motor control device, and more particularly to a brushless DC servo motor control device suitable for servo control that operates a brushless DC servo motor that drives a driven member at a target speed and a target position. It is related.
- the main control methods of the brushless DC motor are the following three methods.
- the motor is controlled in an open loop by sensorless, for example, vector control.
- (3) The U-phase, V-phase, and W-phase signals obtained by the rotary encoder and the magnetic pole position of the rotor are synchronized and controlled as a brushless DC servo motor in a completely closed loop.
- Patent Document 1 three Hall elements and one GMR detector are used as sensors, and information on arbitrary specific positions and torque fluctuation information of a three-phase permanent magnet motor are obtained based on their signal values.
- the invention is disclosed.
- Patent Document 2 describes an invention for controlling a motor without a sensor. That is, in the stationary state of the rotor, a test power smaller than the electric power for continuous rotation of the rotor is applied to the coil of each energized phase in each drive state for a predetermined time to detect the back electromotive force of the coil of each energized phase.
- An invention for selecting a startup drive state according to the magnitude of the counter electromotive force is disclosed.
- Patent Document 3 in a brushless DC motor, information on the rotation angle of the rotating body and information on a change in the rotation angle are extracted from the output values of the rotary encoder counter at the time of forward rotation and reverse rotation. An invention for generating angle information is disclosed.
- Patent Document 4 in an electric power steering apparatus, steering torque T, motor angle ⁇ m, and vehicle speed detection value Vs detected by a steering torque sensor, a motor angle sensor, and a vehicle speed sensor are input to the control apparatus.
- An invention is disclosed in which an absolute rudder angle estimated value ⁇ a is calculated and a DC motor is driven and controlled.
- JP2015-149800A JP 2017-034813 A Japanese Patent No. 5058334 Japanese Patent No. 5401875
- the sensorless invention described in Patent Document 2 is a method for obtaining the rotation angle of a motor by prediction, and since the absolute origin position is not directly detected, a countermeasure for repeated errors is required. In addition, when the back electromotive force detection is employed, some means for detecting the initial position is separately required for starting from zero speed.
- position information corresponding to the absolute origin position is calculated using data of one set of sensor elements, and multi-rotation angle information of the rotating body is generated.
- the invention described in Patent Document 4 uses data of other components of the control system such as a steering torque sensor in addition to the motor angle sensor, and the configuration is complicated.
- a brushless DC servo motor that drives various driven members of an automobile uses an in-vehicle battery as a power source. After the battery power is lost, the motor is intentionally driven by an external force, and the driven member may not be in a normal state. In order to further increase the safety of the automobile, it is desirable that the vehicle can be restarted safely even in such a state.
- Patent Documents 1 to 4 do not disclose such consideration regarding intentional driving after the battery power supply is lost.
- One object of the present invention is to provide a brushless DC servo motor and a control device therefor that can control a motor with high accuracy in a completely closed loop based on an output signal using one MR sensor unit.
- Another object of the present invention is to provide a brushless DC servo motor and its control device that determine whether or not the motor has been intentionally driven after the battery power is lost and that can safely restart various driven members. It is to provide.
- a control unit that generates and outputs a drive signal and controls power supplied to each of the three-phase stator coils of the U-phase, V-phase, and W-phase of the brushless DC servo motor;
- a control unit for a brushless DC servo motor having one MR sensor unit that detects rotation of a rotor having a multipolar permanent magnet, wherein the MR sensor unit is fixed to one end of a rotating shaft of the rotor, A pair of MR magnets fixed on the housing side at a position facing the magnet, a pair of MR sensors magnetized in the radial direction, and a processing circuit unit;
- the processing circuit unit has a position on a boundary line between the N-pole region and the S-pole region of the magnet as a magnet origin position, and based on the outputs of the pair of MR sensors, It is configured to generate and output A-phase and B-phase signals accompanying rotation of the rotating shaft, and to generate information on the origin position of the magnet.
- the control unit matches the number of poles of the rotor.
- a function of generating each phase information of the U phase, the V phase, and the W phase in synchronization with the rising phase of the output signal of the A phase or the B phase of the MR sensor unit, and any one of the three phases The phase corresponding to the phase in which the drive signal to the phase stator coil rises from zero, the phase of the integrated value peak of the back electromotive force to the one-phase stator coil obtained by driving the motor, and the drive signal corresponding to zero
- the rotary shaft is fixed at a position synchronized
- the control unit of the brushless DC servo motor is mounted on an automobile, and information on the absolute origin position is recorded in an EEPROM. Therefore, at the time of starting the automobile, the function of acquiring data from the EEPROM and determining whether or not the motor is intentionally moved after power is not supplied from the battery based on the comparison of the address of the data, and the intentional If it is determined that the motor has been moved, the motor has a function of returning the motor to the state at the time when power is no longer supplied from the battery based on the address of the data.
- one MR sensor unit is a rotary encoder, and based on the A-phase and B-phase signals, phase information of each phase coil of the Z-phase, U-phase, V-phase, and W-phase is generated, It is possible to provide a brushless DC servo motor and its control device that can control the position of the driven member with extremely high accuracy by performing servo control in a completely closed loop by synchronizing each phase of the stator coil and the magnetic pole position of the rotor with the origin position.
- FIG. 2B is a cross-sectional view taken along the line BB of FIG. It is CC sectional drawing of FIG. 2A which shows the structural example of MR sensor unit. It is a figure which shows the structural example of the drive circuit of the brushless DC servomotor in 1st Example. It is a figure which shows an example of a structure of the processing circuit part of MR sensor unit in a 1st Example.
- a phase, B-phase signal, and the data in the Z phase, a magnet home position (T 0) reference illustrates an example of converting the absolute origin position (Z 0) criteria.
- FIG. 1 is a functional block diagram of a brushless DC servo motor control device according to a first embodiment of the present invention.
- the brushless DC servo motor 100 is an inner rotor type three-phase brushless DC servo motor (hereinafter simply referred to as a brushless DC servo motor).
- Reference numeral 300 denotes a brushless DC servo motor control unit.
- a permanent magnet type rotor is formed integrally with the rotary shaft 13, and these are rotatably held by bearings provided in the housing of the brushless DC servo motor.
- each of the three-phase (U-phase, V-phase, and W-phase) stator coils of the brushless DC servo motor 100 the electric power whose current is controlled by the current control unit 44 in accordance with the drive torque, speed command, etc.
- the inverter drive control unit 41 drives the inverter 40 to control the phase of the current supplied to each stator coil, and rotates the rotor.
- the control unit 300 controls the maximum power and current supplied to the inverter 40 via the current detection / limitation unit 45 based on the current detected by the current detection / limitation unit 45.
- Reference numeral 46 denotes a back electromotive force detection unit, which detects and controls the back electromotive force (V BU , V BV , V BW ) of each phase coil of the brushless DC servo motor 100 at the time of initial setting, as will be described in detail later. Transmit to unit 300.
- An MR sensor unit 20 that outputs an incremental signal (A, B) accompanying the rotation of the rotary shaft 13 and functions as a rotary encoder is provided at one end of the rotary shaft 13. That is, the analog signals of the pair of MR sensors detected by the MR sensor unit 20 are converted into digital signals, and incremental A-phase / B-phase signal pulse data (A, B) is transmitted via the communication cable 28. It is transmitted to the control unit 300.
- the number of pulses of the A-phase / B-phase signal output every rotation of the brushless DC servo motor 100 is arbitrarily set according to the resolution required for the control.
- GMR is used as an element of the MR sensor, for example, output of 36000 pulses for each of the A phase and the B phase can be obtained per one rotation of the rotation shaft.
- the position on the rotation axis synchronized with zero of the drive signal of the brushless DC servo motor for example, the circumferential direction on the rotation axis corresponding to the rising point of the A-phase pulse synchronized with zero of the drive signal.
- the specific position is defined as the absolute origin position (Z 0 ).
- a position corresponding to zero of the output of the MR sensor unit 20, that is, a specific position on the boundary line between the N-pole region and the S-pole region of the magnet is defined as a magnet origin position (T 0 ).
- the MR sensor unit 20 also outputs information on the magnet origin position (T 0 ), which is used for initial setting.
- the other end of the brushless DC servo motor 100 is provided with a pinion or the like constituting the speed reducer 14, and the rotation of the rotary shaft 13 is decelerated by the speed reducer 14 and is driven directly or via a clutch. 15 is transmitted.
- the driven member 15 include an oil pump, a water pump, an air pump, an engine control member, and a power steering for an automobile.
- the control unit 300 of the brushless DC servo motor includes a communication control unit 310, a memory control unit 320, an initial setting drive signal (iu, iv, iw) generation unit 340, a rising phase Sn extraction unit 341 for each phase signal, Width setting unit 342, rise of each phase and absolute origin position synchronization setting unit 343, magnet sensor fixed position (absolute origin position Z 0 ) setting unit 344, multi-rotation / absolute signal generation unit 345, normal operation mode motor It has functions such as a control signal (iu, iv, iw) generation unit 346, a normal operation mode DC servo control unit 347, and an inverter drive signal generation unit 348.
- the control unit 300 also has a function of generating a current command value for the current control unit 44, similar to a known brushless DC servo motor, but this point is not a feature of the present invention. The description of the configuration is omitted.
- the control unit 300 is connected to the battery 42 via a switch, for example, an ignition switch 43, and is an external command from an upper computer, for example, an in-vehicle ECU (Electric Control Unit) 500 or the like, or an output of the MR sensor 22. Based on input information such as digital values of the A phase and B phase signals, a control signal is generated, and the driven member 15 is operated by driving the brushless DC servo motor. That is, in the control unit 300 of the brushless DC servo motor, based on the A-phase and B-phase signals that are the outputs of the MR sensor unit 20, multi-rotation / absolute signals of Z-phase signals, U, V, and W-phase signals are generated. . A part of the information of the control unit 300 is also transmitted to the ECU 500.
- a switch for example, an ignition switch 43
- an external command from an upper computer for example, an in-vehicle ECU (Electric Control Unit) 500 or the like, or an output of the MR sensor 22.
- control unit 300 is configured to be able to communicate with a terminal device 700 in a factory that manufactures a brushless DC servo motor via a communication network.
- the terminal device 700 is configured to be able to communicate with other information processing apparatuses, such as computers and servers in a factory production line, via a communication network.
- the initial setting of the brushless DC servo motor is executed by starting an initial setting program of the control unit 300 by the terminal device 700. It is also possible to perform the initial setting of the brushless DC servo motor in scenes other than the factory production line.
- the control unit 300 of the brushless DC servo motor uses, for example, a dedicated ASIC (Application Specific ⁇ Integrated ⁇ Circuit) in which a plurality of necessary functions are integrated into one chip in the form of a logic circuit, or a general-purpose single-chip microcomputer. It is realized as an IC circuit chip. Alternatively, it is realized as a part of the function of the host computer. In the following, a specific configuration example using a general-purpose single-chip microcomputer will be described, but it goes without saying that a brushless DC servo motor control device having the same function may be realized by a dedicated ASIC.
- ASIC Application Specific ⁇ Integrated ⁇ Circuit
- a single-chip microcomputer for realizing the control unit 300 is obtained by integrating a CPU, a memory, an oscillation circuit, a timer, an I / O interface, a serial I / F, etc. into one LSI, and a program held in the memory By executing it on the CPU, the above functions of the control unit 300 of the brushless DC servo motor are realized.
- the memory 330 includes a ROM 331, a RAM 332, at least one EEPROM 333, and the like, and is connected to the CPU via a bus 350.
- the ROM stores a program that is executed at power-on or reset, and constants that do not change during program execution.
- a flash memory may be employed as the ROM.
- the RAM stores program variables, external command values, multi-rotation / absolute signal data, which will be described later, and the like.
- the RAM also stores the target position of the driven member 15 and the target speed (inverter sine wave drive signal, PWM control duty ratio) of the brushless DC servo motor set corresponding to this position.
- the target speed inverter sine wave drive signal, PWM control duty ratio
- a multi-rotation / absolute signal is sequentially held as the brushless DC servo motor is operated.
- Incremental A-phase / B-phase signal data held in the RAM is written (saved) to the EEPROM by an EEPROM application program or driver together with an address to be written to the EEPROM. Also, reading of these data and the like from the EEPROM to the RAM is processed by the application program and the driver using the address.
- a signal other than a sine wave drive signal or a PWM signal may be used as a drive signal for driving the brushless DC servo motor.
- the control unit 300 rotates the position of the brushless DC servo motor that drives the driven member 15. Rotation position is calculated, and inverter drive signal information for supplying current to each of the U-phase, V-phase, and W-phase coils of the brushless DC servo motor is generated so that the driven member 15 operates at each predetermined position. To do. Information of the inverter drive signal for driving the DC servo motor based on these signals is output from the control unit 300 of the brushless DC servo motor to the inverter drive control unit 41 via the serial communication line.
- the control unit 300 executes servo control of the brushless DC servo motor 100 based on information of the rotary encoder (MR sensor unit 20).
- the driven member 15 is a target of servo control by the control unit 300. Further, the rotational speed, rotational position, amount of movement, etc. of the driven member 15 are detected by a device encoder provided on the driven member, and information (R) of this device encoder is fed back to the control unit 300 for reference of servo control. Used as information.
- FIG. 2A is a longitudinal sectional view of the brushless DC servo motor based on the first embodiment
- FIG. 2B is a sectional view taken along the line BB of FIG. 2A.
- the stator coil 11 includes nine field iron cores 112 arranged at equal intervals in the circumferential direction, and a field coil 111 wound through an insulating member 113 in a slot around each field iron core.
- the field iron core 112 is configured by laminating a plurality of steel plates in the axial direction.
- the field coil 111 wound around each field iron core 112 has a U-phase, V-phase, and W-phase, that is, a U-phase field coil (11U1 to 11U3), depending on the phase of the voltage applied from the inverter 40. ), V-phase field coils (11V1 to 11V3), and W-phase field coils (11W1 to 11W3).
- a rotor 12 having an 8-pole permanent magnet is formed integrally with a rotary shaft 13, and these are rotated by a first end cover 18 and a pair of bearings 16 and 17 provided in the motor housing 10. It is held freely.
- the rotor 12 is an 8-pole rotor having a rotor yoke 121 fixed to the rotary shaft 13 and eight permanent magnets 122 fixed to the outer periphery thereof.
- the rotor yoke 121 is formed by laminating a plurality of disk-shaped steel plates in the axial direction and integrating them.
- the outer peripheral surface of the rotor 12 faces the teeth of the stator core 11 via a gap.
- the specific configuration of the brushless DC servo motor 100 such as the number of slots, the number of magnet poles, the motor housing 10 and the cover is not limited to the embodiment.
- the direction of the cup-shaped motor housing 10 is reversed left and right, and a side cover on which the bearing 17 holding portion and the support column are formed is fixed to the opening on the right side of the motor housing.
- the end cover 19 may be fixed.
- the MR sensor unit 20 includes a flat plate-shaped magnet 21 fixed to one end surface of the rotating shaft 13 via a fixing member 26 and a pair of the magnet sensor unit 20 fixed to the motor housing 10 at a position facing the magnet 21.
- MR sensor (magnetoresistive element sensor) 22 and a processing circuit unit 23 are provided.
- a pair of MR sensors 22 arranged to face a flat magnet 21 fixed to one end face of the rotating shaft 13 detects a change in magnetic field resistance caused by switching between the N pole and the S pole. It is.
- the magnet 21 is not multipolarly magnetized but is magnetized with one each of N and S.
- the magnet 21 is composed of a thin film of an alloy mainly composed of a Si or glass substrate and a ferromagnetic metal such as Ni or Fe formed thereon.
- the pair of MR sensors 22 22A, 22B
- the pair of MR sensors 22 are arranged at predetermined intervals in the rotation direction of the rotary shaft 13 so that the phases of the output pulses are shifted from each other by a predetermined angle, for example, 90 degrees.
- the pair of magnetoresistive elements are connected in series, and a voltage Vcc is applied to both ends thereof, and a voltage signal representing the potential at the connection point between the two elements is the output of the MR sensor 22.
- the MR sensor 22 and the processing circuit unit 23 are provided on a single printed board 24.
- the MR sensor 22 faces the magnet 21 by a plurality of, for example, three columns 25, and the rotational centers of the MR sensor 22 and the magnet 21 coincide with the axis of the rotating shaft 13. Accordingly, the motor housing 10 is fixed to the side surface and is covered with a second end cover 19 made of a nonmagnetic material.
- the fixing member 26 is a cup-shaped member made of a non-magnetic material, for example, a resin.
- the magnet 21 is integrally molded at one end thereof.
- the fixing member 26 is rotatable in the circumferential direction with respect to the rotating shaft 13 in a state where the rotating shaft 13 is inserted into the cup-shaped hollow portion, and the fixing member 26 is rotated by a fixing pin 27 or an adhesive. It is fixed with respect to the shaft 13.
- the magnet origin position (T 0 ) is the position of one end on the boundary line between the N-pole region and the S-pole region of the plate-like magnet 21 magnetized with one pole each of N and S. This position should coincide with the absolute origin position (Z 0 ) on the rotation axis.
- the brushless DC servo motor is initially set so that the magnet origin position (T 0 ) and the absolute origin position Z 0 coincide with each other. Secure to the shaft. Therefore, at the stage where the motor stator and the rotor are assembled, the absolute origin position Z 0 on the rotation axis relative to the drive signal. Specifically, in a state where the second end cover 19 is not fixed to the right side surface of the motor housing 10, the magnet 21 is temporarily fixed to the rotating shaft, and the brushless DC servo motor is driven, thereby the MR sensor.
- This initial setting work is processed using, for example, an arm of a work robot with a camera function or by the worker himself.
- the gap between the right side surface of the motor housing 10 and the pair of MR sensors 22 is used for the initial setting work and in order for the pair of MR sensors 22 to ensure a predetermined magnetic sensitivity. It is desirable that the gap is a predetermined minute interval, for example, a gap of 20 mm to 30 mm. A specific method of initial setting will be described in detail later.
- FIG. 3 is a diagram illustrating a configuration example of a drive circuit of the brushless DC servo motor in the first embodiment.
- each of the field coils 11U to 11W includes U1, U2, and U3 coils in series, V1, V2, and V3 coils in series, and W1, W2, and W3 coils in series. Connected. One end of each of these three coil groups is connected at a neutral point.
- the inverter 40 is composed of six switching elements FET1 to FET6 composed of FET transistors, one electrolytic capacitor 47, a resistance element, and the like. One end of each of the switching elements FET1 to FET6 is connected to one of the U-phase, V-phase, and W-phase coils 11U to 11W of the brushless DC servomotor 100, and the other end is connected to the DC power source 42. A voltage, that is, an inverter drive signal generated by the inverter drive control unit 41 is applied between the gate and source of each of the switching elements FET1 to FET6.
- the electrolytic capacitor 47 smoothes the power supply voltage.
- the brushless DC servo motor control unit 300 controls the operation command, the control signal generated based on the normal operation mode motor control signals (iu, iv, iw), and the phase A from the MR sensor unit 20. Based on the B phase signal, the operation of the brushless DC servo motor 100, for example, sine wave drive is continued. Thereby, the driven member 15 performs an operation based on a predetermined operation pattern in a predetermined operation range.
- the control unit 300 of the brushless DC servo motor is mounted on one printed circuit board 600 together with the inverter drive control unit 41 and the inverter 40, for example, on the inner surface of the motor housing 10 and the second end cover 19, and MR It can also be fixed at a position close to the sensor unit 20.
- the inverter 40 is connected to a power supply line in the vicinity of the power supply terminal 48 to the field coil 111.
- the printed circuit board 600 may be installed outside the brushless DC servo motor. In the drawing, power supply lines such as the MR sensor unit 20 and the printed circuit board 600 are omitted.
- Each function realized by executing programs such as the control signal (iu, iv, iw) generation unit 346, the normal operation mode DC servo control unit 347, and the inverter drive signal generation unit 348 is displayed as an example. is there.
- the functions can be arbitrarily classified, and it is needless to say that the plurality of functions may be realized by a common program, or the specific function may be realized by a plurality of different programs or IC circuits. Further, a part of the program related to the initial setting and the memory data of the control unit 300 are shared with the terminal device 700 and the server in the factory, and a part of the initial setting process is shared by the terminal device 700 in the factory. You may comprise so that it may do.
- FIG. 4A shows an example of the processing circuit unit 23 of the MR sensor unit 20.
- the processing circuit unit 23 includes an AD converter 231, an axis deviation correction processing unit 232, a memory 233 such as a RAM, an arctangent calculation processing unit 234, a pulse counter 235, an incremental A phase / B phase signal generation unit 236, and a magnet origin position signal.
- Each of the functions of a (T 0 ) generation unit 237, a parallel / serial conversion unit 238, and a serial communication unit 239 is included.
- the processing circuit unit 23 is realized, for example, by executing a program on a microcomputer with a memory.
- the analog signals of the pair of MR sensors 22A and 22B are quantized and divided into multiple parts by an electrical angle interpolation process, for example, 36000 pulses of A per rotation of the rotation axis.
- Phase and B phase digital signals are subjected to arctangent calculation by an arctangent calculation processing unit 234 and added by a pulse counter 235.
- This cumulative addition value is generated as incremental A-phase signal and B-phase signal (hereinafter referred to as A-phase / B-phase signal) pulse data by the incremental A-phase / B-phase signal generation unit 236 and stored in the memory 233.
- FIG. 4B shows a concept of a method for processing the output signal of the MR sensor.
- the MR sensor 22 is provided so that the characteristic in which the electric resistance value varies with the direction of the acting magnetic field. Therefore, when the magnet 21 rotates by an angle ⁇ and the direction of the magnetic field acting on each MR sensor rotates, the electrical resistance value of the MR sensor, in other words, the voltage of the output signal of the MR sensor 22 fluctuates accordingly.
- a pulse signal for one cycle is output for each SIN wave and COS wave for each rotation 360 ° (mechanical angle) of the rotating shaft 13.
- the A-phase and B-phase signals obtained from the pair of MR sensors 22A and 22B may include errors (mainly axis misalignment errors) due to production errors, installation errors, temperature effects, etc. of each sensor. There is sex. That is, the A-phase / B-phase signal obtained as a result of the arctangent calculation should be positioned on a straight line in proportion to the rotation angle ⁇ of the rotating shaft 13. However, due to errors such as axial misalignment, repeated distortion may be included every 360 degrees or every 90 degrees of phase difference between a pair of MR sensors.
- the axis deviation correction processing unit 232 extracts the rotation center of the pair of MR sensors based on the data for at least one rotation of the rotating shaft 13, and detects the presence or absence of distortion of the A phase and B phase signals with respect to the rotation angle ⁇ . If there is distortion, the correction process is performed.
- the signal of the magnet origin position (T 0 ) is synchronized with the position of the angle 0 that appears every rotation of the rotary shaft 13. Is generated and output.
- the signal of the magnet origin position (T 0 ) is used as information for fixing the magnet 21 to the absolute origin position Z 0 of the rotation axis.
- the A-phase / B-phase signal generated by the parallel transmission processing and the magnet origin position (T 0 ) signal are transmitted data for serial transmission conforming to the serial transmission communication standard. (BUS), and this BUS signal is transmitted from the serial communication unit 239 to the control unit 300 of the brushless DC servo motor via one communication cable 28.
- an up / down counter is employed as the pulse counter 235 of the MR sensor unit, and A and B phase signals are generated by adding information on the forward / reverse rotation direction of the rotating shaft 13 to the cumulative addition / subtraction value of the pulse. You may make it transmit to the control unit 300 of a servomotor. In the present invention, count information with information on the rotation direction by such an up / down counter is also handled as a cumulative addition value.
- the magnet origin position (T 0 ) signal is a signal generated once for each rotation of the rotating shaft 13 and can also be used as a signal for detecting the number of rotations of the rotating shaft 13.
- the initial setting is started by starting a program related to the initial setting of the control unit 300 from the external terminal device 700 and setting necessary parameters (501).
- the magnet 21 is temporarily fixed to the rotating shaft 13 of the brushless DC servo motor 100 at an arbitrary position (magnet origin position (T 0 )) (503), and the pair of MR sensors 22 and the processing circuit 23 is fixed to the side surface of the motor housing 10 (504), and the second end cover 19 is not yet fixed to the right side surface of the motor housing 10.
- the control unit 300 generates an arbitrary (predetermined) driving signal for initial setting in accordance with the activation of the program related to the initial setting, and supplies driving power to the three-phase stator coil of the DC servo motor (505). Along with this, the rotor and the magnet 21 of the MR sensor 20 rotate (506), and the MR sensor (detection element 22, processing circuit 23) outputs the output signals A and B and the information of the magnet origin position (T 0 ). Is generated (507). The control unit 300 generates a temporary data table of A and B signals based on a predetermined drive signal, for example, a rectangular wave signal (508). Table 1 shows an example of a provisional table of (T 0 ) criteria generated by the MR sensor unit 20 and recorded in the RAM of the control unit 300.
- the motor is operated in both forward and reverse directions according to the number of poles of the rotor 12 from the output signals of MR sensors A and B recorded as Table 1.
- the phase information of the U-phase, V-phase, and W-phase signals that rises at 120 ° intervals in terms of electrical angle, which is required to make one rotation each, for example, is generated.
- the phase information of the U-phase, V-phase, and W-phase signals as shown in Table 2 so that the rotor 12 makes one rotation every 45 ° mechanical angle (every 4500 pulses). Generate a table.
- U-up and V-up indicate rising phases of U-phase and V-phase signals.
- the rise of the U-phase and V-phase signals is synchronized with the rise phase of the A-phase signal from the MR sensor unit 20.
- the phase information of W-up, U-dw, V-dw, and W- dw indicating the rising phase of the W-phase signal, and the falling phase of each of the U-phase, V-phase, and W-phase signals, Recorded in the table.
- Table 2 shows the provisional absolute of each phase. generated as data (T 0 reference) (511).
- Table 2 shows an example of provisional absolute data of the U phase, which is recorded in the EEPROM of the control unit 300, here.
- the rising phase Sn of each signal of the U phase, V phase, and W phase is extracted based on the phase of the integral value peak Pz obtained previously (512).
- the absolute origin position of the rotating shaft with respect to the drive signal based on the relationship between the output of the MR sensor, the integrated value peak and the rotation angle of the rotating shaft (Z 0 ) is obtained (514).
- the data of the “absolute origin position (Z 0 ) on the rotation axis” based on the information on the integrated values of the A-phase, B-phase signal, and U-phase back electromotive force corresponding to the initial setting drive signal. Is obtained.
- absolute data as shown in Table 4 below is generated for the U-phase signal.
- the control unit 300 sends a command to the work robot or worker to “fix the rotor, remove the temporary fixing of the magnet, and rotate the magnet with respect to the rotation axis” (516).
- the magnet 21 rotates, information on the magnet origin position (T 0 ) is obtained from the MR sensor 20 (517).
- Information on the magnet origin position (T 0 ) of the magnet 21 is transmitted to the external terminal device 700 via the control unit 300 (518).
- the position with respect to the rotation axis of the magnet is set to an absolute position Z 0 (520), the work robot to fix the magnet 21 to the rotating shaft (521).
- the control unit 300 further sends a command to “release the fixing of the rotor” to the work robot (522).
- the position data of all of the signals obtained from the MR sensor unit is changed to the absolute origin position Z 0 reference, Z phase signal, is related to the "width of the Z phase", the address of the EEPROM is applied. In this way, it is converted into a multi-rotation / absolute signal representing the absolute origin position of the rotating shaft 13. That is, provisional absolute data ((T 0 ) standard) of each phase signal is generated as a table of absolute data corrected to the Z 0 standard (523) and recorded in the EEPROM.
- multi-rotation absolute data for each phase is generated (see FIG. 11B) and recorded in the EEPROM 333 (524). In response, the initial setting ends (525).
- FIG. 6A is a flowchart showing processing at the time of starting the initial setting program of the control unit in the first embodiment of the present invention.
- the control unit 300 of the brushless DC servo motor checks whether or not the initial setting has been completed (S601). If not, the process proceeds to the initial setting process mode (S602).
- FIG. 6B Details of the initial setting process (S602) of the control unit 300 at the time of starting the initial setting program are shown in FIG. 6B.
- the initial setting process first, the magnet of the MR sensor is temporarily fixed at the temporary position (Z ⁇ ) with respect to the rotation axis (S610 in FIG. 6B).
- EEPROM data is initialized (S611), and an initial setting drive signal (iu, iv, iw) generation unit 340 generates an initial setting drive signal for initial setting, for example, a PWM signal ( ⁇ N Rotation).
- the initial setting drive signals (iu, iv, iw) are sufficient to drive the brushless DC servo motor by one to several rotations in the forward and reverse directions with zero rotation in between.
- This initial setting drive signal is output to the inverter drive signal generation unit 348 (S612), and the brushless DC servo motor 100 is driven by the generated inverter drive signal (PWM signal).
- the initial drive signal at the time of this initial setting replaces the DC servo control signal of the brushless DC servo motor.
- the target brushless DC servo motor is originally closed-loop controlled. However, in the initial setting process, each coil of the U phase, V phase, and W phase is controlled by the initial setting drive signal in the open control state of the brushless DC servo motor. Electric power is supplied to the brushless DC servo motor (S613).
- the obtained A phase and B phase signals are compared with the command value of the initial setting process, and whether or not the cumulative addition value is normal, that is, the cumulative addition value corresponds to the command value of the inverter drive signal, and the brushless DC servo It is determined whether or not the response state of the motor or MR sensor is normal (S614). When it is determined that there is an abnormality in the correspondence relationship, output correction processing such as correction of temperature characteristics of the MR sensor is separately performed so that the command value corresponds to the cumulative addition value of the A-phase and B-phase signals. Performed (S615). If the normal state is not obtained even after the output correction process is performed a plurality of times, another cause such as an abnormality in the EEPROM itself may be considered, and an error display to that effect is displayed.
- the initial setting processing next performs absolute conversion of the A-phase and B-phase signals acquired from the MR sensor unit 20 (S616). That is, for recording to the EEPROM, a write address is assigned (addressed) to each data of the A phase and B phase signals. In this way, provisional absolute signal data as shown in Table 1 is recorded in the EEPROM via the RAM.
- the absolute position of the magnet with respect to the rotation axis is obtained, and the process proceeds to a series of processes for enabling generation of absolute signal data based on the absolute position information.
- the back electromotive force of each phase accompanying the supply of drive power to the stator coil based on the first drive signal is detected, and the integrated value peak Pz of the back electromotive force is detected (S617).
- the back electromotive force detection unit 46 detects time-series back electromotive forces Vbu, Vbv, Vbw of the coils of each phase and transmits them to the control unit 300.
- the extraction unit 341 of the rising phase Sn of each phase signal performs an integration calculation of the back electromotive force of each phase, and detects a peak position Pz where the integration value exceeds a predetermined threshold value.
- FIG. 7A is a diagram showing the relationship between the magnetic pole and current of each field coil of the stator and the relationship between the back electromotive force of each field coil in a DC servomotor including a rotor having an 8-pole permanent magnet.
- the rotor 12 rotates by rotating the phase of the current supplied to the field coils 11U, 11V, 11W of the stator.
- back electromotive forces V bu , V bv , and V bw are generated in each field coil.
- magnet origin position (T) is determined based on the synchronous relationship between the A-phase and B-phase output signals from the MR sensor unit and the drive signal to the stator coil of any one phase. 0 )) information is acquired.
- U, V, and W phase drive signals are generated to drive the brushless DC servo motor 100 in both forward and reverse directions, for example, forward and reverse one rotation (S618). That is, in the synchronization setting unit 343 for the rising of each phase and the absolute origin position, the number of poles of the permanent magnet of the rotor 12, that is, 8 poles in this embodiment, is adjusted according to the initial setting drive signal (iu, iv, iw). In addition, it has a function of generating phase information (see Table 2 and FIG. 8A) of U-phase, V-phase, and W-phase signals based on the magnet origin position (T 0 ).
- FIG. 8A shows the relationship between the A-phase and B-phase signals output from the MR sensor unit and the Z-phase, U-phase, V-phase, and W-phase signals generated based on these signals. .
- the phase information of the U-phase, V-phase, and W-phase signals in S618 is completely synchronized with the phases of the A-phase and B-phase output signals from the MR sensor unit 20 that functions as a rotary encoder. This is different from the U-phase, V-phase, and W-phase signals of the initial setting drive signal in S612.
- the extraction unit 341 for the rising phase Sn of each phase signal extracts the rising position (Sn) of each driving signal in the phase data of the U phase, V phase, and W phase driving signals shown in Table 2 and FIG. 8A. (S619).
- FIG. 7B is a diagram showing the relationship among the back electromotive forces V bu , V bv , V bw of each of the field coils 11U to 11W, their integrated value peaks, and positioning information (Sn).
- the integral value peak corresponds to a point in time when the peak of each integral value exceeds a predetermined threshold, and this is generated as positioning information (Sn).
- the integration value peak is at positions of 40 ° and 100 ° within a rotation angle (electrical angle) of 120 °. Has been obtained. That is, for the U-phase field coils (11U1 to 11U3), six integral value peaks are obtained per rotation (360 °).
- positioning information (Sn) may be determined and recorded in the EEPROM for the V phase and the W phase, respectively.
- a plurality of positioning information (Sn) may be generated for each rotation of the rotating shaft 13.
- different types of signals having different resolutions for example, a rough signal of about 1 to 2 times per rotation and a dense signal of about several tens of times per rotation may be combined.
- the rising edge of the first U-phase signal and the rising edge of the first A-phase signal are synchronized with the magnet origin position (T 0 ).
- Z phase signals (Z1, Z2, ⁇ , ⁇ , Zn) are set for every 360 ° (mechanical angle) of the rotating shaft 13 with reference to the magnet origin position (T 0 ).
- the excitation current to the U-phase coil increases from the rising position of the first A-phase signal corresponding to the magnet origin position (T 0 ) in FIG. 8A, in other words, from the rising position of the U-phase signal. Therefore, in the example of FIG.
- FIG. 8B is a diagram showing output signals (A phase, B phase) of the MR sensor based on the magnet origin position (T 0 ) at the time of forward rotation command as an inverter drive signal.
- the phase shift direction is reversed according to the rotation direction of the rotary shaft 13.
- “Z-phase width (1)” having a width corresponding to one pulse of the A-phase signal in synchronization with the rising of the first A-phase signal of each Z-phase signal (Z1, Z2,-,-, Zn). Is determined.
- a signal of “Z-phase width (2)” having a width corresponding to several pulses of the A-phase signal is determined.
- the signals of “Z phase width (1)” and “Z phase width (2)” are signals that repeat at 360 ° (mechanical angle) intervals, respectively.
- FIG. 8C it has a width corresponding to one pulse of the A-phase signal in synchronization with the fall of the first A-phase signal of each Z-phase signal (Z1, Z2,-,-, Zn).
- the signal of “Z phase width (3)” is determined.
- a signal of “Z width (4)” having a width corresponding to several pulses of the A phase signal is determined.
- “Z-phase width (3)” and “Z-phase width (4)” are also signals repeated at intervals of 360 degrees.
- the period of “Z phase width” and the number of “Z phase width” can be arbitrarily set and are recorded in the memory in advance. Moreover, you may produce
- each A-phase / B-phase signal of the U-phase, V-phase, and W-phase signals from which the Z-phase signal was obtained is then calculated for each rotation (every 360 degrees) of the rotating shaft 13. It is converted into a cumulative addition value, and the address of the EEPROM is given to the combination of this and the Z-phase signal, and the temporary multi-rotation absolute signal data as shown in Table 3 is obtained.
- the absolute origin of the rotating shaft with respect to the drive signal is determined based on the relationship between the output of the MR sensor, the integral value peak, and the rotational angle information of the rotating shaft.
- the position (Z 0 ) is obtained (S621 in FIG. 6).
- FIG. 9 is a time chart for explaining the processing for obtaining the absolute origin position (Z 0 ) of the rotating shaft with respect to the drive signal.
- the MR sensor unit 20 When the inverter drive signal is output and the brushless DC servo motor 100 is driven in both forward and reverse directions, the MR sensor unit 20 outputs A phase and B phase signals corresponding to command values (U, V, and W phase drive signals). Is obtained. Further, as described above, based on the data from the back electromotive force detection unit 46, the extraction unit 341 of the rising phase Sn of each phase signal obtains a plurality of corresponding peak positions, that is, a plurality of positioning information (Sn). .
- the positioning information (Sn) corresponding to the absolute origin position (Z 0 ) on the rotating shaft should be output once for one rotation of the rotating shaft 13. Further, this positioning information (Sn) is a position corresponding to the rising point corresponding to 0 degree of the A phase signal in the section where the excitation current to the coil of any one of U, V and W is increasing. It is defined as In this case, it is necessary that the rotation shaft passes through this absolute origin position (Z 0 ) while the brushless DC servo motor is rotating forward. Therefore, in the synchronous setting unit 343 for the rise of each phase and the absolute origin position, as shown in the lower part of FIG. 9, the brushless DC servo motor is started and zero rotation is performed between the initial setting drive signal (inverter drive signal).
- the brushless DC servo motor is rotated forward or backward within the range. For example, when the brushless DC servo motor is rotated forward from ⁇ 1 rotation to +1 rotation, while rotating from ⁇ 1 rotation through zero rotation to +1 rotation, as shown in the middle and upper sections of FIG.
- the integrated value (peak value) of the back electromotive force of the phase coil reaches the threshold value. In this way, positioning information (S1) to (S6) corresponding to the rising time of each signal is output.
- the ON duty of the PWM signal of the U-phase coil of the inverter drive signal is synchronized with zero, and the phase of the positioning information (S4) is synchronized with the absolute origin position (Z 0 ) on the rotating shaft.
- positioning information synchronized with the absolute origin position (Z 0 ) on the rotation axis may be output based on the excitation current to the V-phase or W-phase coil.
- the transmission timing of the command value (PWM signal) of the initial setting drive signal and the A phase, B phase signal, U phase, V phase, W phase And time information such as the reception timing of positioning information may be used.
- a table of absolute values (Table 4) containing the phase information of the coils is generated.
- a request for positioning the magnet is sent from the control unit 300 to the external terminal device 700, and in response to this, the control unit 300 receives the magnet by the magnet fixing position setting unit 344 of the MR sensor unit.
- the process proceeds to the positioning process (S622).
- the magnet positioning process will be described with reference to FIGS. 10A to 10D.
- the magnet 21 is temporarily fixed at an arbitrary angular position (magnet origin position (T 0 )) with respect to the rotating shaft 13 at the time of initial setting.
- the output of the MR sensor 20 is a sign relative to the rotation angle. It changes as shown by the waveform, and a magnet origin position (T 0 ) signal is output. Therefore, as shown in FIG. 10C, the magnet 21 is rotated with respect to the rotating shaft 13, and the output of the MR sensor (magnet origin position (T 0 ) signal) is the previously obtained absolute origin position (Z 0 ). A matching position is obtained, and the magnet 21 is fixed to the rotating shaft 13 at this position. In this way, the magnet 21 is fixed at the absolute origin position (Z 0 ) on the rotating shaft 13.
- the magnet 21 is fixed at a position where the origin position (T 0 ) of the magnet is synchronized with the absolute origin position (Z 0 ) of the rotating shaft 13. It is assumed that the positioning of the magnet 21 by the method of the present embodiment may include a slight error strictly with respect to the resolution (about 36000 pulses) of the MR sensor.
- the “absolute origin position” of the magnet 21 of the present invention is defined as including such a minute error.
- FIG. 10D shows an example of a method for fixing the position of the magnet 21 with respect to the rotating shaft 13.
- the fixing member 26 is fixed to the rotating shaft 13 with a fixing pin 27, an adhesive 28, or the like. From these pieces of information, the relationship between the drive signal and the angle of the magnet on the rotating shaft is obtained, and the magnet is rotated relative to the rotating shaft. That is, by correcting the phases of the rising position Sn absolute origin position Z 0, interim data of a multi-rotation absolute signal, converts the absolute origin position data of the multi-rotation Absolute signal referenced (S623). This makes it possible to completely synchronize the drive signal and the output of the MR sensor.
- FIG. 11A is a diagram showing an example of converting phase data related to the A phase, B phase signals, and Z phase based on the magnet origin position (T 0 ) into Z 0 reference multi-rotation absolute data.
- the absolute data of the multi-rotation of the Z 0 reference recorded in EEPROM333 (S625).
- FIG. 11B is a diagram illustrating an example of data relating to the phases of the A phase, the B phase signal, and the Z phase recorded in the EEPROM with respect to the coils of the U phase, the V phase, and the W phase.
- the data in FIG. 11B, the Z 0 reference, A-phase, B-phase signal, Z phase and, U-phase, V-phase, the rotational speed of each phase coil and W-phase, the absolute information of the rotational angle or phase As a table to be given, it can be used for current control of each coil.
- Each of the “Z phase width (1)” to “Z phase width (4)” (not shown) is used to generate various control signals of the brushless DC servo motor, such as an inverter drive signal.
- the process proceeds to the abnormal termination determination mode.
- the data of the multi-turn absolute signal is read from the EEPROM via the RAM (S603), and the previous brushless DC servo motor operation has been normally completed based on the read absolute signal data. Then, it is determined whether the process has ended in an abnormal state (S604). If successful, the data of the absolute signal of the EEPROM, the position of the absolute value 0 when starting the rotation shaft of the brushless DC servo motor, i.e., it should correspond to the absolute origin position Z 0. If the absolute signal data is away from the absolute value 0, it is determined that the operation has ended abnormally.
- the information on the integrated value of the back electromotive force V BU of each phase coil is used only in the initial setting process, and is essentially unnecessary in the normal operation process mode. Therefore, when the initial setting process is completed, the recording of the positioning information (Sn) data received from the MR sensor unit in the memory may be stopped. Conversely, information on the integrated value of the counter electromotive force V BU may be used as a fail-safe function related to the MR sensor.
- FIG. 12 is a time chart for explaining the process of determining the absolute origin position (Z 0 ) of the rotation axis with respect to the drive signal during the initial setting process based on a combination of coarse and fine positioning information.
- positioning information based on the integrated value peak of the back electromotive force V BU , coarse positioning information once every 180 degrees of rotation of the rotating shaft and dense information once every 6 degrees of rotation of the rotating shaft.
- Positioning information is output.
- the on-duty of the PWM signal of the U-phase coil for driving the inverter is synchronized with zero.
- the positioning information (S40) The position is provisionally determined to be the absolute origin position (Z 0 ) that is synchronized with the rising point of the A-phase pulse.
- dense positioning information ⁇ , S388, ⁇ , ⁇ , S418, ⁇ , is adopted in the vicinity of the provisional position (S40), and the on-duty of the PWM signal is synchronized with zero in this vicinity.
- the position of the positioning information (S406) based on the integrated value peak of the back electromotive force V BU is formally determined as the absolute origin position (Z 0 ) of the rotating shaft with respect to the drive signal.
- the absolute origin position (Z 0 ) of the rotating shaft with respect to the drive signal it is possible to determine the absolute origin position (Z 0 ) with considerably high accuracy. Therefore, it is possible to shorten the time for the subsequent magnet positioning process in S621 to S622 in FIG. 6 and improve the accuracy.
- FIG. 13 is a flowchart showing details of signal processing of the control unit in the normal operation mode in the first embodiment.
- the brushless DC servo motor control unit 300 includes a multi-rotation / absolute signal generation unit 345, a normal operation mode motor control signal (iu, iv, iw) generation unit 346, and a normal operation mode DC servo control.
- the unit 347, the inverter drive signal generation unit 348, and the like operate, and the brushless DC servo motor functions as a rotary encoder based on an external command, information on the EEPROM 333, and information from the MR sensor unit 20.
- the normal operation mode motor control signal (iu, iv, iw) generation unit 346 generates U-phase, V-phase, and W-phase drive signals (S801), and the U-phase and V-phase corresponding to the drive signals from the EEPROM 333 and the like.
- the number of W-phase pulses is acquired (S802), and the Z-phase width signal and the phase data of the Z-phase signals (Z1, Z2,-,-, Zn) are acquired (S803, S804).
- the rising edge of the U phase is synchronized with the absolute origin position (Z 0 ) (S805).
- the A phase / B phase signal from the MR sensor unit is acquired via the RAM (S806), and the EEPROM address is assigned based on the incremental cumulative addition value, and the A phase for each rotation.
- -The B-phase signal, Z-phase signal, U, V, and W-phase signals are made absolute and recorded in the RAM (S807).
- a multi-rotation absolute signal including information on the rotation speed and rotation angle of the brushless DC servo motor is generated from the Z-phase signal and the A-phase / B-phase signals (S808) and recorded in the EEPROM via the RAM (S808). S809).
- each of the A, B, Z, U, V, and W signals is incremented and decremented for each rotation of the rotation shaft of the motor in accordance with forward and reverse rotation of the rotation shaft of the brushless DC servo motor.
- the control unit 300 of the brushless DC servo motor is rotated based on the A phase / B phase signal from the MR sensor unit 20 and the rotation speed / rotation direction of the brushless DC servo motor.
- the absolute origin position is recognized, the recognized rotational speed and direction, and the absolute origin position are compared with the command value, and the sine wave drive signal for driving the inverter for each of the U-phase, V-phase, and W-phase coils. Is generated.
- the rotor is rotated by continuously changing the voltage of the stator coil in a sine wave shape according to the rotation angle of the rotor.
- the U-phase, V-phase, and W-phase coils are supplied with sinusoidal voltage power with a 120 ° (electrical angle) phase shift. Furthermore, the voltage is continuously changed by controlling the duty ratio of the PWM signal for the inverter as the motor drive circuit.
- the DC servo control unit 347 in the normal operation mode is a brushless DC servo based on the rotation speed and rotation angle signals and the multi-rotation / absolute signal recorded in the EEPROM in the form of a table as shown in FIG. 11B.
- the current rotational angle of the rotating shaft 13 of the motor 100 and, in turn, the current absolute position of the driven member 15 are recognized.
- the DC servo control unit 347 calculates a speed command value from the current position of the driven member 15 to the target position based on these pieces of information.
- the inverter drive signal generation unit 348 receives the output of the DC servo control unit 347, generates an inverter drive signal for controlling the rotation of the brushless DC servo motor 100, and outputs the inverter drive signal to the inverter drive control unit 41.
- FIG. 14 is a flowchart showing details of operations of the DC servo control unit 347 and the inverter drive signal generation unit 348 in the normal operation mode.
- the DC servo control unit 347 acquires, from the memory 330 such as the RAM, each target position and target speed as a command value based on a preset operation pattern of the brushless DC servo motor (S901). ).
- the memory as a target speed corresponding to the operation pattern of the brushless DC servo motor set corresponding to each target position of the driven member, a motor drive signal based on sine wave drive or PID control, for example, a PWM control signal Is stored.
- a brushless DC servo motor is an acceleration region from the reverse position of the driven member to the end of acceleration, a constant speed region from the end of acceleration to the start of braking, and from the start of braking to the reverse position. It is a deceleration area.
- the brushless DC servo motor is PWM-controlled according to such a predetermined operation pattern.
- the inverter drive signal generation unit 348 acquires a multi-rotation absolute signal (S902), and calculates a difference value from the command value (S903). Based on this calculation result, the inverter drive signal generation unit 348 determines the presence or absence of “deviation” (S904), and if the difference exceeds the allowable value, determines that there is “deviation”, which is the second time. In the case (S905, S906), it is determined that there is an error including deviation in the rotary encoder (MR sensor unit 20), abnormality information is transmitted to the ECU 500 (S907), and the process is terminated. Note that even if there is an abnormality in the EEPROM itself rather than the rotary encoder, it can be checked at this point.
- an inverter drive signal based on PID control is generated (S908) and output to the inverter drive control unit 41 (S909).
- the multi-rotation / absolute signal based on the A-phase / B-phase signal from the MR sensor unit 20 is acquired (S910), and the difference deviation amount between the inverter drive signal and the multi-rotation / absolute signal is calculated (S911).
- the presence / absence of deviation is determined (S912).
- the brushless DC servo motor of this embodiment is a servo motor that is controlled using the output of one MR sensor 20 that functions as a rotary encoder.
- FIG. 15 shows an example of control as a servo motor using EEPROM data based on the first embodiment.
- the brushless DC servo motor is accurately and quickly driven from the current position P n to the target position P n + 1 by the information of the EEPROM's multi-rotation / absolute signal and the rotation command combining PID control and PWM control. .
- the control unit 300 of the brushless DC servo motor recognizes the operation state of the driven member sequentially based on the A phase / B phase signal from the MR sensor unit 20 and the information of the device encoder. Continue to drive the brushless DC servo motor.
- the driven member performs an operation based on a predetermined operation pattern in a predetermined angle range.
- one MR sensor unit is a rotary encoder, and phase information of each phase coil of Z phase, U phase, V phase, and W phase is based on the A phase and B phase signals.
- a control device for a brushless DC servo motor capable of controlling the position of a driven member with extremely high accuracy by synchronizing each phase of the stator coil and the magnetic pole position of the rotor with the origin position and performing servo control in a completely closed loop. Can be provided.
- the absolute origin position of the rotary shaft is obtained in the same manner as in the first example, and after the magnet is formally fixed to the rotary shaft, the signals relating to the U-phase, V-phase, and W-phase coils are output.
- To determine the width of the Z phase That is, instead of fixing the Z-phase width for the signals related to the U-phase, V-phase, and W-phase coils in Example 1 before fixing the magnet to the absolute origin position of the rotating shaft.
- the Z-phase width is determined for the signals related to the U-phase, V-phase, and W-phase coils, and an absolute data table is generated in the EEPROM. Record.
- the obtained effect is the same as that of the first embodiment of the present invention.
- the third embodiment includes an automobile driven device driven by a brushless DC servo motor.
- each function of the control unit is incorporated in an in-vehicle engine control ECU, unlike the control unit 300 in FIG.
- the functions of the DC servo motor drive control unit 41 and the current control unit 44 are also incorporated in the in-vehicle ECU.
- Each function of the control unit of the third embodiment and the configuration of the brushless DC servo motor and its drive circuit are the same as the configuration and function of the control unit 300 of FIG. 1 and the drive circuit of FIG. Omitted.
- the driven device of the automobile is driven based on the information of the absolute signal generated by using one MR sensor unit as a rotary encoder, the driven device can be controlled with extremely high accuracy.
- a DC motor control device that can be easily realized by incorporating a simple program into a computer and is inexpensive and highly versatile can be provided.
- the multi-rotation / absolute signal is recorded in the EEPROM, it is possible to determine whether or not the automobile driven device is abnormally stopped at the next start-up, and safe operation can be started even in the case of an abnormal stop.
- FIG. 16 is a functional block diagram of a brushless DC servo motor control device according to the fourth embodiment of the present invention.
- each function of the control unit 300 is incorporated in an in-vehicle ECU 1000 unlike the control unit 300 of FIG.
- the functions of the inverter drive control unit 41 and the inverter 40 are also incorporated in the in-vehicle ECU 1000.
- the ECU 1000 includes a control unit 1012 including an upper processor 1010 and an upper memory 1014 for the control unit 300.
- the driven member a plurality of in-vehicle devices driven by a brushless DC servo motor can be targeted.
- the driven member includes a water pump and an oil pump. These driven members are accurately controlled by the brushless DC servo motor 100 based on the multi-rotation / absolute signal, and can be quickly returned to the normal state even when restarted after an abnormal stop.
- Each brushless DC servo motor that drives each driven member is provided with an MR sensor unit 20, and the A-phase / B-phase signal generated by each MR sensor unit 20 is a serial signal corresponding to the ISO 26262 standard. Is transmitted to the ECU 1000 via the communication cable 28. Since information necessary for driving each driven member often includes information common to other driven members, it is desirable that the ECU 1000 collectively manage the information.
- each driven member is driven by the brushless DC servo motor based on the information of the absolute signal generated based on the output of one MR sensor unit. Therefore, the position of each driven member can be controlled with extremely high accuracy.
- the absolute signal is recorded in the EEPROM, it is possible to determine whether or not each driven member of the automobile is abnormally stopped at the next start-up, and to realize safe start of operation even in the case of abnormal stop.
- the data is acquired from the EEPROM at the time of starting the vehicle, so that whether or not the motor is intentionally moved after power is not supplied from the battery is determined by the address of the data.
- a function for determining based on comparison and a function for returning the motor to the state at the time when power is no longer supplied from the battery based on the address of the data when it is determined that the motor is intentionally moved. is doing.
- the brushless DC servo motor control apparatus of the present invention is not only a brushless DC servo motor mounted on an automobile, but also a driven member that requires a multi-rotation / absolute signal based on information on the position of the absolute origin in other fields.
- the present invention can also be applied to a brushless DC servo motor that drives the motor.
- the position of the actuator can be controlled with high accuracy by an absolute signal.
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Microelectronics & Electronic Packaging (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
Abstract
1個のMRセンサユニットを用い、その出力信号に基づいて完全閉ループで高精度にモータを制御できる、ブラシレスDCサーボモータの制御装置を提供する。 3組のステータコイルに供給されるU相、V相、W相の電力を制御する制御ユニットと、前記ステータコイルの逆起電力を検出する機能と、MRセンサユニットとを備えたモータの制御装置において、前記ロータの極数に合わせて、前記MRセンサユニットの前記A相若しくは前記B相の出力信号の立ち上がり位相に同期する、前記U相、V相、W相の各位相情報を生成し、ブラシレスDCサーボモータを駆動した際に、いずれか1相のステータコイルへの駆動信号が零から立ち上がる位相と、該モータの駆動により得られる前記1相のステータコイルへの逆起電力の積分値ピークの位相と、前記駆動信号の零に対応する前記MRセンサユニットからの前記A相若しくは前記B相の出力信号の立ち上がり位相との同期関係に基づき、前記駆動信号に対する前記回転軸の絶対原点位置を取得する。
Description
本発明は、ブラシレスDCモータの制御装置に関するものであり、特に、被駆動部材を駆動するブラシレスDCサーボモータを目標速度及び目標位置で作動させるサーボ制御に適した、ブラシレスDCサーボモータの制御装置に係るものである。
ブラシレスDCモータは、安定した性能が得られ、かつ、耐久性に優れているため、自動車の補器類等、各種の制御システムを構成する機器の駆動源として、様々な分野に広く採用されている。
ブラシレスDCモータの主な制御方法は、以下の3通りである。
(1)ホールセンサとして、U、V、Wの3個のホール素子を用いて、モータの同期制御を行う。
(2)センサレス、たとえばベクトル制御等により、オープンループでモータを制御する。
(3)ロータリーエンコーダで得られるU相、V相、及びW相の信号とロータの磁極位置とを同期させて完全閉ループで、ブラシレスDCサーボモータとして制御する。
ブラシレスDCモータの主な制御方法は、以下の3通りである。
(1)ホールセンサとして、U、V、Wの3個のホール素子を用いて、モータの同期制御を行う。
(2)センサレス、たとえばベクトル制御等により、オープンループでモータを制御する。
(3)ロータリーエンコーダで得られるU相、V相、及びW相の信号とロータの磁極位置とを同期させて完全閉ループで、ブラシレスDCサーボモータとして制御する。
特許文献1には、センサとして3個のホール素子と1個のGMR検出器とを用い、それらの信号値に基づいて、3相永久磁石モータの任意の特定位置の情報やトルク変動情報を得る発明が開示されている。
特許文献2には、センサレスでモータを制御する発明が記載されている。すなわち、ロータの静止状態で、各駆動ステートにおける各通電相のコイルにロータが連続回転する電力よりも小さい検査電力を所定時間加えて、各通電相のコイルの逆起電力を検出し、この検出された逆起電力の大きさに応じて、起動駆動ステートを選定する発明が開示されている。
特許文献2には、センサレスでモータを制御する発明が記載されている。すなわち、ロータの静止状態で、各駆動ステートにおける各通電相のコイルにロータが連続回転する電力よりも小さい検査電力を所定時間加えて、各通電相のコイルの逆起電力を検出し、この検出された逆起電力の大きさに応じて、起動駆動ステートを選定する発明が開示されている。
特許文献3には、ブラシレスDCモータにおいて、ロータリーエンコーダ用カウンタの、正転時と逆転時における出力値から、回転体の回転角度に関する情報と回転角度の変化に関する情報とを抽出し、多回転の角度情報を生成する発明が開示されている。
また、特許文献4には、電動パワーステアリング装置において、操舵トルクセンサ、モータ角度センサ及び車速センサで検出した操舵トルクT、モータ角度θm及び車速検出値Vsを制御装置に入力し、この制御装置で絶対舵角推定値θaを演算するとともに、直流モータを駆動制御する発明が開示されている。
自動車等の各被駆動部材を駆動するブラシレスDCモータを、サーボモータとして完全閉ループで制御するためには、モータの回転速度、回転位相、回転方向等の正確な情報が必要である。これらの正確な情報により、被駆動部材の起動・停止、速度制御、位置制御等を行うことで、自動車等の安全な運転が可能になる。さらに、自動運転制御、若しくは自動運転制御を促進するためには、より高精度の情報が必要であり、モータの回転軸の絶対角度もしくは絶対原点位置(アブソリュート位置)の情報も必要になる。
特許文献1に記載の発明では、ホール素子を採用しているため、高精度の回転速度や回転方向の判別を行うのに充分な分解能や絶対精度が得られ難い。
特許文献2に記載のセンサレスの発明は、モータの回転角度を予測により求める方式であり、絶対原点位置を直接検出していないため、繰り返し誤差に関する対策が必要となる。また、逆起電力検出を採用する場合、速度零からの起動のために、別途、初期位置検出のための何らかの手段が必要である。
特許文献3に記載の発明は、1組のセンサ素子のデータを利用して絶対原点位置に相当する位置情報を算出し、回転体の多回転の角度情報を生成している。しかし、絶対原点位置の情報を、高精度に求めることについては開示されていない。
特許文献4に記載の発明は、モータ角度センサの他、操舵トルクセンサなど、制御システムの他の構成要素のデータも利用しており、構成が複雑である。
特許文献2に記載のセンサレスの発明は、モータの回転角度を予測により求める方式であり、絶対原点位置を直接検出していないため、繰り返し誤差に関する対策が必要となる。また、逆起電力検出を採用する場合、速度零からの起動のために、別途、初期位置検出のための何らかの手段が必要である。
特許文献3に記載の発明は、1組のセンサ素子のデータを利用して絶対原点位置に相当する位置情報を算出し、回転体の多回転の角度情報を生成している。しかし、絶対原点位置の情報を、高精度に求めることについては開示されていない。
特許文献4に記載の発明は、モータ角度センサの他、操舵トルクセンサなど、制御システムの他の構成要素のデータも利用しており、構成が複雑である。
また、自動車の各種被駆動部材を駆動するブラシレスDCサーボモータは、車載のバッテリを電源としている。バッテリ電源の消失後に、外力で故意にモータが駆動され、被駆動部材が正常な状態に無い場合もありうる。自動車の安全性をより高めるためには、このような状態であっても、安全に再起動できるのが望ましい。特許文献1~4には、このような、バッテリ電源の消失後の故意駆動に関する配慮は開示されていない。
本発明の1つの目的は、1個のMRセンサユニットを用い、その出力信号に基づいて完全閉ループで高精度にモータを制御できる、ブラシレスDCサーボモータ及びその制御装置を提供することにある。
本発明の他の目的は、バッテリ電源の消失後の故意にモータが駆動されたか否かを判定し、各種被駆動部材を安全に再起動できるようにした、ブラシレスDCサーボモータ及びその制御装置を提供することにある。
本発明の1つの態様によれば、駆動信号を生成して出力し、ブラシレスDCサーボモータのU相、V相、W相の3相の各ステータコイルに供給される電力を制御する制御ユニットと、多極の永久磁石を有するロータの回転を検知する1個のMRセンサユニットとを有する、ブラシレスDCサーボモータの制御装置において、前記MRセンサユニットは、前記ロータの回転軸の一端に固定され、径方向に着磁された1組のN極領域とS極領域を有する平板状のマグネットと、該マグネットに対向する位置で前記ハウジング側に固定された1対のMRセンサと、処理回路部とを備えており、前記処理回路部は、前記マグネットのN極領域とS極領域の境界線上の位置を、マグネット原点位置とし、前記1対のMRセンサの出力に基づいて、前記回転軸の回転に伴うA相、B相の信号を生成して出力するとともに、前記マグネットの原点位置の情報を生成するように構成されており、前記制御ユニットは、前記ロータの極数に合わせて、前記MRセンサユニットの前記A相若しくは前記B相の出力信号の立ち上がり位相に同期する、前記U相、V相、W相の各位相情報を生成する機能と、前記3相のいずれか1相のステータコイルへの駆動信号が零から立ち上がる位相と、該モータの駆動により得られる前記1相のステータコイルへの逆起電力の積分値ピークの位相と、前記駆動信号の零に対応する前記MRセンサユニットからの前記A相若しくは前記B相の出力信号の立ち上がり位相との同期関係に基づき、前記駆動信号に対する前記回転軸の絶対原点位置を取得する機能と、前記駆動信号の零に対応する前記A相又は前記B相の出力信号の立ち上がりに同期する、360度間隔の複数のZ相信号を設定する機能とを備えており、前記マグネットは前記原点位置が、前記回転軸の前記絶対原点位置と同期する位置に固定されており、前記MRセンサユニットを前記U相、V相、及びW相のロータリーエンコーダとして、前記モータを駆動するように構成されていることを特徴とする。
これにより、1個のMRセンサを利用した簡単な構成で、モータの回転軸の絶対原点位置の情報を生成する機能を備え、U相、V相、W相のロータリーエンコーダとロータの磁極位置を同期させて完全閉ループで制御できる、ブラシレスDCサーボモータ及びその制御装置を提供することができる。
本発明の他の態様によれば、前記ブラシレスDCサーボモータの前記制御ユニットは、自動車に搭載され、前記絶対原点位置の情報がEEPROMに記録されている。そのため、自動車の起動時に、EEPROMからデータを取得し、バッテリから電力が供給されなくなった後に前記モータが故意に動かされたか否かを前記データのアドレスの比較に基づいて判定する機能と、前記故意に動かされたと判定した場合には、前記データのアドレスに基づいて、前記モータを前記バッテリから電力が供給されなくなった時点の状態に復帰させる機能を有している。
これにより、バッテリ電源の消失後の故意にモータが駆動された場合でも、次回の起動時に安全な運転開始を実現できる。
本発明によれば、1個のMRセンサユニットをロータリーエンコーダとし、そのA相、B相信号に基づき、Z相及び、U相、V相、W相の各相コイルの位相情報を生成し、ステータコイルの各相とロータの磁極位置を原点位置に同期させて完全閉ループでサーボ制御することにより、被駆動部材の位置をきわめて精度良く制御できる、ブラシレスDCサーボモータ及びその制御装置を提供できる。
以下、本発明の実施の形態を、図面を参照しながら、詳細に説明する。
図1は、本発明の第1の実施例に基づく、ブラシレスDCサーボモータの制御装置の機能ブロック図である。ブラシレスDCサーボモータ100は、インナーロータ形の三相ブラシレスDCサーボモータ(以下、単にブラシレスDCサーボモータ)である。300は、ブラシレスDCサーボモータの制御ユニットである。
永久磁石タイプのロータが、回転軸13と一体に形成され、これらが、ブラシレスDCサーボモータのハウジングに設けられた軸受により、回転自在に保持されている。ブラシレスDCサーボモータ100の3相(U相、V相、W相)の各ステータコイルには、駆動トルクや速度指令等に応じて、電流制御部44で電流の制御された電力が、バッテリ42からイグニッションスイッチ43、及び、インバータ40を介して給電端子48から供給される。インバータ駆動制御部41は、制御ユニット300からの指令に基づき、インバータ40を駆動して各ステータコイルに供給される電流の位相を制御し、ロータを回転させる。制御ユニット300は、電流検出/制限部45で検出された電流に基づき、電流検出/制限部45を介して、インバータ40に供給される最大の電力や電流を制御する。46は逆起電力検出部であり、後で詳細に述べるように、初期設定時にブラシレスDCサーボモータ100の各相のコイルの逆起電力(VBU、VBV、VBW)を検出し、制御ユニット300に伝送する。
図1は、本発明の第1の実施例に基づく、ブラシレスDCサーボモータの制御装置の機能ブロック図である。ブラシレスDCサーボモータ100は、インナーロータ形の三相ブラシレスDCサーボモータ(以下、単にブラシレスDCサーボモータ)である。300は、ブラシレスDCサーボモータの制御ユニットである。
永久磁石タイプのロータが、回転軸13と一体に形成され、これらが、ブラシレスDCサーボモータのハウジングに設けられた軸受により、回転自在に保持されている。ブラシレスDCサーボモータ100の3相(U相、V相、W相)の各ステータコイルには、駆動トルクや速度指令等に応じて、電流制御部44で電流の制御された電力が、バッテリ42からイグニッションスイッチ43、及び、インバータ40を介して給電端子48から供給される。インバータ駆動制御部41は、制御ユニット300からの指令に基づき、インバータ40を駆動して各ステータコイルに供給される電流の位相を制御し、ロータを回転させる。制御ユニット300は、電流検出/制限部45で検出された電流に基づき、電流検出/制限部45を介して、インバータ40に供給される最大の電力や電流を制御する。46は逆起電力検出部であり、後で詳細に述べるように、初期設定時にブラシレスDCサーボモータ100の各相のコイルの逆起電力(VBU、VBV、VBW)を検出し、制御ユニット300に伝送する。
回転軸13の一端部には、この回転軸13の回転に伴うインクリメンタルな信号(A,B)を出力し、ロータリーエンコーダとして機能するMRセンサユニット20が設けられている。すなわち、MRセンサユニット20において検出された一対のMRセンサのアナログ信号は、デジタル信号に変換され、インクリメンタルなA相・B相各信号のパルスのデータ(A,B)が通信ケーブル28を介して制御ユニット300へ送信される。
ブラシレスDCサーボモータ100の1回転毎に出力されるA相・B相の信号のパルス数は、制御に必要とされる分解能等に応じて、任意に設定される。MRセンサの素子としてGMRを用いた場合、回転軸の1回転あたり、例えば、A相・B相、各々、36000パルスの出力が得られる。
本発明では、ブラシレスDCサーボモータの駆動信号の零に同期する回転軸上の位置、例えば、駆動信号の零に同期するA相のパルスの立ち上がり時点に相当する、回転軸上の周方向上の特定の位置を、絶対原点位置(Z0)と定義する。
また、MRセンサユニット20の出力の零に相当する位置、すなわち、マグネットのN極領域とS極領域の境界線上の特定の位置を、マグネット原点位置(T0)と定義する。
MRセンサユニット20からは、マグネット原点位置(T0)の情報も出力され、初期設定時などに利用される。
また、MRセンサユニット20の出力の零に相当する位置、すなわち、マグネットのN極領域とS極領域の境界線上の特定の位置を、マグネット原点位置(T0)と定義する。
MRセンサユニット20からは、マグネット原点位置(T0)の情報も出力され、初期設定時などに利用される。
一方、ブラシレスDCサーボモータ100の他端には、減速機14を構成するピニオン等が設けられており、回転軸13の回転が減速機14で減速され、直接もしくはクラッチを介して、被駆動部材15に伝達される。
なお、被駆動部材15としては、自動車のオイルポンプ、ウオーターポンプ、エアーポンプ、エンジン制御部材、パワーステアリングなどがある。
なお、被駆動部材15としては、自動車のオイルポンプ、ウオーターポンプ、エアーポンプ、エンジン制御部材、パワーステアリングなどがある。
ブラシレスDCサーボモータの制御ユニット300は、通信制御部310、メモリ制御部320、初期設定駆動信号(iu, iv, iw)生成部340、各相信号の立ち上り位相Snの抽出部341、各相の幅設定部342、各相の立ち上がりと絶対原点位置の同期設定部343、MRセンサユニットのマグネット固定位置(絶対原点位置Z0)設定部344、多回転・アブソリュート信号生成部345、通常運転モードモータ制御信号(iu, iv, iw)生成部346、通常運転モードDCサーボ制御部347、インバータ駆動信号生成部348等の機能を有している。なお、制御ユニット300は、公知のブラシレスDCサーボモータと同様の、電流制御部44に対する電流の指令値を生成する機能も備えているが、この点は本発明の特徴ではないので、以下、その構成の説明を省略する。
制御ユニット300は、スイッチ、例えばイグニッションスイッチ43を介してバッテリ42と接続されており、上位のコンピュータ、例えば車載のECU(Electric Control Unit)500等からの外部指令や、MRセンサ22の出力であるA相、B相信号のデジタル値等の入力情報に基づき、制御信号を生成し、ブラシレスDCサーボモータを駆動して被駆動部材15を動作させる。すなわち、ブラシレスDCサーボモータの制御ユニット300において、MRセンサユニット20の出力であるA相、B相信号に基づき、Z相信号、U、V、W相信号の多回転・アブソリュート信号が生成される。制御ユニット300の情報の一部は、ECU500へも送信される。
また、制御ユニット300は、通信ネットワークを介して、ブラシレスDCサーボモータを製造する工場内の端末装置700とも相互に通信可能に構成されている。この端末装置700は、通信ネットワークを介して、他の情報処理装置、例えば、工場の生産ラインにおけるコンピュータやサーバとも相互に通信可能に構成されている。ブラシレスDCサーボモータの初期設定は、原則として、この端末装置700により制御ユニット300の初期設定用プログラムを起動して実行される。工場の生産ライン以外の場面で、ブラシレスDCサーボモータの初期設定を行うことも可能である。
ブラシレスDCサーボモータの制御ユニット300は、例えば、必要な複数の機能を論理回路の形で一つのチップにまとめた専用のASIC(Application Specific Integrated Circuit)として、あるいは、汎用のシングルチップマイコンを用いたIC回路のチップとして実現される。あるいはまた、ホストコンピュータの機能の一部として実現される。以下では、汎用のシングルチップマイコンを用いた具体的な構成例について説明するが、同じ機能を有するブラシレスDCサーボモータの制御装置を、専用のASICで実現しても良いことは言うまでもない。
制御ユニット300を実現するためのシングルチップマイコンは、CPU、メモリ、発振回路、タイマー、I/Oインタフェース、シリアルI/F等を1つのLSIに集積したものであり、メモリに保持されたプログラムをCPU上で実行することで、ブラシレスDCサーボモータの制御ユニット300の上記各機能が実現される。なお、メモリ330には、ROM331、RAM332、及び少なくとも1つのEEPROM333等が含まれており、バス350を介してCPUと接続されている。ROMには、電源投入時やリセット時に実行するプログラムやプログラム実行中に変化しない定数が保存されている。ROMとしてフラッシュメモリを採用しても良い。RAMにはプログラムの変数や、外部からの指令値や、後述する多回転・アブソリュート信号のデータ等が保持されている。また、RAMには、被駆動部材15の目標の位置やこの位置に対応して設定されたブラシレスDCサーボモータの目標速度(インバータ正弦波駆動信号、PWM制御のduty比)も格納されている。EEPROMには、ブラシレスDCサーボモータの運転に伴い、多回転・アブソリュート信号が、逐次、保持される。
一般に、EEPROMは他のメモリに比して書き込み速度が遅いので、アブソリュート信号のデータ等は、一旦、RAMに保持される。このRAMに保持されたインクリメンタルなA相・B相信号のデータは、EEPROMへ書き込むアドレスと共に、EEPROMのアプリケーションプログラムやドライバーによりEEPROMへの書き込み(保存)がなされる。また、EEPROMからRAMへのこれらのデータ等の読み込みも、このアプリケーションプログラムやドライバーにより、アドレスを用いて処理される。
なお、ブラシレスDCサーボモータを駆動するための駆動信号として、正弦波駆動信号やPWM信号以外の信号を用いても良いことは言うまでもない。
なお、ブラシレスDCサーボモータを駆動するための駆動信号として、正弦波駆動信号やPWM信号以外の信号を用いても良いことは言うまでもない。
制御ユニット300は、メモリ330に記憶された指令値やMRセンサユニット20からの各種の信号に基づいて、被駆動部材15を駆動するブラシレスDCサーボモータの回動位置、ひいては、被駆動部材15の回動位置を演算し、被駆動部材15が所定の各位置で動作するように、ブラシレスDCサーボモータのU相、V相、W相の各コイルへ電流を供給するインバータ駆動信号の情報を生成する。これらの信号に基づくDCサーボモータ駆動用インバータ駆動信号の情報が、ブラシレスDCサーボモータの制御ユニット300から、インバータ駆動制御部41へシリアル通信ラインを介して出力される。
通常運転モードにおいて、制御ユニット300では、ロータリーエンコーダ(MRセンサユニット20)の情報に基づいて、ブラシレスDCサーボモータ100のサーボ制御を実行する。被駆動部材15は、制御ユニット300によるサーボ制御の対象である。また、被駆動部材15の回転数、回転位置、移動量等が被駆動部材に設けられた機器エンコーダで検知され、この機器エンコーダの情報(R)が制御ユニット300にフィードバックされ、サーボ制御の参考情報として利用される。
次に、第1の実施例に基づく、ブラシレスDCサーボモータの具体的な構成例について、説明する。図2Aは、第1の実施例に基づく、ブラシレスDCサーボモータの縦断面図であり、図2Bは、図2AのB-B断面図である。
ブラシレスDCサーボモータ100は、カップ状のモータハウジング10の内部に、3相のステータコイル11が固定されている。ステータコイル11は、周方向に等間隔に配置された9個の界磁鉄心112と、各界磁鉄心周りのスロット内に絶縁部材113を介して巻かれた界磁コイル111で構成されている。界磁鉄心112は、鋼板を軸方向に複数枚積層して構成されている。各界磁鉄心112に巻回された界磁コイル111は、インバータ40から印加される電圧の位相によって、U相、V相、W相の各相、すなわち、U相の界磁コイル(11U1~11U3)、V相の界磁コイル(11V1~11V3)、及び、W相の界磁コイル(11W1~11W3)に分類される。
ブラシレスDCサーボモータ100は、カップ状のモータハウジング10の内部に、3相のステータコイル11が固定されている。ステータコイル11は、周方向に等間隔に配置された9個の界磁鉄心112と、各界磁鉄心周りのスロット内に絶縁部材113を介して巻かれた界磁コイル111で構成されている。界磁鉄心112は、鋼板を軸方向に複数枚積層して構成されている。各界磁鉄心112に巻回された界磁コイル111は、インバータ40から印加される電圧の位相によって、U相、V相、W相の各相、すなわち、U相の界磁コイル(11U1~11U3)、V相の界磁コイル(11V1~11V3)、及び、W相の界磁コイル(11W1~11W3)に分類される。
一方、8極の永久磁石を有するロータ12が、回転軸13と一体に形成され、これらが、第1のエンドカバー18、及びモータハウジング10に設けられた1対の軸受16,17により、回転自在に保持されている。ロータ12は、回転軸13に固定されたロータヨーク121と、その外周部に固定された8個の永久磁石122を有する、8極のロータである。ロータヨーク121は、円板状の鋼板を軸方向に複数枚積層し、一体化したものである。ロータ12の外周面は、ステータコア11のティースに、空隙を介して対向している。
なお、ブラシレスDCサーボモータ100のスロット数やマグネットの極数、モータハウジング10やカバーなどの具体的構成は、実施例に限定されるものではない。例えば、カップ状のモータハウジング10の向きを左右逆にして、モータハウジングの右側の開口部に、軸受17保持部や支柱が形成されたサイドカバーを固定し、さらに、その上に、第2のエンドカバー19を固定するようにしても良い。
なお、ブラシレスDCサーボモータ100のスロット数やマグネットの極数、モータハウジング10やカバーなどの具体的構成は、実施例に限定されるものではない。例えば、カップ状のモータハウジング10の向きを左右逆にして、モータハウジングの右側の開口部に、軸受17保持部や支柱が形成されたサイドカバーを固定し、さらに、その上に、第2のエンドカバー19を固定するようにしても良い。
次に、図2A、図2Cに基づき、ブラシレスDCサーボモータとMRセンサユニットの関係を説明する。図2Cは、図2AのC-C断面図である。
MRセンサユニット20は、回転軸13の一端面に固定部材26を介して固定された平板状のマグネット21と、このマグネット21に対向する位置で離間してモータハウジング10に固定された、1対のMRセンサ(磁気抵抗素子センサ)22と、処理回路部23とを備えている。
回転軸13の一端面に固定された平板状のマグネット21に対向して配置された1対のMRセンサ22は、N極とS極の磁極の切替りによる磁界の抵抗の変化を検出するものである。
MRセンサユニット20は、回転軸13の一端面に固定部材26を介して固定された平板状のマグネット21と、このマグネット21に対向する位置で離間してモータハウジング10に固定された、1対のMRセンサ(磁気抵抗素子センサ)22と、処理回路部23とを備えている。
回転軸13の一端面に固定された平板状のマグネット21に対向して配置された1対のMRセンサ22は、N極とS極の磁極の切替りによる磁界の抵抗の変化を検出するものである。
本発明では、MRセンサ固有の横磁界を使用するため、マグネット21は多極着磁せず、N,S各1極着磁されたものである。マグネット21は、Siもしくはガラス基板と、その上に形成されたNi,Fe等の強磁性金属を主成分とする合金の薄膜で構成されている。
1対のMRセンサ22(22A、22B)としては、例えば、GMR、TMR、AMR等を用いることができる。1対のMRセンサ22は、出力されるパルスの位相が互いに所定の角度、例えば90度ずれるように、回転軸13の回転方向に所定の間隔を空けて配置されている。1対の磁気抵抗効果素子は直列に接続され、その両端に電圧Vccが印加され、両素子の接続点の電位を表す電圧信号がMRセンサ22の出力となる。
1対のMRセンサ22(22A、22B)としては、例えば、GMR、TMR、AMR等を用いることができる。1対のMRセンサ22は、出力されるパルスの位相が互いに所定の角度、例えば90度ずれるように、回転軸13の回転方向に所定の間隔を空けて配置されている。1対の磁気抵抗効果素子は直列に接続され、その両端に電圧Vccが印加され、両素子の接続点の電位を表す電圧信号がMRセンサ22の出力となる。
MRセンサ22と処理回路部23は、1枚のプリント基板24上に設けられている。このプリント基板24は、複数、例えば、3本の支柱25により、MRセンサ22がマグネット21に対向し、MRセンサ22及びマグネット21の各回転中心と回転軸13の軸芯とが一致するような関係で、モータハウジング10の側面に固定され、非磁性材の第2のエンドカバー19で覆われている。
なお、図面上では分かり易くするために、回転軸13のモータハウジング10の端からの突出長さや、固定部材26を、大きく表示している。実用上は、突出長さをできるだけ短く、例えば、3mm程度とするのが望ましい。固定部材26は非磁性材料、例えば樹脂製のカップ状の部材であり、例えばその一端にマグネット21が一体にモールドされている。固定部材26は、そのカップ状の中空部に回転軸13を挿入した状態で、回転軸13に対して円周方向に回動自在であり、固定ピン27や接着剤により、固定部材26が回転軸13に対して固定されている。
図2Cおいて、マグネット原点位置(T0)は、N,S各1極着磁された平板状のマグネット21の、N極領域とS極領域の境界線上の一方の端の位置である。この位置は、回転軸上の絶対原点位置(Z0)と一致すべきものである。
本発明では、ブラシレスDCサーボモータの製造工程の最終段階において、ブラシレスDCサーボモータの初期設定を行い、マグネット原点位置(T0)と絶対原点位置Z0とが一致するようして、マグネットを回転軸に固定する。そのために、モータのステータとロータとが組み立てられた段階で、駆動信号に対する回転軸上の絶対原点位置Z0を求める。具体的には、第2のエンドカバー19がモータハウジング10の右側面に固定されていない状態で、回転軸に対してマグネット21を仮固定し、ブラシレスDCサーボモータを駆動することにより、MRセンサの出力の位相と、U相の界磁コイルの逆起電力の積分値ピークの位相と、インバータ駆動信号の零に対応するU相コイルの立ち上がりの位相の情報とを取得する。これらの各位相の同期関係に基づいて、回転軸上の絶対原点位置Z0を求める。そして、次に、マグネット原点位置(T0)と絶対原点位置Z0の位相が一致するように、回転軸上のマグネット21の位置を決定し、回転軸にマグネット21を正式に固定する。
この初期設定の作業は、例えば、カメラ機能付きの作業ロボットのアーム等を用いて、あるいは、作業者自身によって処理される。この初期設定の作業のために、かつ、1対のMRセンサ22が所定の磁気感度を確保できるようにするために、モータハウジング10の右側面と1対のMRセンサ22との間の間隙は、所定の微小間隔、例えば20mm~30mmの間隙とするのが望ましい。初期設定の具体的な方法については、後で詳細に述べる。
図3は、第1の実施例における、ブラシレスDCサーボモータの駆動回路の構成例を示す図である。
ステータコイル11において、各相の界磁コイル11U~11Wは、U1,U2,U3のコイルが直列に、V1,V2,V3のコイルが直列に、W1,W2,W3のコイルが直列に、各々結線されている。これらの3つのコイル群は、各々の一端が中性点で接続されている。
ステータコイル11において、各相の界磁コイル11U~11Wは、U1,U2,U3のコイルが直列に、V1,V2,V3のコイルが直列に、W1,W2,W3のコイルが直列に、各々結線されている。これらの3つのコイル群は、各々の一端が中性点で接続されている。
インバータ40は、FETトランジスタから成る6つのスイッチング素子FET1~FET6と、1つの電解コンデンサ47、抵抗素子等で構成されている。各スイッチング素子FET1~FET6は、一端がブラシレスDCサーボモータ100の、U相、V相、W相のいずれかのコイル11U~11Wに接続され、他端が直流電源42に接続されている。各スイッチング素子FET1~FET6のゲート・ソース間に電圧、すなわち、インバータ駆動制御部41で生成されたインバータ駆動信号を加える。電解コンデンサ47は、電源電圧を平滑化するものである。
ブラシレスDCサーボモータの制御ユニット300は、通常運転モードにおいて、運転指令と、通常運転モードモータ制御信号(iu, iv, iw)を基に生成された制御信号と、MRセンサユニット20からのA相・B相信号に基づいて、ブラシレスDCサーボモータ100の運転、例えば正弦波駆動を継続する。これにより、被駆動部材15は、所定の動作範囲で、所定の運転パターンに基づく動作を行う。
ブラシレスDCサーボモータの制御ユニット300は、例えば、インバータ駆動制御部41やインバータ40と共に1枚のプリント基板600の上に実装し、モータハウジング10や第2のエンドカバー19の内側面でかつ、MRセンサユニット20に近接した位置に固定することもできる。この場合、インバータ40は、界磁コイル111への給電端子48の近傍の電源ラインに接続される。また、ブラシレスDCサーボモータが設置される環境によっては、ブラシレスDCサーボモータの外部にプリント基板600を設置しても良い。なお、図面上、MRセンサユニット20やプリント基板600等の電源ラインは省略されている。
図1に機能ブロックの形で示した、通信制御部310、メモリ制御部320、初期設定駆動信号(iu, iv, iw)生成部340、各相信号の立ち上り位相Snの抽出部341、各相の幅設定部342、各相信号の立ち上がりと絶対原点位置の同期設定部343、MRセンサユニットのマグネット固定位置(絶対原点位置)設定部344、多回転・アブソリュート信号生成部345、通常運転モードモータ制御信号(iu, iv, iw)生成部346、通常運転モードDCサーボ制御部347、及びインバータ駆動信号生成部348等のプログラムを実行することで実現される各機能は、一例として表示したものである。各機能の区分は任意であり、上記複数の機能を共通のプログラムで実現しても良く、或いは、特定の上記機能を異なる複数のプログラムやIC回路で実現しても良いことは言うまでもない。
また、制御ユニット300の、初期設定に関係したプログラムの一部やメモリのデータは、工場内の端末装置700やサーバと共有され、初期設定の処理の一部を工場内の端末装置700で分担するように構成しても良い。
また、制御ユニット300の、初期設定に関係したプログラムの一部やメモリのデータは、工場内の端末装置700やサーバと共有され、初期設定の処理の一部を工場内の端末装置700で分担するように構成しても良い。
次に、MRセンサユニット20の構成例及び機能について、図4A、図4Bを参照しながら説明する。
図4Aに、MRセンサユニット20の処理回路部23の一例を示す。処理回路部23は、AD変換器231、軸ずれ補正処理部232、RAMなどのメモリ233、逆正接演算処理部234、パルスカウンタ235、インクリメンタルA相・B相信号生成部236、マグネット原点位置信号(T0)生成部237、パラレル・シリアル変換部238、及び、シリアル通信部239の各機能を有している。処理回路部23は、例えば、メモリ付きのマイクロコンピュータ上でプログラムを実行することにより実現される。
図4Aに、MRセンサユニット20の処理回路部23の一例を示す。処理回路部23は、AD変換器231、軸ずれ補正処理部232、RAMなどのメモリ233、逆正接演算処理部234、パルスカウンタ235、インクリメンタルA相・B相信号生成部236、マグネット原点位置信号(T0)生成部237、パラレル・シリアル変換部238、及び、シリアル通信部239の各機能を有している。処理回路部23は、例えば、メモリ付きのマイクロコンピュータ上でプログラムを実行することにより実現される。
処理回路部23では、1対のMRセンサ22A、22Bのアナログ信号が、量子化され、電気角の内挿処理により多分割され、回転軸の1回転あたり、例えば、各々、36000パルスの、A相、B相のデジタル信号に変換される。このA相、B相のデジタル信号は、逆正接演算処理部234で逆正接演算され、パルスカウンタ235で加算される。この累積加算値が、インクリメンタルなA相・B相信号生成部236で、インクリメンタルなA相信号及びB相信号(以下、A相・B相信号)パルスのデータとして生成され、メモリ233に保持される。
図4Bに、MRセンサの出力信号の処理方法の概念を示す。
MRセンサ22は、作用する磁界の方向に対して電気抵抗値の変化する特性が異なるように設けられている。このため、マグネット21が角度Θだけ回転して各MRセンサに作用する磁界の向きが回転すると、それに対応してMRセンサの電気抵抗値、換言するとMRセンサ22の出力信号の電圧が変動する。回転軸13の1回転360°(機械角)毎に、SIN波、COS波の各々で、各々1周期分のパルス信号が出力される。
MRセンサ22は、作用する磁界の方向に対して電気抵抗値の変化する特性が異なるように設けられている。このため、マグネット21が角度Θだけ回転して各MRセンサに作用する磁界の向きが回転すると、それに対応してMRセンサの電気抵抗値、換言するとMRセンサ22の出力信号の電圧が変動する。回転軸13の1回転360°(機械角)毎に、SIN波、COS波の各々で、各々1周期分のパルス信号が出力される。
なお、1対のMRセンサ22A、22Bから得られるA相、B相信号は、各センサ等の制作誤差、設置誤差、温度の影響等により、誤差(主に軸ずれ誤差)を含んでいる可能性がある。すなわち、逆正接演算の結果得られたA相・B相信号は、本来、回転軸13の回転角度Θに比例して直線上に位置すべきものである。しかし、軸ずれ等の誤差により、360度毎に、あるいは、1対のMRセンサの位相差90度毎に、繰り返されるひずみを含んでいる場合がある。
軸ずれ補正処理部232では、回転軸13の少なくとも1回転分のデータに基づき、1対のMRセンサの回転中心を抽出し、回転角度Θに対するA相、B相信号のひずみの有無を検知し、ひずみがある場合にはそれらの補正処理を行う。
マグネット原点位置信号生成部237では、逆正接演算処理部234による逆正接演算の結果として、回転軸13の1回転毎に現われる角度0の位置に同期して、マグネット原点位置(T0)の信号を生成し、出力する。このマグネット原点位置(T0)の信号は、マグネット21を回転軸の絶対原点位置Z0に固定するための情報として利用される。
軸ずれ補正処理部232では、回転軸13の少なくとも1回転分のデータに基づき、1対のMRセンサの回転中心を抽出し、回転角度Θに対するA相、B相信号のひずみの有無を検知し、ひずみがある場合にはそれらの補正処理を行う。
マグネット原点位置信号生成部237では、逆正接演算処理部234による逆正接演算の結果として、回転軸13の1回転毎に現われる角度0の位置に同期して、マグネット原点位置(T0)の信号を生成し、出力する。このマグネット原点位置(T0)の信号は、マグネット21を回転軸の絶対原点位置Z0に固定するための情報として利用される。
さらに、パラレル・シリアル変換部238において、パラレル伝送処理により生成されたA相・B相信号、及び、マグネット原点位置(T0)信号が、シリアル伝送通信の規格に適合したシリアル伝送用の送信データ(BUS)に変換され、このBUS信号がシリアル通信部239から1本の通信ケーブル28を介してブラシレスDCサーボモータの制御ユニット300へ送信される。
なお、MRセンサユニットのパルスカウンタ235としてアップダウンカウンタを採用し、パルスの累積加減算値に、回転軸13の正逆の回転方向の情報も付加したA相、B相信号を生成し、ブラシレスDCサーボモータの制御ユニット300へ送信するようにしても良い。本発明では、このようなアップダウンカウンタによる回転方向の情報付きのカウント情報も、累積加算値として扱うものとする。また、マグネット原点位置(T0)信号は、回転軸13の1回転毎に1回生成される信号であり、回転軸13の回転数を検知する信号と兼用することもできる。
次に、第1の実施例における、初期設定処理の概要を、図5のタイムチャートを参照しながら、説明する。
初期設定は、外部端末装置700から、コントロールユニット300の初期設定に関係したプログラムを起動し、必要なパラメータを設定することにより、開始される(501)。
なお、この段階では、ブラシレスDCサーボモータ100の回転軸13に、マグネット21が任意の位置(マグネット原点位置(T0))で仮固定されており(503)、一対のMRセンサ22や処理回路23が、モータハウジング10の側面に固定され(504)、かつ、第2のエンドカバー19はまだモータハウジング10の右側面に固定されていない。
初期設定は、外部端末装置700から、コントロールユニット300の初期設定に関係したプログラムを起動し、必要なパラメータを設定することにより、開始される(501)。
なお、この段階では、ブラシレスDCサーボモータ100の回転軸13に、マグネット21が任意の位置(マグネット原点位置(T0))で仮固定されており(503)、一対のMRセンサ22や処理回路23が、モータハウジング10の側面に固定され(504)、かつ、第2のエンドカバー19はまだモータハウジング10の右側面に固定されていない。
コントロールユニット300では、初期設定に関係したプログラムの起動に伴い、初期設定用の任意(所定)の駆動信号を生成し、DCサーボモータの3相のステータコイルに駆動電力を供給する(505)。これに伴いロータ及びMRセンサ20のマグネット21が回転し(506)、MRセンサ(検出素子22、処理回路23)で、A,Bの出力信号、及び、マグネット原点位置(T0)の情報が生成される(507)。コントロールユニット300では、所定の駆動信号、例えば矩形波信号に基づく、暫定的なA,Bの信号のデータのテーブルを生成する(508)。
表1に、MRセンサユニット20で生成され、コントロールユニット300のRAMに記録される(T0)基準の暫定的なテーブルの一例を示す。
表1に、MRセンサユニット20で生成され、コントロールユニット300のRAMに記録される(T0)基準の暫定的なテーブルの一例を示す。
そして、ステータコイルへの上記駆動電力の供給に伴う各相の逆起電力の検出を行い(509)、逆起電力の積分値ピークPzを検出する(510)。
一方、初期設定駆動信号(iu, iv, iw)に合わせて、表1として記録されたMRセンサのA,Bの出力信号から、ロータ12の極数に合わせて、モータを正逆双方向に正負の回転数、例えば各々1回転させるのに必要な、電気角で120°の間隔で立ち上がるU相、V相、W相の各信号の位相情報を生成する。本実施例の場合、機械角45°毎(4500パルス毎)に、ロータ12が1回転するように、表2に示したような、U相、V相、W相の各信号の位相情報のテーブルを生成する。
表2中に、U-up、V-upと記載したのは、U相、V相の信号の立ち上がり位相を示している。U相、V相の信号の立ち上がりは、いずれも、MRセンサユニット20からのA相信号の立ち上がり位相に同期している。同様にして、W相の信号の立ち上がり位相や、U相、V相、W相の各信号の立ち下がり位相を示すW-up、U-dw、V-dw、W- dwの位相情報も、テーブルに記録される。
次に、マグネット原点位置(T0)と、A,Bの出力信号と、U相、V相、W相の各相信号の立ち上がり位相Snとを同期させ、表2を、各相の暫定アブソリュートデータ(T0基準)として生成する(511)。
表2は、コントロールユニット300のEEPROMに記録される、ここではU相の、暫定アブソリュートデータの一例を示すものである。
なお、この段階では、このマグネット原点位置(T0)が、MRセンサの絶対原点位置とどのような対応関係にあるかは明確ではない。
表2は、コントロールユニット300のEEPROMに記録される、ここではU相の、暫定アブソリュートデータの一例を示すものである。
なお、この段階では、このマグネット原点位置(T0)が、MRセンサの絶対原点位置とどのような対応関係にあるかは明確ではない。
さらに、前に求めた積分値ピークPzの位相に基づき、U相、V相、W相の各信号の立ち上がり位相Snを抽出する(512)。
さらに、U相、V相、W相の各コイルに関する信号に対して、T0基準のZ相の幅を確定する。そして、各相の幅信号を付加した暫定アブソリュートデータのテーブルを生成する(513)。
下記の表3は、コントロールユニット300のEEPROMに記録される、ここではU相の、暫定アブソリュートデータの一例を示す。
下記の表3は、コントロールユニット300のEEPROMに記録される、ここではU相の、暫定アブソリュートデータの一例を示す。
このようにして、初期設定駆動信号に対応するA相、B相信号及びU相の逆起電力の積分値の情報を基にした、「回転軸上の絶対原点位置(Z0)」のデータが得られる。
例えば、U相信号に関して、下記の表4のようなアブソリュートデータを生成する。
ここまでの一連の処理が完了したら、次に、コントロールユニット300から外部端末装置700へ、回転軸に対するマグネットの位置決めの要求を送る(515)。
これを受けて、コントロールユニット300は、作業ロボットもしくは作業者に、「ロータを固定し、マグネットの仮固定を外し、マグネットを回転軸に対して回転させる」指令を送る(516)。マグネット21の回転に伴いMRセンサ20からマグネット原点位置(T0)の情報が得られる(517)。マグネット21のマグネット原点位置(T0)の情報がコントロールユニット300を経由して(518)、外部端末装置700に送信される。作業ロボットや作業者などは、マグネット原点位置(T0)の情報を基に、マグネットを回転軸に対して絶対原点位置Z0に固定すべき位置(T0=Z0)を決定する(519)。これに伴い、マグネットの回転軸に対する位置が絶対位置Z0に設定され(520)、作業ロボットがマグネット21を回転軸に固定する(521)。コントロールユニット300は、さらに、作業ロボットに、「ロータの固定を解除」する指令を送る(522)。
その後、MRセンサユニットから得られた全ての信号の位置データが絶対原点位置Z0基準に変更され、Z相信号、「Z相の幅」と関係づけられ、EEPROMのアドレスが付与される。このようにして、回転軸13の絶対原点位置を表す、多回転・アブソリュート信号に変換される。すなわち、各相信号の暫定アブソリュートデータ((T0)基準)を、Z0基準に補正したアブソリュートデータのテーブルとして生成し(523)、EEPROMに記録する。
同様にして、各相の多回転アブソリュートデータを生成し(図11B参照)、EEPROM333に記録する(524)。これを受けて、初期設定は終了する(525)。
次に、初期設定の処理について、より詳細に説明する。
図6Aは、本発明の第1の実施例における制御ユニットの、初期設定プログラムの起動時の処理を示すフローチャートである。まず、電源立ち上げ直後に、ブラシレスDCサーボモータの制御ユニット300は、初期設定済か否かをチェックする(S601)。否の場合、初期設定処理モードに移行する(S602)。
図6Aは、本発明の第1の実施例における制御ユニットの、初期設定プログラムの起動時の処理を示すフローチャートである。まず、電源立ち上げ直後に、ブラシレスDCサーボモータの制御ユニット300は、初期設定済か否かをチェックする(S601)。否の場合、初期設定処理モードに移行する(S602)。
初期設定プログラムの起動時の、制御ユニット300の初期設定処理(S602)の詳細を、図6Bに示す。
初期設定処理では、まず、MRセンサのマグネットを、回転軸に対し、暫定位置(Zα )で仮固定する(図6BのS610)。次に、EEPROMデータの初期化を行い(S611)、初期設定駆動信号(iu, iv, iw)生成部340で、初期設定のための初期設定駆動信号、例えばインバータ駆動用のPWM信号(±N回転)を生成する。初期設定駆動信号(iu, iv, iw)は、ブラシレスDCサーボモータを、零回転を挟んで正、逆方向に各々1~数回転だけ駆動する信号で足りる。この初期設定駆動信号を、インバータ駆動信号生成部348へ出力し(S612)、生成されたインバータ駆動信号(PWM信号)で、ブラシレスDCサーボモータ100を駆動する。
初期設定処理では、まず、MRセンサのマグネットを、回転軸に対し、暫定位置(Zα )で仮固定する(図6BのS610)。次に、EEPROMデータの初期化を行い(S611)、初期設定駆動信号(iu, iv, iw)生成部340で、初期設定のための初期設定駆動信号、例えばインバータ駆動用のPWM信号(±N回転)を生成する。初期設定駆動信号(iu, iv, iw)は、ブラシレスDCサーボモータを、零回転を挟んで正、逆方向に各々1~数回転だけ駆動する信号で足りる。この初期設定駆動信号を、インバータ駆動信号生成部348へ出力し(S612)、生成されたインバータ駆動信号(PWM信号)で、ブラシレスDCサーボモータ100を駆動する。
なお、この初期設定時の最初の駆動信号は、ブラシレスDCサーボモータのDCサーボ制御信号に代わるものである。対象のブラシレスDCサーボモータは本来閉ループ制御されるものであるが、初期設定処理では、ブラシレスDCサーボモータをオープン制御の状態で、初期設定駆動信号により、U相、V相、W相の各コイルへ電力を供給してブラシレスDCサーボモータを駆動する(S613)。
得られたA相、B相信号は、初期設定処理の指令値と比較され、その累積加算値が正常か否か、すなわち、累積加算値がインバータ駆動信号の指令値に対応し、ブラシレスDCサーボモータやMRセンサの応答状態が正常であるのか、否かが判定される(S614)。対応関係に異常有りと判定された場合には、指令値とA相、B相の信号の累積加算値とが対応するように、別途、MRセンサの温度特性の補正等の出力補正の処理が行われる(S615)。
なお、出力補正の処理を複数回実施しても正常状態にならない場合は、EEPROM自体に異常がある等の別の原因も考えられるので、その旨のエラー表示を行う。
なお、出力補正の処理を複数回実施しても正常状態にならない場合は、EEPROM自体に異常がある等の別の原因も考えられるので、その旨のエラー表示を行う。
S614でMRセンサが正常と判定された場合、もしくは補正処理がなされた場合、初期設定処理は、次に、MRセンサユニット20から取得したA相、B相信号のアブソリュート化を行う(S616)。すなわち、EEPROMへの記録のために、A相、B相信号の各データに書き込み用のアドレスの付与(番地付け)を行う。このようにして、表1に示したような、暫定的なアブソリュート信号のデータを、RAMを経由してEEPROMに記録する。
次に、回転軸に対するマグネットの絶対位置を求め、絶対位置情報に基づくアブソリュート信号のデータを生成できるようにするための、一連の処理に移行する。
まず、最初の駆動信号に基づく、ステータコイルへの駆動電力の供給に伴う各相の逆起電力の検出を行い、逆起電力の積分値ピークPzを検出する(S617)。
逆起電力検出部46は、各相のコイルの時系列の逆起電力Vbu、Vbv、Vbwを検出し、制御ユニット300へ伝送する。制御ユニット300では、各相信号の立ち上り位相Snの抽出部341において、各相の逆起電力の積分演算を行い、積分値が所定の閾値を超えたピーク位置Pzを検出する。
まず、最初の駆動信号に基づく、ステータコイルへの駆動電力の供給に伴う各相の逆起電力の検出を行い、逆起電力の積分値ピークPzを検出する(S617)。
逆起電力検出部46は、各相のコイルの時系列の逆起電力Vbu、Vbv、Vbwを検出し、制御ユニット300へ伝送する。制御ユニット300では、各相信号の立ち上り位相Snの抽出部341において、各相の逆起電力の積分演算を行い、積分値が所定の閾値を超えたピーク位置Pzを検出する。
この逆起電力の検出について、図7A、図7B、及び、図8Aを参照しながら説明する。
図7Aは、8極の永久磁石を有するロータを備えたDCサーボモータにおける、ステータの各界磁コイルの磁極と電流の関係、及び、各界磁コイルの逆起電力の関係を示す図である。ここでは、0°~120°(電気角)の範囲のみの関係を示している。
ステータの各界磁コイル11U,11V,11Wへ供給される電流の位相を回転させることにより、ロータ12が回転する。この各界磁コイルへ供給される電流の大きさとその方向に応じて、各界磁コイルに逆起電力Vbu、Vbv、Vbwが発生する。
図7Aは、8極の永久磁石を有するロータを備えたDCサーボモータにおける、ステータの各界磁コイルの磁極と電流の関係、及び、各界磁コイルの逆起電力の関係を示す図である。ここでは、0°~120°(電気角)の範囲のみの関係を示している。
ステータの各界磁コイル11U,11V,11Wへ供給される電流の位相を回転させることにより、ロータ12が回転する。この各界磁コイルへ供給される電流の大きさとその方向に応じて、各界磁コイルに逆起電力Vbu、Vbv、Vbwが発生する。
次に、MRセンサユニットからのA相、B相の出力信号と、いずれか1相のステータコイルへの駆動信号との同期の関係から、回転軸に対するMRセンサの位置関係(マグネット原点位置(T0))の情報を取得する。
そのために、まず、ブラシレスDCサーボモータ100を正転、逆転の双方向に駆動する、例えば、正逆各1回転するための、U,V,W相の駆動信号を生成する(S618)。すなわち、各相の立ち上がりと絶対原点位置の同期設定部343において、初期設定駆動信号(iu, iv, iw)に合わせて、ロータ12の永久磁石の極数、本実施例では8極、に合わせた、マグネット原点位置(T0)基準の、U相、V相、W相の各信号の位相情報(表2、及び、図8A参照)を生成する機能を有している。
図8Aは、MRセンサユニットから出力されるA相、B相の信号と、これらの信号に基づいて生成される、Z相、U相、V相、W相の各信号の関係を示している。
なお、このS618におけるU相、V相、W相の各信号の位相情報は、ロータリーエンコーダとして機能するMRセンサユニット20からの、A相、B相の出力信号の位相と完全に同期している点で、S612における初期設定駆動信号のU相、V相、W相の各信号とは異なるものである。
図8Aは、MRセンサユニットから出力されるA相、B相の信号と、これらの信号に基づいて生成される、Z相、U相、V相、W相の各信号の関係を示している。
なお、このS618におけるU相、V相、W相の各信号の位相情報は、ロータリーエンコーダとして機能するMRセンサユニット20からの、A相、B相の出力信号の位相と完全に同期している点で、S612における初期設定駆動信号のU相、V相、W相の各信号とは異なるものである。
各相信号の立ち上り位相Snの抽出部341では、表2や図8Aに示したU相、V相、W相の各駆動信号の位相データにおける、各駆動信号の立ち上がり位置(Sn)を抽出する(S619)。
図7Bは、各界磁コイル11U~11Wの逆起電力Vbu、Vbv、Vbw、その積分値ピーク、及び、位置決め情報(Sn)の関係を示す図である。
積分値ピークは、各積分値のピークが所定の閾値を超えた時点に対応しており、これを位置決め情報(Sn)として生成する。
ここで、特定の位相、例えば、U相の逆起電力の積分値ピークに着目すると、回転角度(電気角)が120°の範囲内で、40°及び100°の位置で、積分値ピークが得られている。すなわち、U相の界磁コイル(11U1~11U3)に関して、1回転(360°)当たり、6回の積分値ピークが得られる。同様に、V相の界磁コイル(11V1~11V3)、及び、W相の界磁コイル(11W1~11W3)に関しても、各々、1回転当たり、6回の積分値ピークが得られる。
この積分値ピークの位置は、ステータの各界磁コイルの構成に応じて変わることは言うまでもない。
なお、V相、W相に関しても、各々、位置決め情報(Sn)を、決定し、EEPROMに記録しても良い。また、位置決め情報(Sn)は、回転軸13の1回転毎に複数個、生成しても良い。あるいは、分解能の異なる異種の信号、例えば、1回転毎に1~2回程度の粗な信号と、1回転毎に数十回程度の密な信号とを組み合わせても良い。
積分値ピークは、各積分値のピークが所定の閾値を超えた時点に対応しており、これを位置決め情報(Sn)として生成する。
ここで、特定の位相、例えば、U相の逆起電力の積分値ピークに着目すると、回転角度(電気角)が120°の範囲内で、40°及び100°の位置で、積分値ピークが得られている。すなわち、U相の界磁コイル(11U1~11U3)に関して、1回転(360°)当たり、6回の積分値ピークが得られる。同様に、V相の界磁コイル(11V1~11V3)、及び、W相の界磁コイル(11W1~11W3)に関しても、各々、1回転当たり、6回の積分値ピークが得られる。
この積分値ピークの位置は、ステータの各界磁コイルの構成に応じて変わることは言うまでもない。
なお、V相、W相に関しても、各々、位置決め情報(Sn)を、決定し、EEPROMに記録しても良い。また、位置決め情報(Sn)は、回転軸13の1回転毎に複数個、生成しても良い。あるいは、分解能の異なる異種の信号、例えば、1回転毎に1~2回程度の粗な信号と、1回転毎に数十回程度の密な信号とを組み合わせても良い。
図8Aの例では、最初のU相信号の立ち上がりと、最初のA相信号の立ち上がりが、マグネット原点位置(T0)に同期している。さらに、マグネット原点位置(T0)を基準として、回転軸13の1回転360°(機械角)毎に、Z相信号(Z1,Z2,―,―,Zn)が設定されている。
図8Aのマグネット原点位置(T0)に対応する最初のA相信号の立ち上がり位置、換言するとU相信号の立ち上がり位置から、U相コイルへの励磁電流が増加する。そのため、図7Bの例では、回転軸13の1回転に1つ、例えば、U相コイルへの励磁電流が増加方向にある、回転角度Θ=100°(電気角)の積分値ピークの位置が、MRセンサのマグネットの絶対原点位置を求めるための1つの「位置決め情報(Sn)」とし、EEPROMに記録される。
図8Aのマグネット原点位置(T0)に対応する最初のA相信号の立ち上がり位置、換言するとU相信号の立ち上がり位置から、U相コイルへの励磁電流が増加する。そのため、図7Bの例では、回転軸13の1回転に1つ、例えば、U相コイルへの励磁電流が増加方向にある、回転角度Θ=100°(電気角)の積分値ピークの位置が、MRセンサのマグネットの絶対原点位置を求めるための1つの「位置決め情報(Sn)」とし、EEPROMに記録される。
図6Bに戻り、次に、各相の幅設定部342は、各相コイルの信号の幅を設定する(S620)。
図8Bは、インバータ駆動信号として正回転指令時の、マグネット原点位置(T0)を基準とした、MRセンサの出力信号(A相、B相)を示す図である。位相のずれ方向は、回転軸13の回転方向に応じて反転する。
ここでは、各Z相信号(Z1,Z2,―,―,Zn)の最初のA相信号の立ち上がりに同期し、A相信号の1パルス分の幅を有する「Z相の幅(1)」の信号が確定される。さらに、A相信号の立ち上がりに同期し、A相信号の数パルス分の幅を有する「Z相の幅(2)」の信号が確定される。「Z相の幅(1)」、「Z相の幅(2)」の信号は、各々、360°(機械角)間隔で繰り返す信号である。
図8Bは、インバータ駆動信号として正回転指令時の、マグネット原点位置(T0)を基準とした、MRセンサの出力信号(A相、B相)を示す図である。位相のずれ方向は、回転軸13の回転方向に応じて反転する。
ここでは、各Z相信号(Z1,Z2,―,―,Zn)の最初のA相信号の立ち上がりに同期し、A相信号の1パルス分の幅を有する「Z相の幅(1)」の信号が確定される。さらに、A相信号の立ち上がりに同期し、A相信号の数パルス分の幅を有する「Z相の幅(2)」の信号が確定される。「Z相の幅(1)」、「Z相の幅(2)」の信号は、各々、360°(機械角)間隔で繰り返す信号である。
同様にして、図8Cに示すように、各Z相信号(Z1,Z2,―,―,Zn)の最初のA相信号の立ち下がりに同期し、A相信号の1パルス分の幅を有する「Z相の幅(3)」の信号を確定する。さらに、A相信号の立ち下がりに同期し、A相信号の数パルス分の幅を有する「Zの幅(4)」の信号を確定する。「Z相の幅(3)」、「Z相の幅(4)」も、各々、360度間隔で繰り返す信号である。なお、「Z相の幅」の周期や、「Z相の幅」の数は任意に設定でき、予め、メモリに記録されている。また、B相信号を基準に生成しても良い。
Z相信号が得られた、U相、V相、W相の各信号の、各A相・B相信号の累積加算値は、次に、回転軸13の1回転毎(360度毎)の累積加算値に変換され、これとZ相信号の組み合わせに、EEPROMのアドレスを付与して、表3に示したような、暫定多回転アブソリュート信号のデータとなる。
次に、各相の立ち上がりと絶対原点位置の同期設定部343において、MRセンサの出力、前記積分値ピーク及び前記回転軸の回転角の情報の関係に基づいて、駆動信号に対する回転軸の絶対原点位置(Z0)を求める(図6のS621)。
図9は、駆動信号に対する回転軸の絶対原点位置(Z0)を求める処理を説明するタイムチャートである。
図9は、駆動信号に対する回転軸の絶対原点位置(Z0)を求める処理を説明するタイムチャートである。
インバータ駆動信号を出力してブラシレスDCサーボモータ100を正・逆双方向に駆動すると、MRセンサユニット20から、指令値(U,V,W相の駆動信号)に対応するA相、B相信号が得られる。また、前記した通り、逆起電力検出部46からのデータに基づき、各相信号の立ち上り位相Snの抽出部341において、対応する複数のピーク位置、すなわち、複数の位置決め情報(Sn)が得られる。
回転軸上の絶対原点位置(Z0)に対応する位置決め情報(Sn)は、回転軸13の1回転に1つ出力されるべきである。さらに、この位置決め情報(Sn)は、U,V,Wのいずれか1相のコイルへの励磁電流が増加方向にある区間内の、A相信号の0度に対応する立ち上がり時点に相当する位置と定義する。この場合、ブラシレスDCサーボモータが正回転の状態で、回転軸がこの絶対原点位置(Z0)を通過する必要がある。
そこで、各相の立ち上がりと絶対原点位置の同期設定部343において、図9の下段に示すように、ブラシレスDCサーボモータを起動し、初期設定駆動信号(インバータ駆動信号)により、間に零回転を含む範囲で、ブラシレスDCサーボモータを正回転もしくは逆回転させる。
ブラシレスDCサーボモータを、例えば、-1回転から+1回転まで正回転させた場合、-1回転から零回転を通過し+1回転まで回転する間に、図9の中段、上段に示すように、U相コイルの逆起電力の積分値(ピーク値)が閾値に達する。このようにして、各信号の立ち上がり時点に対応する位置決め情報(S1)~(S6)が出力される。
そこで、各相の立ち上がりと絶対原点位置の同期設定部343において、図9の下段に示すように、ブラシレスDCサーボモータを起動し、初期設定駆動信号(インバータ駆動信号)により、間に零回転を含む範囲で、ブラシレスDCサーボモータを正回転もしくは逆回転させる。
ブラシレスDCサーボモータを、例えば、-1回転から+1回転まで正回転させた場合、-1回転から零回転を通過し+1回転まで回転する間に、図9の中段、上段に示すように、U相コイルの逆起電力の積分値(ピーク値)が閾値に達する。このようにして、各信号の立ち上がり時点に対応する位置決め情報(S1)~(S6)が出力される。
次に、これらU相の逆起電力の積分値(ピーク値)が閾値に達する位置決め情報(S1)~(S6)の位相の中で、上記定義に基づき、図9の下段に示したように、インバータ駆動信号のU相コイルのPWM信号のONデューティが零に同期する、位置決め情報(S4)の位相が、回転軸上の絶対原点位置(Z0)に同期していると判定する。
なお、U相コイルに代えて、V相若しくはW相のコイルへの励磁電流を基に、回転軸上の絶対原点位置(Z0)に同期する位置決め情報を出力するようにしても良い。また、回転軸上の絶対原点位置(Z0)の決定のために、初期設定駆動信号の指令値(PWM信号)の送信タイミングと、A相、B相信号、U相、V相、W相の信号、及び、位置決め情報の受信タイミング等の時間情報を利用しても良い。
このように、初期設定駆動信号に対応する高分解能のA相、B相信号及びU相の逆起電力の積分値の情報を基にした、高精度の「回転軸上の絶対原点位置(Z0)」のデータ、及び、U相、V相、W相の各信号の位相情報のデータ、すなわち、絶対原点位置(Z0)を基準とした、回転数、U,V,W相の各コイルの位相情報を含んだ、アブソリュートの値のテーブル(表4)が生成される。
なお、U相コイルに代えて、V相若しくはW相のコイルへの励磁電流を基に、回転軸上の絶対原点位置(Z0)に同期する位置決め情報を出力するようにしても良い。また、回転軸上の絶対原点位置(Z0)の決定のために、初期設定駆動信号の指令値(PWM信号)の送信タイミングと、A相、B相信号、U相、V相、W相の信号、及び、位置決め情報の受信タイミング等の時間情報を利用しても良い。
このように、初期設定駆動信号に対応する高分解能のA相、B相信号及びU相の逆起電力の積分値の情報を基にした、高精度の「回転軸上の絶対原点位置(Z0)」のデータ、及び、U相、V相、W相の各信号の位相情報のデータ、すなわち、絶対原点位置(Z0)を基準とした、回転数、U,V,W相の各コイルの位相情報を含んだ、アブソリュートの値のテーブル(表4)が生成される。
ここまでの一連の処理が完了したら、コントロールユニット300から外部端末装置700へ、マグネットの位置決めの要求を送り、これを受けて、コントロールユニット300は、MRセンサユニットのマグネット固定位置設定部344によるマグネットの位置決めの処理(S622)に移行する。
このマグネットの位置決めの処理について、図10A~図10Dを参照しながら説明する。
このマグネットの位置決めの処理について、図10A~図10Dを参照しながら説明する。
図10Aに示したように、初期設定時、マグネット21は回転軸13に対して任意の角度位置(マグネット原点位置(T0))で仮固定されている。
次に、回転軸13を固定した状態で、回転軸13上でマグネット21を相対的に回転させた場合、図10Bに示したように、回転角度に対して、MRセンサ20の出力が、サイン波形で示されるように変化し、マグネット原点位置(T0)信号が出力される。
そこで、図10Cに示したように、マグネット21を回転軸13に対して回転させ、MRセンサの出力(マグネット原点位置(T0)信号)が、先に求めた絶対原点位置(Z0)と一致する位置を求め、この位置でマグネット21を回転軸13に固定する。このようにして、マグネット21は回転軸13上の絶対原点位置(Z0)に固定される。すなわち、マグネット21は、このマグネットの原点位置(T0)が、回転軸13の絶対原点位置(Z0)と同期する位置に固定される。
なお、本実施例の方法によるマグネット21の位置決めは、MRセンサの分解能(36000パルス程度)に対して、厳密には若干の誤差を含む可能性が想定される。本発明のマグネット21の「絶対原点位置」はそのような微小の誤差を含んだものと定義する。マグネット21と回転軸との間で、この絶対原点位置(Z0)が一度設定されると、それは繰り返し誤差の発生しない不変の位置情報として出力される。そのため、サーボ制御を行うブラシレスモータの制御のための「絶対原点位置」の情報として、実用上、なんら支障はない。
そこで、図10Cに示したように、マグネット21を回転軸13に対して回転させ、MRセンサの出力(マグネット原点位置(T0)信号)が、先に求めた絶対原点位置(Z0)と一致する位置を求め、この位置でマグネット21を回転軸13に固定する。このようにして、マグネット21は回転軸13上の絶対原点位置(Z0)に固定される。すなわち、マグネット21は、このマグネットの原点位置(T0)が、回転軸13の絶対原点位置(Z0)と同期する位置に固定される。
なお、本実施例の方法によるマグネット21の位置決めは、MRセンサの分解能(36000パルス程度)に対して、厳密には若干の誤差を含む可能性が想定される。本発明のマグネット21の「絶対原点位置」はそのような微小の誤差を含んだものと定義する。マグネット21と回転軸との間で、この絶対原点位置(Z0)が一度設定されると、それは繰り返し誤差の発生しない不変の位置情報として出力される。そのため、サーボ制御を行うブラシレスモータの制御のための「絶対原点位置」の情報として、実用上、なんら支障はない。
図10Dは、回転軸13に対するマグネット21の位置固定法の一例を示すものであり、固定ピン27や接着剤28等で、固定部材26を回転軸13に固定する。
これらの情報から、駆動信号と回転軸上のマグネットの角度の関係が求まり、マグネットを回転軸に対して相対的に回転させる。すなわち、各相の立ち上がり位置Snを絶対原点位置Z0で補正して、暫定多回転アブソリュート信号のデータを、絶対原点位置を基準とする多回転・アブソリュート信号のデータに変換する(S623)。これにより、駆動信号とMRセンサの出力とを完全に同期させることが可能になる。
これらの情報から、駆動信号と回転軸上のマグネットの角度の関係が求まり、マグネットを回転軸に対して相対的に回転させる。すなわち、各相の立ち上がり位置Snを絶対原点位置Z0で補正して、暫定多回転アブソリュート信号のデータを、絶対原点位置を基準とする多回転・アブソリュート信号のデータに変換する(S623)。これにより、駆動信号とMRセンサの出力とを完全に同期させることが可能になる。
次に、MRセンサユニットから得られた全てのA相、B相信号は、各相信号の絶対位置Z0やZ相信号、「Z相の幅」と関係づけられ、EEPROMのアドレスが付与され、回転軸13の絶対原点位置を表す、多回転・アブソリュート信号に変換される(S624)。
そして、コントロールユニット300では、初期設定処理の結果として、各相信号の暫定アブソリュートデータ(T0基準)を、Z0基準のデータに補正して、多回転のアブソリュートデータを生成する(S624)。
図11Aは、マグネット原点位置(T0)に基づくA相、B相信号、及び、Z相に関する位相のデータを、Z0基準の多回転のアブソリュートデータに変換する一例を示す図である。
コントロールユニット300では、次に、Z0基準の多回転のアブソリュートデータを、EEPROM333に記録する(S625)。
図11Aは、マグネット原点位置(T0)に基づくA相、B相信号、及び、Z相に関する位相のデータを、Z0基準の多回転のアブソリュートデータに変換する一例を示す図である。
コントロールユニット300では、次に、Z0基準の多回転のアブソリュートデータを、EEPROM333に記録する(S625)。
図11Bは、U相、V相、W相の各コイルに関して、EEPROMに記録される、A相、B相信号、Z相の位相に関するデータの一例を示す図である。
例えば、図11Bの各データは、Z0基準の、A相、B相信号、Z相及び、U相、V相、W相の各相コイルの回転数、回転角度若しくは位相のアブソリュート情報等を与えるテーブルとして、各コイルの電流制御に利用することができる。また、各「Z相の幅(1)」~「Z相の幅(4)」(図示略)は、インバータ駆動信号等、ブラシレスDCサーボモータの各種の制御信号等を生成するのに利用される。
例えば、図11Bの各データは、Z0基準の、A相、B相信号、Z相及び、U相、V相、W相の各相コイルの回転数、回転角度若しくは位相のアブソリュート情報等を与えるテーブルとして、各コイルの電流制御に利用することができる。また、各「Z相の幅(1)」~「Z相の幅(4)」(図示略)は、インバータ駆動信号等、ブラシレスDCサーボモータの各種の制御信号等を生成するのに利用される。
図6Aに戻り、初期設定処理済の場合、次に、異常終了判定モードに移行する。このモードでは、EEPROMからRAMを経由して多回転のアブソリュート信号のデータを読み込み(S603)、読み込んだアブソリュート信号のデータを基に、前回のブラシレスDCサーボモータの運転の終了が、正常になされたか、異常状態で終了したのかを判定する(S604)。正常終了であれば、EEPROMのアブソリュート信号のデータは、ブラシレスDCサーボモータの起動時の回転軸の絶対値0の位置、すなわち、絶対原点位置Z0に対応しているはずである。アブソリュート信号のデータが絶対値0から離れていれば、異常終了であったと判定される。異常終了の場合、上位のECUにエラー情報を送信し(S605)、ECU側から、被駆動部材15の運転再開に向けた復帰処理がなされる。
異常がなければ、ブラシレスDCサーボモータの制御ユニット300は、正規の運転処理モードに移行する(S606)。
異常がなければ、ブラシレスDCサーボモータの制御ユニット300は、正規の運転処理モードに移行する(S606)。
なお、各相のコイルの逆起電力VBUの積分値の情報は、初期設定処理のみで使用され、正規の運転処理モードでは、本来不要なものである。そのため、初期設定処理が完了したら、MRセンサユニットから受信した位置決め情報(Sn)のデータのメモリへの記録は停止しても良い。逆に、逆起電力VBUの積分値の情報を、MRセンサに関するフェールセーフ機能として利用しても良い。
また、自動車用のブラシレスDCサーボモータは、被駆動部材の駆動源として、精度の高い制御を行うために、絶対原点位置Z0をより正確に決定することが求められることもある。このような要求に応えるために、密、あるいは粗と密の位置決め情報の組み合わせに基づき、原点位置を決定することもできる。
図12は、粗と密な位置決め情報の組み合わせに基づく、初期設定処理時の、駆動信号に対する回転軸の絶対原点位置(Z0)の決定の処理を説明するタイムチャートである。図12の例では、逆起電力VBUの積分値ピークに基づく位置決め情報として、回転軸の180度回転毎に1回の粗な位置決め情報と、回転軸の6度回転毎に1回の密な位置決め情報とが出力される。まず、粗な位置決め情報(-,S20,-,S45,-,)の中でインバータ駆動用のU相コイルのPWM信号のオンデューティが零に同期する、この例では、位置決め情報(S40)の位置を、A相のパルスの立ち上がり時点に同期する、絶対原点位置(Z0)に仮決めする。次に、仮決め位置(S40)付近に関して、密な位置決め情報(-,S388,-,-,S418,-,)を採用し、その付近でPWM信号のオンデューティが零に同期する、この例では、逆起電力VBUの積分値ピークに基づく位置決め情報(S406)の位置を、駆動信号に対する回転軸の絶対原点位置(Z0)に正式決定する。このようにして、かなり高い精度の絶対原点位置(Z0)を決定できる。そのため、これに続く図6のS621~S622のマグネット位置決めの処理の時間を短縮し、精度を高めることができる。
図12は、粗と密な位置決め情報の組み合わせに基づく、初期設定処理時の、駆動信号に対する回転軸の絶対原点位置(Z0)の決定の処理を説明するタイムチャートである。図12の例では、逆起電力VBUの積分値ピークに基づく位置決め情報として、回転軸の180度回転毎に1回の粗な位置決め情報と、回転軸の6度回転毎に1回の密な位置決め情報とが出力される。まず、粗な位置決め情報(-,S20,-,S45,-,)の中でインバータ駆動用のU相コイルのPWM信号のオンデューティが零に同期する、この例では、位置決め情報(S40)の位置を、A相のパルスの立ち上がり時点に同期する、絶対原点位置(Z0)に仮決めする。次に、仮決め位置(S40)付近に関して、密な位置決め情報(-,S388,-,-,S418,-,)を採用し、その付近でPWM信号のオンデューティが零に同期する、この例では、逆起電力VBUの積分値ピークに基づく位置決め情報(S406)の位置を、駆動信号に対する回転軸の絶対原点位置(Z0)に正式決定する。このようにして、かなり高い精度の絶対原点位置(Z0)を決定できる。そのため、これに続く図6のS621~S622のマグネット位置決めの処理の時間を短縮し、精度を高めることができる。
図13は、第1の実施例における、通常運転モード時の、制御ユニットの信号処理の詳細を示すフローチャートである。
ブラシレスDCサーボモータの制御ユニット300は、正規の運転処理モードにおいては、多回転・アブソリュート信号生成部345、通常運転モードモータ制御信号(iu, iv, iw)生成部346、通常運転モードDCサーボ制御部347、インバータ駆動信号生成部348等が動作し、外部指令、EEPROM333の情報やMRセンサユニット20からの情報に基づき、ブラシレスDCサーボモータを、ロータリーエンコーダとして機能させる。
すなわち、通常運転モードモータ制御信号(iu, iv, iw)生成部346でU相、V相、W相の駆動信号を生成し(S801)、EEPROM333等から駆動信号に対応するU相、V相、W相のパルス数を取得し(S802)、さらに、Z相の幅の信号やZ相信号(Z1,Z2,―,―,Zn)の位相のデータを取得する(S803、S804)。さらに、U相の立ち上がりを絶対原点位置(Z0)に同期させる(S805)。そして、MRセンサユニットからのA相・B相信号を、RAMを経由して取得し(S806)、そのインクリメンタルな累積加算値を基に、EEPROMのアドレスを付与して、1回転毎のA相・B相信号、Z相信号、U、V、W相信号のアブソリュート化を行い、RAMに記録する(S807)。さらに、Z相信号とA相・B相信号とから、ブラシレスDCサーボモータの回転速度と回転角の情報を含む多回転のアブソリュート信号を生成し(S808)、RAMを介してEEPROMに記録する(S809)。
すなわち、ブラシレスDCサーボモータの回転軸の正回転、逆回転に応じて、モータの回転軸の1回転毎に、A、B、Z、U、V、Wの各信号がインクリメント、デクリメントされ、これらの情報は、ブラシレスDCサーボモータの回転軸の現在位置を表す情報として、逐次、RAMを経由してEEPROMに記録される。
ブラシレスDCサーボモータの制御ユニット300は、正規の運転処理モードにおいては、多回転・アブソリュート信号生成部345、通常運転モードモータ制御信号(iu, iv, iw)生成部346、通常運転モードDCサーボ制御部347、インバータ駆動信号生成部348等が動作し、外部指令、EEPROM333の情報やMRセンサユニット20からの情報に基づき、ブラシレスDCサーボモータを、ロータリーエンコーダとして機能させる。
すなわち、通常運転モードモータ制御信号(iu, iv, iw)生成部346でU相、V相、W相の駆動信号を生成し(S801)、EEPROM333等から駆動信号に対応するU相、V相、W相のパルス数を取得し(S802)、さらに、Z相の幅の信号やZ相信号(Z1,Z2,―,―,Zn)の位相のデータを取得する(S803、S804)。さらに、U相の立ち上がりを絶対原点位置(Z0)に同期させる(S805)。そして、MRセンサユニットからのA相・B相信号を、RAMを経由して取得し(S806)、そのインクリメンタルな累積加算値を基に、EEPROMのアドレスを付与して、1回転毎のA相・B相信号、Z相信号、U、V、W相信号のアブソリュート化を行い、RAMに記録する(S807)。さらに、Z相信号とA相・B相信号とから、ブラシレスDCサーボモータの回転速度と回転角の情報を含む多回転のアブソリュート信号を生成し(S808)、RAMを介してEEPROMに記録する(S809)。
すなわち、ブラシレスDCサーボモータの回転軸の正回転、逆回転に応じて、モータの回転軸の1回転毎に、A、B、Z、U、V、Wの各信号がインクリメント、デクリメントされ、これらの情報は、ブラシレスDCサーボモータの回転軸の現在位置を表す情報として、逐次、RAMを経由してEEPROMに記録される。
次に、通常運転モードにおける、DCサーボ制御部347及びインバータ駆動信号生成部348の動作につい、図1及び図14を参照しながら、説明する。
通常の運転モードにおいて、ブラシレスDCサーボモータ100が回転すると、ブラシレスDCサーボモータの制御ユニット300は、MRセンサユニット20からのA相・B相信号に基づいてブラシレスDCサーボモータの回転速度・回転方向及び絶対原点位置を認識し、認識した回転速度と回転方向、及び絶対原点位置と、指令値とを比較して、U相、V相、W相の各コイルに対するインバータ駆動用の正弦波駆動信号を生成する。すなわち、ロータの回転角度に応じて連続的にステータのコイルの電圧を正弦波状に変化させてロータを回転させる。U相、V相、W相の各コイルには、120°(電気角)位相をずらした正弦波電圧の電力が入力される。さらに、モータの駆動回路としてのインバータに対して、PWM信号のデューティ比を制御して電圧を連続的に変化させる。
通常の運転モードにおいて、ブラシレスDCサーボモータ100が回転すると、ブラシレスDCサーボモータの制御ユニット300は、MRセンサユニット20からのA相・B相信号に基づいてブラシレスDCサーボモータの回転速度・回転方向及び絶対原点位置を認識し、認識した回転速度と回転方向、及び絶対原点位置と、指令値とを比較して、U相、V相、W相の各コイルに対するインバータ駆動用の正弦波駆動信号を生成する。すなわち、ロータの回転角度に応じて連続的にステータのコイルの電圧を正弦波状に変化させてロータを回転させる。U相、V相、W相の各コイルには、120°(電気角)位相をずらした正弦波電圧の電力が入力される。さらに、モータの駆動回路としてのインバータに対して、PWM信号のデューティ比を制御して電圧を連続的に変化させる。
通常運転モードにおけるDCサーボ制御部347は、EEPROMに図11Bのようなテーブルなどの形で記録されている、回転速度と回転角の信号、及び、多回転・アブソリュート信号に基づいて、ブラシレスDCサーボモータ100の回転軸13の現在の回転角度、ひいては被駆動部材15の現在の絶対位置を認識する。DCサーボ制御部347は、これらの情報に基づいて、被駆動部材15の現在位置から目標位置までの速度指令値等を演算する。インバータ駆動信号生成部348は、DCサーボ制御部347の出力を受けて、ブラシレスDCサーボモータ100の回転を制御するためのインバータ駆動信号を生成し、インバータ駆動制御部41へ出力する。
図14は、通常運転モードにおける、DCサーボ制御部347及びインバータ駆動信号生成部348の動作の詳細を示すフローチャートである。
通常運転モードにおいて、DCサーボ制御部347は、まず、RAM等のメモリ330から、予め設定されたブラシレスDCサーボモータの運転パターンに基づく、各目標の位置や目標速度を指令値として取得する(S901)。メモリには、被駆動部材の各目標位置に対応して設定されたブラシレスDCサーボモータの運転パターンに対応する目標速度として、正弦波駆動やPID制御を前提としたモータ駆動信号、例えばPWM制御信号のデータが格納されている。各目標の位置を含む運転パターンの例として、ブラシレスDCサーボモータは、被駆動部材の反転位置から加速終了までは加速領域、加速終了からブレーキ開始までは定速領域、ブレーキ開始から反転位置までは減速領域となっている。ブラシレスDCサーボモータは、このような所定の運転パターンに従ってPWM制御される。
通常運転モードにおいて、DCサーボ制御部347は、まず、RAM等のメモリ330から、予め設定されたブラシレスDCサーボモータの運転パターンに基づく、各目標の位置や目標速度を指令値として取得する(S901)。メモリには、被駆動部材の各目標位置に対応して設定されたブラシレスDCサーボモータの運転パターンに対応する目標速度として、正弦波駆動やPID制御を前提としたモータ駆動信号、例えばPWM制御信号のデータが格納されている。各目標の位置を含む運転パターンの例として、ブラシレスDCサーボモータは、被駆動部材の反転位置から加速終了までは加速領域、加速終了からブレーキ開始までは定速領域、ブレーキ開始から反転位置までは減速領域となっている。ブラシレスDCサーボモータは、このような所定の運転パターンに従ってPWM制御される。
例えば、インバータ駆動信号生成部348は、多回転のアブソリュート信号を取得し(S902)、指令値との差分値を算出する(S903)。この算出結果に基づいて、インバータ駆動信号生成部348は、「ずれ」の有無を判定し(S904)、差分が許容値を超えていれば「ずれ」有と判定し、それが2回目である場合(S905、S906)、ずれを含むエラーがロータリーエンコーダ(MRセンサユニット20)にあると判定し、ECU500に、異常情報を送信し(S907)、処理を終了する。なお、ロータリーエンコーダではなく、EEPROM自体に異常がある場合にも、この時点でチェックできる。
ずれの判定(S904)で「ずれ」がなかった場合は、PID制御に基づくインバータ駆動信号を生成し(S908)、インバータ駆動制御部41へ出力する(S909)。そして、MRセンサユニット20からのA相・B相信号に基づく多回転・アブソリュート信号を取得し(S910)、インバータ駆動信号と多回転・アブソリュート信号との差分ずれ量を算出する(S911)。次に、ずれの有無の判定(S912)を行い、もし、2回連続して差分ずれ量が許容値を超えた場合には(S913、S914)、ブラシレスDCサーボモータの異常と判定し、ECU500にブラシレスDCサーボモータの異常情報を送信し(S915)、処理を終了する。
差分ずれ量の判定(S912)で「ずれ」がなかった場合、新たなインバータ駆動信号を生成し(S908)、以下、同様の処理を繰り返し、終了の判定(S916)で運転を終了する。
ずれの判定(S904)で「ずれ」がなかった場合は、PID制御に基づくインバータ駆動信号を生成し(S908)、インバータ駆動制御部41へ出力する(S909)。そして、MRセンサユニット20からのA相・B相信号に基づく多回転・アブソリュート信号を取得し(S910)、インバータ駆動信号と多回転・アブソリュート信号との差分ずれ量を算出する(S911)。次に、ずれの有無の判定(S912)を行い、もし、2回連続して差分ずれ量が許容値を超えた場合には(S913、S914)、ブラシレスDCサーボモータの異常と判定し、ECU500にブラシレスDCサーボモータの異常情報を送信し(S915)、処理を終了する。
差分ずれ量の判定(S912)で「ずれ」がなかった場合、新たなインバータ駆動信号を生成し(S908)、以下、同様の処理を繰り返し、終了の判定(S916)で運転を終了する。
このように、本実施例のブラシレスDCサーボモータは、ロータリーエンコーダとして機能する1個のMRセンサ20の出力を利用して制御される、サーボモータである。
図15は、第1の実施例に基づく、EEPROMのデータを用いた、サーボモータとしての制御例を示すものである。ブラシレスDCサーボモータは、EEPROMの多回転・アブソリュート信号の情報、及びPID制御とPWM制御とを組み合わせた回転指令により、現在位置Pnから目標位置Pn+1まで、正確、かつ、迅速に駆動される。
このようにして、ブラシレスDCサーボモータの制御ユニット300は、MRセンサユニット20からのA相・B相信号、及び、機器エンコーダの情報に基づいて、逐次、被駆動部材の動作状態を認識しながら、ブラシレスDCサーボモータの駆動を継続する。これにより、被駆動部材は所定の角度範囲で、所定の運転パターンに基づく動作を行う。
このようにして、ブラシレスDCサーボモータの制御ユニット300は、MRセンサユニット20からのA相・B相信号、及び、機器エンコーダの情報に基づいて、逐次、被駆動部材の動作状態を認識しながら、ブラシレスDCサーボモータの駆動を継続する。これにより、被駆動部材は所定の角度範囲で、所定の運転パターンに基づく動作を行う。
本発明の一実施例によれば、1個のMRセンサユニットをロータリーエンコーダとし、そのA相、B相信号に基づき、Z相及び、U相、V相、W相の各相コイルの位相情報を生成し、ステータコイルの各相とロータの磁極位置を原点位置に同期させて完全閉ループでサーボ制御することにより、被駆動部材の位置をきわめて精度良く制御できる、ブラシレスDCサーボモータの制御装置を提供できる。
次に、本発明の第2の施例について説明する。
第2の施例では、実施例1と同様にして、回転軸の絶対原点位置を求め、回転軸にマグネットを正式に固定した後に、U相、V相、W相の各コイルに関する信号に対して、Z相の幅を確定する。
すなわち、実施例1で、マグネットを回転軸の絶対原点位置に固定する前に、U相、V相、W相の各コイルに関する信号に対して、Z相の幅を確定していたのに代えて、マグネットを回転軸の絶対原点位置に固定した後に、U相、V相、W相の各コイルに関する信号に対して、Z相の幅を確定し、アブソリュートデータのテーブルを生成し、EEPROMに記録する。得られる効果は、本発明の第1の実施例と同じである。
第2の施例では、実施例1と同様にして、回転軸の絶対原点位置を求め、回転軸にマグネットを正式に固定した後に、U相、V相、W相の各コイルに関する信号に対して、Z相の幅を確定する。
すなわち、実施例1で、マグネットを回転軸の絶対原点位置に固定する前に、U相、V相、W相の各コイルに関する信号に対して、Z相の幅を確定していたのに代えて、マグネットを回転軸の絶対原点位置に固定した後に、U相、V相、W相の各コイルに関する信号に対して、Z相の幅を確定し、アブソリュートデータのテーブルを生成し、EEPROMに記録する。得られる効果は、本発明の第1の実施例と同じである。
次に、本発明の第3の実施例について説明する。第3の実施例では、ブラシレスDCサーボモータで駆動される、自動車の被駆動装置を含んでいる。
本実施例において、制御ユニットの各機能は、図1の制御ユニット300とは異なり、車載のエンジン制御用のECUの中に組みこまれている。DCサーボモータ駆動制御部41や電流制御部44の機能も、車載のECU中に組みこまれている。第3の実施例の制御ユニット等の各機能、及び、ブラシレスDCサーボモータ及びその駆動回路の構成は、図1の制御ユニット300や、図3の駆動回路の構成や機能と同じなので、説明を省略する。
本実施例によれば、1個のMRセンサユニットをロータリーエンコーダとして生成されたアブソリュート信号の情報に基づいて、自動車の被駆動装置が駆動されるので、被駆動装置をきわめて精度良く制御できる。また、コンピュータに簡単なプログラムを組み込むことで容易に実現でき、安価で汎用性の高い直流モータの制御装置を提供できる。さらに、多回転・アブソリュート信号がEEPROMに記録されているので、次回の起動時に、自動車の被駆動装置の異常停止の有無を判定し、異常停止の場合でも安全な運転を開始することができる。
次に、本発明の第4の実施例について説明する。図16は、本発明の第4の実施例に基づく、ブラシレスDCサーボモータの制御装置の機能ブロック図である。
本実施例において、制御ユニット300の各機能は、図1の制御ユニット300とは異なり、車載のECU1000の中に組みこまれている。インバータ駆動制御部41やインバータ40の機能も、車載のECU1000の中に組みこまれている。ECU1000は、制御ユニット300に対する上位のプロセッサ1010と上位のメモリ1014を含むコントロールユニット1012を備えている。制御ユニット300、インバータ40、インバータ駆動制御部41、電流制御部44、電流検出/制限部45、及び、逆起電力検出部46の各機能は、図1の対応するものの機能と同じであるので、説明を省略する。
被駆動部材としては、ブラシレスDCサーボモータで駆動される車載の複数の機器を対象とすることができる。例えば、被駆動部材として、ウオーターポンプ、オイルポンプ等がある。これらの被駆動部材は、ブラシレスDCサーボモータ100により、多回転・アブソリュート信号に基づく正確な多回転の位置制御がなされるとともに、異常停止後の再起動時にも、迅速に正常状態に復帰できる。
本実施例において、制御ユニット300の各機能は、図1の制御ユニット300とは異なり、車載のECU1000の中に組みこまれている。インバータ駆動制御部41やインバータ40の機能も、車載のECU1000の中に組みこまれている。ECU1000は、制御ユニット300に対する上位のプロセッサ1010と上位のメモリ1014を含むコントロールユニット1012を備えている。制御ユニット300、インバータ40、インバータ駆動制御部41、電流制御部44、電流検出/制限部45、及び、逆起電力検出部46の各機能は、図1の対応するものの機能と同じであるので、説明を省略する。
被駆動部材としては、ブラシレスDCサーボモータで駆動される車載の複数の機器を対象とすることができる。例えば、被駆動部材として、ウオーターポンプ、オイルポンプ等がある。これらの被駆動部材は、ブラシレスDCサーボモータ100により、多回転・アブソリュート信号に基づく正確な多回転の位置制御がなされるとともに、異常停止後の再起動時にも、迅速に正常状態に復帰できる。
また、第4の実施例におけるECU1000には、自動車やエンジンの制御に関係する各種の情報が入力される(図示略)。
各被駆動部材を駆動するブラシレスDCサーボモータには、ぞれ、MRセンサユニット20が設けられ、各MRセンサユニット20で生成されたA相・B相信号が、ISO26262の規格に対応するシリアル信号として、通信ケーブル28を介してECU1000に送信される。各被駆動部材を駆動するために必要な情報には、他の被駆動部材と共通の情報も含まれていることが多いので、ECU1000により一括して管理するのが望ましい。
各被駆動部材を駆動するブラシレスDCサーボモータには、ぞれ、MRセンサユニット20が設けられ、各MRセンサユニット20で生成されたA相・B相信号が、ISO26262の規格に対応するシリアル信号として、通信ケーブル28を介してECU1000に送信される。各被駆動部材を駆動するために必要な情報には、他の被駆動部材と共通の情報も含まれていることが多いので、ECU1000により一括して管理するのが望ましい。
本実施例によれば、1個のMRセンサユニットの出力に基づいて生成された、アブソリュート信号の情報に基づいて、各被駆動部材がブラシレスDCサーボモータにより駆動される。そのため、各被駆動部材の位置を、きわめて精度良く制御することができる。また、アブソリュート信号が、EEPROMに記録されているので、次回の起動時に、自動車の各被駆動部材の異常停止の有無を判定し、異常停止の場合でも安全な運転開始を実現できる。
次に、本発明の第4の実施例について説明する。本実施例は、上記各実施例において、自動車の起動時に、EEPROMからデータを取得することにより、バッテリから電力が供給されなくなった後に前記モータが故意に動かされたか否かを前記データのアドレスの比較に基づいて判定する機能と、前記故意に動かされたと判定した場合には、前記データのアドレスに基づいて、前記モータを前記バッテリから電力が供給されなくなった時点の状態に復帰させる機能を有している。
これにより、バッテリ電源の消失後の故意にモータが駆動された場合でも、次回の起動時に安全な運転開始を実現できる。
次に、本発明の第5の実施例について説明する。本発明のブラシレスDCサーボモータの制御装置は、自動車に搭載されるブラシレスDCサーボモータのみならず、他の分野の、絶対原点の位置の情報に基づく多回転・アブソリュート信号を必要とする被駆動部材を駆動するブラシレスDCサーボモータにも適用可能である。例えば、ロボットのハンドのアクチュエータ等に本発明のブラシレスDCサーボモータを採用することにより、アクチュエータの位置を、アブソリュート信号によりきわめて精度良く制御できる。
10 モータハウジング
11 ステータコイル
12 ロータ
13 回転軸
14 減速機
15 被駆動部材
16 軸受
17 軸受
18 第1のエンドカバー
19 第2のエンドカバー
20 MRセンサユニット
21 マグネット
22 MRセンサ
23 処理回路部
24 プリント基板
25 支柱
26 固定部材
27 固定ピン
28 通信ケーブル
40 インバータ
41 インバータ駆動制御部
42 バッテリ
43 イグニッションスイッチ
44 電流制御部
45 電流検出/制限部
46 逆起電力検出部
47 電解コンデンサ
48 給電端子
100 ブラシレスDCサーボモータ
111 界磁コイル
112 界磁鉄心
113 絶縁部材
121 ロータヨーク
122 永久磁石
231 AD変換器
232 軸ずれ補正処理部
233 メモリ
234 逆正接演算処理部
235 パルスカウンタ
236 インクリメンタルA相・B相信号生成部
237 マグネット原点位置信号生成部
238 パラレル・シリアル変換部
239 シリアル通信部
300 ブラシレスDCサーボモータの制御ユニット
310 通信制御部
320 メモリ制御部
330 メモリ
331 ROM
332 RAM
333 EEPROM
340 初期設定駆動信号(iu,iv,iw)生成部
341 各相信号の立ち上り位相Snの抽出部
342 各相の幅設定部
343 各相の立ち上がりと絶対原点位置の同期設定部
344 MRセンサユニットのマグネット固定位置(絶対原点位置)設定部
345 多回転・アブソリュート信号生成部
346 通常運転モードモータ制御信号(iu,iv,iw)生成部
347 通常運転モードDCサーボ制御部
348 インバータ駆動信号生成部
500 車載のECU
600 プリント基板
1000 ECU
11 ステータコイル
12 ロータ
13 回転軸
14 減速機
15 被駆動部材
16 軸受
17 軸受
18 第1のエンドカバー
19 第2のエンドカバー
20 MRセンサユニット
21 マグネット
22 MRセンサ
23 処理回路部
24 プリント基板
25 支柱
26 固定部材
27 固定ピン
28 通信ケーブル
40 インバータ
41 インバータ駆動制御部
42 バッテリ
43 イグニッションスイッチ
44 電流制御部
45 電流検出/制限部
46 逆起電力検出部
47 電解コンデンサ
48 給電端子
100 ブラシレスDCサーボモータ
111 界磁コイル
112 界磁鉄心
113 絶縁部材
121 ロータヨーク
122 永久磁石
231 AD変換器
232 軸ずれ補正処理部
233 メモリ
234 逆正接演算処理部
235 パルスカウンタ
236 インクリメンタルA相・B相信号生成部
237 マグネット原点位置信号生成部
238 パラレル・シリアル変換部
239 シリアル通信部
300 ブラシレスDCサーボモータの制御ユニット
310 通信制御部
320 メモリ制御部
330 メモリ
331 ROM
332 RAM
333 EEPROM
340 初期設定駆動信号(iu,iv,iw)生成部
341 各相信号の立ち上り位相Snの抽出部
342 各相の幅設定部
343 各相の立ち上がりと絶対原点位置の同期設定部
344 MRセンサユニットのマグネット固定位置(絶対原点位置)設定部
345 多回転・アブソリュート信号生成部
346 通常運転モードモータ制御信号(iu,iv,iw)生成部
347 通常運転モードDCサーボ制御部
348 インバータ駆動信号生成部
500 車載のECU
600 プリント基板
1000 ECU
Claims (10)
- 駆動信号を生成して出力し、ブラシレスDCサーボモータのU相、V相、W相の3相の各ステータコイルに供給される電力を制御する制御ユニットと、
多極の永久磁石を有するロータの回転を検知する1個のMRセンサユニットとを有する、ブラシレスDCサーボモータの制御装置において、
前記MRセンサユニットは、
前記ロータの回転軸の一端に固定され、径方向に着磁された1組のN極領域とS極領域を有する平板状のマグネットと、該マグネットに対向する位置で前記ハウジング側に固定された1対のMRセンサと、処理回路部とを備えており、
前記処理回路部は、前記マグネットのN極領域とS極領域の境界線上の位置を、マグネット原点位置とし、前記1対のMRセンサの出力に基づいて、前記回転軸の回転に伴うA相、B相の信号を生成して出力するとともに、前記マグネットの原点位置の情報を生成するように構成されており、
前記制御ユニットは、
前記ロータの極数に合わせて、前記MRセンサユニットの前記A相若しくは前記B相の出力信号の立ち上がり位相に同期する、前記U相、V相、W相の各位相情報を生成する機能と、
前記3相のいずれか1相のステータコイルへの駆動信号が零から立ち上がる位相と、該モータの駆動により得られる前記1相のステータコイルへの逆起電力の積分値ピークの位相と、前記駆動信号の零に対応する前記MRセンサユニットからの前記A相若しくは前記B相の出力信号の立ち上がり位相との同期関係に基づき、前記駆動信号に対する前記回転軸の絶対原点位置を取得する機能と、
前記駆動信号の零に対応する前記A相又は前記B相の出力信号の立ち上がりに同期する、360度間隔の複数のZ相信号を設定する機能とを備えており、
前記マグネットは前記原点位置が、前記回転軸の前記絶対原点位置と同期する位置に固定されており、
前記MRセンサユニットを前記U相、V相、及びW相のロータリーエンコーダとして、前記モータを駆動するように構成されていることを特徴とするブラシレスDCサーボモータの制御装置。 - 請求項1において、
前記制御ユニットは、
前記各Z相信号の最初のA相信号の立ち上がり若しくは前記A相信号の立ち下がりに同期し、前記A相信号の1~数パルス分の幅を有する複数の、Z相の幅の信号を生成する機能と、
前記マグネット原点位置を基準とする、前記A相、B相、前記Z相信号、前記Z相の幅の信号、及び、前記U相、V相、W相の各位相の情報にEEPROMのアドレスを付与し、暫定多回転アブソリュート信号のデータとして生成する機能と、
前記暫定多回転ブソリュート信号のデータを、前記回転軸の前記絶対原点位置を基準とする多回転・アブソリュート信号のデータに変換し、前記EEPROMに記録する機能とを備え、
前記EEPROMのデータを利用して、前記モータを駆動するように構成されていることを特徴とするブラシレスDCサーボモータの制御装置。 - 請求項2において、
前記制御ユニットは、
前記回転軸の回転に伴う前記A相、B相の出力信号の1回転毎の累積加算値のデータと、前記マグネット原点位置の情報の組み合わせに、前記EEPROMのアドレスを付与して、前記多回転・アブソリュート信号のデータとするように構成されていることを特徴とするブラシレスDCサーボモータの制御装置。 - 請求項1において、
前記制御ユニットは、ASICとして構成され、前記ブラシレスDCサーボモータに固定されていることを特徴とするブラシレスDCサーボモータの制御装置。 - 請求項2において、
前記ブラシレスDCサーボモータは自動車の被駆動部材を駆動するサーボモータであり、
前記EEPROMの電源としてのバッテリと、
前記バッテリから電力が供給されなくなった場合に、前記MRセンサユニット、前記制御ユニット、及び、前記EEPROMの電源として機能するバックアップ電源とを備えており、
前記制御ユニットは、
前記自動車のECUもしくは前記被駆動部材に固定され、
前記自動車の起動時に、前記EEPROMから前記A相、B相、前記Z相信号、Z相の幅の信号、及び、前記U相、V相、W相の各位相のデータを取得し、前記バッテリから電力が供給されなくなった後に前記ブラシレスDCサーボモータが故意に動かされたか否かを判定する機能と、
前記故意に動かされたと判定した場合には、前記A相、B相、前記Z相信号、Z相の幅の信号、及び、前記U相、V相、W相の各位相のデータに基づき、前記モータを前記バッテリから電力が供給されなくなった時点の状態に復帰させる機能を有していることを特徴とするブラシレスDCサーボモータの制御装置。 - U相、V相、W相の3相のステータコイルを有し、ハウジングに保持されたステータと、
多極の永久磁石を有し、回転軸に固定されたロータと、
駆動信号を生成して出力し、前記各ステータコイルに供給される電力を制御する制御ユニットと、
前記U相、V相、W相の3相の各ステータコイルに供給される電力を制御する制御ユニットと、
前記ロータの回転を検知する1個のMRセンサユニットとを有する、ブラシレスDCサーボモータにおいて、
前記MRセンサユニットは、
前記ロータの回転軸の一端に固定され、径方向に着磁された1組のN極領域とS極領域を有する平板状のマグネットと、
該マグネットに対向する位置で前記ハウジング側に固定された1対のMRセンサと、処理回路部とを備えており、
前記処理回路部は、前記マグネットのN極領域とS極領域の境界線上の位置を、マグネット原点位置とし、前記1対のMRセンサの出力に基づいて、前記回転軸の回転に伴うA相、B相の信号を生成して出力するとともに、前記マグネットの原点位置の情報を生成するように構成されており、
前記制御ユニットは、
前記ロータの極数に合わせて、前記MRセンサユニットの前記A相若しくは前記B相の出力信号の立ち上がり位相に同期する、前記U相、V相、W相の各位相情報を生成する機能と、
前記3相のいずれか1相のステータコイルへの駆動信号が零から立ち上がる位相と、該モータの駆動により得られる前記1相のステータコイルへの逆起電力の積分値ピークの位相と、前記駆動信号の零に対応する前記MRセンサユニットからの前記A相若しくは前記B相の出力信号の立ち上がり位相との同期関係に基づき、前記駆動信号に対する前記回転軸の絶対原点位置を取得する機能と、
前記駆動信号の零に対応する前記A相又は前記B相の出力信号の立ち上がりに同期する、360度間隔の複数のZ相信号を設定する機能とを備えており、
前記マグネットは前記原点位置が、前記回転軸の前記絶対原点位置と同期する位置に固定されており、
前記MRセンサユニットを前記U相、V相、及びW相のロータリーエンコーダとして、前記モータを駆動するように構成されていることを特徴とするブラシレスDCサーボモータ。 - 請求項6において、
前記制御ユニットは、ASICとして構成され、前記ブラシレスDCサーボモータのハウジング内に固定されており、
前記制御ユニットは、
前記各Z相信号の最初のA相信号の立ち上がり若しくは前記A相信号の立ち下がりに同期し、前記A相信号の1~数パルス分の幅を有する複数の、Z相の幅の信号を生成する機能と、
前記マグネット原点位置を基準とする、前記A相、B相、前記Z相信号、Z相の幅の信号、及び、前記U相、V相、W相の各位相の情報にEEPROMのアドレスを付与し、暫定多回転アブソリュート信号のデータとして生成する機能と、
前記暫定多回転ブソリュート信号のデータを、前記回転軸の前記絶対原点位置を基準とする多回転・アブソリュート信号のデータに変換し、前記EEPROMに記録する機能とを備え、
前記EEPROMのデータを利用して、前記モータを駆動するように構成されていることを特徴とするブラシレスDCサーボモータ。 - 駆動信号を生成して出力する、ブラシレスDCサーボモータの制御ユニットであって、
前記ブラシレスDCサーボモータの3相のステータコイルに電力が供給されるように構成されており、前記モータの回転軸の回転に伴う信号を1対のMRセンサを備えた1個のMRセンサユニットから受信するものにおいて、
前記制御ユニットは、
前記ロータの極数に合わせて、前記MRセンサユニットの前記A相若しくは前記B相の出力信号の立ち上がり位相に同期する、前記U相、V相、W相の各位相情報を生成する機能と、
前記3相のいずれか1相のステータコイルへの駆動信号が零から立ち上がる位相と、該モータの駆動により得られる前記1相のステータコイルへの逆起電力の積分値ピークの位相と、前記駆動信号の零に対応する前記MRセンサユニットからの前記A相若しくは前記B相の出力信号の立ち上がり位相との同期関係に基づき、前記駆動信号に対する前記回転軸の絶対原点位置を取得する機能と、
前記駆動信号の零に対応する前記A相又は前記B相の出力信号の立ち上がりに同期する、360度間隔の複数のZ相信号を設定する機能とを備えており、
前記マグネットは前記原点位置が、前記回転軸の前記絶対原点位置と同期する位置に固定されており、
前記MRセンサユニットを前記U相、V相、及びW相のロータリーエンコーダとして、前記モータを駆動するように構成されていることを特徴とするブラシレスDCサーボモータの制御ユニット。 - 請求項8において、
前記制御ユニットは、
前記各Z相信号の最初のA相信号の立ち上がり若しくは前記A相信号の立ち下がりに同期し、前記A相信号の1~数パルス分の幅を有する複数の、Z相の幅の信号を生成する機能と、
前記マグネット原点位置を基準とする、前記A相、B相、前記Z相信号、Z相の幅の信号、及び、前記U相、V相、W相の各位相の情報にEEPROMのアドレスを付与し、暫定多回転アブソリュート信号のデータとして生成する機能と、
前記暫定多回転ブソリュート信号のデータを、前記回転軸の前記絶対原点位置を基準とする多回転・アブソリュート信号のデータに変換し、前記EEPROMに記録する機能とを備え、
前記EEPROMのデータを利用して、前記モータを駆動するように構成されていることを特徴とするブラシレスDCサーボモータの制御ユニット。 - ブラシレスDCサーボモータの製造方法であって、
前記ブラシレスDCサーボモータは、
前記モータの駆動信号を生成して出力し、U相、V相、W相の3相の各ステータコイルに供給される電力を制御する制御ユニットと、
多極の永久磁石を有するロータの回転を検知するMRセンサユニットとを有し、
前記MRセンサユニットは、
前記ロータの回転軸の一端に固定され、径方向に着磁された1組のN極領域とS極領域を有する平板状のマグネットと、
該マグネットに対向する位置で前記ハウジング側に固定された1対のMRセンサと、処理回路部とを備え、前記マグネットのN極領域とS極領域の境界線上の位置を、マグネット原点位置とするものにおいて、
前記MRセンサユニットにより、前記駆動信号により前記ブラシレスDCサーボモータを駆動して得られる前記1対のMRセンサの出力に基づいて、前記回転軸の回転に伴うA相、B相の信号を生成して出力するとともに、前記マグネットの原点位置の情報を生成し、
前記制御ユニットにより、
前記ロータの極数に合わせて、前記MRセンサユニットの前記A相若しくは前記B相の出力信号の立ち上がり位相に同期する、前記U相、V相、W相の各位相情報を生成すし、
前記駆動信号により前記モータを駆動した際に、前記いずれか1相のステータコイルへの駆動信号が零から立ち上がる位相と、該モータの駆動により得られる前記1相のステータコイルへの逆起電力の積分値ピークの位相と、前記駆動信号の零に対応する前記MRセンサユニットからの前記A相若しくは前記B相の出力信号の立ち上がり位相との同期関係に基づき、前記駆動信号に対する前記回転軸の絶対原点位置を取得し、
前記駆動信号の零に対応する前記A相又は前記B相の出力信号の立ち上がりに同期する、360度間隔の複数のZ相信号を設定し、
前記マグネットの原点位置を基準とする、前記A相、B相、前記Z相信号、前記Z相の幅の信号、及び、前記U相、V相、W相の各位相のデータを、暫定多回転アブソリュート信号のデータとして前記EEPROMに記録し、
前記暫定多回転ブソリュート信号のデータを、前記回転軸の前記絶対原点位置を基準とする、多回転・アブソリュート信号のデータに変換し、前記EEPROMに記録すると共に、
前記マグネットの原点位置を、前記回転軸の前記絶対原点位置に同期する位置に固定することを特徴とするブラシレスDCサーボモータの製造方法。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2017550646A JP6291149B1 (ja) | 2017-06-12 | 2017-06-12 | ブラシレスdcサーボモータの制御装置 |
US16/306,157 US10879820B2 (en) | 2017-06-12 | 2017-06-12 | Control device for brushless DC servo motor |
PCT/JP2017/021703 WO2018229842A1 (ja) | 2017-06-12 | 2017-06-12 | ブラシレスdcサーボモータの制御装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
PCT/JP2017/021703 WO2018229842A1 (ja) | 2017-06-12 | 2017-06-12 | ブラシレスdcサーボモータの制御装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2018229842A1 true WO2018229842A1 (ja) | 2018-12-20 |
Family
ID=61628627
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2017/021703 WO2018229842A1 (ja) | 2017-06-12 | 2017-06-12 | ブラシレスdcサーボモータの制御装置 |
Country Status (3)
Country | Link |
---|---|
US (1) | US10879820B2 (ja) |
JP (1) | JP6291149B1 (ja) |
WO (1) | WO2018229842A1 (ja) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6578499B1 (ja) * | 2019-02-19 | 2019-09-25 | 株式会社 五十嵐電機製作所 | 汎用型ロータリーエンコーダ及びそれを用いたサーボモータ |
JP2021025840A (ja) * | 2019-08-02 | 2021-02-22 | 株式会社 五十嵐電機製作所 | 汎用型ロータリーエンコーダ |
EP3865828A4 (en) * | 2019-11-05 | 2021-12-29 | Igarashi Electric Works Ltd. | Multipurpose rotary encoder |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102017221763A1 (de) * | 2017-12-04 | 2019-06-06 | Robert Bosch Gmbh | Sensorsystem zur Bestimmung mindestens einer Rotationseigenschaft eines um mindestens eine Rotationsachse rotierenden Elements |
FR3089714B1 (fr) * | 2018-12-11 | 2021-07-30 | Valeo Equip Electr Moteur | Rotor comprenant un détecteur magnétique de paramètre de rotation du rotor |
CN114123884B (zh) * | 2021-11-16 | 2023-10-10 | 珠海格力电器股份有限公司 | 一种油烟机的控制方法及控制系统 |
FR3132804A1 (fr) * | 2022-02-14 | 2023-08-18 | Ez-Wheel | Moteur electrique a codeur de rotation |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000295890A (ja) * | 1999-04-01 | 2000-10-20 | Canon Inc | ブラシレスモータ駆動制御装置 |
JP2015049047A (ja) * | 2013-08-29 | 2015-03-16 | アルプス電気株式会社 | モータ制御装置 |
JP2017055608A (ja) * | 2015-09-11 | 2017-03-16 | 日立オートモティブシステムズ株式会社 | インバータ駆動装置、電動ブレーキ装置、及び電動パワーステアリング装置 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101925800B (zh) | 2008-03-18 | 2013-04-17 | 三菱电机株式会社 | 旋转角度检测装置 |
JP5401875B2 (ja) | 2008-09-03 | 2014-01-29 | 日本精工株式会社 | 車両用舵角検出装置及びこれを使用した電動パワーステアリング装置 |
JP2015149800A (ja) | 2014-02-05 | 2015-08-20 | キヤノン株式会社 | 永久磁石モータの制御装置及び画像形成装置 |
US9791296B2 (en) * | 2015-05-05 | 2017-10-17 | Metropolitan Industries, Inc. | System and method of synchronously switching electrical phases of a permanent magnet synchronous motor |
JP6582212B2 (ja) | 2015-07-30 | 2019-10-02 | アダマンド並木精密宝石株式会社 | センサレス・ブラシレスモータの駆動方法及び該駆動方法を用いたモータ制御装置 |
-
2017
- 2017-06-12 JP JP2017550646A patent/JP6291149B1/ja not_active Expired - Fee Related
- 2017-06-12 US US16/306,157 patent/US10879820B2/en active Active
- 2017-06-12 WO PCT/JP2017/021703 patent/WO2018229842A1/ja active Application Filing
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000295890A (ja) * | 1999-04-01 | 2000-10-20 | Canon Inc | ブラシレスモータ駆動制御装置 |
JP2015049047A (ja) * | 2013-08-29 | 2015-03-16 | アルプス電気株式会社 | モータ制御装置 |
JP2017055608A (ja) * | 2015-09-11 | 2017-03-16 | 日立オートモティブシステムズ株式会社 | インバータ駆動装置、電動ブレーキ装置、及び電動パワーステアリング装置 |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6578499B1 (ja) * | 2019-02-19 | 2019-09-25 | 株式会社 五十嵐電機製作所 | 汎用型ロータリーエンコーダ及びそれを用いたサーボモータ |
WO2020170343A1 (ja) * | 2019-02-19 | 2020-08-27 | 株式会社五十嵐電機製作所 | 汎用型ロータリーエンコーダ及びそれを用いたサーボモータ |
JP2021025840A (ja) * | 2019-08-02 | 2021-02-22 | 株式会社 五十嵐電機製作所 | 汎用型ロータリーエンコーダ |
EP3865828A4 (en) * | 2019-11-05 | 2021-12-29 | Igarashi Electric Works Ltd. | Multipurpose rotary encoder |
Also Published As
Publication number | Publication date |
---|---|
JP6291149B1 (ja) | 2018-03-14 |
JPWO2018229842A1 (ja) | 2019-06-27 |
US10879820B2 (en) | 2020-12-29 |
US20200228035A1 (en) | 2020-07-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6291149B1 (ja) | ブラシレスdcサーボモータの制御装置 | |
JP6438176B1 (ja) | Dcモータの制御装置 | |
JP6339307B1 (ja) | 直流モータの制御装置 | |
JP6578499B1 (ja) | 汎用型ロータリーエンコーダ及びそれを用いたサーボモータ | |
JP6412281B1 (ja) | ブラシレスdcサーボモータの制御装置 | |
JP2004271503A5 (ja) | ||
JP2003509999A (ja) | 電動パワーステアリングシステム用のインデックスパルスを確実に生成するための方法及び装置 | |
JP2004271503A (ja) | 電子スイッチング・モータを位置信号により制御する装置 | |
JP6844617B2 (ja) | モータモジュール、モータステップ動作制御システム、およびモータ制御装置 | |
KR20210056948A (ko) | 범용형 로터리 인코더 | |
JP6966143B1 (ja) | バッテリレス対応のロータリーエンコーダ及びそれを用いたサーボ制御装置 | |
WO2019054475A1 (ja) | モータ駆動システムおよびモータの制御方法 | |
JP2008178237A (ja) | リニアシステムの磁極位置補正方法およびこの補正方法を用いたリニアシステム | |
JP6803627B1 (ja) | 汎用型ロータリーエンコーダ | |
US20190162560A1 (en) | Brushless DC Motor and Method for Providing an Angle Signal | |
JP6232526B1 (ja) | 直流モータの制御装置 | |
JP6419922B1 (ja) | 直流モータの制御装置 | |
JP2011147254A (ja) | サーボシステム | |
WO2022034629A1 (ja) | ロータリーエンコーダ及びそれを用いた制御精度切替型サーボ制御装置 | |
JP7574165B2 (ja) | モータ制御のための磁気センサーシステム | |
JP2018064340A (ja) | モータ制御装置 | |
JP2022062707A (ja) | モータ制御のための磁気センサーシステム | |
JP2001078392A (ja) | センサー付きステッピングモータ | |
JP2020134505A (ja) | 汎用型ロータリーエンコーダ | |
JP2006050719A (ja) | ブラシレスモータ |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
ENP | Entry into the national phase |
Ref document number: 2017550646 Country of ref document: JP Kind code of ref document: A |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 17913348 Country of ref document: EP Kind code of ref document: A1 |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
122 | Ep: pct application non-entry in european phase |
Ref document number: 17913348 Country of ref document: EP Kind code of ref document: A1 |