This application claims the priority benefit of Japan Patent Application No. 2017-206492, filed on Oct. 25, 2017. The entirety of the above-mentioned patent application is hereby incorporated by reference herein and made a part of this specification.
The present disclosure relates to a technology for teaching an operation of a corresponding control target to each of a plurality of network-connected driving devices.
In a robot system including a plurality of robot controllers that control a plurality of respective robots, one teaching device (typically, a teaching pendant) is used for each robot controller in the related art (for example, Japanese Laid-Open No. 2000-288976) (see Patent Document 1). Therefore, when teaching to a plurality of robots is performed, a user needs to change a teaching device according to a robot controller that is a teaching target, and work efficiency is low.
As such a robot system, for example, Japanese Laid-Open No. 2017-77606 (Patent Document 2) discloses a robot system in which a teaching device is connected to a network to which a plurality of robot controllers are connected, and a communication destination of the teaching device can be switched so that any one of the robot controllers and the teaching device can selectively communicate in response to a connection request from each robot controller.
Further, Japanese Laid-Open No. 2006-130577 (Patent Document 3) discloses a robot system including a plurality of robots, a robot control device that controls at least one of the plurality of robots, and a teaching device connected to the robot control device.
In a configuration disclosed in Patent Document 2 described above, teaching to a plurality of robots can be performed by one teaching device, but it is necessary for the communication destination of the teaching device to be switched according to the robot controller that is a teaching target. Further, since there is only one robot controller that can be taught in one teaching, it is necessary for a user to perform teaching repeatedly according to the number of robot controllers. Therefore, there is a problem in that work efficiency is still low.
Further, in a robot system, for a plurality of robots in which it is necessary for operation timings to be synchronized with one another, operating the plurality of robots at the same time and performing teaching may be required. However, in the configuration disclosed in Patent Document 2, it is not possible to meet such a requirement.
In the configuration disclosed in Patent Document 3 described above, there is concern that the number of robots connected to the robot control device may be restricted by the hardware of the robot control device. Further, there is a problem in that a model of the robot connected to the robot control device is restricted by the hardware of the robot control device.
In one embodiment of the present disclosure, a control system for controlling a plurality of control targets is provided. The control system includes a plurality of driving devices that are connected to a network and drive the plurality of control targets; a control device that controls the plurality of driving devices via the network; and a teaching device for teaching operations of corresponding control targets to the plurality of driving devices. The teaching device transmits a command for driving the corresponding control target to at least one driving device among the plurality of driving devices via the network.
The present disclosure provides a control system capable of teaching operations of corresponding control targets to a plurality of driving devices connected to a network at the same time using a single teaching device.
According to the present disclosure, in the control system in which the plurality of driving devices and the control device for controlling the driving devices are connected via the network, the teaching device can transmit commands to the plurality of driving devices at the same time using the network. Accordingly, it is possible to perform teaching on the plurality of driving devices at the same time using a single teaching device. Therefore, it is possible to improve work efficiency as compared to a configuration of the related art in which driving devices that are teaching targets are selected one by one and then teaching is performed. Further, since the plurality of driving devices are connected to a so-called industrial network, the number of connectable driving devices is not restricted by hardware of the control device, unlike the configuration of the related art. For a model of the driving device, since a driving device can be connected as long as the driving device can be connected to the industrial network, the model is not restricted by the hardware of the control device. Further, according to the present disclosure, since the teaching device can give commands to the plurality of driving devices at the same time, it is possible to operate the plurality of driving devices of which the operation timings are required to be synchronized with one another at the same time and then perform teaching.
In the above disclosure, the teaching device is connected to a first driving device among the plurality of driving devices via a communication line, and output a command for a second driving device among the plurality of driving devices to the first driving device. The first driving device transmits the command for the second driving device to the second driving device via the network.
According to this disclosure, the teaching device can transmit the command to each of the plurality of driving devices using the network.
In the above disclosure, the teaching device is connected to the network and transmit a command for driving a corresponding control target to the driving device that is a target via the network.
According to this disclosure, the teaching device can transmit the command to each of the plurality of driving devices using the network.
In the above disclosure, the control device collects the command transmitted by the teaching device via the network and transmits the collected command to the driving device that is the target via the network.
According to this disclosure, the teaching device can transmit the command to each of the plurality of driving devices using exchange of data between the control device and each driving device, which is performed on the network.
In the above disclosure, the control device stores the collected command in an area of a communication frame allocated to the driving device that is a target, and transmits the communication frame via the network. When the driving device that is a target receives the communication frame, the driving device that is a target reads the command stored in the area allocated to the driving device that is a target.
According to this disclosure, the command can be transmitted to the driving device that is the target using the communication frame.
In the above disclosure, the control device and the plurality of driving devices include timers synchronized in time with one another. The control device determines a synchronization timing at which a signal corresponding to the command received in each of the plurality of driving devices is output, with reference to a time managed by the timer.
According to this disclosure, since the teaching device can give commands to a plurality of driving devices at the same time, it is possible to operate a plurality of driving devices of which the operation timings are required to be synchronized with one another at the same time and perform teaching.
In the above disclosure, the control device and the plurality of driving devices include timers synchronized in time with one another. The control device transmits a communication frame at predetermined intervals via the network. The teaching device transmits a command for the driving device that is the target and instructs a timing at which a signal corresponding to the command received in the driving device that is the target is output during a period in which the communication frame is not transferred.
According to this disclosure, the teaching device can transmit the command to the driving device that is the target using message communication. In this case, by notifying the driving device that is the target of the timing at which the signal corresponding to the command is output, it is possible to synchronize the output timings among the plurality of driving devices.
In the above disclosure, when the first driving device among the plurality of driving devices receives a command for driving a corresponding first control target from the teaching device, the first driving device determines a likelihood of collision between the first control target and a second control target due to execution of the command. When it is determined that there is a likelihood of collision, the first driving device stops the execution of the command and notifies the teaching device that the command is unable to be executed.
According to this disclosure, since data can be exchanged between the control device and the plurality of driving devices via the network, the driving device that is the target can determine a likelihood of collision between the subject device and another driving device on the basis of the relative positional relationship between the subject device and the other driving device in a situation in which a command is given from the teaching device to the driving device that is the target. Further, when it is determined that there is a likelihood of collision, the driving device that is the target can execute a process for avoiding collision.
In the above disclosure, when the first driving device among the plurality of driving devices receives a command for driving a corresponding first control target from the teaching device, the first driving device determines a likelihood of collision between the first control target and a second control target due to execution of the command, and transmits a collision avoidance command for the second driving device that drives the second control target to the control device via the network when it is determined that there is a likelihood of collision. The control device transmits a command including a corrected position of the second control target to the second driving device via the network when the control device receives the collision avoidance command.
According to this disclosure, since data can be exchanged between the control device and the plurality of driving devices via the network, the driving device that is the target can determine a likelihood of collision between the subject device and the other driving device on the basis of the relative positional relationship between the subject device and the other driving device in a situation in which a command is given from the teaching device to the driving device that is the target. Further, when it is determined that there is a likelihood of collision, the control device and the first and second driving devices can execute a process for avoiding collision in cooperation with one another.
In the above disclosure, the control system further includes a visual sensor including an imaging part connected to the network and disposed to image the plurality of control targets. The teaching device includes a display part that displays an image captured by the imaging part, the image being transferred from the visual sensor via the network, and an operation part that receives an operation for inputting a command for the driving device that is the target.
According to this disclosure, the teaching device can receive an image obtained by imaging the behavior of the control target from the visual sensor connected to the network, and cause the image to be displayed. Accordingly, the user can give a command to the driving target that is a control target while monitoring the behavior of the machine or facility that is the control target displayed on the teaching device. Thus, the user can teach a behavior of the control target difficult to visually see to the driving device.
In the above disclosure, the teaching device includes an operation part that receives an operation for inputting a stop command, and transmits the stop command to at least one driving device among the plurality of driving devices via the network.
According to the present disclosure, it is possible to output the stop command given from the teaching device to the plurality of driving devices via the network in an emergency state. Accordingly, it is possible to emergently stop the plurality of driving devices. The teaching device can emergently stop only a specific driving device set in advance by outputting the stop command only to the specific driving device.
In the above disclosure, the control system further includes a sensor device that is connected to the network and detects states of the plurality of control targets. The teaching device receives an output value of the sensor device via the network.
According to this disclosure, when the user moves the control target using the teaching device, the user can confirm that a sensor device has output a correct value for a behavior of the control target.
According to an embodiment of the present disclosure, it is possible to provide a control system capable of teaching operations of corresponding control targets to a plurality of driving devices connected to a network at the same time using a single teaching device.
Embodiments of the present disclosure will be described in detail with reference to the drawings. It should be noted that in the drawings, the same or corresponding parts are denoted by the same reference numerals, and description thereof will not be repeated.
First, an embodiment of a situation in which the present disclosure is applied will be described with reference to
The control device 100 corresponds to an industrial controller that controls control targets such as various facilities or devices. The control device 100 is a type of computer that executes a control calculation as will be described below and may be typically embodied as a programmable controller (PLC). The control device 100 may be connected to various field devices 500 via a field network 2 or the like. The control device 100 exchanges data with one or a plurality of field devices 500 via the field network 2. Generally, a “field network” is also referred to as a “field bus”, but in the following description, field networks are collectively referred to as a “field network” for simplicity of description.
The control calculation to be executed in the control device 100 includes a process of collecting data (hereinafter also referred to as “input data”) collected or generated in the field device 500 (an input process), a process of generating data such as a command to the field device 500 (hereinafter also referred to as “output data”) (a calculation process), a process of transmitting the generated output data to the field device 500 that is a target (an output process), and the like.
It is preferable for a bus or a network for performing periodic communication in which an arrival time of data is guaranteed to be adopted as the field network 2. EtherCAT (registered trademark), EtherNet/IP (registered trademark), DeviceNet (registered trademark), CompoNet (registered trademark), or the like is known for such a bus or network for performing periodic communication.
A configuration in which respective parts related to the data transfer include timers synchronized in time with one another is assumed when transfer of such field data is realized. That is, in a bus or a network, the respective parts perform transmission or reception of data at a timing that is designated using the timers synchronized in time with one another.
Any field device 500 can be connected to the field network 2. The field device 500 includes an actuator that gives a certain physical action to a manufacturing apparatus, a production line, or the like (hereinafter also referred to as a “field”), an input/output device that exchanges information with the field, and the like.
Data is exchanged between the control device 100 and the field device 500 via the field network 2, and the exchanged data is updated over very short periods in hundreds of μsec to tens of msec order. It should be noted that this process of updating the exchanged data is also referred to as an input and output refreshing process.
In the embodiment of the configuration illustrated in
A device that collects input data such as an input relay or various sensors (for example, an analog sensor, a temperature sensor, and a vibration sensor), and a device that gives some action to a field such as an output relay, a contactor, a servo driver, and any other actuators are also connected to the remote I/O device 510.
The servo drivers 520 drive the servo motors 522 according to output data (for example, a position command or a speed command) from the control device 100.
The robot controllers 530 perform trajectory calculation, angle calculation for each axis, or the like according to, for example, a position command from the control device 100, and drives servo motors or the like constituting the robots 532 and 534 according to calculation results. In the embodiment of a configuration illustrated in
The visual sensor 540 has a configuration in which an imaging part 542 for imaging a machine or facility that is a control target and a subject such as a workpiece, and an image processing part (not illustrated) for processing an image captured by the imaging part 542 are integrated. However, the imaging part 542 and the image processing part may be configured to be separate.
The control device 100 is also connected to other devices via a high-level network 3. Ethernet (registered trademark) or EtherNet/IP (registered trademark) which is a general network protocol may be adopted as the high-level network 3. More specifically, one or a plurality of server devices 300 and one or a plurality of display devices 400 may be connected to the high-level network 3.
The server device 300 is assumed to be a database system, a manufacturing execution system (MES), or the like. The present disclosure is not limited thereto, and a device providing an information-based service may be connected to the high-level network 3. A process of acquiring information from the manufacturing apparatus or facility that is a control target and performing macroscopic or microscopic analysis, or the like is assumed as the information-based service.
The display device 400 receives an operation from the user, outputs a command according to the operation of the user to the control device 100, and graphically displays calculation results in the control device 100, or the like.
A teaching pendant 200 can be connected to the robot controllers 530 which are driving devices of the robots 532 and 534 and the servo drivers 520 which are driving devices of the servo motors 522. The teaching pendant 200 is a device for teaching an operation of the machine or facility that is a control target to the driving device. Specifically, the teaching pendant 200 displays image data from the visual sensor 540, an operation state of the control target from the driving device, and the like, and gives various commands to the driving device in response to an operation of the user. The user can move the control target to a position required for calibration or the like by operating the teaching pendant 200 while referring to the display of the teaching pendant 200.
In the embodiment of the configuration illustrated in
The teaching pendant 200 outputs a command or the like according to a user operation to the robot controller 530. This command includes a position command indicating a target position of the robot 534 that is a control target of the robot controller 530, a speed command indicating a target speed of the robot 534, and the like.
In the control system 1 according to the embodiment, the teaching pendant 200 can further output a command to at least one driving device connected to the field network 2 via the field network 2. A case in which a command is output to a plurality of driving devices (the robot controller 530 and the servo drivers 520) other than the driving device (the robot controller 530) that is a connection destination of the teaching pendant 200 is exemplified in
That is, the teaching pendant 200 can output commands to the plurality of driving devices (the robot controllers 530 and the servo drivers 520) at the same time using the field network 2. Accordingly, the user can teach operations of the corresponding control targets to the plurality of driving devices connected to the field network 2 at the same time using the single teaching pendant 200.
The teaching pendant 200 also receives the image captured by the imaging part 542 of the visual sensor 540 via the field network 2 and the driving device (the robot controller 530) that is the connection destination. The teaching pendant 200 can display the received image on the display part.
The display part 203 includes, for example, a liquid crystal display (LCD) or an organic electro luminescence (EL), and displays an image according to a key operation of the user. The display part 203 can further display the image captured by the imaging part 542 of the visual sensor 540. In the embodiment of the configuration illustrated in
That is, when the teaching pendant 200 executes a command for the machine or facility that is the control target, the teaching pendant 200 can control the display part 203 so that a behavior of the control target and the command for the control target are displayed on the same screen. Thus, the user can confirm the behavior of the control target and the command realizing the behavior on the same screen. The user can further register a position of the control target by operating the operation part 204. The user can also program the operation or work of the control target by operating the operation part 204 and inputting the command for the control target.
The teaching pendant 200 corresponds to an embodiment of a “teaching device”. It should be noted that the teaching device is not limited to the configuration illustrated in
Next, an embodiment of a hardware configuration of the control system 1 according to the embodiment will be described.
The control device 100 includes, as main components, a processor 102, a memory 104, a storage 106, and a communication interface (I/F) 110. These components are connected to each other via a bus 109.
The processor 102 realizes various processes by reading a system program 107 and a user application program 108 stored in the storage 106 to the memory 104 and executing the programs. The memory 104 includes a volatile storage device such as a dynamic random access memory (DRAM) or a static random access memory (SRAM). The storage 106 is a nonvolatile storage device such as a hard disk or a flash memory. In the storage 106, the user application program 108 designed according to a control target or the like is stored, in addition to the system program 107 for controlling each part of the control device 100. A communication I/F 110 corresponds to a transmission and reception circuit that transfers data received from another device to yet another device. The communication I/F 110 includes a communication port connected to the field network 2.
The remote I/O device 510 includes a communication control part 511 and a communication I/F 512. The communication control part 511 mediates requests between the control device 100 and one or a plurality of devices connected to the remote I/O device 510. For example, in response to a communication request from the control device 100, the communication control part 511 requests the one or a plurality of devices to transmit output data.
The servo driver 520 includes a servo control part 525 and a communication I/F 526. The servo control part 525 generates a command to be output to the corresponding servo motor 522 on the basis of a command from the control device 100 or the teaching pendant 200, and controls the corresponding servo motor 522 according to the generated command. An encoder (not illustrated) is provided on a rotation shaft of the servo motor 522. The encoder feeds back a position (a rotation angle), a rotation speed, the cumulative number of rotations, and the like of the servo motor 522 to the servo control part 525. The servo control part 525 includes an interface that transmits a target position, a target rotation speed, or the like of the servo motor 522, and an interface that receives a current position, a current rotation speed, or the like of the servo motor 522.
The communication I/F 526 corresponds to a transmission and reception circuit for transferring data received from another device to yet another device. The communication I/F 526 includes a communication port that is connected to the field network 2 as will be described below.
The robot controller 530 includes a robot control part 535 and a communication I/F 536. The robot control part 535 generates a command to be output to the corresponding robot on the basis of a command from the control device 100 or the teaching pendant 200, and controls the corresponding robot according to the generated command. Specifically, one or a plurality of servo drivers are incorporated in the robot control part 535, and each servo driver controls a corresponding servo motor. An encoder (not illustrated) is provided on the rotation shaft of the servo motor. The encoder feeds back a position (rotation angle) of the servo motor, a rotation speed of the servo motor, the cumulative number of rotations of the servo motor, or the like to the corresponding servo driver. It should be noted that the servo driver is not necessarily incorporated in the robot controller 530 and may be provided separately from the robot controller 530.
The visual sensor 540 includes an imaging part 542 and an image processing part 544. The imaging part 542 is a device that images a subject present in an imaging range, and mainly includes an optical system such as a lens or an aperture, and a light reception element such as a charge coupled device (CCD) image sensor or a complementary metal oxide semiconductor (CMOS) image sensor. The imaging part 542 performs imaging according to a command from the image processing part 544 and outputs image data obtained by performing imaging to the image processing part 544.
The image processing part 544 includes an imaging control part 546 and a communication I/F 548. These components are connected to each other so that the components can perform data communication via a bus (not illustrated). The imaging control part 546 controls an imaging operation in the imaging part 542. The imaging control part 546 includes an interface that transmits various commands to the imaging part 542 and an interface that receives image data from the imaging part 542. The communication I/F 548 exchanges various pieces of data with the control device 100.
The teaching pendant 200 includes a control part 201, a communication I/F 202, a display part 203, and an operation part 204. As illustrated in
The control part 201 receives information that the user inputs to the operation part 204. When a command for a desired driving device is received, the control part 201 generates a command (such as a position command and a speed command) for controlling the driving device on the basis of the command, and outputs the generated command to the driving device (the robot controller 530) that is a connection destination. When the command generated by the teaching pendant 200 is received, the driving device (the robot controller 530) that is a connection destination outputs the command to the desired driving device.
The control part 201 also receives image data output from the visual sensor 540 via the driving device (the robot controller 530) that is a connection destination, and outputs the image data to the display part 203. As illustrated in
The communication I/F 202 is an interface via which the teaching pendant 200 communicates with an external device including the driving device (the robot controller 530) that is a connection destination.
Next, data communication in the control system 1 according to the embodiment will be described.
Referring to
The communication I/F 110 in the control device 100 (the master) corresponds to a communication circuit that transmits and receives data to and from the plurality of field devices 500 via the field network 2. The communication I/F 110 receives data (input data) collected or generated by the plurality of field devices 500, and transmits the data (output data) acquired or generated by the control device 100 to the plurality of field devices 500.
Specifically, the communication I/F 110 is physically connected to the field network 2, transmits a communication frame to the field network 2, and receives a communication frame transferred on the field network 2 to output the communication frame to the processor 102 (see
On the field network 2, communication frames having a predetermined data structure may be sequentially transferred at predetermined periods, and each of the control device 100 and the field device 500 writes designated data to a commanded area and reads necessary data from a corresponding area, for the sequentially transferred communication frames.
More specifically, the communication I/F 110 includes a communication port 114, a transmission and reception controller (Tx/Rx CTRL) 116, and a timer 112. The communication port 114 is a part that is physically connected to the field network 2, generates an electric signal according to a command from the transmission and reception controller 116, transmits the electric signal to the field network 2, converts an electric signal generated on the field network 2 into a digital signal, and outputs the digital signal to the transmission and reception controller 116.
The transmission and reception controller 116 performs a process regarding generation and reception of a communication frame that is transferred on the field network 2.
The timer 112 generates a pulse serving as a reference for a timing at which transmission or the like of a communication frame or the like is instructed from the transmission and reception controller 116. For the timer 112, a real time clock can be adopted, but in the embodiment, a free run counter that counts up (increments) at predetermined periods is used. A current time can be calculated by treating a counter value output by the free run counter as an elapsed time from a certain point of time, and accordingly, the free run counter can be caused to function as a timer.
In each of the field devices 500 (slaves), the communication I/F 502 processes communication frames that are sequentially transferred on the field network 2. That is, when the communication I/F 502 receives any communication frame via the field network 2, the communication I/F 502 performs data writing and/or data reading on the received communication frame, and then, transmits the communication frame to a field device 500 located next on the field network 2. The communication I/F 502 provides a function of such frame relay.
More specifically, the communication I/F 502 includes communication ports 504 and 505, a transmission and reception controller 506, and a timer 503. The communication ports 504 and 505 are parts that are physically connected to the field network 2, and perform a process such as reception and reproduction of communication frames transferred on the field network 2 according to a command from the transmission and reception controller 506 to realize sequential transfer of the communication frames.
The transmission and reception controller 506 performs data writing and/or data reading on the communication frame transferred on the field network 2.
The timer 503 generates a clock serving as a reference for a timing of output of a command, collection of field information, and the like in the transmission and reception controller 506. For the timer 503, a real time clock can be adopted, but in the embodiment, a free run counter that counts up (increments) at predetermined periods is used.
The teaching pendant 200 is connected to the field device 500 constituting a driving device that is a control target among the plurality of field devices 500. In the embodiment of the configuration of
In the teaching pendant 200, the communication I/F 202 includes a communication port 206 and a transmission and reception controller 208. The communication port 202 is connected to the communication port 508 in the slave #01 via a communication line 509. The communication line 509 may be a communication line using any one of a serial communication scheme and a parallel communication scheme or may be any one of a bus and a network. The transmission and reception controller 208 controls exchange of data with the slave #01 via the communication line 509.
Next, an aspect of connection of the teaching pendant 200 to the field network 2 will be described. The connection aspect of the teaching pendant 200 is not limited to the connection aspect illustrated in
The second embodiment of the configuration illustrated in
The teaching pendant 200 includes communication ports 206 and 207, a transmission and reception controller 208, and a timer 209 as a communication I/F 202. The communication ports 206 and 207 are parts that are physically connected to the field network 2, and perform a process such as reception and reproduction of a communication frame transferred on the field network 2 according to a command from the transmission and reception controller 208 to realize sequential transfer of communication frames.
The transmission and reception controller 208 performs data writing and/or data reading on the communication frame transferred on the field network 2.
The timer 209 generates a clock serving as a reference for a timing of output of a command, collection of field information, and the like in the transmission and reception controller 208. The timer 209 is in time synchronization with the timer 112 and the timer 503. For the timer 209, a real time clock can be adopted, but in the embodiment, a free run counter that counts up (increments) at predetermined periods is used.
The third embodiment of the configuration illustrated in
The switch 600 includes communication ports 601 to 603 and a transmission and reception controller 604. The communication ports 601 and 602 are physically connected to the field network 2. The communication port 603 is connected to the communication port 206 of the teaching pendant 200 via a communication line 605. The communication line 605 may be a communication line using any one of a serial communication scheme and a parallel communication scheme or may be any one of a bus and a network.
The switch 600 connects the teaching pendant 200 to the field network 2 when data exchange occurs between the teaching pendant 200 and the control device 100 or the field device 500. Accordingly, the teaching pendant 200 can function as a slave (a slave #04 in
The transmission and reception controller 604 in the switch 600 performs data writing and/or data reading on communication frames transferred on the field network 2. The communication ports 601 and 602 perform a process such as reception and reproduction of the communication frames transferred on the field network 2 according to a command from the transmission and reception controller 604 to realize sequential transfer of the communication frames.
The fourth embodiment of a configuration illustrated in
When no exchange of data occurs between the teaching pendant 200 and the control device 100 or the field device 500, the switch 515 connects the communication port 514 to the transmission and reception controller 506 to connect the end effector 537 to the slave #04. When data exchange occurs between the teaching pendant 200 and the control device 100 or the field device 500, the switch 515 connects the communication port 508 to the transmission and reception controller 506 to connect the teaching pendant 200 to the slave #04.
Next, an embodiment of a communication frame that is used in the control system 1 according to the embodiment will be described. In the embodiment, as an implementation embodiment, a communication frame for performing I/O refreshing is used. The I/O refreshing has a concept including a process of updating the value of the input data held in the control device 100 with a latest value collected by the corresponding field device 500 (input refreshing), and a process of reflecting the value of the output data calculated by the control device 100 as the output value of the corresponding field device 500 (output refreshing).
As such a communication frame, an I/O refreshing frame is adopted. The I/O refreshing frame is configured to be able to store both input data and output data necessary for input refreshing. It should be noted that the input refreshing and the output refreshing may be implemented separately. In this case, a communication frame configured to store only one of the input data and the output data is adopted.
As the frame type stored in the header portion, identification information for specifying a type of a communication frame may be used. For example, identification information indicating unicast, multicast, or broadcast may be used. As the destination, identification information of the field device 500 that is a transmission destination, or the like is used.
A plurality of areas for storing input data and output data are defined in the body portion. The respective areas are associated with all or some of the field devices 500 (slaves #01 to #05) existing in a transfer path of the I/O refreshing frame FL 05), respectively.
When the field device 500 receives the I/O refreshing frame, the field device 500 reads the output data stored in the area allocated to the field device 500, and writes the input data collected or generated by the field device 500 to the area allocated to the field device 500. The reading of the output data and the writing of the input data are executed in each field device, thereby realizing I/O refreshing.
Next, a process necessary for transmitting a command from the teaching pendant 200 to the driving device in the control system 1 according to the embodiment will be described.
As will be described below, a command from the teaching pendant 200 can be transmitted using the communication frame FL illustrated in
Referring to
First, in the teaching pendant 200, a command directed to the slave #02 (hereinafter also referred to as a “command #02”) and a command directed to the slave #03 (hereinafter also referred to as a “command #03”) are generated, and the generated commands #02 and #03 are sent to the slave #01.
In slave #01, an input data transmission process including, for example, collection of input data to be transmitted to the control device 100 is executed before arrival of communication frames FL sequentially transferred on the field network 2. In this input data transmission process, the slave #01 collects commands (commands #02 and #03) to be transmitted from the teaching pendant 200 to the other driving devices.
Next, when the slave #01 receives the communication frame FL, the slave #01 reads output data addressed to the slave #01 from the area allocated to the slave #01 in the received communication frame FL. Subsequently, the slave #01 writes the input data and the commands #02 and #03 to the area allocated to the slave #01 (corresponding to (1) in
The commands #02 and #03 written to the communication frame FL are collected by the control device 100 at an execution timing of the next I/O refreshing process (corresponding to (2) in
In the control device 100, output data to be directed to the driving device that is a target is generated, and a packing process for storing the generated data in the communication frame FL and transmitting the resultant communication frame FL is executed. In this packing process, the collected commands are stored in the area allocated to the driving device that is a target. In the embodiment of
For output data defining an output signal from the field device 500, a communication frame FL in which the output data that is a target has been stored is transmitted to the field device 500 that is a target via the field network 2.
In the field device 500 that is a target, when the communication frame FL is received, a process of reading necessary output data from the received communication frame FL, for example, is executed, and the read output data is externally output as a real signal. In this case, in the slave #02, the command #02 is included in the read output data, and in the slave #03, the command #03 is included in the read output data (corresponding to (4) in
Each of the slaves #02 and #03 reads the output data addressed to the slave from the area allocated to the slave in the communication frame FL, and then, writes the input data to the area allocated to the slave (corresponding to (5) in
Next, an output timing synchronization function provided by the control system 1 according to the embodiment will be described.
Referring to
The articulated robot 534 is driven by the robot controller 530, and the XY stage 750 is driven by the servo drivers 520A and 520B. The servo driver 520A controls a servo motor 522A that drives an X axis of the XY stage 750. The servo driver 520B controls a servo motor 522B that drives a Y axis of the XY stage 750.
Since it is necessary to link the articulated robot 534 with the XY stage 750, the robot controller 530 and the servo drivers 520A and 520B are all connected to the control device 100. The control device 100 gives commands to the robot controller 530 and the servo drivers 520A and 520B.
The teaching pendant 200 is connected to the robot controller 530. The teaching pendant 200 can give commands to the robot controller 530 and the servo drivers 520A and 520B.
By executing a command given from the teaching pendant 200, the robot controller 530 causes the articulated robot 534 to behave according to the command. The servo drivers 520A and 520B execute the command given from the teaching pendant 200 to position the workpiece W placed on the XY stage 750 at an appropriate position.
In order to operate the articulated robot 534 and the XY stage 750 in cooperation with each other using the teaching pendant 200, it is necessary to synchronize control timings between the robot controller 530 and the servo drivers 520A and 520B. The control system 1 according to the embodiment has an output timing synchronization function of synchronizing a timing at which the robot controller 530 outputs a command for the articulated robot 534 with a timing at which the servo drivers 520A and 520B output commands for the servo motors 522A and 522B. Accordingly, the operation of the articulated robot 534 and the operation of the XY stage 750 can be synchronized with each other.
(g1: Process Related to Output Timing Synchronization Function (Part 1))
Referring to
Each of the field devices 500 (including the robot controller 530 and the servo drivers 520A and 520B) connected to the field network 2 executes an input data transmission process including, for example, collection of input data to be transmitted to the control device 100 in advance before arrival of the communication frames sequentially transferred on the field network 2.
As the input data transmission process, the robot controller 530 performs collection of commands received by the teaching pendant 200 together with collection of the input data to be transmitted to the control device 100. When the communication frame is reached, the robot controller 530 reads the output data addressed to the robot controller 530 from the received communication frame and writes prepared input data and command to the received communication frame. The robot controller 530 executes an output data reception process including a process of externally outputting a signal corresponding to the read output data.
When each of the servo drivers 520A and 520B receives the communication frames sequentially transferred on the field network 2, each of the servo drivers 520A and 520B reads data addressed to the servo driver from the received communication frames. Each of the servo drivers 520A and 520B executes an output data reception process for externally outputting a signal corresponding to the read output data.
In the time chart illustrated in
Thus, in the embodiment, the maximum delay time required until the signal corresponding to the output data becomes able to be output in each field device 500 after the transmission of the output data is requested from the control device 100 is calculated, and the output synchronization timing is determined in consideration of the maximum delay time of the entire system. The timing according to the output synchronization timing is set for the mutually synchronized timers mutually held by the respective field devices 500, and therefore, signals corresponding to the output data are externally output from the respective field devices 500 all at once.
Specifically, the delay time of each field device 500 includes a time required until the communication frame including the output data is transmitted to the field network 2 after a command to transmit the output data is given in the control device 100, a time required for the communication frame including the output data transmitted on the network 2 to be transferred to the field device 500 that is the target, and a time required until a signal corresponding to the received data becomes able to be output from each field device 500 after each field device 500 receives the communication frame including the output data.
For each of the field devices 500 included in the control system 1, a total of the above-described time elements (the delay time for each field device 500) is calculated. A maximum delay time among the delay times is determined as a maximum delay time Dmax.
In the setting of the output synchronization timing Tout, the timers held by the control device 100 and the field device 500 are synchronized with each other. For example, the timer 112 of the control device 100 functions as a grand master clock and the timer 503 of the field device 500 is synchronized with the grand master clock. Accordingly, the control device 100 and the field device 500 can execute various controls and actions according to a common clock. Under such circumstances, the activation reference time Tt set at predetermined periods and the output synchronization timing Tout set with reference to the activation reference time Tt are designated for each field device 500. Each field device 500 executes a designated process at the designated timing.
In the embodiment of the configuration of
The calculation and setting of the output synchronization timing as described above may be realized by any one or plurality of calculation subjects. Typically, logic for performing the calculation and setting of the output synchronization timing may be implemented in the control device 100, or a function for performing the calculation and setting of the output synchronization timing may be implemented in the teaching pendant 200.
In any of the implementations, the control device 100 instructs a timing at which a signal corresponding to the output data is externally output or updated (the output synchronization timing Tout) to each of the robot controller 530 and the servo drivers 520A and 520B. The output synchronization timing Tout is set with reference to a time (for example, the activation reference time Tt) managed by the timer 112 which is the grand master clock of the control device 100. This is because each of the field devices 500 included in the control system 1 performs time synchronization with the timer 112 which is the grand master clock.
Referring to
The processor 102 determines the output synchronization timing Tout in the entire control system 1 on the basis of the maximum delay time Dmax determined in step S101 (step S102).
The processor 102 notifies each field device 500 of the output synchronization timing Tout determined in step S102 (step S103). Each field device 500 sets a necessary timing according to the notification from the control device 100.
Through the above process, a setting necessary for the output timing synchronization function is completed. Each field device 500 constituting the control system 1 repeatedly executes the process according to the set timing.
(g2: Process Related to Output Timing Synchronization Function (Part 2))
The configuration in which the command from the teaching pendant 200 is transmitted to the field device 500 that is the target using the communication frame which is the I/O refreshing frame during the period in which I/O refreshing process is executed has been described with reference to
As described above, in the control system 1 according to the embodiment, the timers incorporated in the control device 100 and the field device 500 are kept in a state in which the timers are synchronized with each other. Therefore, the plurality of respective driving devices that have received the command from the teaching pendant 200 can synchronize the output timings with one another on the basis of the timers synchronized with one another.
Schematic diagrams (A) to (C) of
Specifically, as illustrated in schematic diagram (A) of
However, since the communication frame FL and the message frame MSGFL cannot be transmitted at the same time, generation and transmission of a designated message frame MSGFL are delayed when the I/O refreshing is in progress even when a request for transmission of the message frame MSGFL is issued.
For example, it is assumed that a message transmission request is given during the transfer of the communication frame FL for I/O refreshing, as illustrated in schematic diagram (B) of
Further, when the message transmission request is given immediately before transfer of the communication frame FL for I/O refreshing, a transfer period of the communication frame FL is approaching. Therefore, the generation and transmission of the message frame MSGFL are hindered and the message frame MSGFL is generated and transmitted after completion of the transfer of the subsequent communication frame FL, as illustrated in schematic diagram (C) of
Thus, in the field network 2 over which the communication frame FL for performing the I/O refreshing is periodically transmitted, a transmission delay occurs to some extent before the message frame MSGFL is actually transmitted after the message transmission request is given. Further, when a large number of message transmission requests are given, a transmission delay of the message frame MSGFL occurs according to, for example, the number of transmission requests.
Therefore, when a command is transmitted from the teaching pendant 200 to each of the plurality of driving devices using message communication, there is concern that timings at which the output data become able to be output from the plurality of respective driving devices may be different from one another. Therefore, by writing a timing (an output synchronization timing) at which a signal corresponding to the output data is to be externally output or updated to the message frame MSGFL to be transmitted to each driving device together with the command from the teaching pendant 200, each driving device is notified of the output synchronization timing. It should be noted that the output synchronization timing may be notified in the form of a count value or a clock value.
Referring to
The communication I/F of each of the servo drivers 520A and 520B and the robot controller 530 manages data transmission and reception with reference to the timing indicated by the timer 503.
Next, a monitoring function using the teaching pendant 200 provided by the control system 1 according to the embodiment will be described.
In the data communication in the control system 1 according to the embodiment, when the visual sensor 540 receives the communication frame, the visual sensor 540 writes the image data captured by the imaging part 542 to the received communication frame. For example, in the embodiment of the configurations illustrated in
Alternatively, in the embodiments of a configurations illustrated in
Thus, the teaching pendant 200 receives the image data from the visual sensor 540 via the field network 2, and causes the display part 203 to display the received image data. Accordingly, the user can give a command to the driving device that is a control target while monitoring the behavior of the machine or facility that is a control target. For example, in a robot that grips and moves a workpiece on a stage, the user may be unable to visually see a behavior of an end effector of the robot. In such a case, by imaging the behavior of the end effector using the visual sensor 540, the user can give a command to a robot controller that drives the robot while confirming the behavior of the end effector displayed on the display part 203 of the teaching pendant 200.
However, since, for example, the driving device or a reception buffer of the teaching pendant 200 that receives the image data is affected by device-specific performance, a size of data that can be transmitted at one time may also be limited. In such a case, a transmission part of the data size of the image data to be transmitted is reduced. That is, the size of the image data to be transmitted at one time is reduced, and the entire data is transmitted at a larger number of divided transmission times. Thus, when a maximum size that can be received by a driving device on the reception side or the teaching pendant 200 is small, a transmission part of a transmission size is reduced.
Next, a safety function provided by the control system 1 according to the embodiment will be described.
For example, when an abnormality is detected in a behavior of the control target during execution of a monitoring operation using the visual sensor 540 described above, the user operates the emergency stop button 205 (see
Thus, in the control system 1 according to the embodiment, when the emergency stop button 205 in the teaching pendant 200 is operated, the stop command is given to the plurality of driving devices using the field network 2. Therefore, the plurality of driving devices can be stopped rapidly at the time of detection of the abnormality.
Further, when a configuration in which the stop command is given to the specific driving device among the plurality of driving devices is adopted, it is possible to suppress an influence on a manufacturing facility or a production line by stopping only driving devices in which there is concern that a harmful effect is caused due to an abnormality.
Next, an operation confirmation function using the teaching pendant 200 provided by the control system 1 according to the embodiment will be described.
During operation of the robot 533, the teaching pendant 200 receives an ON/OFF value output from a sensor device 550 connected to the field network 2. The sensor device 550 is a device for detecting a state (temperature, displacement, pressure, or the like) of a machine or facility that is a control target, and includes, a temperature sensor, a displacement sensor, a pressure sensor, or the like. The teaching pendant 200 causes the ON/OFF value of the sensor device 550 to be displayed on the display part 203.
For example, in a situation in which a manufacturing facility is designed so that the sensor device 550 outputs an ON value when the robot 33 has moved to a predetermined position, the user operates the operation part 204 to move the robot 533 while monitoring an output value of the sensor device 550 using the display part 203 of the teaching pendant 200. When the user has moved the robot 533 to the predetermined position, the user can confirm that the sensor device 550 correctly outputs the ON value. On the other hand, when the sensor device 550 does not output the ON value, the user can judge that there is a likelihood of the robot 533 having not moved to the predetermined position or there is a likelihood of the sensor device 550 being not normally operating.
Thus, since the teaching pendant 200 can acquire the output of the sensor device 550 via the field network 2, the user can confirm operations of the control target and the sensor device 550 using the teaching pendant 200.
Next, a collision avoidance function among a plurality of control targets provided by the control system 1 according to the embodiment will be described.
In the embodiment of a configuration illustrated in
Each of the robot controllers 530A to 530C performs trajectory calculation, angle calculation of each axis, or the like according to a position command or the like from the control device 100 and drives a servo motor or the like constituting the corresponding robot according to calculation results. In the embodiment of the configuration illustrated in
The teaching pendant 200 is connected to the field network 2. The teaching pendant 200 exchanges data with the field device 500 via the field network 2.
The user can designate the field device 500 that is an operation target by operating the operation part 204 of the teaching pendant 200. The user can further designate the field device 500 that is an avoidance target by operating the operation part 204 of the teaching pendant 200. The field device 500 that is the operation target corresponds to a machine or facility that the user desires to operate and a driving device that drives the machine or facility. The field device 500 that is the avoidance target corresponds to a machine or facility that is likely to collide with the machine or facility that is the operation target and a driving device that drives the machine or facility when the machine or facility that is the operation target is caused to move to a target position.
In the embodiment of a configuration illustrated in
Although, for the designation of the field devices 500 that are avoidance targets, the configuration in which the user inputs the field device 500 that is the operation target and the field devices 500 that are the avoidance targets to the teaching pendant 200 has been exemplified, a configuration in which the teaching pendant 200 may automatically designate the field device 500 that are avoidance targets on the basis of the field device 500 that is the operation target designated by the user may be adopted. For example, the teaching pendant 200 can designate a robot (or a servo motor) that is a target of synchronization control for synchronizing an operation timing with the robot 533, and a driving device thereof as the field devices 500 that are the avoidance targets from configuration information of the control system 1 registered in advance.
Referring to
Each of the plurality of arms of the robot 533 is driven by a servo motor. When the robot controller 530B receives the position command from the teaching pendant 200, the robot controller 530B determines the amount of rotation of each servo motor on the basis of the target position indicated by the received position command and outputs a designation value for designating the determined amount of rotation to each servo motor.
The robot controller 530B further receives position information indicating the position of the robot 532 from the robot controller 530A designated as an avoidance target and also receives position information indicating the position of the robot 534 from the robot controller 530C. The position information of each robot indicates a current position of each of a plurality of axes associated with a plurality of arms included in each robot. The robot controller 530B reads, for example, the input data stored in the area allocated to the robot controller that is the avoidance target from the communication frame repeatedly transferred at predetermined system periods Ts, such that the position information of the robot that is the avoidance target can be acquired.
Next, the robot controller 530B determines a likelihood of collision between the robot 533 that is the operation target and each of the robots 532 and 534 that are the avoidance targets on the basis of the target position and the current position of the robot 533 that is the operation target and the current position of the robots 532 and 534 that are the avoidance targets.
Specifically, the robot controller 530B determines whether or not a relative positional relationship between the robot 533 that is the operation target and each of the robots 532 and 534 that are the avoidance targets is a specific positional relationship. This specific positional relationship includes that a distance between the target position of the robot that is the operation target and the current position of the robot that is the avoidance target is equal to or smaller than a threshold value. The specific positional relationship also includes that a shortest distance between a trajectory connecting the current position of the robot that is the operation target to the target position thereof and the current position of the robot that is the avoidance target is equal to or smaller than a threshold value. It should be noted that the specific positional relationship is not limited to these positional relationships.
When the relative positional relationship between the robot 533 that is the operation target and each of the robots 532 and 534 that are the avoidance targets is any specific positional relationship, the robot controller 530B determines that there is a likelihood of collision between the robot 533 that is the operation target and the robots 532 and 534 that are the avoidance targets. On the other hand, when the relative positional relationship between the robot 533 that is the operation target and each of the robots 532 and 534 that are the avoidance targets is not the specific positional relationship, the robot controller 530B determines that there is no likelihood of collision between the robot 533 that is the operation target and the robots 532 and 534 that are the avoidance targets.
When it is determined that there is a likelihood of collision between the robot 533 that is the operation target and the robots 532 and 534 that are the avoidance targets, the robot controller 530B shifts to a mode for avoiding the collision in advance (a collision avoidance mode).
In the embodiment, the robot controller 530B can select a “subject-robot stop mode” in which the operation of the subject robot is stopped and an “other-robot avoidance mode” in which the robot that is an avoidance target is moved to a position at which collision with the subject robot can be avoided, as the collision avoidance modes.
In the subject-robot stop mode, the robot controller 530B stops the robot 533 that is the operation target at the current position without moving the robot 533 to the target position. In this case, the user is notified, via the teaching pendant 200, that commands cannot be executed since there is a likelihood of collision with the robots 532 and 534 that are the avoidance targets.
On the other hand, in the other-robot avoidance mode, the robot controller 530B notifies the control device 100 of a collision avoidance command for moving the robots 532 and 534 that are the avoidance targets to positions at which the collision can be avoided. When the control device 100 receives the collision avoidance command, the control device 100 generates a correction command for correcting the position of the robot 532 that is the avoidance target and outputs the generated correction command to the robot controller 530A. Further, the control device 100 generates a correction command for correcting the position of the robot 534 that is the avoidance target and outputs the generated correction command to the robot controller 530C. It should be noted that the driving device of the robot likely to collide among the robots that are the avoidance targets may be notified of the collision avoidance command.
As illustrated in
Therefore, when the control device 100 receives the collision avoidance command for the robots 532 and 534 from the robot controller 530B, the control device 100 calculates a corrected position for each of the robots 532 and 534. In the embodiment illustrated in
When the control device 100 receives the collision avoidance command for the robots 532 and 534 from the robot controller 530B, the control device 100 calculates a corrected position for each of the robots 532 and 534. In the embodiment illustrated in
The control device 100 outputs a correction command including the corrected position P2# of the robot 532 to the robot controller 530A and outputs a correction command including the corrected position P3# of the robot 534 to the robot controller 530C. The robot controller 530A moves the robot 532 to the corrected position P2# according to the correction command. The robot controller 530C moves the robot 534 to the corrected position P3# according to the correction command.
Thus, in the other-robot avoidance mode, the robots 532 and 534 that are the avoidance targets are moved to positions at which the collision with the robot 533 that is the operation target can be avoided. The robot 533 that is the operation target is stopped at the current position and enters a standby state while avoidance operations of the robots 532 and 534 that are the avoidance targets are being performed.
When there becomes no likelihood of the collision between the robot 533 that is the operation target and the robots 532 and 534 that are the avoidance targets due to the completion of the avoidance operations of the robots 532 and 534 that are the avoidance targets, the robot controller 530B moves the robot 533 to the target position P1*. When the robot 533 is moved to the target position P1#, the robot controller 530B notifies the teaching pendant 200 of an operation completion.
A processing procedure of the collision avoidance function applied to the embodiment of the configuration illustrated in
Referring to
The robot controller 530B determines whether or not a position command for the robot 533 that is the operation target has been received from the teaching pendant 200 (step S111). When the position command has not been received from the teaching pendant 200 (when NO is determined in S111), the robot controller 530B skips subsequent processes S112 to S122 and ends the process.
On the other hand, when the position command for the robot 533 has been received from the teaching pendant 200 (when YES is determined in S111), the robot controller 530B determines a likelihood of collision between the robot 533 that is the operation target and the robots 532 and 534 that are the avoidance targets (Step S112). The robot controller 530B determines whether there is a likelihood of the collision on the basis of the current position and the target position of the robot 533 that is the operation target and the current positions of the robots 532 and 534 that are the avoidance target.
When it is determined in step S112 that there is no likelihood of collision (when NO is determined in S112), the robot controller 530B moves the robot 533 according to the position command from the teaching pendant 200 (step S120). When the robot 533 moves to the target position, the robot controller 530B determines that the operation of the robot 533 has been completed (when YES is determined in S121) and notifies the teaching pendant 200 of the completion of the operation (step S122). The teaching pendant 200 having received the notification causes the notification to be displayed on the display part 203, thereby informing the user of the completion of the operation of the robot 533.
On the other hand, when it is determined in step S112 that there is a likelihood of collision (when YES is determined in S112), the robot controller 530B shifts to the collision avoidance mode. First, the robot controller 530B determines which of the subject-robot stop mode and the other-robot avoidance mode is selected as the collision avoidance mode (step S113).
When the subject-robot stop mode is selected, the robot controller 530B stops the execution of the position command for the robot 533 to cause the robot 533 to enter a stopped state (step S114) and notifies the teaching pendant 200 that the command cannot be executed (step S115). The teaching pendant 200 having received the notification causes the notification to be displayed on the display part 203, to inform the user that the robot 533 cannot be moved due to there being a likelihood of collision with a device that is an avoidance target.
On the other hand, when the other-robot avoidance mode is selected in step S113, the robot controller 530B notifies the control device 100 of a collision avoidance command for the robots 532 and 534 (step S116). Further, the robot controller 530B notifies the teaching pendant 200 that the robot 533 is in a standby state in order to execute the other-robot avoidance mode (step S117). The teaching pendant 200 causes the display part 203 to display that the robot 533 is in the standby state. The standby state of the robot 533 is released when the robot controller 530B determines that there is no likelihood of collision.
When the control device 100 receives the collision avoidance command from the robot controller 530B in step S116, the control device 100 calculates corrected positions of the respective robots 532 and 534 on the basis of the current position and the target position of the robot 533, for the respective robots 532 and 534. The control device 100 outputs a correction command including the calculated corrected positions to the robot controllers 530A and 530C. When each of the robot controllers 530A and 530C receives the correction command, each of the robot controllers 530A and 530C moves the corresponding robot to the corrected position instructed by the correction command.
According to the embodiment, in the control system in which the plurality of driving devices and the control device for controlling the driving devices are connected via the network, the teaching device can transmit commands to the plurality of driving devices at the same time using the network. Accordingly, it is possible to perform teaching on the plurality of driving devices at the same time using a single teaching device. Therefore, it is possible to improve work efficiency as compared to the configuration of the related art in which driving devices that are teaching targets are selected one by one and teaching is performed.
Further, since the plurality of driving devices are connected to a so-called industrial network, the number of connectable driving devices is not restricted by hardware of the control device, unlike the configuration of the related art. For a model of the driving device, since the driving device can be connected as long as the driving device can be connected to the industrial network, the model is not restricted by the hardware of the control device.
Further, according to the embodiment, since the teaching device can give commands to the plurality of driving devices at the same time, it is possible to operate the plurality of driving devices of which the operation timings are required to be synchronized with one another at the same time and perform teaching.
Further, according to the embodiment, the teaching device can receive the image obtained by imaging the behavior of the control target from the visual sensor connected to the network, and cause the image to be displayed. Accordingly, the user can give a command to the driving device that is a control target while monitoring the behavior of the machine or facility that is the control target displayed on the teaching device. Thus, the user can teach the behavior of the control target difficult to visually see to the driving device.
Further, according to the embodiment, it is possible to output the stop command given from the teaching device to the plurality of driving devices via the network in an emergency state. As a result, it is possible to emergently stop the plurality of driving devices. The teaching device can emergently stop only a specific driving device set in advance by outputting the stop command only to the specific driving device.
Further, according to the embodiment, since data can be exchanged between the control device and the plurality of driving devices via the network, the driving device that is the target can determine a likelihood of collision between the subject device and the other driving device on the basis of the relative positional relationship between the subject device and the other driving device in a situation in which a command is given from the teaching device to the driving device that is the target. Further, when it is determined that there is a likelihood of collision, the control device, the driving device that is the target, and the other driving device can execute the process for avoiding collision in cooperation with one another.
The embodiment of the present disclosure as described above includes the following technical spirit.
A control system (1) for controlling a plurality of control targets, the control system comprising: a plurality of driving devices (500, 520, 530, and 530A to 530C) that are connected to a network (2) and drive a plurality of control targets (522, and 532 to 534); a control device (100) that controls the plurality of driving devices via the network; and a teaching device (200) for teaching operations of corresponding control targets to the plurality of driving devices, wherein the teaching device transmits a command for driving the corresponding control target to at least one driving device among the plurality of driving devices via the network.
The control system according to configuration 1, wherein the teaching device is connected to a first driving device among the plurality of driving devices via a communication line (509), and outputs a command for a second driving device among the plurality of driving devices to the first driving device, and the first driving device transmits the command for the second driving device to the second driving device via the network.
The control system according to configuration 1, wherein the teaching device is connected to the network and transmits a command for driving a corresponding control target to the driving device that is a target via the network.
The control system according to any one of configurations 1 to 3, wherein the control device collects the command transmitted by the teaching device via the network and transmits the collected command to the driving device that is the target via the network.
The control system according to configuration 4, wherein the control device stores the collected command in an area of the communication frame allocated to the driving device that is the target, and transmits the communication frame via the network, and when the driving device that is the target receives the communication frame, the driving device that is the target reads the command stored in the area allocated to the driving device that is the target.
The control system according to configuration 4, wherein the control device and the plurality of driving devices include timers (112, 503) synchronized in time with one another, and the control device determines a synchronization timing at which a signal corresponding to the command received in each of the plurality of driving devices is output, with reference to a time managed by the timer.
The control system according to configuration 1, wherein the control device and the plurality of driving devices include timers synchronized in time with one another, the control device transmits a communication frame at predetermined intervals via the network, and the teaching device transmits a command for the driving device that is the target and instructs a timing at which a signal corresponding to the command received in the driving device that is the target is output during a period in which the communication frame is not transferred.
The control system according to configuration 1, wherein when the first driving device among the plurality of driving devices receives a command for driving a corresponding first control target from the teaching device, the first driving device determines a likelihood of collision between the first control target and a second control target due to execution of the command, and when it is determined that there is a likelihood of collision, the first driving device stops the execution of the command and notifies the teaching device that the command is unable to be executed.
The control system according to configuration 1, wherein when the first driving device among the plurality of driving devices receives a command for driving a corresponding first control target from the teaching device, the first driving device determines a likelihood of collision between the first control target and a second control target due to execution of the command, the first driving device transmits a collision avoidance command for the second driving device that drives the second control target to the control device via the network when it is determined that there is a likelihood of collision, and the control device transmits a command including a corrected position of the second control target to the second driving device via the network when the control device receives the collision avoidance command.
The control system according to configuration 1, further comprising a visual sensor (540) including an imaging part (542) connected to the network and disposed to image the plurality of control targets, wherein the teaching device includes a display part (203) that displays an image captured by the imaging part, the image being transferred from the visual sensor via the network, and an operation part (204) that receives an operation for inputting a command for the driving device that is the target.
The control system according to configuration 1, wherein the teaching device includes an operation part (204) that receives an operation for inputting a stop command, and transmits the stop command to at least one driving device among the plurality of driving devices via the network.
The control system according to configuration 1, further comprising: a sensor device (550) that is connected to the network and detects states of the plurality of control targets, wherein the teaching device receives an output value of the sensor device via the network.
It will be apparent to those skilled in the art that various modifications and variations can be made to the disclosed embodiments without departing from the scope or spirit of the disclosure. In view of the foregoing, it is intended that the disclosure covers modifications and variations provided that they fall within the scope of the following claims and their equivalents.
Number | Date | Country | Kind |
---|---|---|---|
2017-206492 | Oct 2017 | JP | national |