BACKGROUND OF THE INVENTION
[0001] The present invention relates to a positioning-controlling apparatus for positioning
a subject by moving it to a predetermined position and a positioning-controlling method,
and part-mounting equipment and a part-mounting method which comprise the positioning-controlling
apparatus or employ the positioning-controlling method.
[0002] In part-mounting equipment for continuously mounting parts such as electronic parts,
etc. on determined positions of a circuit-formed material such as an electronic circuit
substrate or the like, a part is mounted on a determined position of a circuit-formed
material by introducing the circuit-formed material into the equipment and regulating
and holding it, while carrying and positioning a part at a determined position of
the circuit-formed material, and mounting the part thereon. Or otherwise, in case
where a position to receive a part is specified, a circuit-formed material is carried
and positioned so as to mount the part on a determined position of the circuit-formed
material at the above specified position. Fig. 7 shows an essential portion of part-mounting
equipment comprising the former type positioning means which carries a part and positions
it.
[0003] As seen in Fig. 7, part-mounting equipment (100) essentially consists of a part-supplying
unit (50) for supplying parts to the part-mounting equipment (100), a robot (60) for
carrying a subject on a X-Y plane, a mounting head (75) to be carried by the robot
(60), a circuit-formed material-holding device (80) for carrying and holding a circuit-formed
material, and a controller (90) for controlling overall operations of the part-mounting
equipment (100).
[0004] The robot (60) comprises a Y-direction driving unit which causes motors (62 and 64)
fixed on the equipment to move a beam (70) along ball screws (63 and 64) in the direction
Y, and an X-direction driving unit which causes a motor (72) fixed on the beam (70)
driven by the Y-direction driving unit, to move the mounting head (75) along a ball
screw (73) in the direction X. In this regard, although the Y-direction driving unit
may take such a system in which driving is performed using one motor and one ball
screw, Y-direction driving units of multi-screw driving system (in this drawing, a
twin-screw type using two ball screws (63 and 65)) have come into wide use to meet
a latest demand for high-speed and high-load mounting performance and also to achieve
high rigidity and high accuracy of equipment.
[0005] As seen in Fig. 7, the mounting head (75) has 4 mounting nozzles (76) which are movable
up and down along the direction Z and rotatable on the axis Z as the center, and by
this motion of the nozzles (76), parts are taken out and mounted. The circuit-formed
material-holding device (80) carries a circuit-formed material such as an electronic
circuit substrate (82) as shown in Fig. 7 into the part-mounting equipment and regulates
and holds the substrate (82) at a predetermined position in the course of mounting
the part.
[0006] The part-mounting equipment (100) arranged above is operated as follows, The mounting
head (75) with the respective mounting nozzles (76) which suck parts from the part-supplying
unit (50) and hold them is carried to a mounting position by the robot (60), while
the circuit-formed material-holding device (80) introduces the electronic circuit
substrate (82) and holds it at a predetermined position. The distance which the robot
(60) travels carrying the mounting head is computed and controlled by the controller
(90) based on the data of a condition of the part sucked and held by the mounting
nozzle (76), which is separately recognized, and data of a condition of the electronic
circuit substrate (82) held. The mounting head (75), which is moved to the mounting
position and stopped there, lowers the mounting nozzles (76) so as to mount the parts
sucked at the ends of the nozzles (76) on the mounting positions of the electronic
circuit substrate (82).
[0007] Part-mounting equipment is typically provided with a positioning-controlling apparatus
for moving a subject (the mounting head (75) in case of the X-direction driving unit
shown in Fig. 7) in a predetermined direction along the ball screw which is rotated
by a servo motor, and positioning it at a predetermined position and stopping it there.
The system of detecting the position of the subject in this positioning-controlling
apparatus is classified to a rotary encoder system in which the position of a subject
is detected based on the number of rotations of a rotary encoder which rotates coaxially
with a servo motor shaft, and a linear encoder system in which a position of a linear
scale attached parallel to a direction along which a subject is moving is detected
by a linear position-detecting device attached on the subject.
[0008] Recently, techniques for miniaturizing parts have been advanced, and hence high-density
mounting of parts on an electronic circuit substrate has been realized. Therefore,
accurate positioning and mounting of parts are required for part-mounting equipment.
Under such circumstances, a positioning-controlling apparatus for use in part-mounting
equipment tends to employ the linear encoder system capable of more accurately detecting
a position of a subject than the rotary encoder system. The linear encoder is further
classified to two types; one is an absolute type encoder which detects an absolute
position by counting and the other is an incremental type encoder which detects a
relative position by counting. Of these encoders, presently, the incremental type
encoder is mainly used because of its reliability and its past achievement. A positioning-controlling
apparatus using this incremental type linear encoder according to the prior art is
described with reference to the accompanying drawings.
[0009] Fig. 8 schematically shows the arrangement of a positioning-controlling apparatus
according to the prior art which uses the incremental type linear encoder (hereinafter,
simply referred to as a linear encoder). Illustration of Fig. 8 may be considered
as the essential portion of the X-direction driving unit used by the part-mounting
equipment (100) shown in Fig. 7. As seen in Fig. 8, mounted on the servo motor (1)
is a moving mechanism comprising a ball screw (3) for moving a subject (4), and a
moving member (7) screwed on the ball screw (3). The subject (4) (the mounting head
(75) in case of the X-direction driving unit shown in Fig. 7) is secured on the moving
member (7), and the subject (4) is moved to the direction R or L via the rotation
of the ball screw (3) by the reciprocal rotation of the servo motor (1). The subject
(4) is equipped with a linear encoder (5) which performs a position detection by detecting
a linear scale (6) secured parallel to the ball screw (3). A rotary encoder (2) which
rotates together with the servo motor (1) to detect a rotation amount is coaxially
mounted on the servo motor (1).
[0010] At the time of turning on a power supply, the servo motor (1) using the linear encoder
(5) as a position-detecting means cannot grasp an absolute position of the subject
(4). Therefore, the subject (4) once needs to be returned to an origin position which
is preset as a reference position, and then, a relative position from the origin is
detected by counting output signals from the linear encoder (5) so as to make positioning
control. A detection piece (8) is attached to the moving member (7) on which the subject
(4) is mounted, so as to detect the returning of the subject (4) to the origin. Further,
an origin sensor (11) is arranged at a position of the origin, and the sensor (11)
detects the detection piece (8) which has been moved to the origin.
[0011] The servo driver (10) controls the rotation of the servo motor (1) according to an
instruction from the controller (9) which controls the overall operations of the equipment,
and also according to a detection signal from the origin sensor (11) and output signals
from the rotary encoder (2) and the linear encoder (5). Inside the servo driver (10),
generally, the velocity of the servo motor (1) is detected based on the position data
from the rotary encoder (2) and the detected velocity is used for computation of the
velocity of the servo loop, and the position data from the linear encoder (5) is used
for computation of the position of the servo loop. However, in case where a moving
mechanism for the subject (4), for example, a vibrating component such as the ball
screw (3), is included, the position data and the velocity data from the linear encoder
alone may be used for computation for the servo loop.
[0012] Next, the subject's origin returning operation by the positioning-controlling apparatus
shown in Fig. 8 is described with reference to the flowchart shown in Fig. 9. The
origin returning operation starts when the controller (9) instructs the servo driver
(10) to move the subject (4) in a predetermined direction at Step S1. The servo driver
(10) simultaneously starts an origin sensor-retrieving operation for monitoring the
input of a reference position signal (a signal to be inputted when the origin sensor
detects the detection piece attached to the moving member (hereinafter referred to
as the ON state of the origin sensor)) from the origin sensor (11) at Step S2. At
this point of time, if the subject keeps moving because the 2 phase is not detected
by the linear encoder at Step S5 (No) after the origin sensor (11) has once entered
the ON state (Yes) at Step S2, and if the origin sensor (11) then enters the OFF state
(No) at Step S2, it is decided at Step S3 that the origin sensor (11) has once entered
the ON state and then enters the OFF state. In this case, the moving direction is
inverted at Step S4. If a condition for completing the origin returning operation
is established at Step S5, in other words, if the AND condition of the detection of
the Z phase by the linear encoder and the ON state of the origin sensor is established,
the servo driver (10) stops the moving operation at Step S6, and the controller (9)
stops the instruction and completes the subject's origin returning operation.
[0013] In the positioning-controlling apparatus with the above arrangement, the origin is
defined as a position of the Z phase detected by the linear encoder (5), which is
capable of accurately detecting the position of the subject (4). On the other hand,
the Z phase detected by the rotary encoder (2) is used as a reference for generating
an electrical current instruction with sine waveform pulses for driving the servo
motor (1). That is, the position of the Z phase detected by the linear encoder (5)
is used to determine the position of a spatial absolute reference origin, and the
position of the Z phase detected by the rotary encoder (2) is used to determine an
electrical origin (a reference for determining timing for an electrical waveform which
composes an operational instruction to the servo motor, that is, a reference for synchronization
of servo control) necessary for controlling the servo motor (1).
[0014] Next, a method of driving the servo motor (1) is described with reference to Figs.
10 and 11. The servo motor (1) is driven according to rectangular waveform pulses
as shown in the lower half of Fig. 10, based on a CS phase (commutation signal phase)
which is outputted in accordance with positive or negative induced voltage of the
motor. That is, when the position of the subject (4) is present at, for example, position
A shown in Fig. 10, CS signals 1 and 3 are in the state of ON, which leads to a control
for allowing current to flow on U, W. When the servc motor (1) is present at position
B in Fig. 10, CS signals 1 and 2 are in the state of ON, and a control for allowing
a current to flow on U, V is performed.
[0015] The above CS phase is a generic name of CS1 to CS3. Specifically, CS1 is a rectangular
waveform pulse corresponding to positive or negative of induced voltage U-W, and similarly,
CS2 is a rectangular waveform pulse corresponding to positive or negative of induced
voltage V-U, and CS3 is a rectangular waveform pulse corresponding to positive or
negative of induced voltage W-V. As shown in Fig. 11, in the servo motor, the notations
U, V and W refer to motor power lines for three-phase driving. In detail, U-W indicates
the induced voltage of the motor power line U obtained when the power line W is grounded
(represented by G), and similarly, V-U indicates the induced voltage of the power
line V obtained when the power line U is grounded, and W-V indicates the induced voltage
of the power line W obtained when the power line V is grounded. The driving by rectangular
waveform pulses is employed for constructing a motor at lower cost because the driving
control is possible only by using a combination of the above three CS signals alone,
which leads to simple driving, or it is employed for driving before the completion
of the subject's origin returning operation just after the power supply is turned
on, as mentioned above. This driving mode, however, may not be employed for the essential
use of the servo motor (1) for performing high-speed and high-accuracy driving, because
of the limited performance by this driving mode.
[0016] To solve this problem, the performance of the servo motor (1) is drawn by sine waveform
pulse driving. The sine waveform pulse driving is carried out as follows. The Z phase
detected by the rotary encoder (2) is defined as a reference for an electrical origin
of the serve motor (1), and an electrical distance from this electrical origin is
computed based on the A phase and B phase from the rotary encoder (2), and the result
is outputted as a sine waveform pulse current instruction in proportion to the induced
voltage from the servo motor (1) as shown in the upper half of Fig. 10. In Fig. 10,
the position of the Z phase detected by the rotary encoder (2) is caused to coincide
with the rise of the CS1 signal, and it is possible to estimate an electrical axial
position of the servo motor (1) from the position of the Z phase and the count values
of the A phase and the B phase per one rotation of the rotary encoder (2), and thus,
the sine waveform pulse driving of the servo motor (1) becomes possible. This sine
waveform pulse driving is suitable for high-accuracy driving because an electrical
angle can be found by an encoder resolution per one rotation, so that it becomes possible
to increase the acceleration and to use the servo motor up to the uppermost limit
of its performance. The sine waveform pulse driving is generally performed in part-mounting
equipment, because the rectangular waveform pulse driving of the servo motor (1) makes
it hard to reduce the positioning-settling time and to achieve constant velocity required
for recognition of parts. However, the reference for sine waveform pulse can not be
obtained before the Z phase is detected by the rotary encoder (2), as in the case
immediately after the power supply is turned on. Therefore, the sine waveform pulse
driving may not be realized during such a time frame. In such a case, the foregoing
rectangular waveform pulse driving is performed until the Z phase is detected by the
rotary encoder (2). Then, at a point of time when the rotary encoder (2) detects the
Z phase, the sine waveform pulse driving becomes possible, and the driving is switched
to the sine waveform pulse driving.
[0017] The conventional servo motor (1) is equipped with the rotary encoder (2) capable
of detecting A phase and B phase for use in detecting an rotation angle, Z phase for
indicating the position of the origin, and CS1 to CS3 phases corresponding to positive
or negative of induced voltage of the motor. In case where the servo motor (1) is
provided on the above positioning-controlling apparatus or the like, the linear encoder
(5), in many cases, is used for controlling a position and velocity in the servo loop
and detecting an absolute origin position. Therefore, it is rare to provide the linear
encoder (5) for detecting an electrical origin and CS phases because of the difficulties
in adjusting thereof.
[0018] The operation of part-mounting equipment provided with the above positioning-controlling
apparatus is described with reference to the flowchart shown in Fig. 12 in conjunction
with Fig. 7 already described above.
[0019] As mentioned above, latest part-mounting equipment is required to meet the demand
of high-speed and high-accuracy performance in association with miniaturization of
parts. To solve this problem, advanced synchronous control employing multi-axial driving
such as twin-axial driving is used, especially for the Y-direction driving unit of
the robot (60), In this example, the synchronous control of the motor (62) and the
motor (64) of the above Y-direction driving unit for the Y-directional operation of
the beam (70) which supports the mounting head (75) is described. When the power supply
is turned on, the current positions of the motors (62 and 64) are not known, and therefore,
they are caused to return to the origins, respectively. This origin-returning operation
is carried out according to the method disclosed in Laid-Open Japanese Patent Publication
No. 11-145694/1999 or the like. The summary of the method is illustrated in the flowchart
shown in Fig. 12. The flowchart of Fig. 12 illustrates a case in which the origin-returning
operation described in the flowchart of Fig. 9 is essentially performed on each of
the plurality of axes. That is, at Steps S15 and S21 of the flowchart on Fig. 12,
the origin positions of the mounting head (75) as the subject (4) are independently
detected relative to the motors (62 and 64) so as to complete the mounting head's
returning to the origins on the respective ball screws (63 and 65), and thus, at Steps
S16 and S22, the subject's returning to the origins on the twin axes are completed.
In this connection, the acceleration and the velocity of the motors at the time of
the origin returning operation are controlled lower on the assumption that the rectangular
waveform pulse driving should be done, and therefore, the performance of the motors
may not be important at the time of the origin-returning operation.
[0020] However, the positioning control according to the prior art described above has a
problem in the following. There is a possibility that the subject's origin-returning
may be completed before the rotary encoder detects the Z phase, depending upon a position
at which the origin-returning operation is started or upon a subject's moving direction.
This is because the condition of completing the origin-returning operation is based
on the AND condition of "detection of the Z phase by the linear encoder" and "the
ON state of the origin sensor". The situation of this origin-returning operation is
described in detail with reference to Fig. 13. Assuming that the position of the subject
(4) when the power supply is turned on is at P1 on Fig. 13, and the subject's returning
direction to the origin is of negative (the left direction on the drawing). Under
such an assumption, the subject (4) starts returning to the origin, and keeps moving
when the rotary encoder (2) first detects the Z phase (indicated by the notation X)
and then stops when the linear encoder (5) detects the Z phase. Thus, the subject's
origin returning is completed. In this case, the driving mode of the servo motor (1)
is switched to the sine waveform pulse driving from the rectangular waveform pulse
driving at a point of time when the rotary encoder (2) has detected the Z phase once,
as shown in Fig. 13. Therefore, the serve motor (1) can be driven at high acceleration
or deceleration and at high velocity so as to control the positioning after the completion
of the subject's origin returning, because this driving is done according to the sine
waveform pulses obtained after the above switching. Thus, the driving of the apparatus
which drives the subject (4) is performed without any problem.
[0021] In another case where the position of the subject (4) when the power supply is turned
on is at the position P2 on Fig. 13 and the direction of the subject's returning to
the origin is of positive (the right direction on the drawing), the subject (4) keeps
moving until the linear encoder (5) detects the Z phase, while the rotary encoder
(2) does not detects the Z phase at all, and thus, the subject' returning to the origin
is completed at the time of the detection of the Z phase by the linear encoder (5).
In other words, in spite of the completion of the subject's returning to the origin,
the servo motor (1) is still driven according to rectangular waveform pulses, because
the rotary encoder (2) does not yet detect the Z phase. In this case, if the subject's
moving direction is of negative as shown in Fig. 13 in the positioning operation after
the completion of the subject's returning to the origin, it is understood that the
servo motor (1) is still driven according to rectangular waveform pulses for a period
of time while the rotary encoder (2) rotates once at the most until the first Z phase
is detected by the rotation of the rotary encoder (2). After that, just when the rotary
encoder (2) detects the Z phase, the rotating servo motor (1) is abruptly driven according
to sine waveform pulses which are switched from the rectangular waveform pulses.
[0022] In actual part-mounting equipment, the first origin returning operation just after
the power supply is turned on is performed at acceleration and velocity controlled
lower, assuming the driving in accordance with rectangular waveform pulses. Therefore,
the equipment is operated without any problem, even if driven according to rectangular
waveform pulses. However, the positioning-controlling operation after the completion
of the subject's origin returning is performed at high acceleration and high speed.
Under such a condition, if the servo motor (1) is still driven according to rectangular
waveform pulses, abnormal noises occur and constant velocity is lost. Thus, the servo
motor (11) can not perform the essential positioning control. Further, if the driving
mode of the servo motor (1) accelerating is switched from the rectangular waveform
pulse driving to the sine waveform pulse driving, a rapid change in torque arises,
which leads to occurrence of abnormal noises and pulsating speed.
[0023] As mentioned above, in order for the latest part-mounting equipment to meet the demand
of high-speed and high-accuracy performance, the advanced synchronous control by multi-axial
driving such as twin-axial driving is done on the robot. If the above linear encoder
system positioning-control according to the prior art is applied to such synchronous
control, a highly synchronizing operation becomes impossible during the acceleration
step, depending on the condition of completing the origin returning operations on
the multiple screws. As a result, the beam (70) (see Fig. 7) may be twisted in the
X-axial direction, which gives adverse influences on the accuracy and lifetime of
the equipment. Particularly when the power supply of the part-mounting equipment is
turned off, the subject is generally returned to the origins or around the origins
in order to prevent the interference among the axes. By doing so, in most cases, the
mounting head as the subject is positioned at or around the origin of the linear scale
when the power supply is turned on at next time. When the power supply is again turned
on under this condition so as to carry out the first subject's origin returning operation,
such events frequently occur that the linear encoder detects the Z phase before the
rotary encoder detects the Z phase, thereby completing the subject's origin returning.
This provides a serious problem in that adverse influences are inevitably given on
the accuracy and lifetime of the beam (70) along the direction X at every time when
the power supply is turned on. Under these circumstances, an advanced positioning-controlling
apparatus capable of solving the foregoing problems is desired.
SUMMARY OF THE INVENTION
[0024] The present invention is made in order to solve the abovementioned problems by adding,
to the condition of completing the subject's origin returning operation, a condition
that the rotary encoder should detect the Z phase prior to the Z phase detection by
the linear encoder, in a positioning-controlling process. Specifically, the present
invention provides the following.
[0025] That is, one aspect according to the present invention relates to a positioning-controlling
apparatus which comprises a servo motor, a servo driver for controlling the driving
of the servo motor, a rotary encoder for detecting the rotation amount of the servo
motor, a moving mechanism driven by the rotation of the servo motor, and a linear
encoder for detecting the moving amount of the moving mechanism, wherein said servo
driver detects, from the rotary encoder, a CS phase necessary for driving the servo
motor, and generates a current instruction with rectangular waveform pulses which
are obtained from the CS phase from the rotary encoder until the time when the rotary
encoder detects a Z phase or the linear encoder detects a Z phase, and after the rotary
encoder detects the Z phase or the linear encoder detects the Z phase, generates a
current instruction with sine waveform pulses based on the Z phase detected by the
rotary encoder, thereby switching the driving mode of the servo motor, and wherein
at the time of turning on a power supply, the servo driver returns a subject to be
moved by the moving mechanism, to an origin which is the position of the Z phase detected
by the linear encoder, and then, moves the subject to a required position and stops
it there for positioning, characterized in that the rotary encoder detects the Z phase
previously in the operation of returning the subject to the origin. By adding the
condition that the rotary encoder should previously detect the Z phase to the condition
of completing the subject's origin returning, the driving of the servo motor for positioning
the subject can be previously switched to the driving according to sine waveform pulses.
[0026] The above subject is completely returned to the origin and stopped there under the
condition that, while the subject is being moved by the moving mechanism to return
to the origin, an origin sensor first detects that the subject is being within a detectable
region of the origin sensor, and the rotary encoder detects the Z phase, and than,
the linear encoder detects the Z phase, while the subject is moving within the above
detectable region.
[0027] The subject is not completely returned to the origin and is continued to move, under
the condition that, while the subject is being moved by the moving mechanism to return
to the origin, the origin sensor first detects that the subject is being within the
detectable region of the origin sensor, and the linear encoder detects the Z phase
before the rotary encoder detects the Z phase while the subject is moving within the
above detectable region; and the subject is completely returned to the origin and
stopped there under the condition that the subject is kept moving to once go out of
the above detectable region and then moved in the reverse direction to again enter
the detectable region, and thus, the rotary encoder detects the Z phase and the linear
encoder detects the Z phase in this order, while the subject is moving within the
above detectable region.
[0028] In a positioning-controlling apparatus according to another aspect of the present
invention, the subject is moved by the moving mechanism to return to the origin which
is the position of the Z phase detected by the linear encoder, as follows; the subject's
moving direction for returning to the origin is predetermined, and the origin sensor,
the Z phase to be detected by the rotary encoder and the Z phase to be detected by
the linear encoder are adjusted so that, while the subject is moving to the predetermined
direction, the origin sensor can first detect that the subject is being within the
above detectable region, then that the rotary encoder detect the Z phase, and then
that the linear encoder can detect the Z phase.
[0029] In the positioning-controlling apparatus according to the above aspect, in case where
one end of the subject's movable region coincides with one end of the above detectable
region, the Z phase to be detected by the linear encoder and the Z phase to be detected
by the rotary encoder are arranged so that first the rotary encoder detects the Z
phase and then the linear encoder detects the Z phase while the subject is moved toward
the one end of the above detectable region from the other end thereof.
[0030] Further, when the position of the above subject at the start of the subject's origin
returning operation is outside of the above detectable region, the subject may be
moved to a predetermined direction specified as the moving direction for returning
to the origin, so as to be returned to the origin.
[0031] Further, when the position of the subject at the start of the subject's origin returning
operation is within the detectable region, the subject may be moved in a direction
reverse to the predetermined direction specified as the moving direction for returning
the origin, so as to once go out of the above detectable region, and then moved in
the reverse direction which is the above predetermined direction, so as to be returned
to the origin.
[0032] In a positioning-controlling apparatus according to yet another aspect of the present
invention, an offset amount and an offset direction, which are the distance and the
moving direction from the position where the rotary encoder detects the Z phase to
the position where the linear encoder detects the Z phase, are predetermined, and
the above servo driver switches the driving mode according to the currant instruction
with rectangular waveform pulses to the driving mode according to the current instruction
with sine waveform pulses, when the subject is moved in the offset direction by the
offset amount from the position where the rotary encoder detects the Z phase. In this
aspect, the current instruction with rectangular waveform pulses is not immediately
switched to the current instruction with sine waveform pulses even when the rotary
encoder detects the Z phase, and this switching is executed when the linear encoder
detects the Z phase, or the subject is moved by the offset amount after Z phase is
detected by the rotary encoder.
[0033] Yet another aspect according to the present invention relates to part-mounting equipment
which comprises a circuit-formed material-holding device for carrying and holding
a circuit-formed material, a part-supplying unit for supplying parts, a mounting head
capable of taking a part out of the part-supplying unit and mounting the part on the
circuit-formed material, a robot for carrying the mounting head, and a controller
for controlling the circuit-formed material-holding device, the part-supplying unit,
the mounting head and the robot, and with this arrangement, the part taken out of
the part-supplying unit by the mounting head is mounted on a mounting position of
the circuit-formed material, wherein either or both of the robot and the circuit-formed
material-holding device comprise(s) any of the above positioning-controlling apparatuses
in order to accurately position the part at the predetermined mounting position of
the circuit-formed material.
[0034] In this part-mounting equipment, the robot or the circuit-formed material-holding
device may comprise a multi-axial driving unit for synchronous operation using a plurality
of servo motors, so as to carry the mounting head or the circuit-formed material in
a predetermined direction. That is, the positioning-controlling apparatus of the present
invention may be applied to part-mounting equipment comprising a multi-axial driving
system with high accuracy and high load durability.
[0035] A further aspect according to the present invention relates to a positioning-controlling
method which comprises the steps of driving a servo motor, which is a driving source
for moving a subject, according to a current instruction with rectangular waveform
pulses obtained from a CS phase detected by the above rotary encoder until the time
when the rotary encoder which detects the rotation amount of the servo motor detects
a Z phase or the linear encoder detects a Z phase; switching the driving mode of the
servo motor to a driving mode according to a current instruction with sine waveform
pulses based on the Z phase after the rotary encoder detects the Z phase or after
the linear encoder detects the Z phase; once returning the subject to the origin which
is the position of the Z phase detected by the linear encoder which detects the moving
amount of said subject, and then moving the subject to a required position so as to
position the subject, characterized in that a condition that the rotary encoder should
previously detect the Z phase is added to the condition of completing the subject's
origin returning operation. By the addition of this condition, the driving mode of
the servo motor is previously switched to the driving mode according to sine waveform
pulses for positioning the subject.
[0036] In the above positioning-controlling method, the subject's moving direction for returning
to the origin may be predetermined, and the origin sensor, the Z phase to be detected
by the rotary encoder and the Z phase to be detected by the linear encoder may be
adjusted so that the origin sensor can first detect that the subject is being within
the above detectable region, and the rotary encoder detects the Z phase and the linear
encoder detects the Z phase in this order, while the subject is being moved in the
above detectable region. That is, the timing of the detection of the subject by the
origin sensor, the detection of the Z phase by the rotary encoder and the detection
of the Z phase by the linear encoder is adjusted so that the driving mode of the servo
motor for positioning the subject can be previously switched to the driving mode according
to sine waveform pulses before the positioning operation.
[0037] A further aspect according to the present invention relates to a part-mounting method
which comprises the steps of taking a part out of the part-supplying unit; carrying
the part to a mounting position of a circuit-formed material which is regulated and
held; positioning the part there; and mounting the part at the mounting position;
wherein the foregoing positioning-controlling method is employed for either or both
of positioning a mounting head for holding and carrying the part and a holding device
for regulating and holding the circuit-formed material, in order to accurately position
the part to the predetermined mounting position of the circuit-formed material.
BRIEF DESCRIPTION OF THE DRAWINGS
[0038]
Fig. 1 shows a flowchart illustrating the subject's origin returning operation in
positioning control according to an embodiment of the present invention.
Fig. 2 is a timing diagram showing a mutual relationship between each of the components
in the subject's origin returning operation illustrated in Fig. 1.
Fig. 3 is a timing diagram showing a mutual relationship between each of the components
in the subject's origin returning operation in positioning control according to another
embodiment of the present invention.
Fig. 4 shows a flowchart illustrating the subject's origin returning operation in
the positioning control shown in Fig. 3.
Fig. 5 is a timing diagram showing a mutual relationship between each of the components
in the subject's origin returning operation in positioning control according to a
further embodiment of the present invention.
Fig. 6 shows a flowchart illustrating the subject's origin returning operation in
the positioning control shown in Fig. 5.
Fig. 7 is a schematic drawing showing part-mounting equipment according to the prior
art.
Fig. 8 is a schematic drawing showing a positioning-controlling apparatus according
to the prior art.
Fig. 9 shows a flowchart illustrating the subject's origin returning operation in
positioning control according to the prior art.
Fig. 10 is a diagram illustrating a servo motor-driving method according to the prior
art.
Fig. 11 is a diagram illustrating the constitution of a servo motor operated under
three-phase driving.
Fig. 12 shows a flowchart illustrating the subject's origin returning operation under
twin-axial driving, in the part-mounting equipment shown in Fig. 7.
Fig. 13 is a timing diagram showing a mutual relationship between each of the components
in the subject's origin returning operation shown in Fig. 12.
DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0039] The present invention will now be described in more detail by way of embodiments,
which, however, should not be construed as limiting the scope of the present invention
in any way.
[0040] Positioning control according to the first embodiment of the present invention is
described with reference to the accompanying drawings.
[0041] Fig. 1 shows a flowchart illustrating an origin returning operation in positioning
control according to the present embodiment. In the description set forth below, components
the same as those described in the part of the prior art are referred to by using
the same notations, and therefore, such the same components are described with reference
to the corresponding drawings of the prior art. That is, the arrangement of the positioning-controlling
apparatus of the present embodiment is similar to the prior art shown in Fig. 8. However,
the origin returning operation in the course of the positioning control by the controller
(9) is performed following the flowchart shown in Fig. 1.
[0042] The origin returning operation according to the present embodiment shown in Fig.
1 starts when the controller (9) instructs the servo driver (10) to move the subject
(4) in a predetermined direction at Step S30. Simultaneously, the servo driver (10)
starts retrieving the origin sensor (11) so as to monitor an input of a reference
position signal (a signal to be inputted when the origin sensor (11) enters the state
of ON, i.e., when the sensor (11) detects the detection piece) from the origin sensor
(11) at Step S31. If the subject (4) keeps moving because the detection of the Z phase
by the rotary encoder (2) at Steps S34 and the detection of the Z phase by the linear
encoder (5) at Step S35 are not achieved after the origin sensor (11) has once entered
the ON state at Step S31 (Yes), and therefore, if the program returns to Step S31
and then the origin sensor (11) anters the state of OFF (No), it is decided at Step
S32 that the origin sensor (11) has once entered the ON state and then entered the
OFF state (Yes). In this case, the subject's moving direction is reversed at Step
S33. This is done to move the subject (4) in a direction in which the subject (4)
may come close to the origin sensor (11).
[0043] Next, if the origin sensor (11) enters the state of ON (Yes) at Step S31 and then
if the rotary encoder (2) detects the Z phase once (Yes) at Step S34, it is decided
at Step S35 whether or not the linear encoder (5) detects the Z phase which is the
position of the origin. When it is decided that the linear encoder detects the Z phase
(Yes), the subject's origin returning condition is established, and the servo driver
(10) stops moving the subject (4) at Step S36, and the controller (9) stops instructing
and completes the subject's origin returning operation. On the other hand, if the
rotary encoder (2) does not yet detect the Z phase at Step S34, the program returns
to Step S31, and the above operation is repeated until the rotary encoder (2) detects
the Z phase. In other words, it is understood from the flowchart shown in Fig. 1 that
the condition of completing the subject's origin returning is that the rotary encoder
(Z) should detect the Z phase before the linear encoder (5) detects the Z phase.
[0044] Fig. 2 illustrates different cases of subject's origin returning operations, each
of which is selected for use depending on differences in the mutual positional relationship
between each of the Z phase to be detected by the rotary encoder (2) and the Z phase
to be detected by the linear encoder (5) and the origin sensor (11), and the position
of the subject (4) when the power supply is turned on, in the above origin returning
operation. In case where the subject (4) is present at the position P3 on the drawing
when the power supply is turned on and the moving direction is of negative (direction
from right to left on the drawing), the detection by the origin sensor (11), the detection
of the Z phase by the rotary encoder (2) and the detection of the Z phase by the linear
encoder (5) are achieved in this order while the subject (4) is moving for the origin
returning operation, and this operation is completed at the position of the Z phase
detected by the linear encoder (5). In this regard, the detection by the origin sensor
(11) means that the origin sensor (11) shown in Fig. 8 detects the detection piece
(8) attached to the moving member (7) (or the subject (4)) (in this cases, the origin
sensor (11) enters the state of ON, and the object (4) is located within the detectable
region of the origin sensor (11) shown by a thick bar in the drawing.); the detection
of the Z phase by the rotary encoder (2) means that the rotary encoder (2) detects
the Z phase indicating the origin of the servo motor (1); and the detection of the
Z phase by the linear encoder (5) means that the linear encoder (5) detects the Z
phase indicating the origin on the linear scale (6). In this case, the detection of
the Z phase by the rotary encoder (2) (indicated by the notation X on Fig. 2) is once
achieved before the subject returns to the origin, as mentioned above. Therefore,
according to the flowchart shown in Fig. 1, the linear encoder (5) detects the Z phase
(Yes) at Step S35 after the condition of Step S34 is established (Yes). Therefore,
the normal subject's origin returning operation is possible at Step S36.
[0045] On the other hand, if the position of the subject (4) is at P4 on Fig. 2 when the
power supply is turned on, and if the moving direction is of positive (direction from
left to right on the drawing), it is first detected that the subject (4) is being
within the detectable region of the origin sensor (11) by the detection of the ON
state of the origin sensor (11) while the subject (4) is moving for returning to the
origin, and the subject (4) keeps moving even when the linear encoder (5) detects
the Z phase. In this regard, this detection of the Z phase by the linear encoder (5)
is ignored, because the rotary encoder (2) does not yet detect the Z phase, and therefore,
the condition of Step S34 in the flowchart of Fig. 1 is not established (No). Next,
the servo motor (1) further rotates to move the subject (4) in the positive direction,
while the rotary encoder (2) detects the Z phase (indicated by the notation X). This
detection establishes the condition of Step S34 of the flowchart of Fig. 1 (Yes),
and switches the driving mode of the servo motor (1) from the rectangular waveform
pulse driving to the sine waveform pulse driving. After that, the subject (4) further
moves in the positive direction, and the origin sensor (11) detects that the subject
(4) is outside of the detectable region of the sensor (11). Then, the subject (4)
is caused to move in the reversed direction, i.e., the negative direction at Step
S33 (direction from right to left on the drawing, that is, the returning direction
toward the detectable region of the origin sensor (11)). Thus, as the subject (4)
keeps moving, the rotary encoder (2) again detects the Z phase, and then, the linear
encoder (5) detects the Z phase (Yes) at Step S35, whereby the subject's origin returning
operation is completed, and the subject (4) is stopped at Step S36.
[0046] Where the subject (4) is present at a position other than P3 and P4 when the power
supply is turned on, various patterns are possible depending on the position of the
subject (4) found at the time of starting the origin returning operation and depending
on the subject's moving direction. However, according to the present invention, only
by adding the condition: "the rotary encoder (2) should previously detect the Z phase"
to the condition of completing the subject's origin returning operation, various patterns
of operations are all successfully performed.
[0047] According to the subject's origin returning operation of the present embodiment,
by adding the above condition that the rotary encoder (2) should previously detect
the Z phase, the driving mode of the servo motor (1) is switched from the rectangular
waveform pulse driving to the sine waveform pulse driving at this point of time when
the rotary encoder (2) detects the Z phase. Therefore, the driving mechanism has no
problem in high-acceleration or - deceleration and high-speed driving for positioning
control after the completion of the subject's origin returning operation. Thus, the
problem the prior art has suffered from may be eliminated.
[0048] Next, a positioning-controlling apparatus and a positioning-controlling method according
to the second embodiment of the present invention are described With reference to
the accompanying drawings. The arrangement of the positioning-controlling apparatus
according to the present embodiment is similar to that of the prior art shown in Fig.
8. However, the subject's origin returning operation is carried out following the
flowchart shown in Fig. 4.
[0049] In the first embodiment, the condition: "the rotary encoder (2) should previously
detect the Z phase" is added to the condition of completing the subject's origin returning
operation by the servo driver (10). Alternatively, instead of the addition of the
above condition, the following method may be employed. That is, the subject's moving
direction for returning to the origin is predetermined, and the position of the origin
sensor (11), the position of the Z phase to be detected by the rotary encoder (2)
and the position of the Z phase to be detected by the linear encoder (5) are adjusted
based on the above predetermined moving direction. This adjustment makes it possible
for the rotary encoder (2) to detect the Z phase before the linear encoder (5) detects
the Z phase while the subject (4) is moving in the above predetermined direction within
the origin sensor's detectable region for the subject's origin returning. Thus, the
subject's origin returning is completed at a point of time when the linear encoder
(5) detects the Z phase. This arrangement is further described with reference to Figs.
3 and 4.
[0050] Referring to Fig. 3, the subject's moving direction for returning to the origin is
adjusted to be always of negative (right to left direction on the drawing), and adjustment
is made so that the rotary encoder (2) can first detect the Z phase before the linear
encoder (5) detects the Z phase, while the subject (4) is moving in the left direction
within the detectable region of the origin sensor (11).
[0051] The present embodiment is applied as follows. As shown in Fig. 3, one end of the
movable region of the subject (4) coincides with one end (the left-side end, in this
example) of the detectable region of the origin sensor (11). In other words, the condition:
"the origin position should be set at one end of the movable region of the subject
(4)" is added. The reason for this addition is described below. Referring to the example
shown in the drawing, if the origin sensor (11) is not arranged at the left-side end,
disadvantageously, the subject (4) is moved to the left, which is a direction causing
the subject (4) to move away from the origin sensor (11), because the above subject's
initial moving direction at the start of the origin returning operation is set to
negative.
[0052] For example, in case where the subject (4) is present at the position P5 outside
of the detectable region of the origin sensor (11), the detection of the ON state
of the origin sensor (11), the detection of the Z phase by the rotary encoder (2)
and the detection of the Z phase by the linear encoder (5) are achieved in this order
while the subject (4) is moving, because the predetermined subject's moving direction
for returning the origin is of negative. The condition: "the rotary encoder (2) should
previously detect the Z phase before the linear encoder (5) detects the Z phase" is
satisfied, and thus, the intended subject's origin returning operation can be completed.
[0053] Where the subject (4) is present at the position P6 within the detectable region
of the origin sensor (11) at the start of the subject's origin returning operation,
the subject's moving direction is first reversed from the predetermined subject's
origin returning direction, that is, the subject's moving direction is turned into
the positive direction (left to right direction on the drawing). The Z phase which
is first detected by the linear encoder (5) during this subject's moving is ignored
because the condition: "the rotary encoder (2) should previously detect the Z phase"
is not satisfied and the subject is not moving in the direction for returning to the
origin. Thus, the subject (4) is moved to go once out of the detectable region of
the origin sensor (11). After that, the subject's moving direction is again reversed
and turned into the negative direction (the direction for returning to the origin),
and the detection of the ON state of the origin sensor (11), the detection of the
Z phase by the rotary encoder (2) and the detection of the Z phase by the linear encoder
(5) are achieved in this order in the same manner as in the previous case where the
subject (4) is present at the position P5 at the start of the subject's origin returning
operation. Thus, the intended origin returning operation is completed.
[0054] The above operation is described with reference to the flowchart shown in Fig. 4.
[0055] At the start of the origin returning operation, it is decided at Step S40 whether
or not the subject is within the detectable region of the origin sensor (11). If the
subject is outside of the detectable region (No) (for example, the position P5), the
normal subject's origin returning operation is carried out. That is, the subject's
moving direction is the negative direction which is predetermined for returning to
the origin (Step S41), and the origin sensor (11) detects the detection piece (i.e.,
the ON state) at Step S44, the rotary encoder detects the Z phase at Step 547, and
the linear encoder detects the Z phase at Step S48 in this order, and thus, the subject's
origin returning is completed at Step S49. If the position of the subject (4) is within
the detectable region of the origin sensor (11) (Yes) (for example, the position P6)
at the start of the subject's origin returning operation at Step S40, the subject's
moving direction is reversed from the predetermined origin returning direction (turned
into the positive direction) at Step S42. Than, the subject is moved to once go out
of the detectable region of the sensor (11) (No) at Step S44, and the subject's moving
direction is again reversed (turned into the negative direction) at Step S46. After
that, the detection of the ON state of the origin sensor (11), the detection of the
Z phase by the rotary encoder (2) and the detection of the Z phase by the linear encoder
(5) are achieved in this order at Steps 544 to S48, respectively, and the subject's
origin returning is completed at step S49.
[0056] In the foregoing positioning control according to the present embodiment, the condition:
"the initial subject's moving direction at the start of the subject's origin returning
operation is predetermined (the negative direction in this example)" is added. Needless
to say, the subject's moving direction for returning to the origin may be set at positive,
and adjustment may be made so that the detection of the Z phase by the rotary encoder
(2) and the detection of the Z phase by the linear encoder (5) can be achieved in
this order while the subject (4) is moving in said reverse direction (i.e., the positive
direction).
[0057] Next, the third embodiment of the present invention is described with reference to
the accompanying drawings.
[0058] The arrangement of a positioning-controlling apparatus according to the present embodiment
is shown in Fig. 8, however, the origin returning operation in positioning control
by the controller (9) is carried out following the flowchart shown in Fig. 6. The
difference between the present embodiment and the first embodiment rests in that,
in the first embodiment, the driving mode is switched from the rectangular waveform
pulse driving to the sine waveform pulse driving upon the detection of the Z phase
by the rotary encoder (2) in the origin returning operation, while, in the present
embodiment, the driving mode is switched from the rectangular waveform pulse driving
to the sine waveform pulse driving upon the detection of the Z phase by the linear
encoder (5) after the detection of the Z phase by the rotary encoder (2).
[0059] This different point is described with reference to Figs. 5 and 6
[0060] An offset amount which is the distance the subject (4) moves from the position at
which the Z phase is detected by the rotary encoder (2) to the position at which the
Z phase is detected by the linear encoder (5) as shown in Fig. 5, and an offset direction
which is the direction of the above subject's moving are previously set and recorded
on the controller (9).
[0061] For example, when the subject (4) moves in the negative direction (right to left
direction on the drawing) from the position P7 shown in Fig. 5, the driving mods of
the motor is not switched to the sine waveform pulse driving at the position where
the rotary encoder (2) detects the Z phase (indicated by the notation X on Fig. 5
and Step S54 of the flowchart of Fig. 6), and the subject (4) keeps moving in the
negative direction under the rectangular waveform pulse driving condition. If the
subject's moving direction at this point of time coincides with the offset direction
shown in the drawing (right to left direction on the drawing) (indicated by Step S55
of the flowchart or Fig. 6), the driving mode is switched from the rectangular wavefom
pulse driving to the sine waveform pulse driving at the position where the linear
encoder (5) detects the Z phase (indicated by Step S56 of the flowchart on Fig. 6),
and the subject (4) stops moving. In this stage, when or just before the subject (4)
has moved by the previously recorded offset amount from the position where the rotary
encoder (2) detected the Z phase, the driving mode is switched to the sine waveform
pulse driving wherein the position at which the rotary encoder (2) detects the Z phase
corresponds to the timing of the rise of the sine waveform pulse.
[0062] Next, while the subject (4) is moving in the positive direction (left to right direction
on the drawing) from the position P8 shown in Fig. 5, the ON state of the origin sensor
(11) is first detected, and the subject (4) keeps moving even when the linear encoder
(5) detects the Z phase. This is because this detection of the Z phase by the linear
encoder (5) is done before the rotary encoder (2) detects the Z phase and this detection
is ignored as has already been described in the part of the first embodiment. Thus,
the subject (4) further moves in the positive direction, while the rotary encoder
(2) detects the Z phase. This detection of the Z phase by the rotary encoder (2) is
also ignored, because the subject's moving direction at this point of time is opposite
to the offset direction shown in the drawing (indicated by Step S55 of the flowchart
on Fig. 6). After that, the subject (4) further moves in the positive direction to
go out of the detectable region of the origin sensor (11), and then, the subject'
moving direction is reversed and the subject (4) moves in the negative direction (right
to left direction on the drawing). This subject's moving direction coincides with
the offset direction. Hereinafter, the operation is executed in the same manner as
in the former example in which the subject (4) moves from the position P7. That is,
the rotary encoder (2) detects the Z phase (indicated by the notation X), however,
the driving mode is not switched to sine waveform pulse driving, and the subject (4)
keeps moving in the negative direction still under the rectangular waveform pulse
driving, and the driving mode is switched from the rectangular waveform pulse driving
to the sine waveform pulse driving at the position at which the linear encoder (5)
detects the Z phase (indicated by Step S56 of the flowchart on Fig. 6). Thus, the
subject (4) stops moving.
[0063] The flowchart on Fig. 6 illustrating the above subject's origin returning operation
is different from the flowchart on Fig. 1 illustrating the first embodiment in that
Step S55 is added to the flowchart on Fig. 1. In detail, if, at Step S55, the subject
(4) moves in the direction opposite to the offset direction which is previously inputted
on the controller (9) (No), the detection of the Z phase by the rotary encoder (2)
at Step S54 (Yes) is ignored, and the subject (4) keeps moving. Then, when the subject's
moving direction is reversed at Step S53, and when this moving direction is the same
as the above offset direction, the rotary encoder first detects the Z phase at Step
S54 (Yes), and the subject (4) moves by the previously inputted offset amount. Then,
the linear encoder (5) detects the Z phase at Step S56 (Yes), and the origin returning
operation is completed at Step S57, The switching from the rectangular waveform pulse
driving to the sine waveform pulse driving is done at a timing when the linear encoder
(5) detects the Z phase at Step S56, or the subject (4) moved by the offset amount
after the rotary encoder detects the Z phase.
[0064] According to the subject's origin returning operation of the present embodiment,
the subject (4) is moved under the rectangular waveform pulse driving until the linear
encoder (5) detects the Z phase, and therefore, simple driving control is possible
until the subject (4) is stopped by the completion of the origin returning operation.
[0065] Although, in this embodiment, the offset amount which is the distance the subject
(4) moves from the position where the rotary encoder (2) detects the Z phase to the
position where the linear encoder (5) detects the Z phase is inputted, the position
where the rotary encoder (2) detects the Z phase or the position where the linear
encoder (5) detects the Z phase may be adjusted so that the offset amount can be any
predetermined amount (for example, zero).
[0066] Next, the fourth embodiment according to the present invention is described. The
present embodiment is to apply the positioning-controlling methods and the positioning-controlling
apparatuses of the first, second and third embodiments to a part-mounting method and
part-mounting equipment. As has been already described with reference to Fig. 7, in
the part-mounting equipment, a part taken out of the part-supplying unit (50) by the
mounting head (75) is carried by the robot (60) and mounted on a mounting position
on a circuit-formed material (82) regulated and held at a predetermined position by
the circuit-formed material-holding device (80). The part held by the mounting head
(75) is needed to be accurately positioned at the mounting position by the robot (60).
According to the present embodiment, a part-mounting method and part-mounting equipment
both capable of positioning the part with high reliability and stability are provided
by applying the positioning-controlling methods and the positioning-controlling apparatuses
of the foregoing embodiments to the X-direction driving unit or the Y-direction driving
unit, or both of them, which constitute the robot (60).
[0067] In this regard, other than the above part-mounting equipment, there is such index
type part-mounting equipment that can mount parts continuously and at high speed by
using an index which intermittently rotates a plurality of sucking nozzles which are
arranged circle-like on the robot (60). In this index type part-mounting equipment,
the positions on which the parts sucked by the sucking nozzles are to be mounted are
specifically determined, and therefore, the circuit-formed material-holding device
(80) for holding the circuit-formed material (82) is to be moved in the X or Y direction,
and the mounting position of the circuit-formed material (82) is positioned in accordance
with the specified position of the part. In this case, the positioning-controlling
apparatus and the positioning-controlling mechanism of each of the foregoing embodiments
may be applied to the mechanism for moving the circuit-formed material-holding device.
By doing so, highly reliable and stable part-mounting method and part-mounting equipment
can be provided. In another part-mounting equipment, for example, a part is moved
only in the direction X shown in Fig. 7, and a circuit-formed material is moved only
in the direction Y so as to position both the part and the circuit-formed material.
In this way, it is possible to make positioning by utilizing moving means for variously
combined patterns. The positioning-controlling methods and the positioning-controlling
apparatuses of the above embodiments also can be applied to such various types of
moving means.
[0068] In the positioning controls of the respective embodiments according to the present
invention described above, the position of the Z phase detected by the rotary encoder
(2) is defined as the electrical origin. However, the scope of the present invention
is not limited to this manner. For example, the positioning control of the present
invention can be applied to the method of detecting an electrical origin by using
only a CS signal as disclosed in Japanese Laid-Open Patent Publication No. 61-39885/1986.
That is, the following conditions may be added: a condition that the origin returning
operation should be completed after the electrical origin of a CS signal obtained
from the rotary encoder (2) (for example, timing of the rise of the pulse of CS1 shown
in Fig. 10 is defined as the origin) is detected in advance (the alternate of the
first embodiment), or a condition that the origin returning operation should be completed
by the following; the subject's moving direction for returning to the origin is fixed;
the electrical origin of a CS signal obtained from the rotary encoder is first detected
while the subject moves along this fixed direction; and then, the origin returning
operation is completed when the linear encoder (5) detects the Z phase (the alternative
of the second embodiment). By adding such a condition as above, there can be produced
a similar effect to those of the above embodiments in which the Z phase detected by
the rotary encoder (2) is defined as the electrical origin.
[0069] In the foregoing description, the application of the positioning control according
to the present invention is applied to the positioning control in part-mounting equipment.
However, the present invention is not limited to this, and the present invention can
be widely applied to general positioning controls in which subjects are carried to
predetermined positions for positioning control, such as positioning control of workpieces
in a transfer machine which sequentially conveys the workpieces and positions them
at predetermined positions for working them, positioning control of the components
of a precision instrument by an automatic assembling machine, etc.
[0070] According to the positioning-controlling apparatuses and the positioning-controlling
methods of the present invention, the subject's origin returning operation is completed
after the detection of the Z phase by the rotary encoder, and therefore, the subject's
origin returning operation can be completed under the condition where the servo motor
is surely driven according to sine waveform pulses. Therefore, the high-acceleration
and high-speed positioning operation following the completion of the subject's origin
returning operation can be performed under the sine waveform pulse driving from the
start. Thus, it becomes possible to avoid abnormal noises and pulsating velocity which
would be caused by discontinuous changes in torque in association with the switching
from the rectangular waveform pulse driving to the sine waveform pulse driving, as
is often the case with the conventional positioning-controlling apparatus.
[0071] Further, the above discontinuous changes in torque are eliminated from the multiple
axes of part-mounting equipment on which high-accuracy multi-axial synchronous control
is required to be made, and therefore, the frame which is synchronously controlled
together may not be twisted. Thus, no adverse influence is given on the accuracy and
the lifetime of the equipment.
[0072] By applying the positioning-controlling method or the positioning-controlling apparatus
of the present invention to a part-mounting method or part-mounting equipment, the
positioning of parts or a circuit-formed material is made with high reliability and
stability. Thus, there can be provided a part-mounting method or part-mounting equipment
capable of producing an electronic circuit substrate with high precision and stability
in positioning.
1. A positioning-controlling apparatus comprising a servo motor, a servo driver for controlling
the driving of the servo motor, a rotary encoder for detecting the rotation amount
of the servo motor, a moving mechanism driven by the rotation of the servo motor,
and a linear encoder for detecting the moving amount of the moving mechanism,
wherein said servo driver detects, from the rotary encoder, a CS phase necessary
for driving the servo motor and generates a current instruction with rectangular waveform
pulses which are obtained from the CS phase from the rotary encoder until the time
when the rotary encoder detects a Z phase or the linear encoder detects a Z phase,
and after the rotary encoder detects the Z phase or the linear encoder detects the
Z phase, generates a current instruction with sine waveform -pulses based on the Z
phase detected by the rotary encoder, thereby switching the driving mode of the servo
motor, and wherein at the time of turning on a power supply, said servo driver returns
a subject which is moved by the moving mechanism, to an origin which is the position
of the z phase detected by the linear encoder, and then, moves the subject to a required
position and stops it there for positioning,
characterized in that the rotary encoder detects the Z phase previously in the operation of returning the
subject to the origin.
2. The positioning-controlling apparatus according to claim 1, wherein said subject is
completely returned to the origin under the condition that, while said subject is
bsing moved by the moving mechanism to return to the origin, an origin sensor first
detects that said subject is being within a detectable region of the origin sensor,
and the rotary encoder detects the Z phase and the linear encoder detects the Z phase
in this order within said detectable region.
3. The positioning-controlling apparatus according to claim 1, wherein said subject is
not completely returned to the origin and continued to be moved under the condition
that, while said subject is being moved by the moving mechanism to return to the origin,
the origin sensor first detects that said subject is being within the detectable region
of the origin sensor, and the linear encoder detects the Z phase before the rotary
encoder detects the Z phase within said detectable region; and said subject is completely
returned to the origin under the condition that said subject is continued to be moved
to once go out of said detectable region and then moved to the reverse direction to
again enter said detectable region, so that the rotary encoder detects the Z phase,
and then the linear encoder detect the Z phase within said detectable region.
4. The positioning-controlling apparatus according to claim 1, wherein, when said subject
is moved by the moving mechanism to be returned to the origin, the subject's moving
direction for returning to the origin is predetermined, and wherein the origin sensor,
the Z phase to be detected by the rotary encoder and the Z phase to be detected by
the linear encoder are adjusted so that the origin sensor can first detect that said
subject is being within said detectable region, then the rotary encoder can detect
the Z phase, and then the linear encoder can detect the Z phase, while said subject
is moved along the predetermined direction.
5. The positioning-controlling apparatus according to claim 4, wherein in case one end
of the subject's movable region coincides with one end of said detectable region,
the Z phase to be detected by the linear encoder and the Z phase to be detected by
the rotary encoder are arranged so that first the rotary encoder detects the Z phase
and then the linear encoder detects the Z phase while said subject is moved toward
said one end of said detectable region from the other end thereof.
6. The positioning-controlling apparatus according to claim 5, wherein, when the position
of said subject at the start of the subject's origin returning operation is outside
of said detectable region, said subject is moved to a predetermined direction specified
as the moving direction for returning the origin, so as to be returned to the origin.
7. The positioning-controlling apparatus according to claim 5, wherein, when the position
of said subject at the start of the subject's origin returning operation is within
said detectable region, said subject is moved to a direction reverse to a predetermined
direction specified as the moving direction for returning the origin, so as to once
go out of said detectable region, and then moved to the reverse direction of said
predetermined direction, so as to be returned to the origin.
8. The positioning-controlling apparatus according to claim 1, wherein an offset amount
and an offset direction, which are the distance and the moving direction from the
position where the rotary encoder detects the Z phase to the position where the linear
encoder detects the Z phase are predetermined, and said servo driver switches the
driving mode according to the current instruction with rectangular waveform pulses
to the driving mode according to the current instruction with sine waveform pulses,
when said subject is moved to the offset direction by the offset amount from the position
where the rotary encoder detects the Z phase.
9. Part-mounting equipment comprising
a circuit-formed material-holding device for carrying and holding a circuit-formed
material,
a part-supplying unit for supplying parts,
a mounting head capable of taking a part out of the part-supplying unit and mounting
the part on the circuit-formed material,
a robot for carrying the mounting head, and
a controller for controlling the circuit-formed material-holding device, the part-supplying
unit, the mounting head and the robot,
whereby the part taken out of the part-supplying unit by the mounting head is mounted
on a predetermined mounting position of the circuit-formed material,
characterized in that either or both of the robot and the circuit-formed material-holding device comprise(s)
the positioning-controlling apparatus according to claims 1, in order to accurately
position the part at the predetermined mounting position of the circuit-formed material.
10. The part-mounting equipment according to claim 9,
wherein said robot or said circuit-formed material-holding device comprises a multi-axial
driving unit for synchronous operation using a plurality of servo motors, so as to
carry the mounting head or the circuit-formed material in a predetermined direction.
11. A positioning-controlling method comprising the steps of
driving a servo motor, which is a driving source for moving a subject, according
to a current instruction with rectangular waveform pulses obtained from a CS phase
detected by a rotary encoder until the time when the rotary encoder which detects
the rotation amount of the servo motor detects a Z phase or the linear encoder detects
a Z phase;
switching the driving mode of the servo motor to a driving mode according to a
current instruction with sine waveform pulses based on the Z phase after the rotary
encoder detects the Z phase or the linear encoder detects the Z phase;
once returning said subject to the origin which is the position of the Z phase
detected by the linear encoder which detects the moving amount of said subject, and
moving said subject to a required position so as to position said subject,
characterized in that a condition that the rotary encoder should previously detect the Z phase is added
to the condition of completing the subject's origin returning operation.
12. The positioning-controlling method according to claim 11, wherein, in the subject's
origin returning operation, the subject's moving direction for returning to the origin
is predetermined, and wherein the origin sensor, the Z phase to be detected by the
rotary encoder and the Z phase to be detected by the linear encoder are arranged so
that the origin sensor first detects that said subject is being within said detectable
region, and the rotary encoder detects the Z phase and the linear encoder detects
the Z phase in this order, while said subject is being moved to said predetermined
direction.
13. A part-mounting method comprising the steps of taking a part out of the part-supplying
unit, carrying the part to a mounting position of a circuit-formed material which
is regulated and held, positioning the part at the mounting position, and mounting
the part on the mounting position,
characterized in that the positioning-controlling method according to claim 11 is employed for positioning
either or both of a mounting head for holding and carrying the part and a holding
device for regulating and holding the circuit-formed material, in order to accurately
position said part at the predetermined mounting position of the circuit-formed material.