WO2009119384A1 - 可動機械制御システム - Google Patents

可動機械制御システム Download PDF

Info

Publication number
WO2009119384A1
WO2009119384A1 PCT/JP2009/055157 JP2009055157W WO2009119384A1 WO 2009119384 A1 WO2009119384 A1 WO 2009119384A1 JP 2009055157 W JP2009055157 W JP 2009055157W WO 2009119384 A1 WO2009119384 A1 WO 2009119384A1
Authority
WO
WIPO (PCT)
Prior art keywords
transmission
movable machine
reception
robot
teaching
Prior art date
Application number
PCT/JP2009/055157
Other languages
English (en)
French (fr)
Inventor
信博 谷
泰宏 神品
真司 岡部
Original Assignee
株式会社 ダイヘン
株式会社 不二越
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社 ダイヘン, 株式会社 不二越 filed Critical 株式会社 ダイヘン
Priority to JP2010505554A priority Critical patent/JP5204214B2/ja
Priority to CN2009801057593A priority patent/CN101945740B/zh
Publication of WO2009119384A1 publication Critical patent/WO2009119384A1/ja

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/06Control stands, e.g. consoles, switchboards
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1674Programme controls characterised by safety, monitoring, diagnostic
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/33Director till display
    • G05B2219/33192Radio link, wireless
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00Program-control systems
    • G05B2219/30Nc systems
    • G05B2219/39Robotics, robotics to robotics hand
    • G05B2219/39384Control unit near robot, control and teaching panel in safe zone

