Drive Control System and Machine Control Device
A drive control system includes a drive control device, an auxiliary control device, and a physical-amount detecting device. The physical-amount detecting device detects a physical amount such as position information necessary for the machine control device to operate. The drive control device, the auxiliary control device, and the physical-amount detecting device are connected to each other with a data communication line. Physical amount detected by the physical-amount detecting device is directly transmitted synchronously in a constant cycle to one or both of the drive control device and an auxiliary control device through the data communication line.
Latest MITSUBISHI ELECTRIC CORPORATION Patents:
- USER EQUIPMENT AND PROCESS FOR IMPLEMENTING CONTROL IN SET OF USER EQUIPMENT
- SEMICONDUCTOR DEVICE AND METHOD OF MANUFACTURING SEMICONDUCTOR DEVICE
- PRE-EQUALIZED WAVEFORM GENERATION DEVICE, WAVEFORM COMPRESSION DEVICE, AND PRE-EQUALIZED WAVEFORM GENERATION METHOD
- POWER CONVERSION DEVICE AND CONTROL METHOD FOR POWER CONVERSION DEVICE
- SEMICONDUCTOR DEVICE, METHOD OF MANUFACTURING SEMICONDUCTOR DEVICE, AND POWER CONVERSION DEVICE
The present invention relates to a drive control system and a machine control device that is an important part of a drive control system that are used for a numerical control device and a robot, a semiconductor manufacturing device, and a mounting device of an electronic device.
BACKGROUND ARTA communication line 55 connected to a transmitting unit 60 of the numerical control device 50 is a downlink communication line, and a communication line 56 connected to a receiving unit 61 of the numerical control device 50 is an uplink communication line. The drive control device 51 includes a receiving unit 62 and a transmitting unit 63 connected to the downlink communication line 55, and a transmitting unit 64 and a receiving unit 65 connected to the uplink communication line 56. On the other hand, the drive control device 52 includes a receiving unit 66 connected to the downlink communication line 55, and a transmitting unit 67 connected to the uplink communication line 56.
The drive control device 51 is connected to a servomotor 82, and to an encoder 83 fitted to an end of a rotation axis of the servo motor 82. The drive control device 52 is connected to a servomotor 85, and to an encoder 86 fitted to an end of a rotation axis of the servomotor 85. The drive control devices 51 and 52 acquire control results about the servomotors 82 and 85 from the outputs of the encoders 83 and 86.
A table 88 of a machine tool or the like has ball screws 89 and 90. Those ball screws 89 and 90 can be used for controlling the movement or position of the table 88. The ball screw 89 is coupled to the rotation axis of the servomotor 82, and the ball screw 90 is coupled to the rotation axis of the servomotor 85.
In the drive control system shown in
The outline of the control operation is explained below. A communication cycle of the drive control devices 51 and 52 is 1/n (where n is an integer, and n=2 in the current example) of a communication cycle of the numerical control device 50. In the example of
The drive control device 51 controls the servomotor 82 based on a control instruction received by the receiving unit 62 from the numerical control device 50, and detection data received from the encoder 83. The drive control device 52 controls the servomotor 85 based on a control instruction received by the receiving unit 66 from the numerical control device 50 and detection data received from the encoder 86. The servomotors 82 and 85 drive the ball screws 89 and 90, so that the table 88, which is sitting on the ball screws 89 and 90, is moved to a position indicated in the control instructions.
The drive control device 52 transmits diagnostic data and detection data from the transmitting unit 67 to the uplink communication line 56. The diagnostic data is information such as current state, warning, and alarm. The detection data is information such as position, speed, and current detected at the time of controlling the servomotor 85. Because the drive control device 51 is disposed on the upstream of the drive control device 52, the diagnostic data and the detection data transmitted by the drive control device 52 to the uplink communication line 56 are received by the receiving unit 65 of the drive control device 51 directly, i.e., without passing through the numerical control device 50.
The drive control device 51 compares the detection data received by the receiving unit 65 with its own detection data and calculates a synchronization error based on the comparison. The drive control device 51 generates a synchronization-error-correction control instruction based on the calculated synchronization error, and transmits this instruction via the transmitting unit 63 and the downlink communication line 55 to the drive control device 52.
The receiving unit 66 of the drive control device are directly input to the image recognizing device having the pulse generation function, to carry out the shutter control of the camera 105, imaging, and image recognition.
Patent Document 1: Patent Republication No. 2002-52715
DISCLOSURE OF INVENTION Problem to be Solved by the InventionHowever, in the configuration shown in
In other words, in the configuration shown in
52 receives the synchronization-error-correction control instruction transmitted to the downlink communication line 55. The drive control device 52 drive controls the servomotor 85 to correct the instructed synchronization error.
Because of the difference in the communication cycles, during the time the numerical control device 50 transmits a control instruction once to the downlink communication line 55, the drive control device 52 transmits diagnostic data and detection data twice to the drive control device 51 via the uplink communication line 56, and the drive control device 51 transmits the synchronization-error-correction control instruction twice to the drive control device 52 via the downlink communication line 55.
As explained above, in the drive control system shown in
The position of a workpiece mounted on the table dynamically may change due to the environmental conditions. Therefore, it is necessary to correct the position instruction according to the current position of the workpiece, and it also is necessary to change the target position according to changes in the environmental conditions. It is possible to configure a drive control system that accurately carries out the position control of the table by performing image recognition on an image of the workpiece with an image recognizing device, as shown in
The instruction control device 101 is equivalent to the numerical control device 50 shown in
Specifically, the overall control device 100 sets parameters to the instruction control device 101 at the starting time of the control operation. The overall control device 100 also receives information about control results from the pulse generating device 103 and the image recognizing device 104, and sets parameters to the instruction control device 101.
Further, the instruction control device 101 transmits position instruction data 115 to drive control devices 1021 and 1022. Encoders 1091 and 1092 detect pulse and carries out the image control of the camera.
The above explains the following operation. During the move of the table 106 to a stop position set in advance, the image recognizing device 5 recognizes the position of the workpiece 110 from the image within an image area 111 picked up by the camera 105, and directly gives this position information to the instruction control device 2. The instruction control device 2 calculates a correction instruction from the position information of the workpiece 110, and transmits the correction position to the drive control devices 31 and 32. The operation is repeated in each communication cycle. With this arrangement, the drive control devices 31 and 32 drive control the motors 1081 and 1082 to rotate the ball screws 1071 and 1072, and move the table 106 until when the right end of the workpiece 110 reaches the line 112.
As can be understood from the operation example, the positioning control considering a series of positional correction achieved in the first embodiment can be executed, using only the machine control device 9 containing the instruction control device 2 and the physical-amount detecting device 11, and the first data-communication line group 8 and the second data-communication line group 10, without presence of the overall control device 1.
In this case, the communication speed of the second data-communication line group 10 is set faster than the communication speed of the first data-communication line group 8, and the physical-amount detecting device 11 detects and transmits a physical amount in a higher frequency than that of the control information such as a position instruction for controlling the machine control device 9. Therefore, a positioning control considering the series of positional correction can be carried out in high current positions of servomotors 1081 and 1082, and transmit these pieces of information as feedback-position instruction data 118 and 119, to the drive control devices 1021 and 1022. The drive control devices 1021 and 1022 transmit state data 116 of diagnostic data to the instruction control device 101.
The drive control devices 1021 and 1022 convert the feedback-position instruction data 118 and 119 received from the encoders 1091 and 1092 into feedback pulses 120 and 121 including pulse string signals, and output the feedback pulses 120 and 121 to the pulse generating device 103 and the image recognizing device 104.
The pulse generating device 103 and the image recognizing device 104 count the number of pulses of the feedback pulses 120, 121 to recognize the current positions of the current positions of servomotors 1081 and 1082, and carry out a predetermined operation based on the recognition.
In other words, the pulse generating device 103 counts the number of pulses of the feedback pulses 120, 121. When the count becomes a certain set value, the pulse generating device 103 generates a trigger pulse of the camera 105 attached to the image recognizing device 104 and a shutter pulse 122 of an illuminating device not shown, and gives the trigger pulse to the image recognizing device 104.
In the example shown in
The image recognizing device 104 carries out an instruction control device and the corrected-position instruction data needs to be transmitted to the drive control device, before the table reaches the positioning line. However, this operation is difficult in the example.
Further, when the number of each of the drive control device, the image recognizing device, and the pulse generating device increases, the amount of data that can be transmitted to the communication line and the transmission speed reach the upper limit, because the communication cycle and the communication line are fixed, even if each of the drive control device, the image recognizing device, and the pulse generating device has its own processing capacity. Consequently, the instruction control device cannot transmit position instruction data and state data to all the drive control devices within the time of the communication cycle.
In addition, when the rotation number of the servomotor increases, the frequency of the feedback pulse to the image recognizing device and the pulse generating device increases. Therefore, the quality of the pulse decreases, and there is influence of noise. Accordingly, the rotation number of the servomotor needs to be limited, and the transmission distance needs to be decreased.
In summary, the information of the encoder that generates a shutter pulse needs to be all transmitted to the pulse generating device at high speed. The drive control device needs to take in at high speed not only the information of the encoder of the own device but also the information of other encoder, and needs to carry out the positioning control by considering a difference of positions and variations in characteristics. For this purpose, detection information of a physical-amount detecting device such as an encoder needs to be directly image processing of the imaged data of the workpiece 110 imaged by the camera 105, thereby recognizing the position of the workpiece 110. In the example shown in
The control of stopping the table 106 based on the position of the workpiece 110 can be realized as follows. In the process that the drive control devices 102 and 1022 move the table 106 to the preset stop position, the image recognizing device 104 gives the shutter pulse to the camera 105, and transmits the position information of the workpiece 110 recognized by the image data of the workpiece 110 imaged by the camera 105 to the overall control device 100. The overall control device 100 gives the received position information to the instruction control device 101.
The instruction control device 101 calculates position instruction data 115 obtained by correcting the stop position based on the position information, and transmits the position instruction data 115 to the drive control devices 1021 and 1022. With this arrangement, the drive control devices 1021 and 1022 drive control the servomotors 1081 and 1082 to rotate the ball screws 1071 and 1072, and move the table 106 until when the right end of the workpiece 110 reaches the positioning line 112.
While the pulse generating device 103 is separated from the image recognizing device 104 in
While the table is simultaneously driven by the two-axis ball screws in
Furthermore, the overall control device manages the instruction control device, the image recognizing device, and the pulse generating device. Because various kinds of information are always exchanged via the overall control device, the load of the overall control device increases. Therefore, the overall control device cannot instantly control at high speed the feedback of the correction position recognized by the image recognizing device. In the example shown in
Not only information from the encoders to the physical-amount detecting device, but also the drive control device, and the pulse generating device, instruction information between higher control devices such as the image recognizing device, the overall control device, the instruction control device, and the drive control device needs to be transmitted efficiently at high speed. Therefore, for this purpose, information necessary for the drive control such as position instruction information and feedback position information needs to be transmitted efficiently at high speed between the overall control device, the instruction control device, the drive control device, the image recognizing device, the pulse generating device and the physical-amount detecting device such as an encoder.
However, in taking the measure described above, when the communication speed of each device such as an encoder increases and the number of devices (the number of motors) increases along the increase of the speed of drive control and increase of the number of axes, a set of data communication lines requires high-speed communication of feedback position information. Therefore, a substantial increase of communication speed of the data communication lines becomes necessary. As a result, communication quality of high-speed communication needs to be secured, and this results in cost increase.
Furthermore, the communication speed between the instruction control device and the drive control device can be slower than the communication speed between the drive control device and the physical-amount detecting device such as the encoder. Therefore, all communication lines do not need to be uniformly set to the same communication speed (cycle). The communication line between the devices in the drive control system is fixed, and there is limit to the communication line depending on the type of devices and processing content.
On the other hand, according to the drive control system disclosed in the Patent Document 1, two kinds of communication lines of the data transmitting communication line and the data receiving communication line are configured for the instruction control device, between the devices. Data communication is carried out in a constant communication cycle in these data communication lines. According to this communication cycle, when the number of devices (the number of motors) exceeds the capacity capable of handling data amount, the devices cannot carry out communication. Therefore, communication lines between the devices need to be built up from a new viewpoint.
To achieve the measure, a physical-amount detecting device such as an encoder, a limit switch, and an acceleration sensor needs to be able to communicate with other devices, not only to communicate with corresponding devices. However, according to the drive control system disclosed in the Patent Document 1, the physical-amount detecting device such as an encoder, a limit switch, and an acceleration sensor is configured to communicate with only the corresponding devices, and is not configured to directly communicate with other devices. Therefore, communication lines need to be built up from a new viewpoint.
The present invention has been achieved in view of the above problems, and it is an object of the present invention to obtain a drive control system and a machine control device capable of efficiently transmitting at high speed detection information of a physical-amount detecting device such as an encoder, with minimum transmission delay.
It is another object of the present invention to obtain an efficient drive control system and an efficient machine control device capable of decreasing the load of an overall control device.
It is still another object of the present invention to obtain a drive control system and a machine control device capable of transmitting information at high speed by decreasing the influence of noise, even when devices are disposed at a long distance from each other.
Means for Solving ProblemTo achieve the above objects, according to an aspect of the present invention; a drive control system includes an instruction control device that generates an instruction for drive controlling a motor which controls a drive shaft of an object to be controlled, a physical-amount detecting device that detects a physical amount such as position information and speed information of the controlled object changed by the drive shaft controlled by the motor, and a drive control device that generates a drive control signal to the motor based on the instruction generated by the instruction control device and the physical amount detected by the physical-amount detecting device. A data communication line is provided to connect between the physical-amount detecting device and the drive control device in parallel. The physical-amount detecting device converts detected physical amount into a communication data format, and transmits the communication data to the data communication line following a communication cycle prescribed by the data communication line, and the drive control device receives the physical amount data from the data communication line, following the communication cycle prescribed by the data communication line.
According to the present invention, the physical-amount detecting device such as an encoder can transmit detection information to the drive control device efficiently and at high speed, with minimum transmission delay.
EFFECT OF THE INVENTIONThe present invention has an effect of obtaining a drive control system capable of efficiently transmitting at high speed detection information of a physical-amount detecting device such as an encoder, with minimum transmission delay.
-
- 1 Overall control device
- 2, 20 Instruction control device
- 31, 32, 211, 212, 213 Drive control device
- 4 Pulse generating device
- 5 Image recognizing device
- 61, 62 Encoder
- 8 First data-communication line group
- 81, 82, 83, 84 to 8m First data-communication line
- 9 Machine control device
- 10 Second data-communication line group
- 101, 102, 103, 104 to 10n Second data-communication line
- 11, 111, 112, 113, 114 Physical-amount detecting device
- 12a, 12b, 12c, 12d, 12e Transmitting unit
- 13a, 13b, 13c, 13d, 13e Receiving unit
- 105 Camera
- 106 Table
- 1071, 1072 Ball screw
- 1081, 1082 Servomotor
- 110 Workpiece
- 111 Image area
- 112 Positioning line
- 23a, 23b, 23c, 23d, 23e, 23f, 23g, 23h Transmitting and receiving unit
- 24a, 24b, 24c, 24d, 24e, 24f, 24g, 24h Transmitting and receiving unit
- 25a, 25b, 25c, 25d, 25e, 25f, 25g, 25h Transmitting and receiving unit
- 26a, 26b, 26c, 26d, 26e, 26f, 26g, 26h Transmitting and receiving unit
- 27a, 27b, 27c Transmitting and receiving unit
- 30 Transmitting and receiving unit to first data-communication line group
- 31 Processing main unit
- 32 Transmitting and receiving unit to second data-communication line group
- 331 to 33m, 361 to 36n Transmission buffer
- 341 to 34m, 351 to 35n Receiving buffer
Exemplary embodiments of a drive control system and a machine control device according to the present invention will be explained below in detail with reference to the accompanying drawings.
First EmbodimentIn the present specification, main devices that constitute the drive control system, such as the instruction control device 2, the drive control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, are simply called a “machine control device”, except where these devices are required to be specifically called separately. In
The pulse generating device 4 and the image recognizing device 5 are positioned as auxiliary devices that support the overall drive control. Therefore, the pulse generating device 4 and the image recognizing device 5 are simply collectively called an “auxiliary control device”, except where these devices are required to be specifically called separately. However, the pulse generating device 4 and the image recognizing device 5 are one example of the auxiliary control device. When the drive control system is a robot system, a visual sensor (an image recognizing device) of the robot is the auxiliary control device. In other words, in the present invention, the auxiliary control device is an auxiliary device that processes physical amount data detected by various kinds of physical-amount detecting devices into feedback information to the instruction control device, to achieve drive control at high speed, flexibly, and in high precision.
Unlike in the conventional example (
Specifically, the communication data output from a transmitting unit 12a of the instruction control device 2 is taken into receiving units 13b, 13c, 13d, and 13e of the drive control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, respectively, via the first data-communication line group 81. The communication data output from transmitting units 12b, 12c, 12d, 12e of the drive control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, respectively are taken into a receiving unit 13a of the instruction control device 2, via the first data-communication line 82.
The drive, control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, and the encoders 61, excluding the instruction control device 2, out of the machine control device 9, and the encoders 61 and 62 as the physical-amount detecting device 11 can exchange communication data of a predetermined form to each other, via a second data-communication line group 10 including four data communication lines 101, 102, 103, and 104, respectively.
Specifically, the communication data output from a transmitting unit 18a of the encoder 61 is taken into receiving units 14a, 14b, 14c, and 14d of the drive control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, respectively, via the second data-communication line group 101. The communication data output from transmitting units 15a, 15b, 15c, 14d of the drive control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, respectively are taken into a receiving unit 19a of the encoder 61, via the second data-communication line 102.
The communication data output from a transmitting unit 18b of the encoder 62 is taken into receiving units 16a, 16b, 16c, and 16d of the drive control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, respectively, via the second data-communication line group 103. The communication data output from transmitting units 17a, 17b, 17c, and 17d of the drive control devices 31 and 32, the pulse generating device 4, and the image recognizing device 5, respectively are taken into a receiving unit 19b of the encoder 62, via the second data-communication line 104.
The control operation of the drive control system shown in
As shown in
In
In
On the other hand, the encoders 61 and 62 detect feedback positions of the servomotors 1081 and 1082. The encoder 61 transmits the detected feedback position data to the second data-communication line 101 in synchronism with the second cycle, and the encoder 62 transmits the detected feedback position data to the second data-communication line 103 in synchronism with the second cycle. Because the second communication cycle is shorter than the first communication cycle, the encoders 61 and 62 transmit plural feedback position data within the period of the first communication cycle.
In this case, the encoders 61 and 62 simultaneously transmit the feedback position data of the same content, that is, the feedback position data having the drive control devices 31 and 32 as destinations, and the feedback position data having the pulse generating device 4 and the image recognizing device 5 as destination.
In
The encoder 62 simultaneously-transmits feedback position data “j2−1”, “j2” and “j2+1”, that is, feedback position data (S3) having the drive control devices 31 and 32 as destinations, and feedback position data (S4) having the pulse generating device 4 and the image recognizing device 5 as destinations, to the second data-communication line 103.
Therefore, the drive control devices 31 and 32 can take in the feedback position data (S3) of the servomotors 1081 and 1082 that the encoders 61 and 62 detect and generate, in the same communication cycle as that in which the instruction control device 2 generates and transmits the (i) instruction (S1).
The drive control devices 31 and 32 simultaneously execute positioning controls (S5a), (S5b) based on the (i) instruction (S1), in the next communication cycle of the first data communication cycle in which the instruction control device 2 generates and transmits the (i) instruction (S1). In this case, the feedback position data (S3) of the servomotors 1081 and 1082 that the encoders 61 and 62 detect and generate can be reflected in the positioning control to be executed.
This is explained in detail below. In
In this respect, according to the first embodiment, as described above, the drive control devices 31 and 32 can take in the feedback position data (S3) of the servomotors 1081 and 1082 that the encoders 61 and 62 detect and generate, in the same communication cycle as that in which the instruction control device 2 generates and transmits the (i) instruction (S1). Therefore, the drive control device 31 can simultaneously obtain the information of the encoder 62 as well as the information of the encoder 61. The drive control device 32 can also operate in the similar manner.
Therefore, the drive control devices 31 and 32 can carry out the positioning control by considering the difference of control positions of the mutual servomotors and variations in characteristics. Because the encoders 61, 62 input feedback position data of each servomotor in high frequency, the drive control devices 31 and 32 can carry out the positioning control in high precision.
The pulse generating device 4 and the image recognizing device 5 can take in the feedback position data (S4) of the servomotors 1081 and 1082 that the encoders 61 and 62 detect and generate, in the same communication cycle as that in which the instruction control device 2 generates and transmits the (i) instruction (S1).
Therefore, the pulse generating device 4 and the image recognizing device 5 can control the camera 105 using the feedback position data (S4) of the servomotors 1081 and 1082 obtained from the encoders 61 and 62, to execute a correction position recognition process (S6) from the picked-up image of the workpiece 110, without a delay, in the first communication cycle as that in which the drive control devices 31 and 32 simultaneously carry out positioning controls (S5a), (S5b).
The operation is specifically explained below. The pulse generating device 4 monitors the feedback position data (S4), and generates a trigger pulse such as a shutter pulse of the camera 105 and an illuminating device attached to the image recognizing device 5 at a certain set value. In the example shown in
The image recognizing device 5 image processes the image of the workpiece 110 picked up with the camera 105 to execute the correction position recognizing process (S6) of the drive recognizing system that recognizes the position of the workpiece 110. In the example shown in
The correction position measured with the correction position recognizing process (S6) by the image recognizing device 5 is transmitted to the instruction control device 2 via the first data-communication line 82 (S7). The instruction control device 2 generates a (k) instruction (S8) as a correction position, in the communication cycle next to the first communication cycle in which the image recognizing device 5 executes the correction position recognizing process (S6). The instruction control device 2 transmits the correction position instruction to the drive control device 31 and the drive control device 32 via the first data-communication line 8, (S9). The drive control device 31 and the drive control device 32 simultaneously execute a (k) positioning control (S10a), (S10b) following the correction position instruction, in the communication cycle next to the first communication cycle in which the instruction control device 2 carries out the (k) instruction generation process (S8).
While the pulse generating device 4 is shown separately from the image recognizing device 5 in
As explained above, according to the first embodiment, a machine control device (a drive control device, an auxiliary control device) that constitutes a drive control system is connected and a physical-amount detecting device that detects a physical amount such as position information necessary for the machine control device to operate are connected to each other with a data communication line. Physical amount information detected by the physical-amount detecting device is directly synchronously transmitted to an optional machine control device on the data communication line in a constant cycle. Therefore, communication delay can be decreased, and physical amount information can be transmitted at high speed. Therefore, machine control devices (a drive control device, an auxiliary control device) that constitute a drive control system can cooperate with each other to carry out control synchronously at high speed.
In this case, machine control devices (an instruction control device, a drive control device, an auxiliary control device) are connected to each other by the first data-communication line group that synchronously transmit control information such as position instruction information, in a constant cycle. Each device of the machine control devices (the instruction control device excluded in
Each of the machine control devices and the physical-amount detecting device can directly exchange control information and physical amount information. Therefore, control information of other machine control device (for example, an image recognizing device, and a pulse generating device) does not need to be communicated via the overall control device, and the load of the overall control device can be decreased.
In addition, because the first data-communication line group and the second data-communication line group transmit data in the numerical data format of a predetermined format, communication errors can be easily processed. Quality degradation of a pulse signal does not occur in the direct transmission of a high-frequency pulse string signal, and noise influence is hardly present either. For example, position information from the encoder is directly transmitted as numerical data, without depending on the rotation number of the servomotor, to the pulse generating device or the image recognizing device, via the second data-communication line group. Therefore, problems of noise can be effectively avoided. Consequently, a transmission distance between devices can be decreased.
Second EmbodimentIn the drive control system shown in
The overall control device 1 communicates with only the instruction control device 20. The instruction control device 20 communicates with the drive control devices 211, 212, and 213 via the first data-communication line group 8. The first data-communication line group 8 includes four data communication lines 81, 82, 83, and 84. In other words, each of the instruction control device 20 and the drive control devices 211, 212, and 213 has a transmitting and receiving unit capable of individually accessing the four data communication lines 81, 82, 83, and 84.
In other words, the instruction control device 20 includes a transmitting and receiving unit 23a connected to the first data-communication line 81, a transmitting and receiving unit 23b connected to the first data-communication line 82, a transmitting and receiving unit 23c connected to the first data-communication line 83, and a transmitting and receiving unit 23d connected to the first data-communication line 84.
The drive control device 211 includes a transmitting and receiving unit 24a connected to the first data-communication line 81, a transmitting and receiving unit 24b connected to the first data-communication line 82, a transmitting and receiving unit 24c connected to the first data-communication line 83, and a transmitting and receiving unit 24d connected to the first data-communication line 84.
The drive control device 212 includes a transmitting and receiving unit 25a connected to the first data-communication line 81, a transmitting and receiving unit 25b connected to the first data-communication line 82, a transmitting and receiving unit 25c connected to the first data-communication line 83, and a transmitting and receiving unit 25d connected to the first data-communication line 84.
The drive control device 213 includes a transmitting and receiving unit 26a connected to the first data-communication line 81, a transmitting and receiving unit 26b connected to the first data-communication line 82, a transmitting and receiving unit 26c connected to the first data-communication line 83, and a transmitting and receiving unit 26d connected to the first data-communication line 84.
The second data-communication line group 10 includes four data communication lines 101, 102, 103, and 104. Each of the instruction control device 20 and the drive control devices 211, 212, and 213 has a transmitting and receiving unit capable of individually accessing the four data communication lines 101, 102, 103, and 104.
In other words, the instruction control device 20 includes a transmitting and receiving unit 23e connected to the second data-communication line 104, a transmitting and receiving unit 23f connected to the second data-communication line 103, a transmitting and receiving unit 23g connected to the second data-communication line 102, and a transmitting and receiving unit 23h connected to the second data-communication line 101.
The drive control device 211 includes a transmitting and receiving unit 24e connected to the second data-communication line 104, a transmitting and receiving unit 24f connected to the second data-communication line 103, a transmitting and receiving unit 24g connected to the second data-communication line 102, and a transmitting and receiving unit 24h connected to the second data-communication line 101.
The drive control device 212 includes a transmitting and receiving unit 25e connected to the second data-communication line 104, a transmitting and receiving unit 25f connected to the second data-communication line 103, a transmitting and receiving unit 25g connected to the second data-communication line 102, and a transmitting and receiving unit 25h connected to the second data-communication line 101.
The drive control device 213 includes a transmitting and receiving unit 26e connected to the second data-communication line 104, a transmitting and receiving unit 26f connected to the second data-communication line 103, a transmitting and receiving unit 26g connected to the second data-communication line 102, and a transmitting and receiving unit 26h connected to the second data-communication line 101.
On the other hand, each of the physical-amount detecting devices 111, 112, and 113 has one transmitting and receiving unit, and can access one of the four data communication lines 101, 102, 103, and 104. Specifically, in
Modes of data communication carried out by the drive control system shown in
As shown in
In
At the same time, the drive control devices 211, 212, and 213 monitor the transmission time of the own device within the first data communication cycle. When the transmission time of the own device comes, the drive control devices 211, 212, and 213 transmit the state data of the own device to the instruction control device 20 via the first data-communication line 82, in each first data communication cycle used by the instruction control device 20. As a result, the state data of each drive control device is transmitted in time division within the first data communication cycle. In other words, the “state data of the drive control device 211”, the “state data of the drive control device 212”, and the “state data of the drive control device 213” are repeatedly transmitted as a set, in the order of “i-th instruction data”, “(i+1)-th instruction data”, . . . , in each first data communication cycle used by the instruction control device 20.
On the other hand, the physical-amount detecting devices 111, 112, and 113 monitor the transmission time of the own device within the second data communication cycle, in each second data communication cycle. When the transmission time of the own device comes, the physical-amount detecting devices 111, 112, and 113 transmit the physical amount data (position data in the first embodiment) of the own device to the drive control devices 211, 212, and 213 via the second data-communication line 104. As a result, the position data of each physical-amount detecting device is transmitted by time division within the second data communication cycle. In other words, each physical-amount detecting device transmits the “j-th position data” by time division, and then transmits the “(j+1)-th position data” by time division in the next communication cycle, and repeats this process.
As explained above, according to the second embodiment, in
In the second embodiment, as a concrete example (1), the following operation is shown. As shown in
Because each machine control device constituting the drive control system includes a transmitting and receiving unit capable of individually accessing one or more second data-communication lines constituting the second data-communication line group that collect physical amount information, plural physical-amount detecting device each, including one transmitting and receiving unit, can select optimum one or more second data-communication lines corresponding to the data amount that can be transmitted at one time within the second communication cycle and the time interval of the second communication cycle.
In the second embodiment, as a concrete example (1), the following operation is shown. As shown in
Therefore, according to the second embodiment, even when the number of drive control devices increases, a drive control system can be realized in which each device cooperates to control driving at high speed in synchronization.
According to the data communication method of the second embodiment, while the instruction control device transmits position instruction information by exclusively using one data communication line between the instruction control device and plural drive control device, plural drive control devices can transmit state data by sharing one data communication line. Plural physical-amount detecting devices can also transmit physical amount data by sharing one data communication line. Therefore, while the four first data-communication lines are shown in
In the drive control system shown in
In other words, the transmitting and receiving unit 27a owned by the physical-amount detecting device 111 is connected to the second data-communication line 104. The transmitting and receiving unit 27b owned by the physical-amount detecting device 112 is connected to the second data-communication line 103. The transmitting and receiving unit 27c owned by the physical-amount detecting device 113 is connected to the second data-communication line 102.
Modes of data communication carried out by the drive control system shown in
As shown in
The physical-amount detecting device 111 transmits detected physical amount information to the drive control devices 211, 212, and 213, using the second data-communication line 104. The physical-amount detecting device 112 transmits detected physical amount information to the drive control devices 211, 212, and 213, using the second data-communication line 103. The physical-amount detecting device 113 transmits detected physical amount information to the drive control devices 211, 212, and 213, using the second data-communication line 102.
In
At the same time, the drive control devices 211, 212, monitor the transmission time of the own device in each first data communication cycle. When the transmission time of the own device comes, the drive control devices 211 and 212, transmit the state data of the own device to the instruction control device 20 via the first data-communication line 82, in each first data communication cycle used by the instruction control device 20. As a result, the state data of each drive control device is transmitted in time division within the first data communication cycle. In other words, the “state data of the drive control device 211”, and the “state data of the drive control device 212” are repeatedly transmitted as a set, in the order of the “i-th instruction data”, the “(i+1)-th instruction data”, . . . , in each first data communication cycle used by the instruction control device 20.
At the same time, the drive control device 213 monitors the transmission time of the own device in each first data communication cycle. When the transmission time of the own device comes, the drive control device 213 transmits the state data of the own device that is, “i-th state data”, “(i+1)-th state data”, . . . , repeatedly, to the instruction control device 20 via the first data-communication line 84, in each first data communication cycle used by the instruction control device 20.
On the other hand, the physical-amount detecting devices 111, 112, and 113 transmit position data to the drive control devices 211, 212, and 213, via the second data-communication line 104, in each second data communication cycle. The physical-amount detecting device 112 transmits position data to the drive control devices 211, 212, and 213, via the second data-communication line 103, and the physical-amount detecting device 113 transmits position data to the drive control devices 211, 212, and 213, via the second data-communication line 102. In other words, each physical-amount detecting device simultaneously transmits physical amount data (position data) using the three data communication lines in parallel.
As can be understood from
In this way, according to the third embodiment, while the auxiliary control device is not shown in
While this is similar to that of the second embodiment, according to the third embodiment, as a concrete example (2), the following operation is shown. The data amount that the instruction control device can transmit data to plural drive control devices is not the amount that can be transmitted at one time within the first communication cycle. Therefore, the instruction control device selects one of the first data-communication lines for transmission to the drive control device from the first data-communication line group, and transmits data to drive control devices having a large amount of data. On the other hand, the instruction control device selects the other first data-communication line for transmission to the drive control device from the first data-communication line group, and collectively transmits data at one time to a collected group of drive control devices having a small amount of data.
Out of the plural drive control devices, the drive control device having a large data transmission amount selects one first data-communication line for transmission to the instruction control device from the first data-communication line group. The drive control devices having a small data transmission amount select in a group the other first data-communication line for transmission to the instruction control device from the first data-communication line group, and transmit data at one time in time division, to the instruction control device.
Each machine control device constituting the drive control system includes a transmitting and receiving unit capable of individually accessing two or more data communication lines constituting the second data-communication line group for collecting physical amount information. Therefore, the plural physical-amount detecting devices, each including one transmitting and receiving unit, can optimally select one or more second data-communication lines, according to a data amount to be transmitted at one time within the second communication cycle, and a time width of the second communication cycle.
This is similar to that of the second embodiment. According to the third embodiment, as a concrete example (2), the following operation is shown. In
In this case, in the first data-communication line group and the second data-communication line group, the number of data communication lines increases from that in the second embodiment. However, the machine control device can collect more physical amount data than that according to the second embodiment, within the first communication cycle.
Therefore, according to the third embodiment, even when the number of drive control devices increases, a drive control system can be realized in which each device cooperates to control driving at high speed in synchronization, like in the second embodiment. The drive control can be carried out in high precision.
Fourth EmbodimentThe first data-communication line group 8 includes m first data-communication lines 81 to 8m, and the second data-communication line group 10 includes n second data-communication lines 101 to 10n.
The transmitting and receiving unit 30 for the first data-communication line group 8 includes m transmission buffers 331 to 33m, and m receiving buffers 341 to 34m for the m first data-communication lines 81 to 8m. Input ends of the transmission buffers are collectively connected to one first data-communication line group output port, and output ends of the receiving buffers are collectively connected to one first data-communication line group input port of the processing main unit 31.
The transmitting and receiving unit 32 for the second data-communication line group 10 includes n receiving buffers 351 to 35n, and n transmission buffers 361 to 36n for the n second data-communication lines 101 to 10n. Input ends of the transmission buffers are collectively connected to one second data-communication line group output port, and output ends of the receiving buffers are collectively connected to one second data-communication line group input port of the processing main unit 31.
In the machine control device having the configuration explained above, control information can be transmitted to and received from the first data-communication line group 8, by optionally selecting at least one first data-communication line, by individually conduction controlling the transmission buffers 331 to 33m and the receiving buffers 341 to 34m of the receiving unit 30. For example, by taking the control information of the first data-communication line 8m into the receiving buffer 34m, the processed control information can be transmitted from the transmission buffer 331 to the first data-communication line 81.
Control information can be transmitted to and received from the second data-communication line group 10, by optionally selecting at least one second data-communication line, by individually conduction controlling the transmission buffers 361 to 36n and the receiving buffers 351 to 35n of the receiving unit 32. For example, by taking the control information of the second data-communication line 10n into the receiving buffer 35n, the processed physical amount information can be transmitted from the transmission buffer 361 to the second data-communication line 101.
In
As explained above, according to the fourth embodiment, because a transmitting and receiving unit is provided in each data communication line at both or one of the first data-communication line group and the second data-communication line group, information of plural data communication lines can be simultaneously transmitted and received.
By controlling conduction of the buffer of the transmitting and receiving unit provided in each data communication line at both or one of the first data-communication line group and the second data-communication line group, information of an optional data communication line can be selected and received, and transmitted to other data communication line. Therefore, necessary information can be simultaneously transmitted to each machine control device.
Accordingly, when a drive control system is configured by optimally selecting a data communication line matching a kind of communication information, a communication cycle, and a communication direction, there is an effect of flexibly, efficiently and synchronously transmitting control information and physical amount information necessary for drive control, by suppressing system cost.
In the embodiment explained above, devices exchange signals at high speed via data communication lines in the drive control system including the auxiliary control device. However, the application of the present invention is not limited to this, and can be similarly applied to a drive control system which does not include the auxiliary control device, thereby obtaining similar effects.
The transmitting and receiving unit of the second data-communication line group in the physical-amount detecting device can have a configuration similar to that of the transmitting and receiving unit 32 of the second data-communication line group shown in
As described above, the drive control system and the machine control device according to the present invention are suitable for application to various mechatronic products that require drive control of a numerical control device, a robot, a semiconductor manufacturing device, and a mounting device of an electronic device.
Claims
1-16. (canceled)
17. A drive control system comprising:
- an instruction control device that generates an instruction for drive controlling a motor which controls a drive shaft of an object;
- a physical-amount detecting device that detects a physical amount including at least one of position information and speed information of the object as the drive shaft of the motor rotates based on the instruction;
- a drive control device that generates a drive control signal for controlling the motor based on the instruction and the physical amount;
- an auxiliary control device that generates displacement information of the object, which is required by the instruction control device to generate the instruction, based on the physical amount;
- a first data-communication line that connects the instruction control device and the drive control device in parallel, wherein when transmitting or receiving control information through or from the first data-communication line, the instruction control device and the drive control device transmit or receive the control information in a communication data format following a first communication cycle prescribed by the first data-communication line; and
- a second data-communication line that connects the physical-amount detecting device and the drive control device in parallel, the second data-communication line having a second communication cycle shorter than the first communication cycle, wherein the physical-amount detecting device converts the physical amount into a communication data format and transmits the communication data to the second data-communication line following the second communication cycle, and the drive control device receives the physical amount data from the second data-communication line following the second communication cycle.
18. The drive control system according to claim 17, wherein number of the first data-communication lines is determined based on at least one of a kind of data communicated by the instruction control device, the drive control device, and the auxiliary control device, a relationship between amount of data transmitted and a time width of the first communication cycle, and a communication direction.
19. The drive control system according to claim 17, wherein number of the second data-communication lines is determined based on a relationship between amount of data transmitted by a plurality of the physical-amount detecting devices and a time width of the second communication cycle.
20. The drive control system according to claim 17, wherein the first data-communication line includes a plurality of first data-communication lines, and
- each of the instruction control device, the drive control device, and the auxiliary control device includes a first transmitting/receiving unit capable of accessing the first data-communication lines, and the first transmitting/receiving unit transmits control data received from an arbitrary first data-communication line to another arbitrary first data-communication line.
21. The drive control system according to claim 17, wherein
- the second data-communication line includes a plurality of second data-communication lines, and
- each of the instruction control device, the drive control device, and the auxiliary control device includes a second transmitting/receiving unit capable of accessing each of the second data-communication lines, and the second transmitting/receiving unit transmits control data received from an arbitrary second data-communication line to another arbitrary second data-communication line.
22. The drive control system according to claim 17, wherein
- the second data-communication line includes a plurality of second data-communication lines, and
- the physical-amount detecting device includes a transmitting/receiving unit capable of individually accessing the second data-communication lines.
23. A machine control device comprising:
- an instruction control device that generates an instruction for drive controlling a motor which controls a drive shaft of an object;
- a physical-amount detecting device that detects a physical amount including at least one of position information and speed information of the object as the drive shaft of the motor rotates based on the instruction;
- a drive control device that generates a drive control signal for controlling the motor based on the instruction and the physical amount; and
- an auxiliary control device that generates displacement information of the object, which is required by the instruction control device to generate the instruction, based on the physical amount, wherein
- each of the instruction control device, the physical-amount detecting device, the drive control device, and the auxiliary control device includes a first transmitting/receiving unit that is capable of individually accessing a plurality of data communication lines for transmitting control data, and that receives control data from an arbitrary first data-communication line and transmits received control data to another arbitrary first data-communication line.
24. The machine control device according to claim 23, wherein each of the instruction control device, the physical-amount detecting device, the drive control device, and the auxiliary control device includes a second transmitting/receiving unit that is capable of individually accessing a plurality of second data-communication lines for transmitting physical amount data, the second transmitting/receiving unit receives physical amount data from an arbitrary second data-communication line and transmits received physical amount data to another arbitrary second data-communication line.
Type: Application
Filed: Mar 7, 2005
Publication Date: Aug 20, 2009
Applicant: MITSUBISHI ELECTRIC CORPORATION (Chiyoda-ku, Tokyo)
Inventor: Itsuo Seki (Tokyo)
Application Number: 11/794,613
International Classification: G05B 11/32 (20060101);