Board-to-board processing machine and amplifier
The system uses a communication-linked encoder and amplifier setup to quickly detect interference between movable parts in board-to-board working machines, addressing the challenge of increased speed-related interference.
Patent Information
- Application Number
- JP2021104087
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2021-06-23
- Publication Date
- 2024-12-09
- Estimated Expiration
- 2041-06-23
AI Technical Summary
In board-to-board working machines with multiple motors driving movable parts, interference between these parts can occur, especially when increasing the moving speed to enhance efficiency, making it difficult to quickly detect such interference.
A system comprising a first motor, a first encoder, a second motor, a second encoder, and amplifiers connected via a communication line, allowing the second amplifier to estimate and detect interference between movable parts based on position information from the first encoder and amplifier.
This configuration reduces the number of processing devices and shortens the time required to detect interference by enabling the second amplifier to directly acquire and estimate stop positions, thereby quickly identifying potential collisions.
Smart Images

Figure 0007596221000001 
Figure 0007596221000002 
Figure 0007596221000003
Abstract
Description
[Technical field]
[0001] The present application relates to a technique for detecting interference between multiple moving parts that are moved by a motor. [Background technology]
[0002] The following patent document describes an articulated robot that drives a working end along multiple working axes. In this articulated robot, when one joint of the working end is rotated, the occurrence of motion interference that causes the other joints to rotate is suppressed. [Prior art documents] [Patent documents]
[0003] [Patent Document 1] Japanese Patent Publication No. 61-245204 Summary of the Invention [Problem to be solved by the invention]
[0004] However, when a substrate-related operating machine has multiple motors as drive sources and drives multiple movable parts, interference between the multiple movable parts may occur. Furthermore, when the moving speed of each movable part is increased to improve the operating efficiency of each movable part, the moving speed of the movable parts becomes relatively fast compared to the processing time required for detecting interference, making it easier for interference to occur between the multiple movable parts. For this reason, a technology is needed that can detect interference between the multiple movable parts more quickly.
[0005] The present application has been made in view of the above-mentioned problems, and has an object to provide a substrate-related operating device and an amplifier that are capable of quickly detecting interference between a plurality of movable parts. [Means for solving the problem]
[0006] In order to solve the above problem, the present specification provides a method and apparatus for moving a substrate on a substrate, the method comprising: a first motor; a first movable part that moves along a first movement direction and a second movement direction based on the power of the first motor and performs a task on a substrate; a second motor; a second movable part that moves along the first movement direction and the second movement direction based on the power of the second motor and performs a task on the substrate; a first encoder that outputs first position information that is position information of the first movable part in the first movement direction and the second movement direction; a second encoder that outputs second position information that is position information of the second movable part in the first movement direction and the second movement direction; The present invention discloses a substrate-related operating machine comprising: a first amplifier that controls the power supplied to the second motor; a second amplifier that controls the power supplied to the second motor, is connected to the first amplifier by a communication line, acquires provided information related to the first position information from the first amplifier via the communication line, acquires a first stop position that is a stop position of the first movable part in the first movement direction and the second movement direction based on the provided information, estimates a second stop position that is a stop position of the second movable part in the first movement direction and the second movement direction based on the second position information acquired from the second encoder, and detects interference between the first movable part and the second movable part based on the first stop position and the second stop position. Furthermore, the contents of the present disclosure are not limited to being implemented as a substrate-related operating machine, and may also be usefully implemented, for example, as an amplifier provided in an apparatus having first and second movable parts, first and second motors, first and second encoders, and a first amplifier. Effect of the Invention
[0007] According to the substrate-related operating machine and amplifier of the present disclosure, the second amplifier controls the power supplied to the second motor, moves the second movable part, and acquires the provided information from the first amplifier via the communication line, and acquires the first stop position of the first movable part from the provided information. The second amplifier also estimates the second stop position of the second movable part based on the second position information acquired from the second encoder. The second amplifier then detects the interference between the first and second movable parts based on the first stop position and the estimated second stop position. This allows the second amplifier to directly acquire the provided information from the first amplifier of the first movable part and estimate the second stop position, thereby detecting the interference between the first and second movable parts. Compared to a configuration in which the second amplifier acquires the provided information from a control device or the like that controls the first amplifier, the number of processing devices through which the provided information is transmitted from the first amplifier to the second amplifier can be reduced. Furthermore, the second amplifier does not need to acquire the second stop position from another device by estimating the second stop position by itself. As a result, the processing time required for detecting interference can be shortened, and interference between multiple movable parts can be detected quickly. [Brief description of the drawings]
[0008] [Figure 1] FIG. 1 is a plan view showing a component mounting machine 10. [Diagram 2] FIG. 2 is a block diagram of the component mounting machine 10. [Diagram 3] 2 is a block diagram showing a connection configuration of first and second amplifiers 101 and 102. FIG. [Figure 4] 10 is a schematic diagram showing the state of the first and second mounting heads 26, 27 during mounting work. FIG. [Diagram 5] 13 is a schematic diagram showing the state of the first and second mounting heads 26, 27 when the Y coordinates of the central positions O1, O2 are the same. FIG. [Figure 6] 13 is a schematic diagram showing the state of the first and second mounting heads 26, 27 when the X coordinates of the central positions O1, O2 are the same. FIG. [Figure 7] 13 is a schematic diagram showing the state of the first and second mounting heads 26, 27 for explaining a formula in another example. FIG. [Figure 8]13 is a block diagram showing a connection configuration of first amplifiers 101A and 101B and second amplifiers 102A and 102B in another example. FIG. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0009] Hereinafter, a component mounting work machine 10, which is one embodiment of the substrate-related work machine of the present application, will be described in detail with reference to the drawings. FIG. 1 shows a plan view of the component mounting work machine 10 of this embodiment. FIG. 2 shows a block diagram of the component mounting work machine 10. The component mounting work machine 10 is a device that performs the work of mounting electronic components 13, 14 on a circuit board 12. As shown in FIGS. 1 and 2, the component mounting work machine 10 includes a board transport device 20, a moving device 22, a first mounting head 26, a second mounting head 27, a first supply device 28, a second supply device 29, etc.
[0010] The component mounting machine 10 also includes a first control board 40 and a second control board 41. The first control board 40 includes a first CPU 43, external IFs (abbreviation of interface) 45, 46, 50, a first controller 47, and a memory 48 (see FIG. 2). The first CPU 43, the external IFs 45, 46, 50, the first controller 47, and the memory 48 are connected to each other via a bus 49 so as to be able to communicate with each other. The second control board 41 also includes a second CPU 53, an external IF 56, a second controller 57, and a memory 58. The second CPU 53, the external IF 56, the second controller 57, and the memory 58 are connected to each other via the bus 59 so as to be able to communicate with each other. The memories 48 and 58 are, for example, storage devices such as RAM and ROM. The first control board 40 controls the substrate transport device 20, the first moving device 22A of the moving device 22, the first placing head 26, and the first supply device 28 by having the first CPU 43 execute a control program 48A stored in memory 48. Similarly, the second control board 41 controls the second moving device 22B, the second placing head 27, and the second supply device 29 of the moving device 22 by having the second CPU 53 execute a control program 58A stored in memory 58.
[0011] In the following description, the first CPU 43 that executes the control program 48A may be simply referred to as the "first CPU 43." For example, the statement "the first CPU 43 controls the first controller 47" means that "the first CPU 43 controls the first controller 47 by executing the control program 48A." The same applies to the second CPU 53.
[0012] The board transport device 20 holds the circuit board 12, which has been carried in from an upstream device in the production line, fixedly at a predetermined work position under the control of the first control board 40. When the first and second mounting heads 26, 27 finish mounting the electronic components 13, 14 on the circuit board 12 at the work position, the board transport device 20 transports the circuit board 12 to a downstream device. In the following description, as shown in FIG. 1, the transport direction in which the board transport device 20 transports the circuit board 12 is referred to as the X-axis direction, the direction parallel to the plane of the transported circuit board 12 and perpendicular to the X-axis direction is referred to as the Y-axis direction, and the direction perpendicular to both the X-axis direction and the Y-axis direction is referred to as the Z-axis direction.
[0013] The board transport device 20 is disposed on the upper surface of the base 16 of the component mounting work machine 10. The board transport device 20 includes, for example, a pair of conveyors 20A, 20B along the Y-axis direction. The conveyors 20A, 20B are disposed at a predetermined interval in the Y-axis direction to form a transport path 21 along the X-axis direction. The conveyors 20A, 20B rotate a conveyor belt based on the drive of a servo motor (not shown), and the conveyor belt transports the circuit board 12 in the transport direction along the transport path 21. The first controller 47 of the first control board 40 is connected to the board transport device 20 via a drive circuit 61. The drive circuit 61 includes an amplifier and the like that controls the servo motor of the board transport device 20. The first CPU 43 controls the first controller 47, and controls the servo motor of the board transport device 20 via the drive circuit 61.
[0014] The external IF 45 of the first control board 40 is connected to a touch panel 63 provided in the component mounting machine 10. The touch panel 63 is disposed, for example, on the outer wall of the component mounting machine 10, and changes the display content based on the control of the first control board 40. The touch panel 63 also outputs a signal according to an operation input from a user to the first control board 40. In particular, the component mounting machine 10 of this embodiment displays a warning on the touch panel 63 when it detects interference between the first and second mounting heads 26, 27, as described later. The external IF 46 is also connected to an external IF 56 of the second control board 41. The first control board 40 is capable of communicating with the second control board 41 via the external IFs 46, 56.
[0015] The moving device 22 includes a first moving device 22A and a second moving device 22B. The first moving device 22A is a device that moves the first mounting head 26 to any position in the X-axis, Y-axis, and Z-axis directions. Similarly, the second moving device 22B is a device that moves the second mounting head 27 to any position in the X-axis, Y-axis, and Z-axis directions. The second moving device 22B has the same configuration as the first moving device 22A. Therefore, in the following description, the first moving device 22A will be mainly described, and the description of the second moving device 22B will be omitted as appropriate.
[0016] The first movement device 22A is equipped with an X-slide mechanism 65, a Y-slide mechanism 66, and a Z-slide mechanism 67. The X-slide mechanism 65 is equipped with an X-axis linear motor 81 and an X-axis linear scale 82 (see FIG. 2). The Y-slide mechanism 66 is equipped with a Y-axis linear motor 83 and a Y-axis linear scale 84. The Z-slide mechanism 67 is equipped with a Z-axis linear motor 85 and a Z-axis linear scale 86.
[0017] Similarly, the second movement device 22B is equipped with an X-slide mechanism 69, a Y-slide mechanism 70, and a Z-slide mechanism 71. The X-slide mechanism 69 is equipped with an X-axis linear motor 91 and an X-axis linear scale 92. The Y-slide mechanism 70 is equipped with a Y-axis linear motor 93 and a Y-axis linear scale 94. The Z-slide mechanism 71 is equipped with a Z-axis linear motor 95 and a Z-axis linear scale 96.
[0018] The Y slide mechanism 66 of the first moving device 22A has a pair of guide rails along the Y axis direction. The pair of guide rails of the Y slide mechanism 66 extend parallel to each other along the Y axis direction above the base 16. Each of the pair of guide rails of the Y slide mechanism 66 is connected to each of the pair of guide rails of the Y slide mechanism 70 of the second moving device 22B.
[0019] The Y-axis linear motor 83 of the Y-slide mechanism 66 is, for example, a moving coil type linear motor, and includes two sets (pairs) of a combination of a stator (not shown) and a Y-axis slider 83A (movable element). Each of the pair (each set) of stators is provided on each of a pair of guide rails, and has a rail along the Y-axis direction and a plurality of permanent magnets arranged on the rail. Each of the pair of Y-axis sliders 83A is provided movably along the respective rails of the pair of stators, and a coil is provided at a position facing the permanent magnet of the stator. The Y-axis linear motor 83 is connected to the first controller 47 via a first amplifier 101. The first controller 47 controls the first amplifier 101 based on the control of the first CPU 43, controls the power supplied to the pair of Y-axis sliders 83A (coils) of the Y-axis linear motor 83, and changes the position of the pair of Y-axis sliders 83A.
[0020] Furthermore, the Y-axis linear scale 84 is connected to the first amplifier 101, and outputs position information according to the position of the Y-axis slider 83A in the Y-axis direction to the first amplifier 101. The Y-axis linear scale 84 has, for example, a non-detection section provided on the stator and a detection section provided on the Y-axis slider 83A, and outputs the position of the Y-axis slider 83A in the Y-axis direction as position information to the first amplifier 101. The method by which the Y-axis linear scale 84 detects the position information is not particularly limited, and for example, an optical detection method or an electromagnetic induction detection method can be adopted.
[0021] The first controller 47 changes the position of the Y-axis linear motor 83, i.e., the positions of the pair of Y-axis sliders 83A of the Y-axis linear motor 83, via the first amplifier 101 based on the control of the first CPU 43. The X-slide mechanism 65 has a guide rail extending along the X-axis direction. Both ends of the guide rail of the X-slide mechanism 65 in the X-axis direction are held by each of the pair of Y-axis sliders 83A. This allows the X-slide mechanism 65 to move to an arbitrary position in the Y-axis direction in response to the driving of the Y-axis linear motor 83 of the Y-slide mechanism 66.
[0022] Similarly to the Y-axis linear motor 83, the X-axis linear motor 81 of the X-slide mechanism 65 has a stator and an X-axis slider 81A (movable element), and moves the X-axis slider 81A along a guide rail (X-axis direction). The X-axis linear motor 81 is connected to a first amplifier 101, and the power supplied to the X-axis slider 81A is controlled by the first amplifier 101 to change the position of the X-axis slider 81A in the X-axis direction. The X-axis linear scale 82 is connected to the first amplifier 101, and outputs position information of the X-axis slider 81A in the X-axis direction to the first amplifier 101.
[0023] The Z-slide mechanism 67 is attached to the X-axis slider 81A. Therefore, the Z-slide mechanism 67 can move to any position in the X-axis direction and the Y-axis direction in response to the driving of the X-slide mechanism 65 and the Y-slide mechanism 66. The Z-axis linear motor 85 of the Z-slide mechanism 67 has a stator and a Z-axis slider 85A, similar to the Y-axis linear motor 83, for example, and moves the Z-axis slider 85A along the guide rail (Z-axis direction). The Z-axis linear motor 85 is connected to a first amplifier 101, and the power supplied to the Z-axis slider 85A is controlled by the first amplifier 101, and the position of the Z-axis slider 85A in the Z-axis direction is changed. In addition, the Z-axis linear scale 86 is connected to the first amplifier 101, and outputs position information of the Z-axis slider 85A in the Z-axis direction to the first amplifier 101. Therefore, the first amplifier 101 is a multi-axis amplifier that controls the X-axis linear motor 81, the Y-axis linear motor 83, and the Z-axis linear motor 85. The first amplifier 101 acquires position information from the linear scale in each axial direction and controls a linear motor in each axial direction.
[0024] In addition, the first placing head 26 is configured to be detachable from the Z-axis slider 85A. This allows the user to change to a different type of first placing head 26 by removing the first placing head 26 from the Z-axis slider 85A. In addition, the first placing head 26 moves to any position in the X-axis direction and the Y-axis direction in response to the driving of the X-slide mechanism 65 and the Y-slide mechanism 66. In addition, the first placing head 26 moves to any position in the Z-axis direction in response to the driving of the Z-slide mechanism 67.
[0025] Similarly, the second moving device 22B moves the second mounting head 27 to any position in the X-axis direction, Y-axis direction, and Z-axis direction based on the control of the second control board 41. Although details are omitted, the second controller 57 of the second control board 41 is connected to the Y-axis linear motor 93 and the Y-axis linear scale 94 via the second amplifier 102, and changes the position of the Y-axis slider 93A of the Y-axis linear motor 93. In addition, the second controller 57 is connected to the X-axis linear motor 91 and the X-axis linear scale 92 via the second amplifier 102, and changes the position of the X-axis slider 91A of the X-axis linear motor 91. In addition, the second controller 57 is connected to the Z-axis linear motor 95 and the Z-axis linear scale 96 via the second amplifier 102, and changes the position of the Z-axis slider 95A of the Z-axis linear motor 95. This allows the second mounting head 27 to be moved to any position in the X-axis, Y-axis, and Z-axis directions. Further, the second mounting head 27 is configured to be detachable from the Z-axis slider 95A.
[0026] The first mounting head 26 is provided with a plurality of suction nozzles that suction and hold the electronic components 13 in a removable manner. The first mounting head 26 is also provided with a positive and negative pressure supply device 111. The plurality of suction nozzles are connected to the positive and negative pressure supply device 111, and suction and hold the electronic components 13 when negative pressure is supplied from the positive and negative pressure supply device 111, and release the held electronic components 13 when positive pressure is supplied from the positive and negative pressure supply device 111. The positive and negative pressure supply device 111 is connected to a drive circuit 112 via a connector provided on the Z-axis slider 85A. The drive circuit 112 is connected to a first controller 47. The positive and negative pressure supply device 111 is controlled by the first control board 40 to supply positive pressure or negative pressure. This allows the first control board 40 to control the suction operation by the suction nozzles of the first mounting head 26.
[0027] Similarly, the second mounting head 27 is equipped with a positive / negative pressure supply device 121 and is capable of controlling the suction operation of a plurality of suction nozzles. The positive / negative pressure supply device 121 is connected to the second controller 57 via a drive circuit 122. This allows the second control board 41 to control the suction operation by the suction nozzles of the second mounting head 27.
[0028] The first mounting head 26 also includes a head motor 113. The head motor 113 is a motor that functions as a drive source for driving various devices provided in the first mounting head 26. Specifically, for example, the first mounting head 26 is provided with a nozzle holder that detachably holds each of the multiple suction nozzles. The head motor 113 is, for example, an R-axis motor that rotates (revolves) the entire nozzle holder, a Q-axis motor that rotates (spins) the multiple suction nozzles individually, or an elevation motor that raises and lowers the multiple suction nozzles individually. The head motor 113 is connected to a head amplifier 114 via a connector provided on the Z-axis slider 85A. The head amplifier 114 is connected to the first controller 47. This allows the first control board 40 to rotate, raise and lower the multiple suction nozzles of the first mounting head 26.
[0029] Similarly, the second mounting head 27 is provided with a head motor 123 that rotates the multiple suction nozzles. The head motor 123 is connected to the second controller 57 via a head amplifier 124. This enables the second control board 41 to rotate, raise and lower the multiple suction nozzles of the second mounting head 27.
[0030] Moreover, the first and second supply devices 28, 29 are disposed on both sides of the base 16 in the Y-axis direction. The first supply device 28 is disposed at a position opposite to the second supply device 29 with the transport path 21 of the substrate transport device 20 interposed therebetween in the Y-axis direction. The first supply device 28 is connected to the first controller 47 via the drive circuit 115, and the supply operation is controlled by the first controller 47. The second supply device 29 is connected to the second controller 57 via the drive circuit 125, and the supply operation is controlled by the second controller 57. The first supply device 28 is provided with a plurality of detachable tape feeders 130, and each of the second supply devices 29 is provided with a plurality of detachable tape feeders 132. Each of the plurality of tape feeders 130 contains a taped component in which the electronic component 13 is taped in a wound state. Each of the plurality of tape feeders 132 contains a taped component in which the electronic component 14 is taped in a wound state. Each of tape feeders 130, 132 feeds out taped components and supplies each of electronic components 13, 14 at a supply position (the position where electronic components 13, 14 are shown in FIG. 1). First placement head 26 sucks and holds electronic components 13 at the supply position of each of the multiple tape feeders 130. Similarly, second placement head 27 sucks and holds electronic components 14 at the supply position of each of the multiple tape feeders 132.
[0031] The component mounting machine 10, with the above-mentioned configuration, performs mounting work of electronic components 13, 14 on the circuit board 12 transported by the board transport device 20. Specifically, the board transport device 20 fixes and holds the circuit board 12 transported from an upstream device at a work position. The first and second supply devices 28, 29 supply the electronic components 13, 14 at the supply positions based on the control of the first control board 40 and the second control board 41, respectively. The first control board 40 controls the first moving device 22A to move, elevate, etc. the first mounting head 26, and sucks and holds the electronic component 13 from the tape feeder 130 and mounts it on the circuit board 12. Similarly, the second control board 41 controls the second moving device 22B to move, elevate, etc. the second mounting head 27, and sucks and holds the electronic component 14 from the tape feeder 132 and mounts it on the circuit board 12. When the mounting work by the first and second mounting heads 26, 27 is completed, the first control board 40 controls the board transport device 20 to transport the circuit board 12 to a downstream device.
[0032] The above-described configuration of the component mounting machine 10 is merely an example. For example, the component mounting machine 10 may be provided with a mark camera on the Z-axis sliders 85A, 95A that photographs the circuit board 12 from above. The component mounting machine 10 may also be provided with a parts camera on the base 16 that photographs the electronic components 13, 14 sucked and held by the first and second mounting heads 26, 27 from below. The component mounting machine 10 may also be configured to include three or more mounting heads.
[0033] As shown in FIG. 2, the first control board 40 is connected to the management PC 11 via the external IF 50. The external IF 50 is, for example, a LAN interface. The management PC 11 is, for example, a device for managing a plurality of substrate-related operation machines in a production line including the component mounting operation machine 10. For example, the first control board 40 acquires control programs 48A and 58A corresponding to the circuit board 12 to be produced from the management PC 11 via the external IF 50 in accordance with a change in the type of the circuit board 12 to be produced on the production line. The control programs 48A and 58A corresponding to the circuit board 12 to be produced here are programs (so-called recipes) that indicate the types of electronic components 13 and 14 to be mounted on the circuit board 12 to be produced, the positions at which they are to be mounted, and the like. The second control board 41 acquires the control program 58A corresponding to the circuit board 12 to be produced from the first control board 40 via the external IFs 46 and 56. The first and second control boards 40, 41 respectively control the first and second mounting heads 26, 27 based on control programs 48A, 58A to perform the mounting work.
[0034] The second control board 41 may be directly connected to the management PC 11 without the first control board 40, and may acquire the control program 58A from the management PC 11. The control programs 48A, 58A include a program for controlling each device of the component mounting machine 10 in addition to the recipe program. Each of the first and second control boards 40, 41 appropriately acquires the program for controlling each device from the management PC 11 during initial setup of the component mounting machine 10 or during system update. In the present application, acquisition is a concept including not only a process of requesting data transmission from the receiving side to the transmitting side and receiving the data, but also a process of receiving data without requesting transmission. Therefore, the first control board 40 may transmit the control programs 48A, 58A from the management PC 11 to the first control board 40 without the first control board 40 requesting the management PC 11, which is also described as acquisition by the first control board 40. This also applies to the following description.
[0035] (About estimated stopping position) Here, as described above, the component mounting machine 10 uses the first and second mounting heads 26, 27 to mount the electronic components 13, 14 on the circuit board 12. The first and second control boards 40, 41, for example, synchronize the start timing of the mounting operation through the external IFs 46, 56, and then independently control the first and second mounting heads 26, 27 to perform the mounting operation. The control programs 48A, 58A are set with the order and positions for mounting the electronic components 13, 14 so that the first and second mounting heads 26, 27 do not interfere with each other. Therefore, if the component mounting machine 10 is operating normally, the possibility of the first and second mounting heads 26, 27 coming into contact or colliding with each other (hereinafter, may be referred to as contact, etc.) during the mounting operation is extremely low.
[0036] However, there is a risk that the first and second mounting heads 26, 27 may come into contact with each other due to the occurrence of an unexpected event. An example of an unexpected event is a pickup error. When a supply error of the tape feeders 130, 132 causes the first and second mounting heads 26, 27 to be unable to pick up the electronic components 13, 14 and the pickup error is detected by the parts camera, the first and second mounting heads 26, 27 reacquire the electronic components 13, 14. Alternatively, the first and second mounting heads 26, 27 may drop the electronic components 13, 14 depending on the pickup posture, causing a pickup error. In such a case, the first and second mounting heads 26, 27 may move to a path or position different from that planned by the recovery operation, and may come into contact with each other.
[0037] Alternatively, the first and second control boards 40, 41 may perform an emergency stop of the first and second mounting heads 26, 27 due to detection of a communication error, detection of an abnormal current, etc. In such a case, the first and second mounting heads 26, 27 may stop at a position different from that planned and may come into contact with each other. Therefore, it is necessary to detect the possibility of contact, etc. between the first and second mounting heads 26, 27. In this application, the possibility of such contact or collision between multiple mounting heads is referred to as interference. Therefore, detecting interference means, for example, detecting the possibility of contact or collision between the first and second mounting heads 26, 27.
[0038] Furthermore, increasing the movement speed of the first and second mounting heads 26, 27 can shorten the mounting operation time, which in turn shortens the production time per circuit board 12. However, increasing the movement speed of the first and second mounting heads 26, 27 also increases the speed at which they approach each other. For this reason, when the above-mentioned unexpected situation occurs, it is necessary to detect interference more quickly.
[0039] In this embodiment, the second amplifier 102 communicates with the first amplifier 101 to detect interference. More specifically, FIG. 3 is a block diagram showing a connection configuration of the first and second amplifiers 101, 102. In FIG. 3, Z-axis linear motors 85, 95, etc. are omitted from illustration to prevent the drawing from becoming complicated. As shown in FIG. 3, for example, when the first CPU 43 of the first control board 40 determines the next destination position (hereinafter referred to as the destination position) of the first mounting head 26 based on the control program 48A during the mounting operation, it outputs the XY coordinates of the destination position to the first controller 47.
[0040] The XY coordinates referred to here are values indicating positions in the X-axis direction and the Y-axis direction. For example, the first and second CPUs 43, 53 set XY coordinates with a predetermined reference position on the base 16 of the component mounting machine 10 as the origin, and manage and process the positions of the first and second mounting heads 26, 27 using the XY coordinates from the common origin. Note that the first and second CPUs 43, 53 may control the first and second mounting heads 26, 27 using XY coordinates with origins at different positions.
[0041] The first controller 47 determines a target torque for operating the X-axis linear motor 81 and the Y-axis linear motor 83 based on the destination position acquired from the first CPU 43 and the current position of the first mounting head 26. The first controller 47 outputs the determined target torque to the first amplifier 101. The first amplifier 101 changes the power supplied to the X-axis linear motor 81 and the Y-axis linear motor 83 based on the target torque acquired from the first controller 47. Specifically, for example, the first amplifier 101 changes the value and cycle of a current flowing through the coil of the X-axis slider 81A to move the X-axis slider 81A with the target torque. In addition, the first amplifier 101 changes the value of a current flowing through the coil of the Y-axis slider 83A to move the Y-axis slider 83A with the target torque. The first amplifier 101 acquires a scale value ex1 from the X-axis linear scale 82 as position information in the X-axis direction, and acquires a scale value ey1 from the Y-axis linear scale 84 as position information in the Y-axis direction. The scale values ex1 and ey1 are values indicating the positions in the X-axis and Y-axis directions (XY coordinates) read by the respective detection sections of the X-axis linear scale 82 and the Y-axis linear scale 84.
[0042] The first amplifier 101 acquires the scale values ex1 and ey1 at every predetermined period. This period is a time stipulated by the product specifications of the first amplifier 101, the X-axis linear scale 82, etc., and the communication protocol between the first amplifier 101 and the X-axis linear scale 82, etc., and is, for example, 62.5 μs. The first amplifier 101 changes the current to be output based on the scale values ex1 and ey1, and changes the moving speed, acceleration, etc. of the first mounting head 26. The first amplifier 101 executes feedback control of the supply current based on the scale values ex1 and ey1, and matches the moving speed of the first mounting head 26 to a speed according to the target torque.
[0043] Further, the first controller 47 acquires the scale values ex1, ey1 via the first amplifier 101, and changes the target torque according to the acquired scale values ex1, ey1, i.e., the XY coordinates of the first mounting head 26. This allows the first controller 47 to move the first mounting head 26 to a desired destination position. When the first controller 47 detects based on the scale values ex1, ey1 that the first mounting head 26 has moved to the destination position acquired from the first CPU 43, it notifies the first CPU 43 of a movement completion notification. The first CPU 43 determines the next destination position of the first mounting head 26 based on the control program 48A, and executes an instruction to the first controller 47. Note that the change in the target torque according to the position of the first mounting head 26 described above may be executed by a device other than the first controller 47, for example, the first amplifier 101.
[0044] Similarly, the second CPU 53 of the second control board 41 outputs the XY coordinates of the destination position to the second controller 57 to control the movement operation of the second mounting head 27. Although details are omitted, the second controller 57 changes the target torque to be output to the second amplifier 102 based on the XY coordinates of the destination position acquired from the second CPU 53. The second amplifier 102 outputs the scale value ex2 of the X-axis linear scale 92 and the scale value ey2 of the Y-axis linear scale 94 to the second controller 57 while executing feedback control on the X-axis linear motor 91 and the Y-axis linear motor 93 according to the target torque. The first controller 47 acquires the scale values ex2 and ey2 via the second amplifier 102, and changes the target torque according to the acquired scale values ex2 and ey2, i.e., the XY coordinates of the second mounting head 27. This allows the second controller 57 to move the second mounting head 27 to the desired destination position.
[0045] Furthermore, when an unexpected event occurs during the control of the above-mentioned mounting operation, the first and second CPUs 43, 53 each execute a recovery operation or an emergency stop of the first and second mounting heads 26, 27. For example, the first and second CPUs 43, 53 notify the first and second controllers 47, 57 of a change in the destination position, and execute the stop of the first and second mounting heads 26, 27 or the change in the destination. Alternatively, the first and second controllers 47, 57 may detect some abnormality and change the target torque. When control is executed in response to such an unexpected event, the first and second mounting heads 26, 27 may move to or stop at a position different from the planned position.
[0046] The first amplifier 101 estimates the stop positions in the X-axis and Y-axis directions of the first mounting head 26 based on the scale values ex1 and ey1 while executing control over the X-axis linear motor 81 and the Y-axis linear motor 83. The first amplifier 101 outputs the estimated stop positions to the second amplifier 102 as provided information PI.
[0047] As described above, the first amplifier 101 acquires the position of the X-axis slider 81A in the X-axis direction from the X-axis linear scale 82 at every predetermined period as the scale value ex1. In this case, considering the X-axis direction, if the scale value acquired from the X-axis linear scale 82 at any time t is ex1(t), the scale value acquired one period before is ex1(t-1), and the acquisition period is T, then the speed Vx1(t) at which the first mounting head 26 (X-axis slider 81A) moves in the X-axis direction at time t is expressed by the following equation. Vx1(t)=(ex1(t)-ex1(t-1))*T (Formula 1) Equation (1) calculates the movement speed by multiplying the amount of displacement of the position in the X-axis direction by the time it takes to move by that amount of displacement (the interval for obtaining the scale value ex1).
[0048] In addition, if the scale value acquired at any time t is ex1(t), the moving speed at time t is Vx1(t), and the deceleration at which the first mounting head 26 (X-axis slider 81A) is decelerated when interference is detected is Ax1, the estimated stop position Px1(t) where deceleration begins at time t and the first mounting head 26 stops at the deceleration speed Ax1 is expressed by the following equation. Px1(t)=ex1(t)+Vx1(t)*Vx1(t) / 2Ax1 (Formula 2) ex1(t) is the position of the first mounting head 26 in the X-axis direction at time t. Vx1(t)*Vx1(t) / 2Ax1 is the distance traveled before stopping when the first mounting head 26 decelerates at a deceleration rate Ax1 from a state in which the first mounting head 26 is moving in the X-axis direction at a speed Vx1(t). The value of the deceleration rate Ax1 is set in advance in the first amplifier 101 by the first controller 47, for example.
[0049] The first controller 47 may change the deceleration Ax1 depending on the type of the first mounting head 26. The deceleration Ax1 may also be determined by the first amplifier 101. For example, the first amplifier 101 may change the deceleration Ax1 depending on the target torque at the start of deceleration. Although details will be described later, the first amplifier 101 may also execute a process of correcting the position (scale value ex1) of the X-axis slider 81A to the position (center position described later) of the first mounting head 26 for the above-mentioned estimated stop position Px1 (see FIG. 4).
[0050] The first amplifier 101 calculates an estimated stop position Px1 of the first mounting head 26 in the X-axis direction using the above-mentioned formulas (1) and (2). The first amplifier 101 also calculates an estimated stop position Py1 in the Y-axis direction using a formula similar to the above-mentioned formulas (1) and (2). The first amplifier 101 acquires a scale value ey1 from the Y-axis linear scale 84 at predetermined intervals, for example, and calculates a speed Vy1(t) of the first mounting head 26 moving in the Y-axis direction from the acquired scale value ey1. The first amplifier 101 calculates an estimated stop position Py1 of the first mounting head 26 in the Y-axis direction based on the scale value ey1(t), speed Vy1(t), and deceleration Ay1 at time t (see formulas (1) and (2)).
[0051] The first amplifier 101 also includes a network IF 135. The network IF 135 is connected to a network IF 137 of the second amplifier 102. The network IFs 135 and 137 are, for example, LAN interfaces and are connected to each other via a LAN cable 139. The first amplifier 101 transmits the calculated estimated stop positions Px1 and Py1 as the provided information PI to the second amplifier 102 via the LAN cable 139. The first amplifier 101 calculates the estimated stop positions Px1 and Py1, for example, every time the scale values ex1 and ey1 are acquired, that is, every cycle of acquiring the scale values ex1 and ey1, and transmits the provided information PI to the second amplifier 102. The communication method for transmitting the provided information PI can employ, for example, a predetermined packet communication using the TCP / IP protocol. The communication line using the LAN cable 139 is an example of the communication line of the present application.
[0052] The communication line of the present application is not limited to TCP / IP communication using the LAN cable 139. For example, a communication line using another communication method such as UART communication may be used. The first amplifier 101 may share the communication line for transmitting the provided information PI with a communication line for other data. For example, when the first amplifier 101 communicates with the first controller 47, the X-axis linear scale 82, etc. using an industrial network (for example, MECHATROLINK (registered trademark)-III) in communication of the scale values ex1 and ey1, the second amplifier 102 may be connected to the industrial network. Then, the first amplifier 101 may transmit the provided information PI to the second amplifier 102 via the industrial network. The communication line for transmitting the provided information PI is not limited to a wired line and may be a wireless line.
[0053] Similarly to the first amplifier 101, the second amplifier 102 calculates estimated stop positions Px2, Py2 of the second placing head 27. Although details will be omitted, the second amplifier 102 calculates the estimated stop position Px2 of the second placing head 27 in the X-axis direction based on the scale value ex2 acquired from the X-axis linear scale 92 while changing the position of the second placing head 27. Similarly to the first amplifier 101, the second amplifier 102 calculates the estimated stop position Px2, Py2 of the second placing head 27 in the Y-axis direction based on the scale value ex2 acquired from the Y-axis linear scale 94. For example, similar to the first amplifier 101, the second amplifier 102 estimates the estimated stop positions Px2, Py2 for each cycle in which the scale values ex2, ey2 are acquired. The second amplifier 102 detects interference between the first and second mounting heads 26, 27 based on the estimated stop positions Px1, Py1 acquired from the first amplifier 101 via the LAN cable 139 and the estimated stop positions Px2, Py2 estimated by the second amplifier 102. The second amplifier 102 acquires the estimated stop positions Px1, Py1 and determines interference each time it estimates the estimated stop positions Px2, Py2, that is, for each control period of the scale value ex1, etc. The second amplifier 102 may determine interference only when an unexpected situation such as the above-mentioned recovery operation or abnormal stop occurs.
[0054] The process of estimating the estimated stop positions Px1, Py1 may be executed by a device other than the first amplifier 101, for example, the second amplifier 102. For example, the first amplifier 101 may transmit the scale values ex1, ey1 to the second amplifier 102 as the provided information PI without estimating the estimated stop positions Px1, Py1. Then, the second amplifier 102 may calculate Vxt1(t) or the like based on the scale values ex1, ey1 acquired from the first amplifier 101 and the period for acquiring the scale values ex1, ey1 from the first amplifier 101, and estimate the estimated stop positions Px1, Py1. That is, the second amplifier 102 may estimate both the estimated stop positions Px1, Py1 and the estimated stop positions Px2, Py2 to detect interference. In this case, the information of the decelerations Ax1, Ay1 may be set in the second amplifier 102.
[0055] Alternatively, the first amplifier 101 may transmit information on the current scale values ex1, ey1, speeds Vx1, Vy2, and decelerations Ax1, Ay1 to the second amplifier 102. That is, the first amplifier 101 may perform the calculation of the above-mentioned formula (1) and transmit the calculated speeds Vx1, Vy2 together with the scale value ex1, etc. to the second amplifier 102 to estimate the estimated stop positions Px1, Py1. The first amplifier 101 may also detect interference. Alternatively, both the first amplifier 101 and the second amplifier 102 may detect interference.
[0056] (About interference determination process) Next, the detection of interference by the second amplifier 102 will be described. Fig. 4 shows a schematic diagram of the state of the first and second mounting heads 26, 27 during mounting work. For example, as shown in Fig. 4, the first and second mounting heads 26, 27 have a substantially rectangular shape with a predetermined width in the X-axis direction and the Y-axis direction when viewed in a plane in the Z-axis direction. In the following description, the position at the center of the first mounting head 26 in the XY coordinate system is referred to as the center position O1. Also, the position at the center of the second mounting head 27 in the XY coordinate system is referred to as the center position O2.
[0057] Also, the distance from the center position O1 to the end of the first mounting head 26 along the X-axis direction is defined as the X-axis head width Hx1. The X-axis head width Hx1 is, for example, the distance along the X-axis direction from the center position O1 to the outer peripheral surface (end) of the first mounting head 26. The above definition of the X-axis head width Hx1 is an example. For example, the X-axis head width Hx1 may be the distance between the end of the first mounting head 26 that protrudes most outward in the X-axis direction and a straight line that passes through the center position O1 and is parallel to the Y-axis direction. Similarly, the distance from the center position O1 to the end of the first mounting head 26 along the Y-axis direction is defined as the Y-axis head width Hy1. The distance from the center position O2 to the end of the second mounting head 27 along the X-axis direction is defined as the X-axis head width Hx2. The distance from the center position O2 to the end of the second mounting head 27 along the Y-axis direction is defined as the Y-axis head width Hy2.
[0058] The estimated stop positions Px1 and Py1 are the XY coordinates of the center position O1 of the first mounting head 26 at the stop position. Similarly, the estimated stop positions Px2 and Py2 are the XY coordinates of the center position O2 of the second mounting head 27 at the stop position. Here, since the estimated stop positions Px1 and Py1 are estimated based on the position of the X-axis slider 81A (scale value ex1) and the Y-axis slider 83A (scale value ey1) as described above, there is a possibility that a structural error occurs between the estimated stop positions Px1 and Py1 and the actual center position O1 of the first mounting head 26. For example, as shown in FIG. 4, the position indicated by the scale values ex1 and ey1 read from the X-axis linear scale 82 and the Y-axis linear scale 84 is the center position O1', which may differ from the actual center position O1 of the first mounting head 26. In such a case, the first amplifier 101 may perform correction of the estimated stop positions Px1 and Py1. Specifically, for example, the error between the central position O1′ and the central position O1 may be measured in advance on the vendor side, and a correction value may be set in the first amplifier 101.
[0059] The correction process of the estimated stop positions Px1, Py1 may be performed by the first amplifier 101 or the second amplifier 102. For example, when an error occurs between the scale value ey1 of the Y-axis linear scale 84 and the Y coordinate of the actual center position O1 due to a difference in the mounting positions of the Y-axis slider 83A and the first mounting head 26, the first amplifier 101 corrects the scale value ey1 to the center position O1 by a preset correction value. The first amplifier 101 may perform the correction process every time the estimated stop position Px1 is calculated. Alternatively, the correction process of the scale values ex1, ey1 may be performed in the reading process of the detection unit of the X-axis linear scale 82 or the Y-axis linear scale 84. That is, the X-axis linear scale 82, etc. may output the corrected scale values ex1, ex1 to the first amplifier 101. The same applies to the other scale values ey1, ex2, ey2. Moreover, instead of correcting the central position O1, the coefficients of the equations (3) and (4) for determining interference based on the central position O1, which will be described later, may be corrected.
[0060] Then, when both of the following two expressions (3) and (4) are satisfied, the second amplifier 102 determines that interference between the first and second mounting heads 26, 27 has occurred, that is, detects interference. |Px1-Px2| <Hx1+Hx2+αx ····(3) |Py1-Py2| <Hy1+Hy2+αy ····(4) 4, |Px1-Px2| in equation (3) is the absolute value of the distance between central positions O1 and O2 in the X-axis direction, i.e., the distance between the first and second mounting heads 26 and 27. |Py1-Py2| in equation (4) is the absolute value of the distance between central positions O1 and O2 in the Y-axis direction, i.e., the distance between the first and second mounting heads 26 and 27.
[0061] For example, Fig. 5 illustrates the first and second mounting heads 26, 27 when the Y coordinates (estimated stop positions Py1, Py2) of the central positions O1, O2 are the same. If the first and second mounting heads 26, 27 move in the X-axis direction from the state shown in Fig. 5 while keeping the Y coordinates the same, the first and second mounting heads 26, 27 will come into contact when the distance |Px1-Px2| between the two central positions O1, O2 in the X-axis direction becomes shorter to the sum of the two X-axis head widths Hx1, Hx2.
[0062] Similarly, Fig. 6 illustrates the first and second mounting heads 26, 27 when the X coordinates (estimated stop positions Px1, Px2) of the central positions O1, O2 are the same. If the first and second mounting heads 26, 27 move in the Y-axis direction from the state shown in Fig. 6 while keeping the X coordinates the same, the first and second mounting heads 26, 27 will come into contact when the distance (Py1-Py2) between the two central positions O1, O2 in the Y-axis direction becomes shorter to the sum of the two Y-axis head widths Hy1, Hy2.
[0063] When |Px1-Px2| < Hx1+Hx2 and |Py1-Py2| < Hy1+Hy2, the first and second mounting heads 26, 27 come into contact with each other. In other words, if either |Px1-Px2|>Hx1+Hx2 or |Py1-Py2|>Hy1+Hy2 is satisfied, ideally no contact or collision will occur. However, there is a possibility that contact will occur due to an error in the mounting position of the head or an error in the acceleration and deceleration control of the head. αx in the above formula (3) and αy in the above formula (4) are correction values for correcting so that the first and second mounting heads 26, 27 do not come into contact with each other due to, for example, an error in the mounting position or an error in the acceleration and deceleration control. Therefore, the correction values αx and αy can be set based on the above errors. The second amplifier 102 calculates the above-mentioned equations (3) and (4) based on the estimated stop positions Px1, Py1 obtained from the first amplifier 101 and the estimated stop positions Px2, Py2 estimated by the second amplifier 102 itself, and determines that interference has been detected if both equations (3) and (4) are satisfied.
[0064] As described above, the second amplifier 102 uses the X-axis head widths Hx1, Hx2, the Y-axis head widths Hy1, Hy2, and the correction values αx, αy as thresholds to determine the distance between the estimated stop positions Px1, Py1, Px2, Py2 and detect interference. The sizes and shapes of the first and second mounting heads 26, 27 differ depending on the types of the first and second mounting heads 26, 27. For this reason, the X-axis head widths Hx1, Hx2 and the Y-axis head widths Hy1, Hy2 are values that change depending on the types of the first and second mounting heads 26, 27.
[0065] The second CPU 53 of this embodiment sets the X-axis head widths Hx1, Hx2 and the Y-axis head widths Hy1, Hy2 in response to replacement of the first and second mounting heads 26, 27. In more detail, as described above, the first mounting head 26 is configured to be detachable from the Z-axis slider 85A (Z slide mechanism 67). Similarly, the second mounting head 27 is configured to be detachable from the Z-axis slider 95A (Z slide mechanism 71). For example, when the first mounting head 26 is replaced, the first CPU 43 detects the type of the replaced first mounting head 26 and transmits information on the detected type of the first mounting head 26 to the second CPU 53 via the external IFs 46, 56. The second CPU 53 sets the X-axis head widths Hx1 and the Y-axis head widths Hy1 in the second amplifier 102 in response to the type of the first mounting head 26 acquired from the first CPU 43. Furthermore, for example, when the second mounting head 27 is replaced, the second CPU 53 detects the type of the replaced second mounting head 27. The second CPU 53 sets the X-axis head width Hx2 and the Y-axis head width Hy2 in the second amplifier 102 according to the type of the second mounting head 27.
[0066] The method of detecting the types of the first and second mounting heads 26, 27 is not particularly limited, but for example, the first CPU 43 may read out identification information for identifying the head as information on the head type from the replaced first mounting head 26 via the Z-axis slider 85A. Similarly, the second CPU 53 may read out identification information from the replaced second mounting head 27 via the Z-axis slider 95A. Alternatively, the first CPU 43 may receive information on the types of the first and second mounting heads 26, 27 from the user via the touch panel 63. In this case, the first CPU 43 transmits the received information to the second CPU 53 via the external IFs 46, 56.
[0067] Also, for example, the memory 58 of the second control board 41 stores data in which identification information indicating the type of the first placement head 26 is associated with information on the X-axis head width Hx1 and the Y-axis head width Hy1. Also, the memory 58 stores data in which identification information of the second placement head 27 is associated with information on the X-axis head width Hx2 and the Y-axis head width Hy2. Then, the second CPU 53 determines the X-axis head width Hx1, etc. based on the detected head identification information and the data in the memory 58, and sets it in the second amplifier 102. Thereby, when at least one of the first and second placement heads 26, 27 is replaced, the thresholds of the X-axis head width Hx1, etc. that match the size of the replaced first and second placement heads 26, 27 can be set in the second amplifier 102. As a result, interference between the first and second placement heads 26, 27 can be detected with higher accuracy.
[0068] The second amplifier 102 may use the same fixed values as threshold values for the X-axis head width Hx1, etc., regardless of the types of the first and second mounting heads 26, 27. Furthermore, in addition to the X-axis head width Hx1, etc., the second amplifier 102 may also change the correction values αx, αy according to the types of the first and second mounting heads 26, 27. For example, if the error in the stop position increases due to an increase in the weight of the first and second mounting heads 26, 27, the correction values αx, αy may be changed to larger values.
[0069] Also, the second amplifier 102 may set the formula itself in addition to or instead of changing the thresholds of the formulas (3) and (4). As described above, each of the first and second control boards 40 and 41 is connected to the management PC 11 via the external IF 50, and downloads the entire control program 48A, 58A or updates a part of it. For example, each of the first and second control boards 40 and 41 newly downloads the control program 48A, 58A from the management PC 11 when the component mounting machine 10 is installed in a production factory and initial settings are performed. Alternatively, each of the first and second control boards 40 and 41 updates each of the control programs 48A, 58A based on data downloaded from the management PC 11 in response to program updates, etc. At this time, each of the first and second control boards 40 and 41 acquires the control program 48A, 58A corresponding to the type of the component mounting machine 10 from the management PC 11. When the component mounting work machine 10 acquires at least one of the control programs 48A, 58A, the second control board 41 may set an equation (called an interference judgment equation, such as the above-mentioned (3) and (4)) for determining interference based on the acquired control programs 48A, 58A.
[0070] For example, the control programs 48A, 58A are set with an interference determination formula corresponding to the control cycle and processing capacity of the first and second amplifiers 101, 102. For example, a person in charge of the vendor providing the control programs 48A, 58A sets data of the interference determination formula corresponding to the control cycle and processing capacity of the first and second amplifiers 101, 102 mounted on the component mounting machine 10 into the control programs 48A, 58A for the component mounting machine 10.
[0071] For example, in the above interference determination equations (3) and (4), the interference between the first and second mounting heads 26, 27 is determined using the linear distance. In contrast to this, interference may be detected by setting a circular area from the center position O1 as shown in Fig. 7. In this case, if a circular area 141 with a radius R1 centered on the center position O1 is set, the coordinates (x1, y2) within the area 141 are expressed by the following interference determination equation (5). (x1-Px1) 2 +(y1-Py1) 2 <R12 (5) The second amplifier 102 may determine, for example, whether or not the XY coordinates of each of the arbitrary determination positions 143 on the outer periphery of the second mounting head 27 satisfy formula (5). The determination positions 143 are positions that are set according to the shape, etc., of the second mounting head 27, and are positions that are likely to be entered first when the second mounting head 27 moves in the X-axis direction and the Y-axis direction and enters the region 141 of the first mounting head 26.
[0072] The second amplifier 102 sets the XY coordinates of each of the multiple judgment positions 143 based on, for example, the center position O2. The second amplifier 102 detects the occurrence of interference when the XY coordinates of at least one of the multiple judgment positions 143 satisfy the formula (5). In such a judgment method, the amount of calculation increases as the number of judgment positions 143 increases, that is, the processing load increases. On the other hand, depending on the shapes of the first and second mounting heads 26, 27, the accuracy of detecting interference may be improved compared to the above interference judgment formulas (3) and (4). Therefore, for example, the vendor's staff sets the data of the interference judgment formula (5) in the control programs 48A, 58A for the component mounting machine 10 of a model with a low control cycle and a high processing capacity of the first and second amplifiers 101, 102. In this way, the accuracy of detecting interference can be improved by setting the interference judgment formula more suitable for the control cycle and processing capacity of the first and second amplifiers 101, 102 in the control programs 48A, 58A. The second control board 41 does not have to set the interference determination equation based on the control programs 48A and 58A. For example, the second amplifier 102 may be configured to prohibit changes to the interference determination equation set in advance at the time of manufacture.
[0073] (About the behavior when interference is detected) The second amplifier 102, for example, acquires the estimated stop positions Px1, Py1 from the first amplifier 101, and determines interference using the above interference determination equations (3) and (4) each time it estimates an estimated stop position Px2, Py2. When the second amplifier 102 detects interference between the first and second mounting heads 26, 27, it controls the power supplied to the X-axis linear motor 91 and the Y-axis linear motor 93 to cause the X-axis linear motor 91 and the Y-axis linear motor 93 to generate a deceleration torque that decelerates the moving speed of the second mounting head 27.
[0074] Here, by cutting off the power supply to the movers, the X-axis linear motor 91 and the Y-axis linear motor 93 lose the driving force of the linear motors, and the movers move by inertia. The movers decelerate due to load torque (resistance force of the slider, etc.) and come to a stop. The second amplifier 102, for example, does not use such an inertial brake, but changes the current value, period, etc. of the current supplied to the movers, changes the magnetic poles of the movers, etc. to generate a deceleration torque between the movers and the stators, and actively decelerates the second mounting head 27. This makes it possible to prevent contact between the first and second mounting heads 26, 27, etc.
[0075] The second amplifier 102 may control the X-axis linear motor 91 or the like based on the detection of interference to generate deceleration torque, or may notify the second controller 57 of the detection of interference and generate deceleration torque based on the control of the second controller 57. For example, when the second controller 57 receives a notification of the detection of interference from the second amplifier 102, it changes the target torque to a torque value that generates deceleration torque and outputs the changed torque value to the second amplifier 102. This makes it possible to generate deceleration torque according to the change in the target torque. The second amplifier 102 may also execute a process of stopping the supply of power to the mover without executing the above-mentioned active brake control. That is, it may be stopped in a free-running state (a state in which the mover runs by inertia). The second amplifier 102 may also move the second placing head 27 to a retracted position where it does not interfere with the first placing head 26, for example, to a position closest to the tape feeder 132 in the X-axis direction, without stopping the second placing head 27. In addition, the second amplifier 102 executes control to generate deceleration torque only if the second mounting head 27 is moving when interference is detected, and if the second mounting head 27 is stopped, the second amplifier 102 may keep the second mounting head 27 stopped without executing torque control.
[0076] Furthermore, when the second amplifier 102 detects interference, it notifies at least one of the first amplifier 101, the second control board 41, and the head amplifier 124 of the detection of interference. For example, when the first amplifier 101 receives a notification of interference from the second amplifier 102, it generates a deceleration torque in the X-axis linear motor 81 and the Y-axis linear motor 83 to decelerate the first placing head 26, similar to the brake control of the second amplifier 102 described above. This makes it possible to more reliably prevent the first and second placing heads 26, 27 from coming into contact with each other, etc.
[0077] The first amplifier 101 may detect interference in its own device and decelerate the first mounting head 26. For example, the first and second amplifiers 101, 102 may exchange information such as an estimated stop position Px1. The first amplifier 101 may transmit the estimated stop positions Px1, Py1 to the second amplifier 102 as provided information PI, while the second amplifier 102 may also transmit the estimated stop positions Px2, Py2 to the first amplifier 101. Then, each of the first and second amplifiers 101, 102 may detect interference and stop each of the first and second mounting heads 26, 27.
[0078] Furthermore, for example, when the second control board 41 receives a notification of interference from the second amplifier 102, it notifies the first control board 40 of the interference via the external IFs 46, 56. When the first control board 40 receives the notification of interference from the second control board 41, it displays a message on the touch panel 63 indicating that interference has occurred and that the first and second mounting heads 26, 27 have been stopped. This makes it possible to notify the user of the occurrence of interference and prompt them to take appropriate action.
[0079] As described above, the head motor 123 is, for example, an R-axis motor that rotates the nozzle holder, a Q-axis motor that rotates the suction nozzle, and an elevation motor that raises and lowers the suction nozzle. The second amplifier 102 notifies the head amplifier 124 of the occurrence of interference via, for example, the second controller 57. Upon receiving the notification of interference, the head amplifier 124 controls the head motor 123 to stop the operation of the nozzle holder and the suction nozzle. This makes it possible to prevent the suction nozzle from coming into contact with other members (such as electronic components on the circuit board 12) due to an emergency stop. Similarly to the second amplifier 102, the first amplifier 101 may notify the head amplifier 114 of the occurrence of interference to stop the nozzle holder, etc.
[0080] As described above, the first amplifier 101 of the present embodiment estimates the estimated stop positions Px1, Py1 based on the scale values ex1, ey1 acquired from the X-axis linear scale 82 and the Y-axis linear motor 83. The second amplifier 102 acquires the estimated stop positions Px1, Py1 estimated by the first amplifier 101 from the first amplifier 101 as provided information PI. This allows the first amplifier 101 to estimate the estimated stop positions Px1, Py1 and then provide them to the second amplifier 102 as provided information PI, thereby reducing the processing load of the second amplifier 102 in detecting interference. Note that, as described above, the first amplifier 101 may transmit the scale values ex1, ex1, etc. to the second amplifier 102 as provided information PI, and the second amplifier 102 may estimate the estimated stop positions Px1, Py1 of the first mounting head 26.
[0081] The component mounting machine 10 also includes first and second control boards 40 and 41. The first control board 40 acquires scale values ex1 and ey1 of the X-axis linear scale 82 and the like via the first amplifier 101, and controls the first amplifier 101 based on the acquired scale values ex1 and ex1 to move the first mounting head 26. The second control board 41 acquires scale values ex2 and ey2 from the X-axis linear scale 92 and the like via the second amplifier 102, and controls the second amplifier 102 based on the acquired scale values ex2 and ey2 to move the second mounting head 27. In such a configuration in which the amplifiers are controlled by the control board, in this embodiment, interference is not judged or detected by the control board, but is processed by the second amplifier 102. This allows the estimated stop position Px1 and the like to be estimated at the stage when the scale value ex1 and the like are acquired by the first amplifier 101 or the second amplifier 102. The estimated stop position Px1 and the like can be estimated by shortening the time required to transfer the scale value ex1 and the like from the first amplifier 101 to the first controller 47 and the like. Estimation of the estimated stop position Px1, etc. can be started more quickly.
[0082] Furthermore, the second amplifier 102 acquires the provided information PI from the first amplifier 101 through the LAN cable 139, not via the first and second control boards 40, 41. This allows the provided information PI to be provided to the second amplifier 102 more quickly than when the provided information PI is transmitted from the first amplifier 101 to the second amplifier 102 through a higher-level device such as the first controller 47 or the first CPU 43. As a result, the processing time from acquisition of the scale value ex1, etc. to detection of interference can be further shortened. In other words, interference can be detected more quickly.
[0083] The component mounting machine 10 also includes a board transport device 20, and first and second supply devices 28, 29. The board transport device 20 transports the circuit board 12 along the transport path 21. The second supply device 29 is disposed on the opposite side of the first supply device 28 in the Y-axis direction, with the transport path 21 in between. The first mounting head 26 mounts the electronic components 13 picked up from the first supply device 28 onto the circuit board 12. The second mounting head 27 mounts the electronic components 14 picked up from the second supply device 29 onto the circuit board 12.
[0084] According to this, by operating each of the first and second mounting heads 26, 27 to perform mounting work on the circuit board 12, it is possible to shorten the mounting time for each electronic component 13, 14. In a component mounting machine 10 equipped with such multiple mounting heads, there is a risk that an unexpected situation will occur and interference will occur when the first and second mounting heads 26, 27 arranged on either side of the transport path 21 perform their work independently. Therefore, in a component mounting machine 10 equipped with such multiple mounting heads, it is extremely effective to detect interference using the second amplifier 102.
[0085] Incidentally, the component mounting work machine 10 is an example of a substrate-related work machine. The circuit board 12 is an example of a board. The electronic component 13 is an example of a first electronic component. The electronic component 14 is an example of a second electronic component. The board transport device 20 is an example of a transport device. The first mounting head 26 is an example of a first movable part. The second mounting head 27 is an example of a second movable part. The first control board 40 is an example of a first control device. The second control board 41 is an example of a second control device. The X-axis linear motor 81 and the Y-axis linear motor 83 are an example of a first motor. The X-axis linear motor 91 and the Y-axis linear motor 93 are an example of a second motor. The X-axis linear scale 82 and the Y-axis linear scale 84 are an example of a first encoder. The X-axis linear scale 92 and the Y-axis linear scale 94 are an example of a second encoder. The head motors 113 and 123 are an example of a third motor. The driving circuits 115, 125 are an example of a third amplifier. The scale values ex1, ey1 are an example of first position information. Communication through the LAN cable 139 is an example of a communication line. The scale values ex2, ey2 are an example of second position information. The estimated stop positions Px1, Py1 are an example of a first stop position. The estimated stop positions Px2, Py2 are an example of a second stop position. The X-axis direction and the Y-axis direction are an example of a first movement direction and a second movement direction.
[0086] As described above, the present embodiment has the following advantages. The second amplifier 102 of the component mounting machine 10 according to an embodiment of the present application controls the power supplied to the X-axis linear motor 91 and the X-axis linear scale 92 to move the second mounting head 27. While controlling the second mounting head 27, the second amplifier 102 acquires the provided information PI from the first amplifier 101 via the LAN cable 139, and acquires the estimated stop positions Px1, Py1 of the first mounting head 26 in the X-axis direction and the Y-axis direction from the provided information PI. The second amplifier 102 also estimates the estimated stop positions Px2, Py2 of the second mounting head 27 in the X-axis direction and the Y-axis direction based on the scale value ex2 acquired from the X-axis linear scale 92 and the scale value ey2 of the Y-axis linear scale 94. The second amplifier 102 then detects interference between the first and second mounting heads 26, 27 based on the estimated stop positions Px1, Py1, Px2, Py2.
[0087] According to this, the second amplifier 102 controls the power supplied to the X-axis linear motor 91 and the like, and while moving the second placing head 27, acquires the provided information PI from the first amplifier 101 via the LAN cable 139, and acquires the estimated stop positions Px1, Py1 of the first placing head 26 from the provided information PI. The second amplifier 102 detects interference based on the estimated stop positions Px1, Py1 and the estimated stop positions Px2, Py2 estimated by the second amplifier 102 itself. As a result, the second amplifier 102 directly acquires the provided information PI from the first amplifier 101 of the first placing head 26, and estimates the estimated stop positions Px2, Py2, thereby making it possible to detect interference between the first and second placing heads 26, 27 that move independently of each other. Compared to a configuration in which the second amplifier 102 acquires the provided information PI from the first control board 40 that controls the first amplifier 101, the number of processing devices through which the provided information PI is transmitted from the first amplifier 101 to the second amplifier 102 can be reduced. Furthermore, the second amplifier 102 estimates the estimated stop positions Px2, Py1 by itself, which eliminates the need for processing to obtain the estimated stop positions Px2, Py1 from another device. As a result, the processing time required for detecting interference can be shortened, and interference between the first and second mounting heads 26, 27 can be detected quickly.
[0088] Furthermore, the present disclosure is not limited to the above-described embodiments, but can be embodied in various forms with various modifications and improvements based on the knowledge of those skilled in the art. For example, in the above embodiment, multi-axis amplifiers (first and second amplifiers 101, 102) that control linear scales in the X-, Y-, and Z-axis directions are used as the first and second amplifiers of the present application. However, the first and second amplifiers of the present application may be configured to control only one axis direction. FIG. 8 shows a connection configuration of the first amplifiers 101A, 101B and the second amplifiers 102A, 102B in another example. In order to avoid cluttering the drawings, the amplifiers (Z-axis amplifiers) that control the Z-axis linear motors 85, 95 are omitted from the illustration.
[0089] As shown in Fig. 8, a first amplifier 101A controls an X-axis linear motor 81 based on a scale value ex1 of an X-axis linear scale 82. A first amplifier 101B controls a Y-axis linear scale 84 based on a scale value ey1 of a Y-axis linear motor 83. Similarly, a second amplifier 102A controls an X-axis linear motor 91, and a second amplifier 102B controls a Y-axis linear scale 94. That is, in the configuration shown in Fig. 8, an amplifier is provided corresponding to the linear motor and linear scale in each axial direction.
[0090] For example, when a single amplifier cannot read the scale values in the X, Y, and Z axis directions due to differences in communication protocols, each amplifier may be configured independently. In such a case, for example, the first amplifier 101A may estimate the estimated stop position Px1 and output it to the first amplifier 101B. The first amplifier 101B may estimate the estimated stop position Py1 and transmit the estimated stop positions Px1, Py1 to the second amplifier 102A via the LAN cable 139. That is, the first amplifier 101B of the Y axis may transfer data of the first amplifier 101A of the X axis to the second amplifier 102A of another second mounting head 27. Also, the second amplifier 102A may estimate the estimated stop position Px2 and transmit the estimated stop position Px2 estimated by the own device in addition to the estimated stop positions Px1, Py1 to the second amplifier 102B. The second amplifier 102B may detect interference based on all of the estimated stop positions Px1, Py1, Px2, and Py2. Which amplifier transfers the estimated stop position to which amplifier, and which amplifier judges interference, may be determined according to the processing power of each amplifier. For example, an estimated stop position or scale value may be transferred from an amplifier with low processing power to an amplifier with high processing power, and interference may be judged by the amplifier with the highest processing power. Even if such amplifiers are configured independently for each drive axis, the occurrence of interference can be quickly detected by directly transmitting and receiving data between the amplifiers.
[0091] In the above embodiment, linear motors such as the X-axis linear motor 81 are used as the first and second motors of the present application, but the motors of the present application are not limited to linear motors. For example, the first and second motors of the present application may be rotary motors (such as servo motors) equipped with a rotor and a stator. The first control board 40 and the second control board 41 may be configured as a single board. The second amplifier 102 acquires the provided information PI from the first amplifier 101 via the LAN cable 139, but the present invention is not limited to this. For example, the second amplifier 102 may acquire the provided information PI via the first amplifier 101, the first control board 40, and the second control board 41.
[0092] When the second amplifier 102 detects interference, it notifies at least one of the first amplifier 101, the second control board 41, and the head amplifier 124 of the detection of interference, but it is not necessary to notify them. In this case, the second amplifier 102 may execute only the stop control of the second mounting head 27, for example. Furthermore, the component mounting machine 10 may be configured to include three or more mounting heads. In this case, the above-described interference detection by the amplifier may be performed for any two of the mounting heads. Furthermore, the substrate-related operation machine in the present application is not limited to a component mounting operation machine that mounts electronic components 13, 14 on circuit board 12. For example, the substrate-related operation machine in the present application may be a solder application device that includes multiple squeegee units as movable parts and operates each movable part to apply solder to a circuit board. In this case, squeegee interference of the multiple squeegee units may be detected by an amplifier that operates the squeegee units, similar to the above-mentioned second amplifier 102. In the above embodiment, the component mounting machine 10 that mounts the electronic components 13, 14 on the circuit board 12 is used as the device equipped with the amplifier of the present application, but the present application is not limited to this. As the device equipped with the amplifier of the present application, various devices that have two movable parts, a first movable part and a second movable part, and move each movable part by driving a motor, and in which there is a risk of interference between the two movable parts, can be used. For example, as the device equipped with the amplifier of the present application, a system equipped with a set of articulated robots, a machine tool equipped with two or more chucks that hold turrets and workpieces, a transport device that moves two or more carriers, etc. can be used. In other words, the device equipped with the amplifier of the present application is not limited to a substrate-related operating machine. [Explanation of symbols]
[0093] 10 component mounting machine (substrate-related machine), 12 circuit board (substrate), 13 electronic component (first electronic component), 14 electronic component (second electronic component), 20 substrate transport device (transport device), 21 transport path, 26 first mounting head (first movable part), 27 second mounting head (second movable part), 29 second supply device, 29 second supply device, 40 first control board (first control device), 41 second control board (second control device), 81 X-axis linear motor (first motor), 82 X-axis linear scale (first encoder), 83 Y-axis linear motor (first motor), 84 Y-axis linear scale (first encoder), 91 X-axis linear motor (second motor), 92 X-axis linear scale (second encoder), 93 Y-axis linear motor (second motor), 94 Y-axis linear scale (second encoder), 101 first amplifier, 102 second amplifier, 113, 123 Head motor (third motor), 115, 125 drive circuit (third amplifier), 139 LAN cable (communication line), ex1, ey1 scale value (first position information), ex2, ey2 scale value (second position information), PI provided information, Px1, Py1 estimated stop position (first stop position), Px2, Py2 estimated stop position (second stop position).
Claims
1. A first motor; a first movable unit that moves along a first movement direction and a second movement direction based on power of the first motor and performs an operation on a substrate; A second motor; a second movable unit that moves along the first movement direction and the second movement direction based on power of the second motor and performs an operation on the substrate; a first encoder that outputs first position information that is position information of the first movable part in the first movement direction and the second movement direction; a second encoder that outputs second position information that is position information of the second movable part in the first movement direction and the second movement direction; a first amplifier that acquires the first position information from the first encoder and controls power supplied to the first motor; a second amplifier that controls power supplied to the second motor, is connected to the first amplifier via a communication line, acquires provided information related to the first position information from the first amplifier via the communication line, acquires a first stop position that is a stop position of the first movable part in the first movement direction and the second movement direction based on the provided information, estimates a second stop position that is a stop position of the second movable part in the first movement direction and the second movement direction based on the second position information acquired from the second encoder, and detects interference between the first movable part and the second movable part based on the first stop position and the second stop position; A substrate-related operating machine comprising:
2. The first amplifier is estimating the first stop position of the first movable part based on the first position information acquired from the first encoder; The second amplifier is The substrate-related operating apparatus according to claim 1 , wherein the first stop position estimated by the first amplifier is obtained as the provided information from the first amplifier.
3. a first control device that acquires the first position information from the first encoder via the first amplifier and controls the first amplifier based on the acquired first position information to move the first movable part; a second control device that acquires the second position information from the second encoder via the second amplifier and controls the second amplifier based on the acquired second position information to move the second movable part; The substrate-related operating machine according to claim 1 , further comprising:
4. The second amplifier is The substrate-related operating apparatus according to claim 3 , wherein the provided information is acquired from the first amplifier through the communication line without passing through the first control device and the second control device.
5. A third motor; a third amplifier that controls the power of the third motor; Further equipped with The second movable portion is performing an operation different from the movement in the first movement direction and the movement in the second movement direction based on the power of the third motor; The second amplifier is 5. The substrate-related operating machine according to claim 3, wherein when interference between the first movable part and the second movable part is detected, at least one of the first amplifier, the second control device, and the third amplifier is notified of the detection of interference.
6. The second amplifier is Detecting interference between the first movable part and the second movable part based on values of the first stop position and the second stop position and a predetermined calculation formula; The second control device is 6. The substrate-related operation machine according to claim 3, further comprising: a control program corresponding to a type of the substrate-related operation machine obtained from a management device; and a calculation formula for the second amplifier set based on the obtained control program.
7. The second amplifier is detecting interference between the first movable part and the second movable part based on a value based on the first stop position and the second stop position and a predetermined threshold value; The second movable portion is The substrate-related operation machine is provided so as to be detachable from the substrate-related operation machine. The second control device is 7. The substrate-related operating machine according to claim 3, further comprising: a step of: setting, after the second movable part is replaced, the threshold value used by the second amplifier in accordance with a type of the replaced second movable part.
8. The second amplifier is 8. The substrate-related operating machine according to claim 1, wherein when interference between the first movable part and the second movable part is detected based on the first stop position and the second stop position, a deceleration torque is generated in the second motor by controlling power supplied to the second motor to decelerate a moving speed of the second movable part.
9. A transport device that transports the substrate along a transport path; a first supply device that supplies a first electronic component; a second supply device that is disposed on the opposite side of the transport path from the first supply device and supplies a second electronic component; Further equipped with The first movable portion is mounting the first electronic component obtained from the first supply device onto the board; The second movable portion is The substrate-related operation apparatus according to claim 1 , further comprising: a second supply device that supplies the second electronic component to the substrate;
10. A first motor; a first movable portion that moves along a first movement direction and a second movement direction based on power of the first motor; A second motor; a second movable portion that moves along the first movement direction and the second movement direction based on power of the second motor; a first encoder that outputs first position information that is position information of the first movable part in the first movement direction and the second movement direction; a second encoder that outputs second position information that is position information of the second movable part in the first movement direction and the second movement direction; a first amplifier that acquires the first position information from the first encoder and controls power supplied to the first motor; An amplifier provided in an apparatus comprising: The amplifier is An amplifier that controls power supplied to the second motor, is connected to the first amplifier via a communication line, acquires provided information related to the first position information from the first amplifier via the communication line, acquires a first stop position that is a stop position of the first movable part in the first movement direction and the second movement direction based on the provided information, estimates a second stop position that is a stop position of the second movable part in the first movement direction and the second movement direction based on the second position information acquired from the second encoder, and detects interference between the first movable part and the second movable part based on the first stop position and the second stop position.
Citation Information
Patent Citations
Control system for multi-joint robot
JP1986245204A
Electronic part fixture
JP2009135268A
Electronic component mounting device
JP2011014592A
Transmission device and working robot
JP2018126838A
System for driving component mounting machine
WO2016166877A1