Definitions

  • the present invention relates to a movable machine control system that wirelessly connects a portable teaching operation device and a movable machine control device.
  • Patent Documents 1 to 3 Conventionally, there has been proposed a movable machine control system that operates while performing wireless communication between a movable machine control device and a portable teaching operation device (see Patent Documents 1 to 3).
  • an operator teaches an operation to a movable machine using a teaching operation device before the movable machine that is mechanically operated by being connected to a control device of the movable machine with a cable.
  • the control device 500 of the movable machine such as a robot is arranged outside the safety fence 530, and the movable machine 540 is arranged inside the safety fence 530.
  • Patent Documents 2 and 3 as shown in FIG.
  • a transmission / reception device 520 for allowing the control device 500 of the movable machine to perform wireless communication with the teaching operation device 510 has been described so far. It is arranged in the vicinity or in the vicinity. JP 2008-009872 A JP 2007-042061 A JP 2006-341356 A
  • Patent Documents 2 and 3 cannot solve the following problems. That is, it is not possible to determine whether or not the teaching operation device 510 that has established safety communication with the transmission / reception device 520 is located in the vicinity of the movable machine 540 in the safety fence 530. Therefore, from the outside of the safety fence 530, the operation of the movable machine 540 by the teaching operation device 510 that has established safety communication cannot be prohibited. That is, as shown in FIG. 5, when another worker M exists in the safeguarded space of the safety fence 530, the worker M is exposed to a dangerous state.
  • the safety communication is communication performed in order to stop the operation of the movable machine 540 by operating an emergency stop switch (not shown) provided in the teaching operation device 510 in an emergency.
  • the control apparatus 500 detects this communication abnormality and automatically stops the movable machine 540. Further, when the safety communication is established between the transmission / reception device 520 and the teaching operation device 510, the safety communication cannot be established with any teaching operation device other than the teaching operation device 510. Other teaching operation devices that have not established safety communication are possible in communication other than safety communication, for example, communication such as simple data communication not involving the operation of the robot.
  • the object is to provide a movable machine control system capable of ensuring safety.
  • a portable teaching operation device for wirelessly transmitting teaching data, a transmitting / receiving unit for receiving the teaching data, and teaching data received by the transmitting / receiving unit.
  • a movable machine control system including a control device for controlling the movable machine based on the above is provided.
  • the wireless communicable range of the transmission / reception means is set as a wirelessly operable area of the movable machine, the movable machine is arranged in the wirelessly operable area, and the control device is capable of the wireless operation.
  • a first assigning unit that is arranged outside the area and that gives received route information indicating that it has passed through the transmitting / receiving unit to received data received by the transmitting / receiving unit; Based on the determination result, it is determined whether or not the position of the portable teaching operation device that is the transmission source of the received data is within the wirelessly operable region, and establishment of safety communication with the teaching operation device is permitted based on the determination result. And determining means for permitting an operation involving the operation of the movable machine based on the teaching data.
  • the movable machine it is possible to prevent the movable machine from operating unexpectedly by an operation from the outside of the predetermined area including the area where the movable machine performing the teaching operation is located. It is possible to ensure the safety of the worker in a predetermined area including the area where the movable machine that performs the work is located.
  • This predetermined area is an area in which the transmission / reception means can perform wireless communication. In other words, this is an area where the movable machine can be operated wirelessly (a wirelessly operable area).
  • the movable machine control system includes a variable unit that varies a wireless output of the transmission / reception unit, and the wirelessly operable region can be changed by changing the wireless output of the transmission / reception unit by the variable unit.
  • the wirelessly operable area can be adjusted by the variable means, and the safety of the worker in the area can be ensured.
  • the transmission / reception means is preferably provided in a movable machine.
  • the transmission / reception means is provided in the movable machine, it is possible to ensure the safety of the operator in the area centered on the movable machine, that is, in the wirelessly operable area.
  • a plurality of movable machines each having the transmission / reception means and the first provision means are arranged, and each transmission / reception means is connected to each other in series by a wire and then connected to the control device, and the determination means is provided in the control device. It is preferable that the waypoint information is given to the reception data received by each of the transmission / reception means by the first provision means provided in each movable machine. In this case, even when there are a plurality of movable machines, it is possible to ensure the safety of workers in the predetermined area (that is, the wireless communication possible area of the transmission / reception means) including the area where the movable machine performing the teaching work is located. it can.
  • a communication device is provided in a control device including a control unit that controls the movable machine, the communication device is provided with a first connector that mediates the transmission / reception means and the determination means, and the communication device further includes: Provided in the control device is a second connector that mediates a non-operation processing unit that performs non-operation processing irrelevant to control of the movable machine and a local network, and the plug of the second connector is a jack of the first connector It is preferable that the connection is impossible.
  • the plug of the second connector is configured so that it cannot be connected to the jack of the first connector, erroneous connection can be prevented.
  • the plug of the second connector is configured so that it cannot be connected to the jack of the first connector, teaching data erroneously entered into the local network is transmitted to the movable machine control unit via the first connector. There is no.
  • the movable machine is surrounded by a safety fence
  • the control device is arranged outside the area surrounded by the safety fence
  • the wirelessly operable area is included in the area surrounded by the safety fence.
  • the transmission / reception means includes a wired transmission / reception means, provided on the safety fence, connected to the wired transmission / reception means by a wire and detachably connected to the teaching operation device, and the terminal and the wired transmission / reception means.
  • Second grant means for giving waypoint information indicating that the received data has been passed through the transmission / reception means, and the determination means is the received data to which the placepoint information is given by the second grant means Based on the above, it is preferable to determine that the position of the teaching operation device that is the transmission source of the received data is located at the position of the terminal.
  • the transit point information is given to the received data from the teaching operation device connected to the terminal by the second assigning means, the establishment of the safety communication with the teaching operation device communicated from the terminal is permitted, and the teaching is performed. An operation involving the operation of the movable machine by data is permitted. As a result, for example, even when an operator having a teaching operation device connected to a terminal tries to enter an area surrounded by a safety fence, the operator's safety can be ensured.
  • (A) is explanatory drawing which shows the outline of the robot control system of 1st Embodiment which actualized this invention
  • (b) is explanatory drawing which shows the outline of the robot control system of 2nd Embodiment.
  • 1 is a block diagram of a robot control system according to a first embodiment embodying the present invention. Explanatory drawing of a data packet. Explanatory drawing of the conventional robot control system. Explanatory drawing of the conventional robot control system.
  • a portable teaching operation device 10 and a robot control device 20 as a control device for a movable machine are connected via a wireless LAN (local area network) as a network means. ing.
  • a wireless LAN local area network
  • teaching operation devices 10 can be connected to the robot control device 20, only one teaching operation device 10 is shown in FIG.
  • the robot R controlled by the robot control device 20 is, for example, a welding robot.
  • the movable machine is not limited to the welding robot, and may be an apparatus other than the transfer robot.
  • Robot R is surrounded by a safety fence 50.
  • the space surrounded by the safety fence 50 becomes a space where the operation of the manipulator of the robot is allowed and a space where an operator can enter.
  • the safety fence 50 is provided with a door (not shown), and an operator can enter the safety fence 50 by opening the door.
  • the teaching operation device 10 includes a CPU (Central Processing Unit) 11, ROM 12, RAM 13, hard disk 14, wireless LAN I / F (interface) 15, keyboard 16, display device 17, and wired LAN I / F (interface). 18 are provided, and each part is connected via a bus 19.
  • CPU Central Processing Unit
  • ROM 12 ROM 12
  • RAM 13 hard disk 14
  • wireless LAN I / F interface 15
  • keyboard 16 display device 17
  • wired LAN I / F interface
  • the ROM 12 stores an RDP (Remote Desktop) client program for executing robot operations and communications from the teaching operation device 10.
  • the program stored in the ROM 12 includes, for example, a GUI display processing program for controlling display of GUI (Graphical user interface) screen data acquired from the robot controller 20 on the display device 17.
  • the ROM 12 stores various programs for causing the CPU 11 to function as a personal computer.
  • the RAM 13 is used as a working area for the CPU 11 and temporarily stores data being calculated.
  • the hard disk 14 stores execution variables of the control program.
  • the wireless LAN I / F 15 is a communication device used for wireless connection with the robot control device 20.
  • the wired LAN I / F 18 is a communication device used for wired connection with the robot controller 20.
  • the keyboard 16 is used as an interface for an operator (that is, an operator) of the teaching operation device 10 to input teaching data indicating a robot operation.
  • the display device 17 is used as a display device for the operator of the teaching operation device 10 to confirm the operation conditions and operation state of the robot.
  • the teaching operation device 10 includes a charging device 60 provided in the safety fence 50. It can be detachably attached to. Further, the charging device 60 is provided with a connector 62 that is detachably connected to the wired LAN I / F 18, and when the teaching operation device 10 is attached to the charging device 60 for charging, The wired LAN I / F 18 and the connector 62 can be connected.
  • the charging device 60 corresponds to a terminal. In FIG. 2, for convenience of explanation, a state in which the teaching operation device 10 is attached to the charging device 60 is shown.
  • the connector 62 is connected to a transmission / reception device 40 as transmission / reception means provided in the robot R by wire.
  • the transmission / reception device 40 may be provided inside the robot R or may be attached to the outside.
  • the transmission / reception device 40 includes a wireless LAN I / F 42, a volume switch 44 for wireless output adjustment, a waypoint information adding unit 46, and a wired LAN I / F 48.
  • the volume switch 44 corresponds to a variable means, and the wireless output of the wireless LAN I / F 42 can be adjusted by manually operating an operation knob (not shown).
  • the wireless output of the wireless LAN I / F 42 covers the area in the safety fence 50, and wireless communication is possible. Wireless communication from outside the safety fence 50 is disabled.
  • the wirelessly operable area of the robot R can be changed by the volume switch 44, and the entire wirelessly operable area is set to be included in the area surrounded by the safety fence 50 by the adjustment operation of the volume switch 44.
  • This wirelessly operable region is a wirelessly communicable range of the transmitting / receiving device 40.
  • the volume switch 44 may be omitted.
  • the position of the robot R that is, the position of the transmission / reception device 40 and the area surrounded by the safety fence 50 are measured, and the wireless output range, that is, the output radio wave intensity covers the area surrounded by the safety fence 50.
  • the circuit configuration may be set so that wireless communication is possible, or the wireless output range may be set by software.
  • the wireless LAN I / F 42 can communicate with the wireless LAN I / F 15 of a plurality of teaching operation devices such as the teaching operation device 10.
  • the wireless LAN I / F 42 and the wireless LAN I / F 15 can perform packet communication.
  • the data packet transmitted from the teaching operation device 10 is generated in the form of a packet by a communication protocol predetermined by the CPU 11 of the teaching operation device 10.
  • FIG. 3 shows an example of a data packet transmitted from the teaching operation device 10 by wireless communication or wired communication.
  • the data packet includes destination data 70 for specifying the robot control device 20 to be transmitted from the teaching operation device 10, transmission source data 80 for specifying the transmission source, and a TP (teach pendant including teaching data).
  • Data 90 and error detection data 100 are included.
  • the transmission source data 80 includes TP information 82 and waypoint information 84.
  • the TP information 82 is ID information for specifying a transmission source.
  • the waypoint information 84 is ID information indicating where the data packet has passed, but the route point information transmitted from the teaching operation device 10 is set with an initial value indicating that nowhere is passing. Is done.
  • the wired LAN I / F 48 is connected to a communication cable connected to the connector 62 of the charging device 60, and can perform packet communication with the wired LAN I / F of the teaching operation device connected via the connector 62.
  • the wired LAN I / F 48 corresponds to wired transmission / reception means.
  • the data packet used in wired transmission / reception is the same as the data packet in the wireless communication.
  • the waypoint information adding unit 46 sets the ID information of the transmission / reception device 40 stored in advance in the memory 46a in the waypoint information 84 of the data packet received via the wireless LAN I / F 42 or the wired LAN I / F 48. It indicates that the transit point of the data packet is the transmission / reception device 40. Then, the waypoint information adding unit 46 transmits a data packet in which the waypoint information is set to the robot control device 20.
  • the waypoint information giving unit 46 corresponds to a first giving unit and a second giving unit, and the ID information of the transmission / reception device 40 corresponds to waypoint information.
  • the robot control device 20 includes an ID confirmation circuit 24 provided on an Ethernet (registered trademark) card 22 as a communication device, a robot control unit 32 and an operation outside processing unit 34 provided on a main board 30. .
  • the Ethernet card 22 includes a first connector 26 connected to the waypoint information adding unit 46 of the transmission / reception device 40 and a second connector 28 connected to a local LAN as a local network.
  • the first connector 26 is provided at a female jack (not shown) provided on the Ethernet card 22 and an end of a communication cable 41 extended from the transmitting / receiving device 40, and is connected to the male plug ( (Not shown).
  • the second connector 28 is provided at the end of a communication cable 52 connected to the local LAN, and a female plug (not shown) provided on the Ethernet card 22 and connected to the jack. (Not shown).
  • the plug of the first connector 26 and the plug of the second connector are different in shape and cannot be connected to jacks of other connectors.
  • the local area communication cable 52 cannot be connected to the jack of the first connector 26.
  • the communication cable 41 of the transmission / reception device 40 cannot be connected to the jack of the second connector 28.
  • the ID confirmation circuit 24 can be switched and connected to a transmission / reception apparatus 40 connected via the first connector 26 and a local LAN connected via the second connector 28.
  • the ID confirmation circuit 24 confirms the waypoint information 84 included in the reception data (ie, data packet) from the transmission / reception apparatus 40 and the local area LAN.
  • the ID confirmation circuit 24 stores the ID information of the transmission / reception device 40 in advance when the ID information of the transmission / reception device 40 is confirmed from the waypoint information 84 of the received data received via the first connector 26, that is, stores the waypoint information 84 in advance. Only when the ID information of the transmission / reception device 40 matches, the received data is attached to the received data and then transmitted to the robot controller 32.
  • the robot control unit 32 provided on the main board 30 includes a CPU, a ROM, a RAM, a servo driver for driving the robot R, a video RAM, and the like. Not connected through).
  • the ROM stores various programs such as a control program for controlling the operation of the robot R to be controlled by the robot control device 20 and its control constant, GUI program, and RDP host program.
  • the servo driver is connected to a motor (not shown) that drives each joint of the robot R, and controls the current supplied to the motor. Then, the CPU controls the robot R via the servo driver based on the teaching data.
  • the video RAM is used to temporarily store the GUI screen data to be displayed on the display device 17 of the teaching operation device 10 before sending it to the teaching operation device 10.
  • the robot control unit 32 When the robot control unit 32 receives the received data to which the confirmed data is given from the Ethernet card 22, the position of the teaching operation device 10 that is the transmission source of the received data is within the wirelessly operable region. Or it determines with it being located in the charging device 60 provided in the safety fence 50, and outputs "approval of establishment of safe communication”. Further, the robot control unit 32 outputs the “permission for establishment of safety communication”, and after the establishment of the safety communication with the teaching operation device, outputs the “operation permission” for permitting the operation with the operation of the robot R. . Only the teaching operation device that has received this operation permission can operate using the teaching data of the robot R.
  • the robot control unit 32 corresponds to a movable machine control unit and a determination unit.
  • the non-operation processing unit 34 includes a CPU, a ROM, and a RAM (not shown), and performs a robot operation non-processing unrelated to the robot control by a command from the local LAN connected via the Ethernet card 22. Do. Examples of the robot out-of-motion processing include processing such as data creation for managing the robot R, totalization of maintenance information, and reporting, but are not limited to these processing.
  • the safety communication is communication performed to stop the operation of the robot R by operating an emergency stop switch (not shown) provided in the teaching operation device in an emergency. Even if there is a communication abnormality in this safety communication, the robot controller 20 detects this communication abnormality and automatically stops the operation of the robot R. Further, when the safety communication with the teaching operation device is established with the transmission / reception device 40, the safety communication cannot be established with the teaching operation device other than the teaching operation device with which the safety communication with the transmission / reception device 40 is established. . It is possible to communicate with other teaching operation devices that have not established safety communication, for example, communication other than safety communication, for example, communication such as simple data communication that does not involve robot operation.
  • the worker opens the door (not shown) and enters the safety fence 50, and then connects the teaching operation device 10 and the transmission / reception device 40 by wireless communication to establish safety communication. That is, in this case, the operator requests connection of the teaching operation device 10 by operating the keyboard 16 and causes the teaching operation device 10 to transmit a data packet (signal) wirelessly.
  • This data packet (signal) is sent to the Ethernet card 22 inside the robot controller 20 connected by the communication cable 41 via the transmitter / receiver 40 of the robot R.
  • the received data from the teaching operation device 10 is set (provided) with the ID information of the transmission / reception device 40 in the waypoint information 84, and is sent to the Ethernet card 22.
  • the ID confirmation circuit 24 confirms the waypoint information 84 of the received data, and only when the waypoint information 84 matches the ID information of the transmitting / receiving device 40 stored in advance, the received data is included in the received data. On the other hand, after giving data indicating confirmation, the received data is sent to the robot controller 32.
  • the robot control unit 32 Upon receiving this received data, the robot control unit 32 confirms that it is not in safety communication with another teaching operation device. In addition, the robot control unit 32 determines whether or not the received data has been received based on the waypoint information 84 and whether or not the received data has been received via the first connector 26 of the Ethernet card 22. Judgment according to whether or not.
  • the robot control unit 32 sends safety communication permission to the teaching operation device 10 via the Ethernet card 22 and the TP information 82.
  • safety communication is established.
  • the worker When the worker enters the safety fence 50, the worker sets the teaching operation device 10 on the charging device 60 and connects it to the connector 62 before entering the safety fence 50, and establishes safety communication with the robot control device 20. May be.
  • a data packet (signal) is transmitted from the teaching operation device 10 to the transmission / reception device 40 of the robot R by wire.
  • the data packet (signal) is sent to the Ethernet card 22 inside the robot controller 20 connected by the communication cable 41.
  • the robot control unit 32 gives “operation permission” to the teaching operation device 10 via the Ethernet card 22 and the transmission / reception device 40.
  • the worker removes the teaching operation device 10 from the charging device 60, opens a door (not shown), and enters the safety fence 50. Thereafter, the operator operates the keyboard 16 of the teaching operation device 10 to transmit a data packet by wireless communication.
  • the transmission / reception device 40 sends the data to the Ethernet card 22 after adding ID information allocated to the data packet received from the teaching operation device 10 regardless of wireless or wired connection. become.
  • the robot controller 20 receives the received data. It can be determined that the data is received from the teaching operation device 10 of the worker entering or about to enter the safety fence 50.
  • the robot control system of the present embodiment is provided such that the wireless communication possible range of the transmission / reception device 40 (transmission / reception means) is a wirelessly operable area, and the robot R is located in the wirelessly operable area.
  • a control device 20 is disposed outside the wirelessly operable area.
  • the robot control system includes a waypoint information giving unit 46 (first giving means) for giving route point information 84 indicating that the received data received by the sending / receiving device 40 has passed through the sending / receiving device 40.
  • the position of the teaching operation device 10 that is the transmission source of the received data is within the wirelessly operable region or the position of the charging device 60 that is the terminal.
  • a robot control unit 32 determines and permits establishment of safety communication with the teaching operation device 10 based on the determination result, and permits an operation involving the operation of the robot R based on the teaching data.
  • the robot R can be prevented from operating unexpectedly by an operation from a region other than the predetermined region including the region where the robot R performing the teaching operation is located, and the predetermined region including the region where the robot R performing the teaching operation is located.
  • the safety of workers in the area can be ensured.
  • the robot control system includes a volume switch 44 (variable means) that varies the wireless output of the transmission / reception device 40 (transmission / reception means).
  • the wireless output of the transmission / reception device 40 can be changed. As a result, it is possible to adjust the wirelessly operable area by the volume switch 44 and to ensure the safety of the worker in the area.
  • the transmission / reception device 40 (transmission / reception means) is provided in the robot R (movable machine), in the region centered on the robot R, that is, in the wirelessly operable region. The safety of workers can be ensured.
  • an Ethernet card 22 as a communication device is provided in the robot control device 20 including the robot control unit 32 (movable machine control unit).
  • the robot control unit 32 movable machine control unit
  • the Ethernet card 22 is provided with a second connector 28 that is provided in the robot control device 20 and that performs an out-of-operation processing unit 34 that performs out-of-robot operation processing irrelevant to robot control and the local area LAN.
  • the plug of the first connector 26 is configured so as not to be connected to the jack of the second connector 28, and the plug of the second connector 28 is configured not to be connected to the jack of the first connector 26.
  • the non-operation processing unit 34 connected to the second connector 28 does not perform robot control. Therefore, the robot R does not malfunction. Further, since the plug of the second connector 28 is configured so as not to be connected to the jack of the first connector 26, the teaching data erroneously entered into the local area LAN is transmitted to the movable machine control unit via the first connector 26. Is never sent to. As a result, it is possible to ensure the safety of workers in a predetermined area including the area where the robot R is located.
  • the robot R is surrounded by the safety fence 50 and the robot control device 20 is arranged outside the area surrounded by the safety fence 50. Further, the wirelessly operable area of the robot R is included in the area surrounded by the safety fence 50. As a result, the robot R can be prevented from operating unexpectedly by an operation from the outside of the safety fence 50, and the safety of the worker within a predetermined area including the area where the robot R performing the teaching work is secured is ensured. can do.
  • the transmission / reception device 40 is provided on the wired LAN I / F 48 (wired transmission / reception means) and the safety fence 50 and is connected to the wired LAN I / F 48 by wire and the teaching operation device 10 And a charging device 60 (terminal) that is detachably connected. Then, the robot control system gives waypoint information 84 indicating that the data has passed through the transmission / reception device 40 to the reception data received via the charging device 60 (terminal) and the wired LAN I / F 48 (wired transmission / reception means).
  • the information provision part 46 (2nd provision means) is provided.
  • the transit point information is added to the received data from the teaching operation device 10 connected to the charging device 60 by the transit point information adding unit 46, so that the communication with the teaching operation device 10 communicated from the charging device 60 is performed.
  • the establishment of the safety communication is permitted, and the operation accompanied by the operation of the robot R based on the teaching data is permitted. From this, for example, even when an operator having the teaching operation device 10 connected to the charging device 60 tries to enter an area surrounded by the safety fence 50, the operator's safety can be ensured.
  • a second embodiment will be described with reference to FIG.
  • Each of the transmission / reception devices 40A and 40B includes a wireless LAN I / F 42, a volume switch 44, a waypoint information adding unit 46, a memory 46a, and a wired LAN I / F 48, as in the case of the transmission / reception device 40.
  • FIG. Not shown.
  • the wired LAN I / F 48 of the transmission / reception device 40A is connected to the connector 62 of the charging device 60, and the communication cable 41 of the transmission / reception device 40A is connected to the wired LAN I / F 48 of the transmission / reception device 40B.
  • the waypoint information adding unit 46 of the transmission / reception device 40B is connected to the Ethernet card 22 in the robot control device 20 via the first connector 26 via the communication cable 41.
  • the received data from the teaching operation device 10 is used.
  • the ID information of each of the transmission / reception devices 40 ⁇ / b> A and 40 ⁇ / b> B is set as a route information 84 in a certain data packet and transmitted to the Ethernet card 22.
  • the ID information of only the transmission / reception device 40B is set as the waypoint information 84 in the data packet that is received data from the teaching operation device 10. Then, it is transmitted to the Ethernet card 22.
  • FIG. 1B there are two robots as an example, but even if the number of robots exceeds two, similarly, only the ID information of the transmitting / receiving device via the received data received from the teaching operation device is used. Is set in the waypoint information 84.
  • the second embodiment has the following features. (1) In the robot control system of the second embodiment, two (a plurality of) robots R1 and R2 each having transmission / reception devices 40A and 40B (transmission / reception means) and a waypoint information giving unit 46 (first giving means) are arranged. Has been.
  • the transmission / reception devices 40A and 40B are connected in series to each other and then connected to the robot control device 20 (movable machine control device).
  • the robot control device 20 is provided with a robot control unit 32 (determination means). It is done.
  • the transit point information is given to the reception data received by each of the transmission / reception devices 40A and 40B by the transit point information assigning unit 46 (first granting unit) provided in each of the robots R1 and R2.
  • Ethernet card 22 is used as a communication device, but the present invention is not limited to the Ethernet card, and other standard LAN boards may be used.
  • the transmission / reception device 40 may be provided inside the robot R or may be provided outside the robot R.
  • the transmission / reception device 40 is not necessarily limited to being attached to the robot R. Instead, it may be arranged near the robot R.
  • the robot control unit 32 when the charging device 60 is omitted, in order to establish safety communication, the operator first brings the teaching operation device 10 into the safety fence 50. For this reason, when the robot control unit 32 receives the received data to which the confirmed data is given from the Ethernet card 22, the position of the teaching operation device 10 that is the transmission source of the received data is set in the wirelessly operable region. It may be determined that it is within the network, and “safe communication establishment permission” may be granted. In this case, the robot control unit 32 sends the “permission for establishment of safety communication”, and after the establishment of the safety communication with the teaching operation device 10, grants “operation permission” for permitting an operation involving the operation of the robot R. To do.
  • the transit point information is ID information of the transmission / reception device 40 in the embodiment, but is not limited to ID information, and may be information that can identify the transmission / reception device 40 through which the reception data has passed.
  • the plug of the first connector is configured so as not to be connected to the jack of the second connector, but the plug of the first connector may be connectable to the jack of the second connector. Even in this case, since the plug of the second connector is configured so as not to be connected to the jack of the first connector, after all, the teaching data erroneously transmitted from the local area LAN is transmitted to the robot controller 32. None sent.
  • the non-operation processing unit 34 connected to the second connector does not control the movable machine, so that the movable machine malfunctions. I don't have to.
  • the charging device 60 has a terminal function, but may be changed to a terminal having no charging function.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

ロボット制御システムは、送受信装置(40)の無線通信可能範囲である無線操作可能領域内にロボットが位置するように設けられ、ロボット制御装置(20)が無線操作可能領域外に配置される。経由地情報付与部(46)は送受信装置(40)が受信した受信データに、送受信装置(40)を経由したことを示す経由地情報を付与する。ロボット制御部(32)は経由地情報が付与された受信データに基づき受信データの発信元である教示操作装置(10)の位置が無線操作可能領域内にあるか否かを判定し、その判定結果に基づき教示操作装置(10)との安全通信の確立を許可し、教示データによるロボットの動作を伴う操作を許可する。それにより、教示作業を行う可動機械の位置する領域を含む所定領域の外方からの操作によって、予期せずに可動機械が動作するのを防止し、前記所定領域内の作業者の安全を確保することができる可動機械制御システムが提供される。

Description

可動機械制御システム
 本発明は、可搬式の教示操作装置と可動機械の制御装置とを無線で接続する可動機械制御システムに関する。
 従来、可動機械の制御装置と可搬式の教示操作装置との間で、無線通信を行いながら運用する可動機械制御システムが提案されている(特許文献1~3参照)。これらの装置では、一般的に作業者は、可動機械の制御装置にケーブルでつなげられて機械的に動作する可動機械を前に、教示操作装置を使ってその可動機械に対する動作教示を行う。この場合、図4において、ロボットなどの可動機械の制御装置500は、安全柵530の外方に配置され、可動機械540は安全柵530の内部に配置される。特に、特許文献2,3では、図4に示されているように、可動機械の制御装置500が教示操作装置510との間で無線通信を行うための送受信機器520は、これまで制御装置500の中か、その近傍に配置している。
特開2008-009872号公報 特開2007-042061号公報 特開2006-341356号公報
 ところが、特許文献2,3に示される従来の方法では以下の問題を解決することができなかった。
 すなわち、送受信機器520との間で安全通信を確立している教示操作装置510が、安全柵530内にある可動機械540の付近に位置しているか否かを判別できない。そのため、安全柵530の外方から、安全通信を確立している教示操作装置510による可動機械540の動作を禁止することができない。すなわち、図5に示すように安全柵530の安全防護空間内に別の作業者Mがいる場合には、その作業者Mが危険な状態にさらされる。ここで、安全通信とは、緊急の場合に、教示操作装置510に設けられた非常停止スイッチ(図示しない)の操作によって可動機械540の動作を停止するために行われる通信のことである。仮に、この安全通信に通信異常があった場合においても、この通信異常を制御装置500で検出して自動的に可動機械540を停止することが行われる。又、送受信機器520と教示操作装置510との間で安全通信を確立した場合、その教示操作装置510以外の教示操作装置とは、安全通信は確立できないようになっている。安全通信を確立していない他の教示操作装置とは、安全通信以外の通信、例えば、ロボットの操作を伴わない単なるデータ通信等の通信の場合は可能である。
 本発明の目的は、教示作業を行う可動機械の位置する領域を含む所定領域の外方からの操作によって、予期せずに可動機械が動作するのを防止し、前記所定領域内の作業者の安全を確保することができる可動機械制御システムを提供することにある。
 上記問題点を解決するために、本発明の第1の態様では、教示データを無線で送る可搬式の教示操作装置と、前記教示データを受信する送受信手段と、前記送受信手段が受信した教示データに基づいて可動機械を制御する制御装置を備えた可動機械制御システムが提供される。その可動機械制御システムは、前記送受信手段の無線通信可能範囲を前記可動機械の無線操作可能領域とし、該無線操作可能領域内に前記可動機械が配置されるとともに、前記制御装置が前記無線操作可能領域の外方に配置され、前記送受信手段が受信した受信データに、該送受信手段を経由したことを示す経由地情報を付与する第1付与手段と、前記経由地情報が付与された受信データに基づいて、受信データの発信元である可搬式教示操作装置の位置が前記無線操作可能領域内にあるか否かを判定し、その判定結果に基づいて教示操作装置との安全通信の確立を許可し、教示データによる前記可動機械の動作を伴う操作を許可する判定手段を備えることを特徴とする。
 そのため、本発明の第1の態様によれば、教示作業を行う可動機械の位置する領域を含む所定領域の外方からの操作によって、予期せずに可動機械が動作するのを防止し、教示作業を行う可動機械の位置する領域を含む所定領域内の作業者の安全を確保することができる。この所定領域とは、送受信手段の無線通信可能領域である。すなわち、可動機械を無線により操作可能な領域(無線操作可能領域)である。
 可動機械制御システムは、前記送受信手段の無線出力を可変する可変手段を備え、前記無線操作可能領域は、前記可変手段にて前記送受信手段の無線出力を変更することにより変更可能であることが好ましい。この場合、可変手段により、無線操作可能領域を調整でき、その領域内の作業者の安全を確保することができる。
 前記送受信手段は可動機械に設けられていることが好ましい。この場合、送受信手段が可動機械に設けられていることにより、可動機械を中心とした領域、すなわち、無線操作可能領域内において、作業者の安全を確保することができる。
 前記送受信手段及び第1付与手段をそれぞれ有する複数の可動機械が配置され、各送受信手段が有線で互いに直列接続された上で、前記制御装置に接続され、前記制御装置に前記判定手段が設けられ、前記各送受信手段が受信した受信データに、各可動機械に設けられた第1付与手段により、前記経由地情報がそれぞれ付与されることが好ましい。この場合、複数の可動機械がある場合においても、教示作業を行う可動機械の位置する領域を含む前記所定領域(すなわち、送受信手段の無線通信可能領域)内の作業者の安全を確保することができる。
 前記可動機械を制御する制御部を備える制御装置に通信機器が設けられ、前記通信機器には、前記送受信手段と前記判定手段を仲介する第1コネクタが設けられ、さらに、前記通信機器には、前記制御装置に設けられて、可動機械の制御に無関係の動作外処理を行う動作外処理部と構内ネットワークとを仲介する第2コネクタが設けられ、第2コネクタのプラグは、第1コネクタのジャックに対して接続不能に構成されていることが好ましい。
 この場合、第2コネクタのプラグは、第1コネクタのジャックに接続不能に構成されていることから、誤接続が防止できる。この結果、構内ネットワークからの教示データが送られてくることによる可動機械の誤作動を防止して教示作業を行う可動機械の位置する領域を含む所定領域内の作業者の安全を確保することができる。又、第2コネクタのプラグは、第1コネクタのジャックに接続不能に構成されているため、構内ネットワークに誤って入った教示データが第1コネクタを介して、可動機械制御部に送信されることがない。
 前記可動機械が安全柵により囲まれるとともに、前記制御装置が前記安全柵で囲まれた領域外に配置され、前記無線操作可能領域が、前記安全柵で囲まれた領域に含まれることが好ましい。この場合、安全柵外からの操作によって、予期せずに可動機械が動作するのを防止でき、教示作業を行う可動機械の位置する領域を含む所定領域内の作業者の安全を確保することができる。
 前記送受信手段が有線送受信手段を含み、前記安全柵に設けられて、前記有線送受信手段に有線で接続されるとともに、教示操作装置と着脱自在に接続されるターミナルと、前記ターミナル及び有線送受信手段を介して受信した受信データに該送受信手段を経由したことを示す経由地情報を付与する第2付与手段とを備え、前記判定手段は、前記第2付与手段により経由地情報が付与された受信データに基づいて、該受信データの発信元である教示操作装置の位置が前記ターミナルの位置に位置していることを判定することが好ましい。この場合、ターミナルに接続された教示操作装置からの受信データに対して第2付与手段により経由地情報が付与されるため、ターミナルから通信した教示操作装置との安全通信の確立を許可し、教示データによる前記可動機械の動作を伴う操作を許可する。この結果、例えば、ターミナルに接続した教示操作装置を有する作業者が、これから安全柵で囲まれた領域に入ろうとする場合にもこの作業者の安全を確保することができる。
(a)は本発明を具体化した第1実施形態のロボット制御システムの概略を示す説明図、(b)は、第2実施形態のロボット制御システムの概略を示す説明図。 本発明を具体化した第1実施形態のロボット制御システムのブロック図。 データパケットの説明図。 従来のロボット制御システムの説明図。 従来のロボット制御システムの説明図。
 第1実施形態
 以下、本発明の可動機械制御システムをロボット制御システムに具体化した第1実施形態を図1(a)、図2、及び図3を参照して説明する。
 図1に示すように、ロボット制御システムは、可搬式の教示操作装置10と、可動機械の制御装置としてのロボット制御装置20とがネットワーク手段としての無線LAN(ローカルエリアネットワーク)を介して接続されている。
 なお、ロボット制御装置20に対して、複数の教示操作装置10が接続可能であるが、説明の便宜上、図1(a)では、1つの教示操作装置10のみを示している。
 ロボット制御装置20が制御するロボットRは、例えば溶接ロボットである。可動機械としては、溶接ロボットに限定されるものではなく、搬送ロボット以外の装置であってもよい。
 ロボットRは、安全柵50に囲まれている。安全柵50で囲まれた空間は、ロボットのマニピュレータの作動が許容される空間、及び作業者が入る許容空間となる。安全柵50には、図示しない扉が設けられており、該扉を開放することにより、安全柵50内に作業者が入ることが可能である。
 図2に示すように、教示操作装置10はCPU(中央処理装置)11、ROM12、RAM13、ハードディスク14、無線LANI/F(インターフェイス)15、キーボード16、表示装置17及び有線LANI/F(インターフェイス)18の各部を備えるとともに、各部はバス19を介して接続されている。
 ROM12には、教示操作装置10からのロボットの操作や通信を実行するためのRDP(リモートデスクトップ)クライアントプログラムが格納されている。ROM12が格納するプログラムには、例えば、ロボット制御装置20から取得したGUI(Graphical user interface)画面データを表示装置17に表示制御するためのGUI表示処理プログラムが含まれる。又、ROM12には、CPU11をパーソナルコンピュータとして機能させるための各種プログラムが格納されている。RAM13は、CPU11のワーキングエリアとして用いられ、計算途中のデータが一時的に格納されている。ハードディスク14には、制御プログラムの実行変数が格納されている。
 無線LANI/F15はロボット制御装置20との無線接続に使用される通信機である。又、有線LANI/F18はロボット制御装置20との有線接続に使用される通信機である。キーボード16は教示操作装置10の操作者(すなわち、作業者)がロボットの操作を示す教示データを入力するためのインターフェイスとして使用される。表示装置17は教示操作装置10の作業者がロボットの操作条件や動作状態を確認するための表示機として使用される。
 図示はしないが、教示操作装置10の各種回路の電源としては2次電池が使用され、この2次電池を充電するために、教示操作装置10は、前記安全柵50に設けられた充電機器60に着脱自在に取付可能である。又、充電機器60には、有線LANI/F18に対して取り外し可能に接続されるコネクタ62が設けられ、前記教示操作装置10が充電機器60に対して充電のために取付けられた場合には、前記有線LANI/F18とコネクタ62とが接続可能である。充電機器60はターミナルに相当する。なお、図2では、説明の便宜上、教示操作装置10が充電機器60に取付けられた状態が示されている。前記コネクタ62はロボットRに設けられた送受信手段としての送受信装置40に有線で接続されている。送受信装置40はロボットRの内部に設けられていても良く、外部に取付けられていても良い。
 前記送受信装置40は、無線LANI/F42、無線出力調整のためのボリュームスイッチ44、経由地情報付与部46及び有線LANI/F48を備えている。ボリュームスイッチ44は可変手段に相当し、図示しない操作ツマミを手動操作することにより、無線LANI/F42の無線出力の調整が可能である。本実施形態では、ボリュームスイッチ44の調整操作により、無線LANI/F42の無線出力(すなわち、出力電波強度)が前記安全柵50内の領域をカバーして、無線通信が可能になっているとともに、安全柵50外からの無線通信ができないようにされている。すなわち、ロボットRの無線操作可能領域が前記ボリュームスイッチ44により変更可能であり、ボリュームスイッチ44の調整操作により無線操作可能領域全体が安全柵50で囲まれた領域に含まれるように設定されている。この無線操作可能領域は送受信装置40の無線通信可能範囲である。
 なお、ボリュームスイッチ44を省略してもよい。この場合、ロボットRの位置、すなわち、送受信装置40の位置と安全柵50で囲まれる領域とを測定して、無線出力範囲すなわち、出力電波強度が、安全柵50で囲まれる領域をカバーして、無線通信が可能になるように、回路構成を設定したり、或いはソフトウェアによって無線出力範囲を設定するようにしてもよい。
 無線LANI/F42は、教示操作装置10はじめとする複数の教示操作装置の無線LANI/F15と交信可能である。無線LANI/F42と無線LANI/F15とはパケット通信が可能である。教示操作装置10から送信されるデータパケットは、教示操作装置10のCPU11により予め定められた通信プロトコルによってパケットの形式で生成される。
 図3は、教示操作装置10から無線通信又は有線通信で送信されるデータパケットの一例を示している。同図に示すように、前記データパケットには、教示操作装置10から、送信したいロボット制御装置20を特定する宛先データ70、送信元を特定する送信元データ80、教示データを含むTP(ティーチペンダント)データ90、誤り検出データ100が含まれる。前記送信元データ80は、TP情報82と経由地情報84とからなる。前記TP情報82は、送信元を特定するためのID情報である。経由地情報84は、このデータパケットがどこを経由したかを示すID情報であるが、教示操作装置10から送信された際の経由地情報は、どこも経由していないことを示す初期値がセットされる。
 有線LANI/F48は、充電機器60のコネクタ62と接続される通信ケーブルに接続され、コネクタ62を介して接続された教示操作装置の有線LANI/Fとパケット通信が可能である。有線LANI/F48は有線送受信手段に相当する。有線送受信で使用されるデータパケットは、前記無線通信でのデータパケットと同じである。
 図2に示す経由地情報付与部46は、無線LANI/F42及び有線LANI/F48にそれぞれ接続されている。経由地情報付与部46は、無線LANI/F42、又は有線LANI/F48を介して受信したデータパケットの経由地情報84に、メモリ46aに予め格納している送受信装置40のID情報をセットし、該データパケットの経由地が当該送受信装置40であることを示す。そして、経由地情報付与部46は、経由地情報をセットしたデータパケットをロボット制御装置20に送信する。前記経由地情報付与部46は、第1付与手段及び第2付与手段に相当し、送受信装置40のID情報は経由地情報に相当する。
 ロボット制御装置20は、通信機器としてのイーサーネット(登録商標)カード22に設けられたID確認回路24と、メインボード30に設けられたロボット制御部32及び動作外処理部34とを備えている。
 前記イーサーネットカード22は、前記送受信装置40の経由地情報付与部46に接続される第1コネクタ26と、構内ネットワークとしての構内LANに接続される第2コネクタ28とを備えている。第1コネクタ26は、イーサーネットカード22に設けられた図示しない雌型のジャックと、送受信装置40から延出された通信ケーブル41の端に設けられ、該ジャックに接続された雄型のプラグ(図示しない)からなる。又、第2コネクタ28は、イーサーネットカード22に設けられた図示しない雌型のジャックと、構内LANに接続された通信ケーブル52の端に設けられ、該ジャックに接続された雄型のプラグ(図示しない)からなる。
 そして、第1コネクタ26のプラグと、第2コネクタのプラグとは、形状が異なっており、互いに他のコネクタのジャックには接続できないようになっている。このことにより、構内LANの通信ケーブル52は、第1コネクタ26のジャックに対して接続不能である。また、送受信装置40の通信ケーブル41は第2コネクタ28のジャックに対して接続不能である。
 ID確認回路24は、第1コネクタ26を介して接続された送受信装置40及び第2コネクタ28を介して接続された構内LANと切り替え接続可能になっている。そして、送受信装置40及び構内LANのいずれかから受信データを受信すると、ID確認回路24は、送受信装置40、構内LANからの受信データ(すなわち、データパケット)に含まれる経由地情報84を確認する。又、ID確認回路24は、第1コネクタ26を介して受信した受信データの経由地情報84から送受信装置40のID情報の確認がとれた場合、すなわち、経由地情報84と予め記憶している送受信装置40のID情報とが一致した場合のみ、その受信データに対して、確認済のデータを付与した上で、該受信データをロボット制御部32に送信する。
 メインボード30に設けられたロボット制御部32は、図示はしないがCPU、ROM、RAM、ロボットRを駆動するためのサーボドライバ、及びビデオRAM等の各部を備えているとともに、各部はバス(図示しない)を介して接続されている。前記ROMには、ロボット制御装置20が制御対象とするロボットRの動作制御を実行するための制御プログラムとその制御定数、GUIプログラム、RDPホストプログラム等の各種プログラムが格納されている。前記サーボドライバは、ロボットRの各関節を駆動する図示しないモータに接続され、該モータに通電する電流を制御する。そして、前記CPUは、教示データに基づいて、前記サーボドライバを介してロボットRを制御する。前記ビデオRAMは、教示操作装置10の表示装置17に表示するGUI画面のデータを教示操作装置10へ送出する前に一時保存するために使用される。
 ロボット制御部32は、イーサーネットカード22から、確認済のデータが付与された前記受信データを受けると、その受信データの発信元である教示操作装置10の位置が前記無線操作可能領域内にあるか、或いは、安全柵50に設けられた充電機器60に位置すると判定して、「安全通信の確立許可」を出力する。又、ロボット制御部32は、前記「安全通信の確立許可」を出力して、教示操作装置との安全通信が確立した後、ロボットRの動作を伴う操作を許可する「操作許可」を出力する。この操作許可を受けた、教示操作装置のみが、ロボットRの教示データによる操作が可能となる。ロボット制御部32は、可動機械制御部及び判定手段に相当する。
 動作外処理部34は図示はしないがCPU、ROM、RAMを備えており、前記イーサーネットカード22を介して接続された構内LANからの指令により、前記ロボット制御とは無関係のロボット動作外処理を行う。このロボット動作外処理とは、例えば、ロボットRを管理するためのデータ作成、メンテナンス情報等の集計、報告等の処理があるが、これらの処理に限定されるものではない。
 さて、上記のように構成されたロボット制御システムの作用を以下に説明する。なお、説明の便宜上、安全柵50内には作業者が入っておらず、教示操作装置10は送受信装置40と安全通信を行っていないものとする。
 ここで、安全通信とは、緊急の場合に、教示操作装置に設けられた非常停止スイッチ(図示しない)の操作によってロボットRの動作を停止するために行われる通信のことである。仮に、この安全通信に通信異常があった場合においても、この通信異常をロボット制御装置20で検出して自動的にロボットRの動作を停止することが行われる。又、送受信装置40との間で教示操作装置と安全通信を確立した場合、送受信装置40と安全通信を確立した教示操作装置以外の教示操作装置とは、安全通信は確立できないようになっている。なお、安全通信を確立していない他の教示操作装置とは、安全通信以外の通信、例えば、ロボットの操作を伴わない単なるデータ通信等の通信の場合は可能である。
 作業者は、図示しない扉を開けて安全柵50内に入ってから、教示操作装置10と送受信装置40とを無線通信で接続し、安全通信を確立する。すなわち、この場合、作業者がキーボード16の操作により教示操作装置10の接続を要求して、教示操作装置10からデータパケット(信号)を無線で送信させる。このデータパケット(信号)は、ロボットRの送受信装置40を経由し、通信ケーブル41で接続されたロボット制御装置20内部のイーサーネットカード22に送られる。
 送受信装置40を経由するとき、送受信装置40において、教示操作装置10からの受信データは、送受信装置40のID情報が経由地情報84にセット(付与)されて、イーサーネットカード22に送出される。イーサーネットカード22では、ID確認回路24が前記受信データの経由地情報84を確認し、経由地情報84と予め記憶している送受信装置40のID情報とが一致した場合のみ、その受信データに対して、確認済を示すデータを付与した上で、該受信データをロボット制御部32に送る。
 この受信データを受けると、ロボット制御部32は、自身が他の教示操作装置と安全通信をしていないことを確認する。また、ロボット制御部32は、経由地情報84に基づいて、イーサーネットカード22の第1コネクタ26を経由して受信データを受けたか否かを、確認済を示すデータが受信データに存在しているか否かに応じて判定する。
 この後、受信データに確認済を示すデータがある場合には、ロボット制御部32は、安全通信許容をイーサーネットカード22及び前記TP情報82を介して教示操作装置10に送る。教示操作装置10が、この安全通信許容を受けると、安全通信が確立される。
 なお、作業者は、安全柵50内に入る場合、安全柵50内に入る前に充電機器60に教示操作装置10をセットしてコネクタ62と接続し、ロボット制御装置20と安全通信を確立してもよい。この場合、作業者がキーボード16の操作により教示操作装置10の接続を要求することにより、教示操作装置10からデータパケット(信号)を有線でロボットRの送受信装置40に送信する。該データパケット(信号)は、通信ケーブル41で接続されたロボット制御装置20内部のイーサーネットカード22に送られることになる。
 前記のようにロボット制御部32は、安全通信が確立した後、イーサーネットカード22及び送受信装置40を介して、教示操作装置10に「操作許可」を付与する。
 このように安全通信が確立した後、作業者は教示操作装置10を充電機器60から取り外して、図示しない扉を開けて安全柵50内に入る。この後、作業者は教示操作装置10のキーボード16を操作して、データパケットを無線通信で送信する。
 又、ロボット制御装置20から、イーサーネットカード22の第1コネクタ26を通じて送信される通信データは、全てロボットRの送受信装置40を経て教示操作装置10に届くことになる。一方、送受信装置40は無線、有線接続を問わず、教示操作装置10から受信したデータパケットの中に自らに割り振られているID情報を追加した後で、そのデータをイーサーネットカード22に送ることになる。
 そして、イーサーネットカード22の第1コネクタ26から受信したデータであることと、データパケット内の送受信装置40のID情報(すなわち、固有ID)を確認することによって、ロボット制御装置20は受信データが安全柵50内に入っている、または入ろうとする作業者の教示操作装置10から受信したデータであることが判別できる。
 さて、本実施形態によれば、以下のような特徴がある。
 (1) 本実施形態のロボット制御システムは、送受信装置40(送受信手段)の無線通信可能範囲を無線操作可能領域とし、該無線操作可能領域内にロボットRが位置するように設けられるとともに、ロボット制御装置20が前記無線操作可能領域の外方に配置されている。又、ロボット制御システムは、送受信装置40が受信した受信データに、送受信装置40を経由したことを示す経由地情報84を付与する経由地情報付与部46(第1付与手段)を備える。ロボット制御システムは経由地情報84が付与された受信データに基づき、受信データの発信元である教示操作装置10の位置が無線操作可能領域内、又は、ターミナルである充電機器60の位置であると判定して、その判定結果に基づいて教示操作装置10との安全通信の確立を許可し、教示データによるロボットRの動作を伴う操作を許可するロボット制御部32(判定手段)を備える。
 この結果、教示作業を行うロボットRの位置する領域を含む所定領域以外からの操作によって、予期せずにロボットRが動作するのを防止でき、教示作業を行うロボットRの位置する領域を含む所定領域内の作業者の安全を確保することができる。
 (2) 本実施形態のロボット制御システムでは、送受信装置40(送受信手段)の無線出力を可変するボリュームスイッチ44(可変手段)を備え、送受信装置40の無線操作可能領域は、ボリュームスイッチ44にて送受信装置40の無線出力を変更可能である。この結果、ボリュームスイッチ44により、無線操作可能領域を調整でき、その領域内の作業者の安全を確保することができる。
 (3) 本実施形態のロボット制御システムでは、送受信装置40(送受信手段)がロボットR(可動機械)に設けられていることにより、ロボットRを中心とした領域、すなわち、無線操作可能領域内において、作業者の安全を確保することができる。
 (4) 本実施形態のロボット制御システムでは、ロボット制御部32(可動機械制御部)を備えるロボット制御装置20に通信機器としてのイーサーネットカード22(LANカード)が設けられ、イーサーネットカード22には、送受信装置40と、ロボット制御部32(判定手段)を仲介する第1コネクタ26が設けられている。又、イーサーネットカード22には、ロボット制御装置20に設けられて、ロボット制御に無関係のロボット動作外処理を行う動作外処理部34と構内LANとを仲介する第2コネクタ28が設けられている。そして、第1コネクタ26のプラグは、第2コネクタ28のジャックに対して接続不能に構成され、第2コネクタ28のプラグは、第1コネクタ26のジャックに対して接続不能に構成されていることから、誤接続が防止できる。この結果、構内LANからの教示データが送られてくることによるロボットRの誤作動を防止して、教示作業を行うロボットRの位置する領域を含む所定領域内の作業者の安全を確保することができる。
 すなわち、第2コネクタ28を介して、構内LANから、誤って教示データが受信データとして入った場合においても、第2コネクタ28に接続される動作外処理部34は、ロボット制御を行うことがないため、ロボットRが誤動作することもない。又、さらに、第2コネクタ28のプラグは、第1コネクタ26のジャックに接続不能に構成されているため、構内LANに誤って入った教示データが第1コネクタ26を介して、可動機械制御部に送信されることもない。この結果、ロボットRの位置する領域を含む所定領域内の作業者の安全を確保することができる。
 (5) 本実施形態のロボット制御システムでは、ロボットRが安全柵50により囲まれるとともに、ロボット制御装置20が安全柵50で囲まれた領域外に配置されている。又、ロボットRの無線操作可能領域が、安全柵50で囲まれた領域に含まれている。この結果、安全柵50の外方からの操作によって、予期せずにロボットRが動作するのを防止でき、教示作業を行うロボットRの位置する領域を含む所定領域内の作業者の安全を確保することができる。
 (6) 本実施形態のロボット制御システムでは、送受信装置40が有線LANI/F48(有線送受信手段)と、安全柵50に設けられて有線LANI/F48に有線で接続されるとともに教示操作装置10と着脱自在に接続される充電機器60(ターミナル)とを備える。そして、ロボット制御システムは、充電機器60(ターミナル)及び有線LANI/F48(有線送受信手段)を介して受信した受信データに、送受信装置40を経由したことを示す経由地情報84を付与する経由地情報付与部46(第2付与手段)を備える。
 この結果、充電機器60に接続された教示操作装置10からの受信データに対して経由地情報付与部46により経由地情報84が付与されるため、充電機器60から通信した教示操作装置10との安全通信の確立を許可し、教示データによるロボットRの動作を伴う操作を許可する。このことから、例えば、充電機器60に接続した教示操作装置10を有する作業者が、これから安全柵50で囲まれた領域に入ろうとする場合にもこの作業者の安全を確保することができる。
第2実施形態
 次に、第2実施形態を図1(b)を参照して説明する。なお、前記実施形態と同一又は相当する構成については、同一符号を付し、異なる構成を中心に説明する。
 第2実施形態では、図1(b)に示すように、安全柵50内にロボットR1,R2が併設されたときのように複数のロボットが50内に配置されている場合、これらのロボットR1,R2にそれぞれ送受信装置40A,40Bが配置されている。
 送受信装置40A,40Bは、それぞれ送受信装置40と同様に無線LANI/F42、ボリュームスイッチ44、経由地情報付与部46、メモリ46a及び有線LANI/F48を備えるが、図1(b)では説明の便宜上、図示していない。
 この場合、送受信装置40Aの有線LANI/F48は充電機器60のコネクタ62に接続され、送受信装置40Aの通信ケーブル41は、送受信装置40Bの有線LANI/F48に接続される。又、送受信装置40Bの経由地情報付与部46は、通信ケーブル41を介して、ロボット制御装置20におけるイーサーネットカード22に対して第1コネクタ26を介して接続される。
 従って、第2実施形態では、充電機器60に教示操作装置10がセットされた場合、又はロボットR1の送受信装置40Aで教示操作装置10と無線交信された場合、教示操作装置10からの受信データであるデータパケットに、経由地情報84として送受信装置40A,40BのそれぞれのID情報がセットされ、イーサーネットカード22に送信される。又、ロボットR2の送受信装置40Bでのみ教示操作装置10と無線交信された場合、教示操作装置10からの受信データであるデータパケットには、経由地情報84として送受信装置40BのみのID情報がセットされて、イーサーネットカード22に送信されることになる。
 なお、図1(b)では、例示としてロボットは2台としているが、2台を越えてロボットを配置しても同様に、教示操作装置から受信した受信データの経由した送受信装置のID情報のみが、経由地情報84にセットされることになる。
 第2実施形態では、下記の特徴がある。
 (1) 第2実施形態のロボット制御システムは、送受信装置40A,40B(送受信手段)及び経由地情報付与部46(第1付与手段)をそれぞれ有する2台(複数)のロボットR1,R2が配置されている。
 又、同システムでは、各送受信装置40A,40Bが互いに直列接続された上で、ロボット制御装置20(可動機械制御装置)に接続され、ロボット制御装置20にロボット制御部32(判定手段)が設けられる。又、同システムでは、各送受信装置40A,40Bが受信した受信データに、各ロボットR1,R2に設けられた経由地情報付与部46(第1付与手段)により、前記経由地情報がそれぞれ付与される。この結果、本実施形態では、複数のロボットR1,R2がある場合においても、教示作業を行うロボットの位置する領域を含む所定領域(すなわち、送受信装置40の無線通信可能領域)内の作業者の安全を確保することができる。
 なお、本発明の実施形態は以下のように変更してもよい。
 前記各実施形態では、通信機器としてイーサーネットカード22を使用したが、イーサーネットカードに限定されるものではなく、他の規格のLANボードを使用してもよい。
 前記実施形態では、送受信装置40はロボットRの内部に設けられていても良く、外部に取付する形で設けられていても良いとしたが、必ずしも、ロボットRに付設することに限定されるものではなく、ロボットRに近傍に配置してもよい。
 前記実施形態で、充電機器60を省略する場合、安全通信を確立するためには、まず、安全柵50内に教示操作装置10を作業者は持ち込むことになる。このため、ロボット制御部32は、イーサーネットカード22から、確認済のデータが付与された前記受信データを受けると、その受信データの発信元である教示操作装置10の位置が前記無線操作可能領域内にあると判定して、「安全通信の確立許可」を付与するようにしてもよい。この場合、ロボット制御部32は、前記「安全通信の確立許可」を送って、教示操作装置10との安全通信が確立した後、ロボットRの動作を伴う操作を許可する「操作許可」を付与する。
 前記経由地情報は、前記実施形態では送受信装置40のID情報としているが、ID情報に限定されるものではなく、受信データが経由した送受信装置40を特定できる情報であればよい。
 前記各実施形態では、第1コネクタのプラグは、第2コネクタのジャックに対して接続不能に構成したが、第1コネクタのプラグは、第2コネクタのジャックに接続可能であってもよい。この場合においても、第2コネクタのプラグは、第1コネクタのジャックに対して接続不能に構成されているため、結局のところ、構内LANから誤って送信された教示データが、ロボット制御部32に送信されることはない。
 又、第1のコネクタのプラグが第2のコネクタのジャックに接続されたとしても、第2コネクタに接続される動作外処理部34は、可動機械制御を行うことがないため、可動機械が誤動作することもない。
 前記各実施形態では、充電機器60にターミナルの機能を持たせたが、充電機能を持たないターミナルに変更してもよい。

Claims (7)

  1.  教示データを無線で送る可搬式の教示操作装置と、前記教示データを受信する送受信手段と、前記送受信手段が受信した教示データに基づいて可動機械を制御する制御装置を備えた可動機械制御システムにおいて、
     前記送受信手段の無線通信可能範囲を無線操作可能領域とし、該無線操作可能領域内に前記可動機械が位置するように設けられるとともに、前記制御装置が前記無線操作可能領域の外方に配置され、
     前記送受信手段が受信した受信データに、該送受信手段を経由したことを示す経由地情報を付与する第1付与手段と、
     前記経由地情報が付与された受信データに基づいて、受信データの発信元である教示操作装置の位置が前記無線操作可能領域内にあるか否かを判定し、その判定結果に基づいて教示操作装置との安全通信の確立を許可し、教示データによる前記可動機械の動作を伴う操作を許可する判定手段を備えたことを特徴とする可動機械制御システム。
  2.  前記送受信手段の無線出力を変更可能な可変手段を備え、
     前記無線操作可能領域は、前記可変手段にて前記送受信手段の無線出力を変更することにより変更可能であることを特徴とする請求項1に記載の可動機械制御システム。
  3.  前記送受信手段が可動機械に設けられていることを特徴とする請求項1又は請求項2に記載の可動機械制御システム。
  4.  前記送受信手段及び第1付与手段をそれぞれ有する複数の可動機械が配置され、
     各送受信手段が互いに直列接続された上で、前記制御装置に接続され、
     前記制御装置に前記判定手段が設けられ、
     前記各送受信手段が受信した受信データに、各可動機械に設けられた第1付与手段により、前記経由地情報がそれぞれ付与されることを特徴とする請求項1又は請求項2に記載の可動機械制御システム。
  5.  前記可動機械を制御する制御部を備える制御装置に通信機器が設けられ、
     前記通信機器には、前記送受信手段と前記判定手段を仲介する第1コネクタが設けられ、
     さらに、前記通信機器には、前記制御装置に設けられて、可動機械の制御に無関係の動作外処理を行う動作外処理部と構内ネットワークとを仲介する第2コネクタが設けられ、
     第2コネクタのプラグは、第1コネクタのジャックに対して接続不能に構成されていることを特徴とする請求項1乃至請求項4のうちいずれか1項に記載の可動機械制御システム。
  6.  前記可動機械が安全柵により囲まれるとともに、前記制御装置が前記安全柵で囲まれた領域外に配置され、
     前記無線操作可能領域が、前記安全柵で囲まれた領域に含まれることを特徴とする請求項1乃至請求項5のうちいずれか1項に記載の可動機械制御システム。
  7.  前記送受信手段が、有線送受信手段を含み、
     前記安全柵に設けられて、前記有線送受信手段に有線で接続されるとともに、教示操作装置と着脱自在に接続されるターミナルと、
     前記ターミナル及び有線送受信手段を介して受信した受信データに該送受信手段を経由したことを示す経由地情報を付与する第2付与手段とを備え、
     前記判定手段は、前記第2付与手段により経由地情報が付与された受信データに基づいて、該受信データの発信元である教示操作装置の位置が前記ターミナルの位置に位置していることを判定することを特徴とする請求項6に記載の可動機械制御システム。
PCT/JP2009/055157 2008-03-28 2009-03-17 可動機械制御システム WO2009119384A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2010505554A JP5204214B2 (ja) 2008-03-28 2009-03-17 可動機械制御システム
CN2009801057593A CN101945740B (zh) 2008-03-28 2009-03-17 可动机械控制系统

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2008087539 2008-03-28
JP2008-087539 2008-03-28

Publications (1)

Publication Number Publication Date
WO2009119384A1 true WO2009119384A1 (ja) 2009-10-01

Family

ID=41113581

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2009/055157 WO2009119384A1 (ja) 2008-03-28 2009-03-17 可動機械制御システム

Country Status (3)

Country Link
JP (1) JP5204214B2 (ja)
CN (1) CN101945740B (ja)
WO (1) WO2009119384A1 (ja)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103419199A (zh) * 2013-07-09 2013-12-04 天津大学 一种基于开放式焊接机器人的示教系统
JP2016016496A (ja) * 2014-07-10 2016-02-01 株式会社ダイヘン ロボット制御装置及びロボット制御システムの無線通信接続確立方法
JP2020189391A (ja) * 2019-05-24 2020-11-26 川崎重工業株式会社 教示システム

Families Citing this family (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6095361B2 (ja) * 2012-12-26 2017-03-15 株式会社ダイヘン ロボット制御システム
JP6530621B2 (ja) * 2015-03-17 2019-06-12 ファナック株式会社 機械と可搬式無線操作盤との間の距離に基づいて警告を発生し、または機械を停止させる機能を備えたロボット制御システム
JP6453825B2 (ja) * 2016-09-27 2019-01-16 ファナック株式会社 操作盤と無線通信を行う制御装置、無線モジュール、及び無線中継器
JP6814506B2 (ja) * 2016-12-21 2021-01-20 三菱重工機械システム株式会社 無線操作システム及びそれを使用した製函機
JP6897443B2 (ja) * 2017-09-13 2021-06-30 ブラザー工業株式会社 制御システム、副制御装置及び制御方法
JP7058126B2 (ja) * 2018-01-12 2022-04-21 株式会社日立製作所 ロボット制御装置および自動組立システム
JP6947101B2 (ja) 2018-03-28 2021-10-13 コベルコ建機株式会社 遠隔操作システム及び主操作装置
CN109291057A (zh) * 2018-11-22 2019-02-01 希美埃(芜湖)机器人技术有限公司 一种机器人无线示教系统及其控制方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6446190U (ja) * 1987-09-11 1989-03-22
WO2006080179A1 (ja) * 2005-01-26 2006-08-03 Kabushiki Kaisha Yaskawa Denki ロボットシステム
WO2006103838A1 (ja) * 2005-03-25 2006-10-05 Kabushiki Kaisha Yaskawa Denki 自動機械システムおよびその無線通信方法
JP2006321014A (ja) * 2005-05-19 2006-11-30 Yaskawa Electric Corp 自動機械システムおよびその通信制御方法
JP2007042061A (ja) * 2005-07-07 2007-02-15 Yaskawa Electric Corp 自動機械システム
JP2008093743A (ja) * 2006-10-06 2008-04-24 Yaskawa Electric Corp 自動機械システム

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN200988223Y (zh) * 2004-06-24 2007-12-12 Abb公司 用于由无线示教单元控制机器人的设备
WO2006000571A1 (en) * 2004-06-24 2006-01-05 Abb Ab Industrial robot system with a portable operator control device

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6446190U (ja) * 1987-09-11 1989-03-22
WO2006080179A1 (ja) * 2005-01-26 2006-08-03 Kabushiki Kaisha Yaskawa Denki ロボットシステム
WO2006103838A1 (ja) * 2005-03-25 2006-10-05 Kabushiki Kaisha Yaskawa Denki 自動機械システムおよびその無線通信方法
JP2006321014A (ja) * 2005-05-19 2006-11-30 Yaskawa Electric Corp 自動機械システムおよびその通信制御方法
JP2007042061A (ja) * 2005-07-07 2007-02-15 Yaskawa Electric Corp 自動機械システム
JP2008093743A (ja) * 2006-10-06 2008-04-24 Yaskawa Electric Corp 自動機械システム

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103419199A (zh) * 2013-07-09 2013-12-04 天津大学 一种基于开放式焊接机器人的示教系统
JP2016016496A (ja) * 2014-07-10 2016-02-01 株式会社ダイヘン ロボット制御装置及びロボット制御システムの無線通信接続確立方法
JP2020189391A (ja) * 2019-05-24 2020-11-26 川崎重工業株式会社 教示システム
WO2020241413A1 (ja) * 2019-05-24 2020-12-03 川崎重工業株式会社 教示システム
JP7205972B2 (ja) 2019-05-24 2023-01-17 川崎重工業株式会社 教示システム
US12005576B2 (en) 2019-05-24 2024-06-11 Kawasaki Jukogyo Kabushiki Kaisha Teaching system

Also Published As

Publication number Publication date
CN101945740B (zh) 2012-04-11
JPWO2009119384A1 (ja) 2011-07-21
JP5204214B2 (ja) 2013-06-05
CN101945740A (zh) 2011-01-12

Similar Documents

Publication Publication Date Title
JP5204214B2 (ja) 可動機械制御システム
US8022655B2 (en) Robot control system comprising a portable operating device with safety equipement
JP3140561U (ja) 無線ティーチペンダントによりロボットを制御する装置及び方法
KR101290050B1 (ko) 머니퓰레이터를 안전하게 제어하기 위한 장치 및 방법
JP2017213645A (ja) 教示装置
JP2015044280A (ja) ロボット制御装置
JP4600307B2 (ja) 自動機械システム
JP5394136B2 (ja) 無線教示操作盤およびロボット制御システム
JP2014021538A (ja) 動力工具の作業状況管理システム
JP2012148350A (ja) ロボット制御システム
JPWO2017085852A1 (ja) ロボットシステム及び遠隔制御システム
JP6300448B2 (ja) ロボット制御システム
JP4669750B2 (ja) エレベータ装置
JP5492438B2 (ja) 可動機械システム、可動機械制御システム及び判定装置
JP2010026947A (ja) 可動機械制御システム及び可動機械制御装置
CN110039541A (zh) 一种机器人安全工作控制方法和装置以及设备
KR101602930B1 (ko) 호이스트 제어장치
CN110520252B (zh) 制造系统
JP5940406B2 (ja) ロボット制御装置
KR102253791B1 (ko) 휴대용 단말을 이용한 로봇 제어 방법
JPH11165981A (ja) クレーン用無線制御装置
US11926059B2 (en) Method and system for automatically securing the operation of a robot system controlled by a mobile operating device
JP5220849B2 (ja) 可動機械の制御システム
JP2020142906A (ja) 通信方法、通信システム、送信機及び受信機
TW202031055A (zh) 容許通訊對方登錄方法

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 200980105759.3

Country of ref document: CN

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 09724670

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2010505554

Country of ref document: JP

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 09724670

Country of ref document: EP

Kind code of ref document: A1