WO2020213161A1 - ロボット - Google Patents

ロボット Download PDF

Info

Publication number
WO2020213161A1
WO2020213161A1 PCT/JP2019/016855 JP2019016855W WO2020213161A1 WO 2020213161 A1 WO2020213161 A1 WO 2020213161A1 JP 2019016855 W JP2019016855 W JP 2019016855W WO 2020213161 A1 WO2020213161 A1 WO 2020213161A1
Authority
WO
WIPO (PCT)
Prior art keywords
serial communication
control device
robot
communication line
robot control
Prior art date
Application number
PCT/JP2019/016855
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 PCT/JP2019/016855 priority Critical patent/WO2020213161A1/ja
Priority to JP2020564691A priority patent/JP6837621B1/ja
Priority to CN201980095437.9A priority patent/CN113710437A/zh
Priority to US17/602,288 priority patent/US20220152815A1/en
Priority to DE112019007060.6T priority patent/DE112019007060B4/de
Publication of WO2020213161A1 publication Critical patent/WO2020213161A1/ja

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06F—ELECTRIC DIGITAL DATA PROCESSING
    • G06F13/00—Interconnection of, or transfer of information or other signals between, memories, input/output devices or central processing units
    • G06F13/38—Information transfer, e.g. on bus
    • G06F13/42—Bus transfer protocol, e.g. handshake; Synchronisation
    • G06F13/4282—Bus transfer protocol, e.g. handshake; Synchronisation on a serial bus, e.g. I2C bus, SPI bus
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J15/00—Gripping heads and other end effectors
    • B25J15/02—Gripping heads and other end effectors servo-actuated
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00—Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0025—Means for supplying energy to the end effector
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/10—Programme-controlled manipulators characterised by positioning means for manipulator elements
    • B25J9/12—Programme-controlled manipulators characterised by positioning means for manipulator elements electric
    • B25J9/126—Rotary actuators
    • H—ELECTRICITY
    • H04—ELECTRIC COMMUNICATION TECHNIQUE
    • H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
    • H04L5/00—Arrangements affording multiple use of the transmission path
    • H04L5/14—Two-way operation using the same type of signal, i.e. duplex
    • H04L5/16—Half-duplex systems; Simplex/duplex switching; Transmission of break signals non-automatically inverting the direction of transmission

Definitions

  • the present invention relates to a robot that detects the movement of a robot arm.
  • the robot is composed of a robot arm and a robot control device that controls the robot arm.
  • a servomotor that controls the operation of each operation axis of the robot arm and a rotation position of the servomotor are detected.
  • the position detector to be used is arranged.
  • Communication between the robot control device and the position detector includes a one-to-one communication method and a one-to-many communication method in which a plurality of position detectors are connected to one serial transmission line.
  • serial transmission lines for the number of position detectors are required, and wiring in the robot arm increases, so that the wire may be disconnected due to the operation of the robot.
  • the robot described in Patent Document 1 connects a plurality of position detectors in parallel to a half-duplex serial transmission line capable of bidirectional communication, and a request signal from a drive control device to the position detector via one serial transmission line. Is output to perform one-to-many communication.
  • the present invention has been made in view of the above, and it is possible to connect a connecting device that performs half-duplex communication and a connecting device that performs full-duplex communication to a robot control device while suppressing an increase in the number of wires.
  • the purpose is to get a robot that can do it.
  • the robot of the present invention has a robot control device, a first serial communication line connected to the robot control device, and a second serial communication line connected to the robot control device. It is equipped with a serial communication line.
  • the robot of the present invention is a plurality of first connection devices that are devices that perform data communication with the robot control device, and a second connection device that is a device that performs data communication between the robot control device. And have.
  • Each of the first connected devices is connected to either the first serial communication line or the second serial communication line to perform half-duplex communication with the robot control device, and the second connected device. Is connected to the first serial communication line and the second serial communication line to perform full duplex communication with the robot control device.
  • the robot according to the present invention has the effect of being able to connect a connecting device that performs half-duplex communication and a connecting device that performs full-duplex communication to the robot control device while suppressing an increase in the number of wires.
  • the figure which shows the connection structure in the robot which concerns on Embodiment 1. The figure for demonstrating the transmission cycle in a robot which concerns on Embodiment 1.
  • the figure which shows the connection structure in the robot which concerns on Embodiment 2. The figure which shows the hardware configuration example of the control circuit which concerns on Embodiment 2.
  • FIG. 1 is a diagram showing a configuration of a robot according to the first embodiment.
  • the robot 100 includes a robot arm 20 and a robot control device 11 that controls the robot arm 20.
  • the robot arm 20 includes a plurality of servomotors 13, a plurality of position detectors 14, a serial communication line group 12, a sensor 16, an actuator 17 which is an electric actuator, and a hand 18.
  • the position detector 14, the sensor 16, and the actuator 17 perform data communication with the robot control device 11.
  • the robot arm 20 includes a servomotor 13 for each operating axis. Further, the robot arm 20 is provided with a position detector 14 for each servomotor 13.
  • FIG. 1 shows a case where the robot arm 20 has six operating axes, and includes six servomotors 13 and six position detectors 14.
  • Each servomotor 13 drives each operation axis according to an instruction from the robot control device 11.
  • the position detector 14 detects the position of the servomotor 13 and transmits the position data indicating the detected position to the robot control device 11.
  • An example of the position detector 14 is an encoder.
  • the hand 18 has a function of grasping an object.
  • the actuator 17 is an example of a connected device that performs data communication with the robot control device 11.
  • the actuator 17 drives the hand 18 according to an instruction from the robot control device 11, and transmits data on the operating state of the actuator 17 to the robot control device 11.
  • the data transmitted and received by the actuator 17 to and from the robot control device 11 is referred to as actuator data.
  • An example of the sensor 16 is a pressure sensor. When the sensor 16 is a pressure sensor, the sensor 16 detects whether or not the robot arm 20 has come into contact with another device or the like.
  • the sensor 16 transmits the sensor data, which is the detected data, to the robot control device 11.
  • the position detector 14 and the sensor 16 are the first connected devices, and the actuator 17 is the second connected device.
  • Each position detector 14, the sensor 16, and the actuator 17 are connected to the robot control device 11 via the serial communication line group 12.
  • Each position detector 14, the sensor 16, and the actuator 17 perform data communication with the robot control device 11 via the serial communication line group 12.
  • each position detector 14 and the sensor 16 are allowed to have lower communication performance than the actuator 17. That is, it is assumed that each position detector 14 and the sensor 16 can perform a desired operation even when the communication performance is deteriorated.
  • the amount of data transmitted per transmission cycle of data communication from the robot control device 11 to the second connected device (actor 17) is determined by the robot control device 11 to the first connected device (position detector 14 and sensor 16).
  • the serial communication line group 12 is a group of communication lines for performing serial communication.
  • FIG. 2 is a diagram showing a connection configuration in the robot according to the first embodiment.
  • FIG. 2 shows a case where the position detectors 14 arranged on the robot 100 are four position detectors 14A, 14B, 14C, and 14D.
  • the serial communication line group 12 has four serial communication lines.
  • the serial communication line group 12 has two sets of serial communication lines AX and two sets of serial communication lines BX.
  • the serial communication line AX which is the first serial communication line, is composed of two serial communication lines AX (A +, A-) for differential communication, and is a second serial communication line, serial.
  • the communication line BX is composed of two serial communication lines BX (B +, B ⁇ ) for performing differential communication.
  • the serial communication lines AX (A +, A-) and BX (B +, B-) can perform half-duplex communication, respectively, and the serial communication lines AX (A +, A-) and the serial communication line BX. Fully duplex communication can be performed using the four communication lines (B +, B-).
  • the A + (non-inverting) communication line may be referred to as the serial communication line A +
  • the A- (inverted) communication line may be referred to as the serial communication line A-
  • the B + (non-inverting) communication line may be referred to as the serial communication line B +
  • the B- (inverted) communication line may be referred to as the serial communication line B-.
  • the position detector 14C and the sensor 16 are connected to two communication lines, A + and A-, respectively, which are serial communication lines. Further, the position detectors 14A, 14B, and 14D are connected to two communication lines, serial communication lines B + and B-, respectively.
  • the actuator 17 is connected to four communication lines, A +, A ⁇ , B +, and B ⁇ , which are serial communication lines.
  • the robot control device 11 is connected to four communication lines A +, A-, B +, and B- serial communication lines.
  • the position detectors 14A to 14D and the sensor 16 perform half-duplex communication with the robot control device 11, and the actuator 17 performs full-duplex communication with the robot control device 11.
  • the position detectors 14A to 14D used in the half-duplex communication, the sensor 16, and the actuator 17 used in the full-duplex communication can be communicated with the robot control device 11 without reducing the communication speed. it can.
  • the robot control device 11 includes a control circuit 30, differential drives 32 and 34, and differential receivers 31 and 33.
  • the output terminal is connected to the control circuit 30, the non-inverting input terminal is connected to the serial communication line A +, and the inverting input terminal is connected to the serial communication line A ⁇ .
  • the output terminal is connected to the control circuit 30, the non-inverting input terminal is connected to the serial communication line B +, and the inverting input terminal is connected to the serial communication line B-.
  • the input terminal is connected to the control circuit 30, the non-inverting output terminal is connected to the serial communication line A +, and the inverting output terminal is connected to the serial communication line A-.
  • the input terminal is connected to the control circuit 30, the non-inverting output terminal is connected to the serial communication line B +, and the inverting output terminal is connected to the serial communication line B-.
  • the differential drives 32 and 34 and the differential receivers 31 and 33 have input terminals for enable signals.
  • the enable signal input terminal receives the enable signal sent from the control circuit 30.
  • An example of the control circuit 30 is a microcomputer.
  • the position detector 14A includes a control circuit 40A, a differential drive 41A, and a differential receiver 42A.
  • the differential drive 41A the input terminal is connected to the control circuit 40A, the non-inverting output terminal is connected to the serial communication line B +, and the inverting output terminal is connected to the serial communication line B ⁇ .
  • the differential receiver 42A the output terminal is connected to the control circuit 40A, the non-inverting input terminal is connected to the serial communication line B +, and the inverting input terminal is connected to the serial communication line B ⁇ .
  • the position detector 14B includes a control circuit 40B, a differential drive 41B, and a differential receiver 42B.
  • the differential drive 41B the input terminal is connected to the control circuit 40B, the non-inverting output terminal is connected to the serial communication line B +, and the inverting output terminal is connected to the serial communication line B ⁇ .
  • the differential receiver 42B the output terminal is connected to the control circuit 40B, the non-inverting input terminal is connected to the serial communication line B +, and the inverting input terminal is connected to the serial communication line B ⁇ .
  • the position detector 14D includes a control circuit 40D, a differential drive 41D, and a differential receiver 42D.
  • the differential drive 41D the input terminal is connected to the control circuit 40D, the non-inverting output terminal is connected to the serial communication line B +, and the inverting output terminal is connected to the serial communication line B ⁇ .
  • the differential receiver 42D the output terminal is connected to the control circuit 40D, the non-inverting input terminal is connected to the serial communication line B +, and the inverting input terminal is connected to the serial communication line B ⁇ .
  • the position detector 14C includes a control circuit 40C, a differential drive 41C, and a differential receiver 42C.
  • the differential drive 41C the input terminal is connected to the control circuit 40C, the non-inverting output terminal is connected to the serial communication line A +, and the inverting output terminal is connected to the serial communication line A ⁇ .
  • the differential receiver 42C the output terminal is connected to the control circuit 40C, the non-inverting input terminal is connected to the serial communication line A +, and the inverting input terminal is connected to the serial communication line A ⁇ .
  • the sensor 16 includes a control circuit 60, a differential drive 61, and a differential receiver 62.
  • the differential drive 61 the input terminal is connected to the control circuit 60, the non-inverting output terminal is connected to the serial communication line A +, and the inverting output terminal is connected to the serial communication line A ⁇ .
  • the differential receiver 62 the output terminal is connected to the control circuit 60, the non-inverting input terminal is connected to the serial communication line A +, and the inverting input terminal is connected to the serial communication line A ⁇ .
  • the actuator 17 includes a control circuit 70, a differential drive 71, and a differential receiver 72.
  • the differential drive 71 the input terminal is connected to the control circuit 70, the non-inverting output terminal is connected to the serial communication line B +, and the inverting output terminal is connected to the serial communication line B ⁇ .
  • the differential receiver 72 the output terminal is connected to the control circuit 70, the non-inverting input terminal is connected to the serial communication line B +, and the inverting input terminal is connected to the serial communication line B ⁇ .
  • the robot control device 11 transmits a request command to the position detectors 14A to 14D, the sensor 16, and the actuator 17.
  • the position detectors 14A to 14D, the sensor 16 and the actuator 17 receive the request command from the robot control device 11, the position detectors 14A to 14D transmit the data corresponding to the content of the request command to the robot control device 11.
  • the position detectors 14A to 14D transmit the position data to the robot control device 11.
  • the position data transmitted by the position detector 14A is referred to as position data # 1
  • the position data transmitted by the position detector 14B is referred to as position data # 2
  • the position data transmitted by the position detector 14C is referred to as position data # 2.
  • the position data transmitted by the position detector 14D may be referred to as position data # 4.
  • the sensor 16 transmits sensor data to the robot control device 11, and the actuator 17 transmits and receives actuator data to and from the robot control device 11.
  • the robot control device 11 performs half-duplex communication with the position detectors 14A, 14B, 14D using the serial communication lines B +, B-, and communicates with the position detector 14C and the sensor 16.
  • Half-duplex communication is performed using the serial communication lines A + and A-.
  • the robot control device 11 performs full-duplex communication with the actuator 17 using serial communication lines A +, A ⁇ , B +, and B ⁇ .
  • half-duplex communication can be performed for devices (position detectors 14A to 14D, sensor 16) that do not require full-duplex communication, and half-duplex communication is possible for devices (actuators 17) that require full-duplex communication.
  • Fully redundant communication can be performed. Therefore, since the robot control device 11 can secure the communication speed with the robot arm 20, the robot control device 11 can communicate with the robot arm 20 at an appropriate speed. For example, even when the number of position detectors 14 connected to the robot control device 11 is increased, the robot control device 11 can perform full duplex communication with the actuator 17, so that the robot control device 11 can communicate with the actuator 17. Communication speed can be secured. Further, even when the sensor 16 or the actuator 17 is expanded (added), it is appropriate by appropriately allocating the wiring of the position detectors 14A, 14B, 14C, 14D to the serial communication line AX or the serial communication line BX. Transmission cycle can be set.
  • FIG. 3 is a diagram for explaining a transmission cycle in the robot according to the first embodiment.
  • the horizontal axis of FIG. 3 is time.
  • the upper part of FIG. 3 shows signals transmitted and received by the robot control device 11 using the serial communication lines A + and A-, and the lower part of FIG. 3 shows the signals transmitted and received by the robot control device 11 using the serial communication lines B + and B-. Indicates signals to be sent and received.
  • the position detector 14C, the sensor 16, and the actuator 17 receive this request command.
  • the position detector 14C, the sensor 16, and the actuator 17 prepare data to be transmitted to the robot control device 11.
  • the position detector 14C, the sensor 16, and the actuator 17 individually send data request instructions from the robot control device 11, the position detector 14C, the sensor 16, and the actuator 17 transmit the data corresponding to the data request instructions to the robot control device 11. That is, the robot control device 11 reads the data to the position detector 14C and the sensor 16, and reads and writes the data to the actuator 17.
  • the sensor 16 transmits the sensor data to the serial communication line AX, and the robot control device 11 receives the sensor data (T2).
  • the position detector 14C transmits the position data # 3 to the serial communication line AX, and the robot control device 11 receives the position data # 3 (T3).
  • the robot control device 11 transmits the actuator data to the serial communication line AX (T4), and the actuator 17 receives the actuator data.
  • the actuator data transmitted by the robot control device 11 to the actuator 17 is, for example, a control signal for turning on or off the grip of the hand 18.
  • the position detectors 14A, 14B, 14D, and the actuator 17 receive this request command.
  • the position detectors 14A, 14B, 14D, and the actuator 17 prepare data to be transmitted to the robot control device 11.
  • the position detectors 14A, 14B, 14D, and the actuator 17 individually send data request instructions from the robot control device 11, the position detectors 14A, 14B, 14D, and the actuator 17 transmit the data corresponding to the data request instructions to the robot control device 11. That is, the robot control device 11 reads the data to the position detectors 14A, 14B, and 14D, and reads and writes the data to the actuator 17.
  • the position detector 14A transmits the position data # 1 to the serial communication line BX, and the robot control device 11 receives the position data # 1 (T12).
  • the position detector 14B transmits the position data # 2 to the serial communication line BX, and the robot control device 11 receives the position data # 2 (T13).
  • the position detector 14D transmits the position data # 4 to the serial communication line BX, and the robot control device 11 receives the position data # 4 (T14).
  • the actuator 17 transmits the actuator data to the serial communication line BX, and the robot control device 11 receives the actuator data (T15).
  • the actuator data received by the robot control device 11 from the actuator 17 is, for example, a signal indicating an on state or an off state of the grip of the hand 18.
  • the data transmission from T1 to T4 and the data transmission from T11 to T15 are executed in parallel.
  • the period from when the robot control device 11 starts transmitting the request command to the serial communication line AX and the serial communication line BX until both the data transmission from T1 to T4 and the data transmission from T11 to T15 are completed is the robot.
  • the transmission cycle is 100.
  • the robot control device 11 sequentially performs data communication with the connected devices connected to the serial communication line AX. For example, the robot control device 11 sends a data request instruction to the sensor 16, receives sensor data from the sensor 16, then sends a data request instruction to the position detector 14C, and receives position data # 3 from the position detector 14C. To do. After that, the robot control device 11 transmits the actuator data to the actuator 17.
  • the robot control device 11 arbitrates the reception of the half-duplex communication on the serial communication line AX and the transmission of the full-duplex communication.
  • the robot control device 11 may send a data request instruction to each of the position detector 14C and the sensor 16 at a specific timing, and may transmit actuator data to the actuator 17 at a specific timing. That is, the robot control device 11 may execute data communication with the connected device connected to the serial communication line AX at specific cycles.
  • the robot 100 may use communication other than the differential communication.
  • the number of connected devices that perform half-duplex communication is not limited to 5, and may be 4 or less, or 6 or more.
  • the number of connected devices that perform full-duplex communication is not limited to one, and may be two or more.
  • the connecting device that performs half-duplex communication may be another type of connecting device other than the position detectors 14A to 14D and the sensor 16.
  • the connecting device that performs full duplex communication may be another type of connecting device other than the actuator 17, such as an input / output device (also referred to as an IO (Input Output) device) that inputs / outputs an on signal and an off signal.
  • an input / output device also referred to as an IO (Input Output) device
  • the position detectors 14A to 14D and the sensor 16 perform half-duplex communication using the serial communication lines AX and BX, and the actuator is used by using the serial communication lines AX and BX. Since the 17 performs full-duplex communication, the actuator 17 for which full-duplex communication is desired can be connected to the one-to-many transmission line.
  • Embodiment 2 Next, a second embodiment of the present invention will be described with reference to FIG.
  • the position detector and the actuator are connected to both the serial communication lines AX and BX, and the robot control device 11 switches between half-duplex communication and full-duplex communication.
  • FIG. 4 is a diagram showing a connection configuration in the robot according to the second embodiment.
  • components that achieve the same functions as the robot 100 of the first embodiment shown in FIG. 2 are designated by the same reference numerals, and redundant description will be omitted.
  • Robot 100X is another configuration example of robot 100.
  • a plurality of position detectors 14 and actuators 17X are connected to the robot control device 11X.
  • FIG. 4 shows a case where the position detectors 14 arranged on the robot 100X are three position detectors 14P, 14Q, and 14R.
  • the robot control device 11X includes a control circuit 30X, differential drives 32 and 34, and differential receivers 31 and 33.
  • the control circuit 30X has, in addition to the function of the control circuit 30, a function of switching the position detectors 14P to 14R between half-duplex communication and full-duplex communication.
  • the position detector 14P includes a control circuit 40P, differential drives 42P and 44P, and differential receivers 41P and 43P.
  • the position detector 14Q includes a control circuit 40Q, differential drives 42Q and 44Q, and differential receivers 41Q and 43Q.
  • the position detector 14R includes a control circuit 40R, differential drives 42R and 44R, and differential receivers 41R and 43R.
  • the non-inverting input terminal is connected to the serial communication line A +, and the inverting input terminal is connected to the serial communication line A-.
  • the non-inverting output terminal is connected to the serial communication line A +, and the inverting output terminal is connected to the serial communication line A ⁇ .
  • the non-inverting input terminal is connected to the serial communication line B +, and the inverting input terminal is connected to the serial communication line B ⁇ .
  • the differential drives 44P, 44Q, 44R the non-inverting output terminal is connected to the serial communication line B +, and the inverting output terminal is connected to the serial communication line B ⁇ .
  • the output terminals of the differential receivers 41P and 43P are connected to the control circuit 40P, and the input terminals of the differential drives 42P and 44P are connected to the control circuit 40P.
  • the output terminals of the differential receivers 41Q and 43Q are connected to the control circuit 40Q, and the input terminals of the differential drives 42Q and 44Q are connected to the control circuit 40Q.
  • the output terminals of the differential receivers 41R and 43R are connected to the control circuit 40R, and the input terminals of the differential drives 42R and 44R are connected to the control circuit 40R.
  • the differential drives 42P and 44P and the differential receivers 41P and 43P have input terminals for enable signals.
  • the enable signal input terminal receives the enable signal sent from the control circuit 40P.
  • the differential drives 42Q and 44Q and the differential receivers 41Q and 43Q have input terminals for enable signals.
  • the enable signal input terminal receives the enable signal sent from the control circuit 40Q.
  • the differential drives 42R and 44R and the differential receivers 41R and 43R have input terminals for enable signals.
  • the enable signal input terminal receives the enable signal sent from the control circuit 40R.
  • control circuits 40P to 40R have the same functions and execute the same operations. Therefore, the functions and operations of the control circuits 40P will be described below.
  • the control circuit 40P has a function of switching between full-duplex communication and half-duplex communication in addition to the functions of the control circuits 40A to 40D. Specifically, the control circuit 40P has a function of transmitting an enable signal to the differential drives 42P and 44P and the differential receivers 41P and 43P in accordance with the instruction from the robot control device 11X.
  • the position detector 14P has a function of transmitting the device ID (IDentification) of the position detector 14P to the robot control device 11X.
  • the actuator 17X includes a control circuit 70X instead of the control circuit 70 as compared with the actuator 17.
  • the control circuit 70X has a function of transmitting the device ID of the actuator 17X to the robot control device 11X in addition to the function of the control circuit 70. That is, in the robot 100X, the connecting device connected to the robot control device 11X has a function of transmitting the device ID of its own connecting device to the robot control device 11X.
  • the device ID is identification information unique to the connected device.
  • An example of a device ID is a product ID of a connected device.
  • the control circuit 30X of the robot control device 11X provides each connected device with either half-duplex communication or full-duplex communication based on the number and types of connected devices connected to the robot control device 11X. Decide if you want to do it. Further, the control circuit 30X selects and sets which of the serial communication line AX and the serial communication line BX is to perform the half-duplex communication for the connected device to perform the half-duplex communication. In the second embodiment, a case where the control circuit 30X causes the position detectors 14P to 14R to perform half-duplex communication and the actuator 17X to perform full-duplex communication will be described.
  • the control circuit 30X sends a command requesting the device ID to the connected device.
  • Each connected device transmits the device ID stored in each connected device to the robot control device 11X.
  • the control circuit 30X specifies the number and type of connected devices based on the received device ID, and based on the specific result, the entire communication of the serial communication lines AX and BX is performed. Determine the load.
  • the control circuit 30X may determine the communication load based on the number of position detectors 14. That is, the control circuit 30X may determine the communication load based on the number of connected devices (position detector 14, sensor 16, etc.) that do not require full duplex communication. Since the communication load differs depending on the type of connected device, the robot control device 11X stores information on the communication load (hereinafter referred to as load information) for each device ID of the connected device.
  • the robot control device 11X is connected to a first connecting device which is a connecting device that does not require full-duplex communication and a second connecting device that is a connecting device that requires full-duplex communication.
  • the robot control device 11X has information that specifies the device ID of the connected device that may perform half-duplex communication and the device ID of the connected device that does not perform half-duplex communication (Hereinafter referred to as specified information) is stored.
  • Examples of connected devices that do not require full-duplex communication are position detectors 14P to 14R, and examples of connected devices that require full-duplex communication are actuators 17X.
  • a connected device that requires full-duplex communication is required to have a faster communication speed than a connected device that does not require full-duplex communication.
  • the control circuit 30X determines the total communication load of the serial communication lines AX and BX based on the number and type of connected devices and the load information, and based on the determination result, fully duplex communication and half for each connected device. Determine which of the duplicated communications is to be performed. The control circuit 30X determines, for example, that when the number of connected devices becomes larger than the threshold value, the connected devices that do not require full-duplex communication perform half-duplex communication.
  • control circuit 30X determines which connected device is to be made to perform half-duplex communication based on the specified information. In the second embodiment, the control circuit 30X determines that the position detectors 14P to 14R perform half-duplex communication.
  • the control circuit 30X selects the serial communication line AX or the serial communication line BX for each of the position detectors 14P to 14R based on the load information.
  • the control circuit 30X has the serial communication line AX or the serial communication line BX for each of the position detectors 14P to 14R so that the difference between the communication load on the serial communication line AX and the communication load on the serial communication line BX is minimized.
  • the control circuit 30X can suppress the transmission delay by appropriately distributing the number (number of stations) of the position detectors 14P to 14R that use the serial communication line AX or the serial communication line BX. Further, the control circuit 30X determines that the actuator 17X executes full-duplex communication.
  • the control circuit 30X transmits a command specifying the serial communication line AX or the serial communication line BX to the connected device determined to perform half-duplex communication.
  • the connected device that receives the command for which the serial communication line AX is specified enables the serial communication line AX and disables the serial communication line BX.
  • the connected device that receives the command for which the serial communication line BX is specified enables the serial communication line BX and disables the serial communication line AX.
  • the position detectors 14P to 14R perform half-duplex communication with the robot control device 11 using the designated serial communication line AX or serial communication line BX.
  • Each control circuit of each position detector switches between enabling and disabling the serial communication lines AX and BX by inputting an enable signal to the differential drive and the differential receiver. For example, when the control circuit 40P of the position detector 14P receives a command in which the serial communication line AX is specified from the control circuit 30X, the control circuit 40P inputs the enable signal ON to the differential receiver 41P and the differential drive 42P, and the differential receiver Input the enable signal off to 43P and the differential drive 44P.
  • the position detectors 14P to 14R perform half-duplex communication
  • the actuator 17X performs full-duplex communication.
  • the robot 100X determines, for example, whether or not to allow each connected device to perform half-duplex communication when a new connected device is connected to the serial communication lines AX and BX. Further, the robot 100X determines whether or not to allow each connected device to perform half-duplex communication when the connected device is removed from the serial communication lines AX and BX.
  • the robot 100X may use communication other than the differential communication.
  • the number of connected devices connected to the robot control device 11X is not limited to four, and may be three or less, or five or more.
  • another type of connecting device such as the sensor 16 may be connected to the robot control device 11X.
  • the control circuit of another type of connected device has a function of transmitting the device ID to the robot control device 11X and a function of outputting an enable signal, similarly to the position detectors 14P to 14R.
  • the robot control device 11X switches between half-duplex communication and full-duplex communication to another type of connected device by the same processing as the processing for the position detectors 14P to 14R.
  • the robot control device 11X sets half-duplex communication for the connected devices that do not require full-duplex communication based on the number and type of connected devices. Further, the robot control device 11X uses the serial communication line AX or the serial communication line as the connection device for setting the half-duplex communication so that the difference between the communication load on the serial communication line AX and the communication load on the serial communication line BX becomes small.
  • Set BX that is, the robot control device 11X distributes each of the position detectors 14P to 14R to the serial communication line AX or the serial communication line BX.
  • the robot control device 11X can secure a communication speed with the robot arm 20, so that the robot control device 11X can communicate with the robot arm 20 at an appropriate speed. Further, since the communication speed can be secured, not only the position detector 14 but also the sensor or the actuator can be expanded.
  • the position detectors 14P to 14R are connected to the serial communication line AX and the serial communication line BX. Then, when the number of position detectors 14 is larger than the threshold value, the robot control device 11X causes the position detectors 14P to 14R to perform half-duplex communication using the serial communication line AX or the serial communication line BX. As a result, the robot 100X can reduce the communication load on the serial communication lines AX and BX when the number of position detectors 14 is larger than the threshold value.
  • control circuits 30, 30X, 40A to 40D, 40P to 40R, 60, 70, 70X will be described. Since the control circuits 30, 30X, 40A to 40D, 40P to 40R, 60, 70, and 70X have the same hardware configuration, the hardware configuration of the control circuit 30X will be described here.
  • FIG. 5 is a diagram showing a hardware configuration example of the control circuit according to the second embodiment.
  • the control circuit 30X can be realized by the processor 301 and the memory 302 shown in FIG.
  • An example of the processor 301 is a CPU (Central Processing Unit, central processing unit, processing unit, arithmetic unit, microprocessor, microcomputer, processor, DSP (Digital Signal Processor)) or system LSI (Large Scale Integration).
  • An example of the memory 302 is a RAM (Random Access Memory) or a ROM (Read Only Memory).
  • the control circuit 30X is realized by the processor 301 reading and executing a program stored in the memory 302 for executing the operation of the control circuit 30X. It can also be said that this program causes a computer to execute the procedure or method of the control circuit 30X.
  • the memory 302 is also used as a temporary memory when the processor 301 executes various processes.
  • the program executed by the processor 301 may be a computer program product having a computer-readable and non-transitory recording medium containing a plurality of instructions for performing data processing, which can be executed by a computer. ..
  • the program executed by the processor 301 causes the computer to execute data processing by a plurality of instructions.
  • control circuit 30X may be realized by dedicated hardware. Further, the functions of the control circuit 30X may be partially realized by dedicated hardware and partially realized by software or firmware.
  • the configuration shown in the above-described embodiment shows an example of the content of the present invention, can be combined with another known technique, and is one of the configurations without departing from the gist of the present invention. It is also possible to omit or change the part.
  • 11,11X robot control device 12 serial communication line group, 13 servomotor, 14,14A, 14B, 14C, 14D, 14P, 14Q, 14R position detector, 16 sensor, 17,17X actuator, 18 hand, 20 robot arm , 30,30X, 40A-40D, 40P-40R, 60,70,70X Control circuit, 31,33,41P-41R, 42A-42D, 43P-43R, 62,72 Differential receiver, 32,34,41A- 41D, 42P-42R, 44P-44R, 61,71 differential drive, 100,100X robot, AX, BX serial communication line.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Theoretical Computer Science (AREA)
  • Signal Processing (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Engineering & Computer Science (AREA)
  • Artificial Intelligence (AREA)
  • Evolutionary Computation (AREA)
  • Fuzzy Systems (AREA)
  • Mathematical Physics (AREA)
  • Software Systems (AREA)
  • Manipulator (AREA)
  • Numerical Control (AREA)

Abstract

ロボット（１００）が、ロボット制御装置（１１）と、シリアル通信線（ＡＸ）と、シリアル通信線（ＢＸ）と、ロボット制御装置（１１）との間でデータ通信を行う位置検出器（１４Ａ～１４Ｄ）と、ロボット制御装置（１１）との間でデータ通信を行うアクチュエータ（１７）と、を備え、位置検出器（１４Ａ～１４Ｄ）のそれぞれは、シリアル通信線（ＡＸ）またはシリアル通信線（ＢＸ）の何れかに接続されることにより、ロボット制御装置（１１）との間で半二重化通信を行い、アクチュエータ（１７）は、シリアル通信線（ＡＸ）およびシリアル通信線（ＢＸ）に接続されることにより、ロボット制御装置（１１）との間で全二重化通信を行う。

Description

ロボット
　本発明は、ロボットアームの動作を検出するロボットに関する。
　ロボットは、ロボットアームと、ロボットアームを制御するロボット制御装置とで構成されており、ロボットアーム内には、ロボットアームの各動作軸の動作を制御するサーボモータと、サーボモータの回転位置を検出する位置検出器とが配置されている。
　ロボット制御装置と位置検出器との間の通信は、１対１で通信する方法と、１つのシリアル伝送路に複数の位置検出器を接続して、１対多で通信する方法とがある。１対１で通信する場合、位置検出器の数分のシリアル伝送路が必要になり、ロボットアーム内の配線が増えるので、ロボットの動作によって断線する場合がある。
　特許文献１に記載のロボットは、複数の位置検出器を双方向通信が可能な半二重シリアル伝送路に並列接続し、１つのシリアル伝送路を介して駆動制御装置から位置検出器にリクエスト信号を出力することで、１対多の通信を行っている。
特開２００６－２６０５８１号公報
　しかしながら、上記特許文献１の技術では、位置検出器の数が増えると伝送周期分だけ通信速度に遅れが生じるので通信性能が低下する。駆動制御装置に接続されて駆動制御装置との間でデータ通信を行うアクチュエータ等の接続機器は、位置検出器と異なり伝送路を介したデータの送受信量が多いので、通信性能が低下すると所望の動作を実行することができない。このため、データの送受信量が多い接続機器は、駆動制御装置との間で全二重化通信を行うことが望まれる。特許文献１の技術に対して、全二重化通信を行うための配線を追加すると、全二重化通信を行うための配線と、半二重化通信を行うための配線とを別々に設ける必要があり、配線数が増加するという問題があった。
　本発明は、上記に鑑みてなされたものであって、配線数の増加を抑制しつつ、半二重化通信を行う接続機器と、全二重化通信を行う接続機器とをロボット制御装置に接続することができるロボットを得ることを目的とする。
　上述した課題を解決し、目的を達成するために、本発明のロボットは、ロボット制御装置と、ロボット制御装置に接続された第１のシリアル通信線と、ロボット制御装置に接続された第２のシリアル通信線と、を備えている。また、本発明のロボットは、ロボット制御装置との間でデータ通信を行う機器である複数の第１の接続機器と、ロボット制御装置との間でデータ通信を行う機器である第２の接続機器と、を備えている。第１の接続機器のそれぞれは、第１のシリアル通信線または第２のシリアル通信線の何れかに接続されることにより、ロボット制御装置との間で半二重化通信を行い、第２の接続機器は、第１のシリアル通信線および第２のシリアル通信線に接続されることにより、ロボット制御装置との間で全二重化通信を行う。
　本発明にかかるロボットは、配線数の増加を抑制しつつ、半二重化通信を行う接続機器と、全二重化通信を行う接続機器とをロボット制御装置に接続することができるという効果を奏する。
実施の形態１にかかるロボットの構成を示す図 実施の形態１にかかるロボット内の接続構成を示す図 実施の形態１にかかるロボット内での伝送周期を説明するための図 実施の形態２にかかるロボット内の接続構成を示す図 実施の形態２にかかる制御回路のハードウェア構成例を示す図
　以下に、本発明の実施の形態にかかるロボットを図面に基づいて詳細に説明する。なお、これらの実施の形態によりこの発明が限定されるものではない。
実施の形態１．
　図１は、実施の形態１にかかるロボットの構成を示す図である。ロボット１００は、ロボットアーム２０と、ロボットアーム２０を制御するロボット制御装置１１とを備えている。
　ロボットアーム２０は、複数のサーボモータ１３と、複数の位置検出器１４と、シリアル通信線群１２と、センサ１６と、電動アクチュエータであるアクチュエータ１７と、ハンド１８とを備えている。位置検出器１４、センサ１６、およびアクチュエータ１７は、ロボット制御装置１１との間でデータ通信を行う。
　ロボットアーム２０は、動作軸毎にサーボモータ１３を備えている。また、ロボットアーム２０は、サーボモータ１３毎に位置検出器１４を備えている。図１では、ロボットアーム２０が、６軸の動作軸を有し、６つのサーボモータ１３と、６つの位置検出器１４とを備えている場合を示している。
　各サーボモータ１３は、ロボット制御装置１１からの指示に従って各動作軸を駆動する。位置検出器１４は、サーボモータ１３の位置を検出し、検出した位置を示す位置データをロボット制御装置１１に送信する。位置検出器１４の例は、エンコーダである。
　ハンド１８は、物を掴む機能を有している。アクチュエータ１７は、ロボット制御装置１１との間でデータ通信を行う接続機器の一例である。アクチュエータ１７は、ロボット制御装置１１からの指示に従ってハンド１８を駆動させ、アクチュエータ１７の動作状態のデータをロボット制御装置１１に送信する。以下の説明では、アクチュエータ１７が、ロボット制御装置１１との間で送受信するデータをアクチュエータデータという。センサ１６の例は、圧力センサである。センサ１６が圧力センサである場合、センサ１６は、ロボットアーム２０が、他の機器等に接触したか否かを検出する。センサ１６は、検出したデータであるセンサデータをロボット制御装置１１に送信する。
　位置検出器１４およびセンサ１６が、第１の接続機器であり、アクチュエータ１７が第２の接続機器である。各位置検出器１４、センサ１６、およびアクチュエータ１７は、シリアル通信線群１２を介して、ロボット制御装置１１に接続されている。各位置検出器１４、センサ１６、およびアクチュエータ１７は、シリアル通信線群１２を介して、ロボット制御装置１１との間でデータ通信を行う。実施の形態１では、各位置検出器１４およびセンサ１６は、アクチュエータ１７よりも、通信性能の低下が許容されるものとする。すなわち、各位置検出器１４およびセンサ１６は、通信性能が低下した場合であっても、所望の動作が可能であるものとする。換言すると、ロボット制御装置１１から第２の接続機器（アクチュエータ１７）へのデータ通信の伝送周期あたりのデータ送信量は、ロボット制御装置１１から第１の接続機器（位置検出器１４およびセンサ１６）のそれぞれへのデータ通信の伝送周期あたりのデータ送信量（第１の接続機器の個別のデータ送信量）よりも多い。また、第２の接続機器からロボット制御装置１１へのデータ通信の伝送周期あたりのデータ送信量は、第１の接続機器からロボット制御装置１１へのそれぞれへのデータ通信の伝送周期あたりのデータ送信量よりも多い。シリアル通信線群１２は、シリアル通信を行うための通信線の集まりである。
　つぎに、各位置検出器１４、センサ１６、およびアクチュエータ１７と、ロボット制御装置１１との接続構成について説明する。図２は、実施の形態１にかかるロボット内の接続構成を示す図である。図２では、ロボット１００に配置される位置検出器１４が、位置検出器１４Ａ，１４Ｂ，１４Ｃ，１４Ｄの４つである場合を示している。
　シリアル通信線群１２は、４本のシリアル通信線を有している。シリアル通信線群１２は、２本の組のシリアル通信線ＡＸと、２本の組のシリアル通信線ＢＸとを有している。第１のシリアル通信線であるシリアル通信線ＡＸは、差動通信を行うために、２本のシリアル通信線ＡＸ（Ａ＋，Ａ－）で構成されており、第２のシリアル通信線であるシリアル通信線ＢＸは、差動通信を行うために、２本のシリアル通信線ＢＸ（Ｂ＋，Ｂ－）で構成されている。
　ロボット１００では、シリアル通信線ＡＸ（Ａ＋，Ａ－），ＢＸ（Ｂ＋，Ｂ－）で、それぞれ半二重化通信を行うことができ、またシリアル通信線ＡＸ（Ａ＋，Ａ－）およびシリアル通信線ＢＸ（Ｂ＋，Ｂ－）の４本の通信線を使用して全二重化通信を行うことができる。
　以下、シリアル通信線ＡＸのうちの、Ａ＋（非反転）の通信線をシリアル通信線Ａ＋といい、Ａ－（反転）の通信線をシリアル通信線Ａ－という場合がある。また、シリアル通信線ＢＸのうちの、Ｂ＋（非反転）の通信線をシリアル通信線Ｂ＋といい、Ｂ－（反転）の通信線をシリアル通信線Ｂ－という場合がある。
　位置検出器１４Ｃおよびセンサ１６は、それぞれシリアル通信線Ａ＋，Ａ－の２本の通信線に接続されている。また、位置検出器１４Ａ，１４Ｂ，１４Ｄは、それぞれシリアル通信線Ｂ＋，Ｂ－の２本の通信線に接続されている。そして、アクチュエータ１７は、シリアル通信線Ａ＋，Ａ－，Ｂ＋，Ｂ－の４本の通信線に接続されている。
　また、ロボット制御装置１１は、シリアル通信線Ａ＋，Ａ－，Ｂ＋，Ｂ－の４本の通信線に接続されている。この構成により、位置検出器１４Ａ～１４Ｄおよびセンサ１６は、ロボット制御装置１１との間で半二重化通信を行い、アクチュエータ１７は、ロボット制御装置１１との間で全二重化通信を行う。これにより、半二重化通信で使用される位置検出器１４Ａ～１４Ｄおよびセンサ１６、全二重化通信で使用するアクチュエータ１７を、それぞれ通信速度を落とすことなく、ロボット制御装置１１との間で通信させることができる。
　ロボット制御装置１１は、制御回路３０と、差動ドライブ３２，３４と、差動レシーバ３１，３３とを備えている。差動レシーバ３１は、出力端子が制御回路３０に接続され、非反転入力端子がシリアル通信線Ａ＋に接続され、反転入力端子がシリアル通信線Ａ－に接続されている。
　また、差動レシーバ３３は、出力端子が制御回路３０に接続され、非反転入力端子がシリアル通信線Ｂ＋に接続され、反転入力端子がシリアル通信線Ｂ－に接続されている。
　また、差動ドライブ３２は、入力端子が制御回路３０に接続され、非反転出力端子がシリアル通信線Ａ＋に接続され、反転出力端子がシリアル通信線Ａ－に接続されている。
　また、差動ドライブ３４は、入力端子が制御回路３０に接続され、非反転出力端子がシリアル通信線Ｂ＋に接続され、反転出力端子がシリアル通信線Ｂ－に接続されている。
　差動ドライブ３２，３４および差動レシーバ３１，３３は、イネーブル信号の入力端子を有している。イネーブル信号の入力端子は、制御回路３０から送られてくるイネーブル信号を受け付ける。制御回路３０の例は、マイクロコンピュータである。
　位置検出器１４Ａは、制御回路４０Ａ、差動ドライブ４１Ａ、および差動レシーバ４２Ａを備えている。差動ドライブ４１Ａは、入力端子が制御回路４０Ａに接続され、非反転出力端子がシリアル通信線Ｂ＋に接続され、反転出力端子がシリアル通信線Ｂ－に接続されている。差動レシーバ４２Ａは、出力端子が制御回路４０Ａに接続され、非反転入力端子がシリアル通信線Ｂ＋に接続され、反転入力端子がシリアル通信線Ｂ－に接続されている。
　位置検出器１４Ｂは、制御回路４０Ｂ、差動ドライブ４１Ｂ、および差動レシーバ４２Ｂを備えている。差動ドライブ４１Ｂは、入力端子が制御回路４０Ｂに接続され、非反転出力端子がシリアル通信線Ｂ＋に接続され、反転出力端子がシリアル通信線Ｂ－に接続されている。差動レシーバ４２Ｂは、出力端子が制御回路４０Ｂに接続され、非反転入力端子がシリアル通信線Ｂ＋に接続され、反転入力端子がシリアル通信線Ｂ－に接続されている。
　位置検出器１４Ｄは、制御回路４０Ｄ、差動ドライブ４１Ｄ、および差動レシーバ４２Ｄを備えている。差動ドライブ４１Ｄは、入力端子が制御回路４０Ｄに接続され、非反転出力端子がシリアル通信線Ｂ＋に接続され、反転出力端子がシリアル通信線Ｂ－に接続されている。差動レシーバ４２Ｄは、出力端子が制御回路４０Ｄに接続され、非反転入力端子がシリアル通信線Ｂ＋に接続され、反転入力端子がシリアル通信線Ｂ－に接続されている。
　位置検出器１４Ｃは、制御回路４０Ｃ、差動ドライブ４１Ｃ、および差動レシーバ４２Ｃを備えている。差動ドライブ４１Ｃは、入力端子が制御回路４０Ｃに接続され、非反転出力端子がシリアル通信線Ａ＋に接続され、反転出力端子がシリアル通信線Ａ－に接続されている。差動レシーバ４２Ｃは、出力端子が制御回路４０Ｃに接続され、非反転入力端子がシリアル通信線Ａ＋に接続され、反転入力端子がシリアル通信線Ａ－に接続されている。
　センサ１６は、制御回路６０、差動ドライブ６１、および差動レシーバ６２を備えている。差動ドライブ６１は、入力端子が制御回路６０に接続され、非反転出力端子がシリアル通信線Ａ＋に接続され、反転出力端子がシリアル通信線Ａ－に接続されている。差動レシーバ６２は、出力端子が制御回路６０に接続され、非反転入力端子がシリアル通信線Ａ＋に接続され、反転入力端子がシリアル通信線Ａ－に接続されている。
　アクチュエータ１７は、制御回路７０、差動ドライブ７１、および差動レシーバ７２を備えている。差動ドライブ７１は、入力端子が制御回路７０に接続され、非反転出力端子がシリアル通信線Ｂ＋に接続され、反転出力端子がシリアル通信線Ｂ－に接続されている。差動レシーバ７２は、出力端子が制御回路７０に接続され、非反転入力端子がシリアル通信線Ｂ＋に接続され、反転入力端子がシリアル通信線Ｂ－に接続されている。
　ロボット制御装置１１は、位置検出器１４Ａ～１４Ｄ、センサ１６、およびアクチュエータ１７に対し、リクエストコマンドを送信する。位置検出器１４Ａ～１４Ｄ、センサ１６、およびアクチュエータ１７は、ロボット制御装置１１からリクエストコマンドを受信すると、リクエストコマンドの内容に対応するデータをロボット制御装置１１に送信する。
　位置検出器１４Ａ～１４Ｄは、位置データをロボット制御装置１１に送信する。なお、以下の説明では、位置検出器１４Ａが送信する位置データを位置データ＃１といい、位置検出器１４Ｂが送信する位置データを位置データ＃２といい、位置検出器１４Ｃが送信する位置データを位置データ＃３といい、位置検出器１４Ｄが送信する位置データを位置データ＃４という場合がある。センサ１６は、センサデータをロボット制御装置１１に送信し、アクチュエータ１７は、ロボット制御装置１１との間で、アクチュエータデータを送受信する。
　このように、ロボット制御装置１１は、位置検出器１４Ａ，１４Ｂ，１４Ｄとの間では、シリアル通信線Ｂ＋，Ｂ－を用いて半二重化通信を行い、位置検出器１４Ｃおよびセンサ１６との間ではシリアル通信線Ａ＋，Ａ－を用いて半二重化通信を行う。そして、ロボット制御装置１１は、アクチュエータ１７との間ではシリアル通信線Ａ＋，Ａ－，Ｂ＋，Ｂ－を用いて全二重化通信を行う。
　これにより、全二重化通信が不要な装置（位置検出器１４Ａ～１４Ｄ、センサ１６）に対しては、半二重化通信を行うことができ、全二重化通信が必要な装置（アクチュエータ１７）に対しては、全二重化通信を行うことができる。したがって、ロボット制御装置１１は、ロボットアーム２０との間で通信速度を確保することができるので、適切な速さでロボットアーム２０と通信することができる。例えば、ロボット制御装置１１に接続される位置検出器１４の数を増やした場合であっても、ロボット制御装置１１は、アクチュエータ１７とは全二重化通信を行うことができるので、アクチュエータ１７との間の通信速度を確保できる。また、センサ１６またはアクチュエータ１７を拡張（追加）した場合であっても、位置検出器１４Ａ，１４Ｂ，１４Ｃ，１４Ｄの配線をシリアル通信線ＡＸまたはシリアル通信線ＢＸに適切に配分することによって、適切な伝送周期を設定することができる。
　図３は、実施の形態１にかかるロボット内での伝送周期を説明するための図である。図３の横軸は時間である。図３の上段は、ロボット制御装置１１が、シリアル通信線Ａ＋，Ａ－を用いて送受信する信号を示し、図３の下段は、ロボット制御装置１１が、シリアル通信線Ｂ＋，Ｂ－を用いて送受信する信号を示している。
　ロボット制御装置１１は、シリアル通信線ＡＸにリクエストコマンドをコマンド送信すると（Ｔ１）、このリクエストコマンドを、位置検出器１４Ｃ、センサ１６、およびアクチュエータ１７が受信する。位置検出器１４Ｃ、センサ１６、およびアクチュエータ１７は、リクエストコマンドを受信すると、ロボット制御装置１１に送信するデータを準備する。
　この後、位置検出器１４Ｃ、センサ１６、およびアクチュエータ１７は、ロボット制御装置１１から個別にデータ要求指示が送られてくると、データ要求指示に対応するデータをロボット制御装置１１に送信する。すなわち、ロボット制御装置１１は、位置検出器１４Ｃおよびセンサ１６に対し、データのリードを行い、アクチュエータ１７に対し、データのリードおよびライトを行う。
　具体的には、センサ１６は、シリアル通信線ＡＸにセンサデータを送信し、ロボット制御装置１１がセンサデータを受信する（Ｔ２）。位置検出器１４Ｃは、シリアル通信線ＡＸに位置データ＃３を送信し、ロボット制御装置１１が位置データ＃３を受信する（Ｔ３）。また、ロボット制御装置１１は、シリアル通信線ＡＸにアクチュエータデータを送信し（Ｔ４）、アクチュエータ１７が、アクチュエータデータを受信する。ロボット制御装置１１がアクチュエータ１７に送信するアクチュエータデータは、例えば、ハンド１８のグリップをオンまたはオフにさせる制御信号である。
　ロボット制御装置１１は、シリアル通信線ＢＸにリクエストコマンドをコマンド送信すると（Ｔ１１）、このリクエストコマンドを、位置検出器１４Ａ，１４Ｂ，１４Ｄ、およびアクチュエータ１７が受信する。位置検出器１４Ａ，１４Ｂ，１４Ｄ、およびアクチュエータ１７は、リクエストコマンドを受信すると、ロボット制御装置１１に送信するデータを準備する。
　この後、位置検出器１４Ａ，１４Ｂ，１４Ｄ、およびアクチュエータ１７は、ロボット制御装置１１から個別にデータ要求指示が送られてくると、データ要求指示に対応するデータをロボット制御装置１１に送信する。すなわち、ロボット制御装置１１は、位置検出器１４Ａ，１４Ｂ，１４Ｄに対し、データのリードを行い、アクチュエータ１７に対し、データのリードおよびライトを行う。
　具体的には、位置検出器１４Ａは、シリアル通信線ＢＸに位置データ＃１を送信し、ロボット制御装置１１が位置データ＃１を受信する（Ｔ１２）。位置検出器１４Ｂは、シリアル通信線ＢＸに位置データ＃２を送信し、ロボット制御装置１１が位置データ＃２を受信する（Ｔ１３）。位置検出器１４Ｄは、シリアル通信線ＢＸに位置データ＃４を送信し、ロボット制御装置１１が位置データ＃４を受信する（Ｔ１４）。アクチュエータ１７は、シリアル通信線ＢＸにアクチュエータデータを送信し、ロボット制御装置１１がアクチュエータデータを受信する（Ｔ１５）。ロボット制御装置１１がアクチュエータ１７から受信するアクチュエータデータは、例えば、ハンド１８のグリップのオン状態またはオフ状態を示す信号である。
　ロボット１００では、Ｔ１からＴ４のデータ伝送と、Ｔ１１からＴ１５のデータ伝送とが並行して実行される。
　ロボット制御装置１１が、シリアル通信線ＡＸおよびシリアル通信線ＢＸにリクエストコマンドのコマンド送信を開始してから、Ｔ１からＴ４のデータ伝送およびＴ１１からＴ１５のデータ伝送の両方が完了するまでの期間がロボット１００の伝送周期である。ロボット制御装置１１は、シリアル通信線ＡＸ上におけるデータ送受信のタイミングを制御するため、シリアル通信線ＡＸに接続されている接続機器と順番にデータ通信を行う。例えば、ロボット制御装置１１は、センサ１６にデータ要求指示を送り、センサ１６からセンサデータを受信し、その後、位置検出器１４Ｃにデータ要求指示を送り、位置検出器１４Ｃから位置データ＃３を受信する。その後、ロボット制御装置１１は、アクチュエータ１７にアクチュエータデータを送信する。これにより、ロボット制御装置１１は、シリアル通信線ＡＸでの半二重化通信の受信と、全二重化通信の送信とを調停する。なお、ロボット制御装置１１は、位置検出器１４Ｃおよびセンサ１６のそれぞれに特定のタイミングでデータ要求指示を送り、アクチュエータ１７に特定のタイミングでアクチュエータデータを送信してもよい。すなわち、ロボット制御装置１１は、特定の周期毎に、シリアル通信線ＡＸに接続されている接続機器とデータ通信を実行してもよい。
　なお、実施の形態１では、ロボット１００が差動通信を行う場合について説明したが、ロボット１００は、差動通信以外の通信を用いてもよい。また、半二重化通信を行う接続機器は、５つに限らず、４つ以下であってもよいし、６つ以上であってもよい。また、全二重化通信を行う接続機器は、１つに限らず、２つ以上であってもよい。また、半二重化通信を行う接続機器は、位置検出器１４Ａ～１４Ｄおよびセンサ１６以外の別種類の接続機器であってもよい。また、全二重化通信を行う接続機器は、オン信号およびオフ信号の入出力を行う入出力装置（ＩＯ（Input　Output）装置とも呼ばれる）といったアクチュエータ１７以外の別種類の接続機器であってもよい。
　このように、実施の形態１によれば、シリアル通信線ＡＸ，ＢＸを用いて、位置検出器１４Ａ～１４Ｄおよびセンサ１６が半二重化通信を行うとともに、シリアル通信線ＡＸ，ＢＸを用いて、アクチュエータ１７が全二重化通信を行うので、１対多の伝送路に、全二重化通信が望まれるアクチュエータ１７を接続することができる。
実施の形態２．
　つぎに、図４を用いてこの発明の実施の形態２について説明する。実施の形態２では、位置検出器およびアクチュエータを、シリアル通信線ＡＸ，ＢＸの両方に接続しておき、ロボット制御装置１１によって、半二重化通信と全二重化通信とを切替える。
　図４は、実施の形態２にかかるロボット内の接続構成を示す図である。図４の各構成要素のうち図２に示す実施の形態１のロボット１００と同一機能を達成する構成要素については同一符号を付しており、重複する説明は省略する。
　ロボット１００Ｘは、ロボット１００の別構成例である。ロボット１００Ｘでは、ロボット制御装置１１Ｘに、複数の位置検出器１４とアクチュエータ１７Ｘとが接続されている。図４では、ロボット１００Ｘに配置される位置検出器１４が、位置検出器１４Ｐ，１４Ｑ，１４Ｒの３つである場合を示している。
　ロボット制御装置１１Ｘは、制御回路３０Ｘと、差動ドライブ３２，３４と、差動レシーバ３１，３３とを備えている。制御回路３０Ｘは、制御回路３０の機能に加えて、位置検出器１４Ｐ～１４Ｒに対して半二重化通信と全二重化通信とを切替えさせる機能を有している。
　位置検出器１４Ｐは、制御回路４０Ｐ、差動ドライブ４２Ｐ，４４Ｐ、および差動レシーバ４１Ｐ，４３Ｐを備えている。位置検出器１４Ｑは、制御回路４０Ｑ、差動ドライブ４２Ｑ，４４Ｑ、および差動レシーバ４１Ｑ，４３Ｑを備えている。位置検出器１４Ｒは、制御回路４０Ｒ、差動ドライブ４２Ｒ，４４Ｒ、および差動レシーバ４１Ｒ，４３Ｒを備えている。
　差動レシーバ４１Ｐ，４１Ｑ，４１Ｒは、非反転入力端子がシリアル通信線Ａ＋に接続され、反転入力端子がシリアル通信線Ａ－に接続されている。差動ドライブ４２Ｐ，４２Ｑ，４２Ｒは、非反転出力端子がシリアル通信線Ａ＋に接続され、反転出力端子がシリアル通信線Ａ－に接続されている。差動レシーバ４３Ｐ，４３Ｑ，４３Ｒは、非反転入力端子がシリアル通信線Ｂ＋に接続され、反転入力端子がシリアル通信線Ｂ－に接続されている。差動ドライブ４４Ｐ，４４Ｑ，４４Ｒは、非反転出力端子がシリアル通信線Ｂ＋に接続され、反転出力端子がシリアル通信線Ｂ－に接続されている。
　差動レシーバ４１Ｐ，４３Ｐの出力端子は、制御回路４０Ｐに接続され、差動ドライブ４２Ｐ，４４Ｐの入力端子は、制御回路４０Ｐに接続されている。差動レシーバ４１Ｑ，４３Ｑの出力端子は、制御回路４０Ｑに接続され、差動ドライブ４２Ｑ，４４Ｑの入力端子は、制御回路４０Ｑに接続されている。差動レシーバ４１Ｒ，４３Ｒの出力端子は、制御回路４０Ｒに接続され、差動ドライブ４２Ｒ，４４Ｒの入力端子は、制御回路４０Ｒに接続されている。
　差動ドライブ４２Ｐ，４４Ｐおよび差動レシーバ４１Ｐ，４３Ｐは、イネーブル信号の入力端子を有している。イネーブル信号の入力端子は、制御回路４０Ｐから送られてくるイネーブル信号を受け付ける。
　差動ドライブ４２Ｑ，４４Ｑおよび差動レシーバ４１Ｑ，４３Ｑは、イネーブル信号の入力端子を有している。イネーブル信号の入力端子は、制御回路４０Ｑから送られてくるイネーブル信号を受け付ける。
　差動ドライブ４２Ｒ，４４Ｒおよび差動レシーバ４１Ｒ，４３Ｒは、イネーブル信号の入力端子を有している。イネーブル信号の入力端子は、制御回路４０Ｒから送られてくるイネーブル信号を受け付ける。
　なお、制御回路４０Ｐ～４０Ｒは、同様の機能を有し、同様の動作を実行するので、以下では、制御回路４０Ｐの機能および動作について説明する。制御回路４０Ｐは、制御回路４０Ａ～４０Ｄの機能に加えて、全二重化通信と半二重化通信とを切替える機能を有している。具体的には、制御回路４０Ｐは、ロボット制御装置１１Ｘからの指示に従って、差動ドライブ４２Ｐ，４４Ｐおよび差動レシーバ４１Ｐ，４３Ｐにイネーブル信号を送信する機能を有している。
　また、位置検出器１４Ｐは、位置検出器１４Ｐの機器ＩＤ（IDentification）をロボット制御装置１１Ｘに送信する機能を備えている。また、アクチュエータ１７Ｘは、アクチュエータ１７と比較して、制御回路７０の代わりに、制御回路７０Ｘを備えている。制御回路７０Ｘは、制御回路７０の機能に加えて、アクチュエータ１７Ｘの機器ＩＤをロボット制御装置１１Ｘに送信する機能を備えている。すなわち、ロボット１００Ｘでは、ロボット制御装置１１Ｘに接続されている接続機器が、自らの接続機器の機器ＩＤをロボット制御装置１１Ｘに送信する機能を有している。機器ＩＤは、接続機器に固有の識別情報である。機器ＩＤの例は、接続機器の製品ＩＤである。
　ロボット制御装置１１Ｘの制御回路３０Ｘは、通信初期化時に、ロボット制御装置１１Ｘに接続されている接続機器の個数および種類に基づいて、各接続機器に、半二重化通信と全二重化通信との何れを行わせるかを決定する。また、制御回路３０Ｘは、半二重化通信を行わせる接続機器に対しては、シリアル通信線ＡＸおよびシリアル通信線ＢＸの何れで半二重化通信を行わせるかを選択して設定する。実施の形態２では、制御回路３０Ｘが、位置検出器１４Ｐ～１４Ｒに半二重化通信を行わせ、アクチュエータ１７Ｘに全二重化通信を行わせる場合について説明する。
　通信初期化時には、制御回路３０Ｘが、接続機器に対して、機器ＩＤを要求するコマンドを送信する。各接続機器は、各接続機器が格納している機器ＩＤをロボット制御装置１１Ｘに送信する。制御回路３０Ｘは、各接続機器から各機器ＩＤを受信すると、受信した機器ＩＤに基づいて、接続機器の個数および種類を特定し、特定結果に基づいて、シリアル通信線ＡＸ，ＢＸの全体の通信負荷を判定する。なお、制御回路３０Ｘは、位置検出器１４の個数に基づいて、通信負荷を判定してもよい。すなわち、制御回路３０Ｘは、全二重化通信が不要な接続機器（位置検出器１４、センサ１６等）の個数に基づいて、通信負荷を判定してもよい。通信負荷は、接続機器の種類毎に異なるものであるので、ロボット制御装置１１Ｘには、接続機器の機器ＩＤ毎の通信負荷の情報（以下、負荷情報という）を格納しておく。
　また、ロボット制御装置１１Ｘには、全二重化通信が不要な接続機器である第１の接続機器と、全二重化通信が必要な接続機器である第２の接続機器とが接続されている。これらの接続機器を識別するため、ロボット制御装置１１Ｘには、半二重化通信を行わせてもよい接続機器の機器ＩＤと、半二重化通信を行わせない接続機器の機器ＩＤとを指定した情報（以下、指定情報という）を格納しておく。全二重化通信が不要な接続機器の例は、位置検出器１４Ｐ～１４Ｒであり、全二重化通信が必要な接続機器の例は、アクチュエータ１７Ｘである。全二重化通信が必要な接続機器は、全二重化通信が不要な接続機器よりも、速い通信速度が要求される。
　制御回路３０Ｘは、接続機器の個数および種類と、負荷情報とに基づいて、シリアル通信線ＡＸ，ＢＸの全体の通信負荷を判定し、判定結果に基づいて、各接続機器に全二重化通信および半二重化通信の何れを行わせるかを判定する。制御回路３０Ｘは、例えば、接続機器の個数が閾値よりも大きくなると、全二重化通信が不要な接続機器に半二重化通信を行わせると判定する。
　制御回路３０Ｘは、接続機器に半二重化通信を行わせる場合、指定情報に基づいて、何れの接続機器に半二重化通信を行わせるかを判定する。実施の形態２では、制御回路３０Ｘは、位置検出器１４Ｐ～１４Ｒに半二重化通信を行わせると判定する。
　制御回路３０Ｘは、負荷情報に基づいて、位置検出器１４Ｐ～１４Ｒのそれぞれに対して、シリアル通信線ＡＸまたはシリアル通信線ＢＸを選択する。制御回路３０Ｘは、シリアル通信線ＡＸでの通信負荷およびシリアル通信線ＢＸでの通信負荷の差が最小となるよう、位置検出器１４Ｐ～１４Ｒのそれぞれに対し、シリアル通信線ＡＸまたはシリアル通信線ＢＸを設定する。制御回路３０Ｘは、シリアル通信線ＡＸまたはシリアル通信線ＢＸを使わせる位置検出器１４Ｐ～１４Ｒの個数（局数）を、適切に分配することによって、伝送遅延を抑制することが可能となる。また、制御回路３０Ｘは、アクチュエータ１７Ｘに対しては、全二重化通信を実行させると判定する。
　制御回路３０Ｘは、半二重化通信を行わせると判定した接続機器に対しては、シリアル通信線ＡＸまたはシリアル通信線ＢＸを指定したコマンドを送信する。これにより、シリアル通信線ＡＸが指定されたコマンドを受信した接続機器は、シリアル通信線ＡＸを有効にし、シリアル通信線ＢＸを無効にする。同様に、シリアル通信線ＢＸが指定されたコマンドを受信した接続機器は、シリアル通信線ＢＸを有効にし、シリアル通信線ＡＸを無効にする。これにより、位置検出器１４Ｐ～１４Ｒが、指定されたシリアル通信線ＡＸまたはシリアル通信線ＢＸを用いて、ロボット制御装置１１との間で半二重化通信を行う。
　各位置検出器の各制御回路は、イネーブル信号を差動ドライブおよび差動レシーバに入力することによって、シリアル通信線ＡＸ，ＢＸの有効と無効とを切替える。例えば、位置検出器１４Ｐの制御回路４０Ｐは、制御回路３０Ｘからシリアル通信線ＡＸが指定されたコマンドを受信すると、差動レシーバ４１Ｐおよび差動ドライブ４２Ｐにイネーブル信号のオンを入力し、差動レシーバ４３Ｐおよび差動ドライブ４４Ｐにイネーブル信号のオフを入力する。
　このような処理により、位置検出器１４Ｐ～１４Ｒは、半二重化通信を行うこととなり、アクチュエータ１７Ｘは全二重化通信を行うこととなる。ロボット１００Ｘは、例えば、新たな接続機器がシリアル通信線ＡＸ，ＢＸに接続された際に、各接続機器に対し、半二重化通信を行わせるか否かを判定する。また、ロボット１００Ｘは、接続機器がシリアル通信線ＡＸ，ＢＸから取り外された際に、各接続機器に対し、半二重化通信を行わせるか否かを判定する。
　なお、実施の形態２では、ロボット１００Ｘが差動通信を行う場合について説明したが、ロボット１００Ｘは、差動通信以外の通信を用いてもよい。また、ロボット制御装置１１Ｘに接続される接続機器は、４つに限らず、３つ以下であってもよいし、５つ以上であってもよい。また、ロボット制御装置１１Ｘには、センサ１６といった別種類の接続機器を接続してもよい。この場合、別種類の接続機器の制御回路は、位置検出器１４Ｐ～１４Ｒと同様に、機器ＩＤをロボット制御装置１１Ｘに送信する機能およびイネーブル信号を出力する機能を備えている。ロボット制御装置１１Ｘは、位置検出器１４Ｐ～１４Ｒへの処理と同様の処理によって、別種類の接続機器への半二重化通信と全二重化通信とを切替える。
　このように、ロボット制御装置１１Ｘは、接続機器の個数および種類に基づいて、全二重化通信が不要な接続機器に半二重化通信を設定する。また、ロボット制御装置１１Ｘは、シリアル通信線ＡＸでの通信負荷とシリアル通信線ＢＸでの通信負荷との差が小さくなるよう、半二重化通信を設定する接続機器にシリアル通信線ＡＸまたはシリアル通信線ＢＸを設定する。すなわち、ロボット制御装置１１Ｘは、位置検出器１４Ｐ～１４Ｒのそれぞれを、シリアル通信線ＡＸまたはシリアル通信線ＢＸに分配する。これにより、ロボット制御装置１１Ｘは、ロボットアーム２０との間で通信速度を確保することができるので、適切な速さでロボットアーム２０と通信することができる。また、通信速度を確保できるので、位置検出器１４だけでなく、センサまたはアクチュエータを拡張することができる。
　このように、実施の形態２では、位置検出器１４Ｐ～１４Ｒが、シリアル通信線ＡＸおよびシリアル通信線ＢＸに接続されている。そして、ロボット制御装置１１Ｘは、位置検出器１４の個数が閾値よりも大きい場合には、位置検出器１４Ｐ～１４Ｒに、シリアル通信線ＡＸまたはシリアル通信線ＢＸを用いた半二重化通信を行わせる。これにより、ロボット１００Ｘは、位置検出器１４の個数が閾値よりも大きい場合には、シリアル通信線ＡＸ，ＢＸにおける通信負荷を低減することができる。
　ここで、制御回路３０，３０Ｘ，４０Ａ～４０Ｄ，４０Ｐ～４０Ｒ，６０，７０，７０Ｘのハードウェア構成について説明する。なお、制御回路３０，３０Ｘ，４０Ａ～４０Ｄ，４０Ｐ～４０Ｒ，６０，７０，７０Ｘは、同様のハードウェア構成を有しているので、ここでは制御回路３０Ｘのハードウェア構成について説明する。
　図５は、実施の形態２にかかる制御回路のハードウェア構成例を示す図である。制御回路３０Ｘは、図５に示したプロセッサ３０１およびメモリ３０２により実現することができる。プロセッサ３０１の例は、ＣＰＵ（Central　Processing　Unit、中央処理装置、処理装置、演算装置、マイクロプロセッサ、マイクロコンピュータ、プロセッサ、ＤＳＰ（Digital　Signal　Processor）ともいう）またはシステムＬＳＩ（Large　Scale　Integration）である。メモリ３０２の例は、ＲＡＭ（Random　Access　Memory）またはＲＯＭ（Read　Only　Memory）である。
　制御回路３０Ｘは、プロセッサ３０１が、メモリ３０２で記憶されている、制御回路３０Ｘの動作を実行するためのプログラムを読み出して実行することにより実現される。また、このプログラムは、制御回路３０Ｘの手順または方法をコンピュータに実行させるものであるともいえる。メモリ３０２は、プロセッサ３０１が各種処理を実行する際の一時メモリにも使用される。
　プロセッサ３０１が実行するプログラムは、コンピュータで実行可能な、データ処理を行うための複数の命令を含むコンピュータ読取り可能かつ非遷移的な（non-transitory）記録媒体を有するコンピュータプログラムプロダクトであってもよい。プロセッサ３０１が実行するプログラムは、複数の命令がデータ処理を行うことをコンピュータに実行させる。
　また、制御回路３０Ｘを専用のハードウェアで実現してもよい。また、制御回路３０Ｘの機能について、一部を専用のハードウェアで実現し、一部をソフトウェアまたはファームウェアで実現するようにしてもよい。
　以上の実施の形態に示した構成は、本発明の内容の一例を示すものであり、別の公知の技術と組み合わせることも可能であるし、本発明の要旨を逸脱しない範囲で、構成の一部を省略、変更することも可能である。
　１１，１１Ｘ　ロボット制御装置、１２　シリアル通信線群、１３　サーボモータ、１４，１４Ａ，１４Ｂ，１４Ｃ，１４Ｄ，１４Ｐ，１４Ｑ，１４Ｒ　位置検出器、１６　センサ、１７，１７Ｘ　アクチュエータ、１８　ハンド、２０　ロボットアーム、３０，３０Ｘ，４０Ａ～４０Ｄ，４０Ｐ～４０Ｒ，６０，７０，７０Ｘ　制御回路、３１，３３，４１Ｐ～４１Ｒ，４２Ａ～４２Ｄ，４３Ｐ～４３Ｒ，６２，７２　差動レシーバ、３２，３４，４１Ａ～４１Ｄ，４２Ｐ～４２Ｒ，４４Ｐ～４４Ｒ，６１，７１　差動ドライブ、１００，１００Ｘ　ロボット、ＡＸ，ＢＸ　シリアル通信線。

Claims (7)

  1. 　ロボット制御装置と、
    　前記ロボット制御装置に接続された第１のシリアル通信線と、
    　前記ロボット制御装置に接続された第２のシリアル通信線と、
    　前記ロボット制御装置との間でデータ通信を行う機器である複数の第１の接続機器と、
    　前記ロボット制御装置との間でデータ通信を行う機器である第２の接続機器と、
    　を備え、
    　前記第１の接続機器のそれぞれは、前記第１のシリアル通信線または前記第２のシリアル通信線の何れかに接続されることにより、前記ロボット制御装置との間で半二重化通信を行い、
    　前記第２の接続機器は、前記第１のシリアル通信線および前記第２のシリアル通信線に接続されることにより、前記ロボット制御装置との間で全二重化通信を行う、
    　ことを特徴とするロボット。
  2. 　前記第１の接続機器のそれぞれは、前記第１のシリアル通信線での通信負荷と、前記第２のシリアル通信線での通信負荷との差が最小となるよう、前記第１のシリアル通信線または前記第２のシリアル通信線の何れかに接続されている、
    　ことを特徴とする請求項１に記載のロボット。
  3. 　ロボット制御装置と、
    　前記ロボット制御装置に接続された第１のシリアル通信線と、
    　前記ロボット制御装置に接続された第２のシリアル通信線と、
    　前記ロボット制御装置との間でデータ通信を行う機器である複数の第１の接続機器と、
    　前記ロボット制御装置との間でデータ通信を行う機器である第２の接続機器と、
    　を備え、
    　前記第１の接続機器および前記第２の接続機器は、前記第１のシリアル通信線および前記第２のシリアル通信線に接続されており、
    　前記第１の接続機器のそれぞれは、前記ロボット制御装置からの指示があった場合には、前記指示に従って前記第１のシリアル通信線および前記第２のシリアル通信線の何れかを用いて前記ロボット制御装置との間で半二重化通信を行い、
    　前記第２の接続機器は、前記ロボット制御装置との間で全二重化通信を行う、
    　ことを特徴とするロボット。
  4. 　前記ロボット制御装置は、前記第１の接続機器および前記第２の接続機器のそれぞれに、各接続機器の識別情報を要求するコマンドを送信し、
    　前記第１の接続機器および前記第２の接続機器のそれぞれは、それぞれが格納している識別情報を前記ロボット制御装置に送信し、
    　前記ロボット制御装置は、前記識別情報に基づいて前記ロボット制御装置に接続されている前記第１の接続機器および前記第２の接続機器の個数を特定し、特定結果に基づいて、前記第１の接続機器に前記半二重化通信および前記全二重化通信の何れを行わせるかを判定し、前記半二重化通信を行わせる場合には、前記第１の接続機器のそれぞれに対し、前記第１のシリアル通信線または前記第２のシリアル通信線の何れかを指定したコマンドを送信し、
    　前記第１の接続機器は、指定された前記第１のシリアル通信線または指定された前記第２のシリアル通信線を用いて、前記ロボット制御装置との間で前記半二重化通信を行う、
    　ことを特徴とする請求項３に記載のロボット。
  5. 　前記ロボット制御装置は、前記第１のシリアル通信線での通信負荷と、前記第２のシリアル通信線での通信負荷との差が最小となるよう、前記第１の接続機器のそれぞれに対し、前記第１のシリアル通信線または前記第２のシリアル通信線の何れかを設定する、
    　ことを特徴とする請求項４に記載のロボット。
  6. 　前記ロボット制御装置から前記第２の接続機器へのデータ通信の伝送周期あたりのデータ送信量は、前記ロボット制御装置から前記第１の接続機器のそれぞれへのデータ通信の伝送周期あたりのデータ送信量よりも多い、
    　ことを特徴とする請求項１から５の何れか１つに記載のロボット。
  7. 　前記ロボット制御装置は、ロボットアームの各動作軸を駆動するサーボモータと、前記ロボットアームのハンドを駆動するアクチュエータとを制御し、
    　前記第１の接続機器は、前記サーボモータの回転位置を検出する位置検出器であり、
    　前記第２の接続機器は、前記アクチュエータである、
    　ことを特徴とする請求項１から６の何れか１つに記載のロボット。
PCT/JP2019/016855 2019-04-19 2019-04-19 ロボット WO2020213161A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
PCT/JP2019/016855 WO2020213161A1 (ja) 2019-04-19 2019-04-19 ロボット
JP2020564691A JP6837621B1 (ja) 2019-04-19 2019-04-19 ロボット
CN201980095437.9A CN113710437A (zh) 2019-04-19 2019-04-19 机器人
US17/602,288 US20220152815A1 (en) 2019-04-19 2019-04-19 Robot
DE112019007060.6T DE112019007060B4 (de) 2019-04-19 2019-04-19 Roboter

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2019/016855 WO2020213161A1 (ja) 2019-04-19 2019-04-19 ロボット

Publications (1)

Publication Number Publication Date
WO2020213161A1 true WO2020213161A1 (ja) 2020-10-22

Family

ID=72837145

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/016855 WO2020213161A1 (ja) 2019-04-19 2019-04-19 ロボット

Country Status (5)

Country Link
US (1) US20220152815A1 (ja)
JP (1) JP6837621B1 (ja)
CN (1) CN113710437A (ja)
DE (1) DE112019007060B4 (ja)
WO (1) WO2020213161A1 (ja)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4868474A (en) * 1986-11-20 1989-09-19 Westinghouse Electric Corp. Multiprocessor position/velocity servo control for multiaxis digital robot control system
JPH11175118A (ja) * 1997-10-08 1999-07-02 Denso Corp ロボット制御装置
JP2000006070A (ja) * 1998-06-19 2000-01-11 Fanuc Ltd ロボット制御システム
JP2003127080A (ja) * 2001-10-24 2003-05-08 Tokyo Inst Of Technol 組込み型制御用計算機
JP2006312209A (ja) * 2005-05-09 2006-11-16 Toyota Motor Corp 脚式移動ロボット及び車輪移動式人型ロボット
JP2008238382A (ja) * 2007-03-29 2008-10-09 Daihen Corp 搬送ロボットの制御方法
WO2008154958A1 (en) * 2007-06-21 2008-12-24 Abb Technology Ab A control system for controlling at least one industrial robot
JP2015095221A (ja) * 2013-11-14 2015-05-18 オムロン株式会社 エンコーダおよびサーボシステム
JP2016218867A (ja) * 2015-05-22 2016-12-22 株式会社安川電機 エンコーダ、コントローラ、モータ制御システム、ロボット制御システム、ロボット、データ送信方法、及び情報処理方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1041901A (ja) * 1996-07-24 1998-02-13 Nissin Electric Co Ltd 監視制御装置
JP4175377B2 (ja) 1997-10-08 2008-11-05 株式会社デンソーウェーブ ロボット制御装置
JP3236563B2 (ja) * 1998-06-19 2001-12-10 ファナック株式会社 制御装置
WO2015052790A1 (ja) * 2013-10-09 2015-04-16 富士機械製造株式会社 多重化通信システム及び作業用ロボット
US9965410B2 (en) * 2016-01-21 2018-05-08 Qualcomm Incorporated Priority-based data communication over multiple communication buses
CN206960960U (zh) * 2017-06-28 2018-02-02 安徽工程大学 一种基于avr单片机的移动机器人控制系统

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4868474A (en) * 1986-11-20 1989-09-19 Westinghouse Electric Corp. Multiprocessor position/velocity servo control for multiaxis digital robot control system
JPH11175118A (ja) * 1997-10-08 1999-07-02 Denso Corp ロボット制御装置
JP2000006070A (ja) * 1998-06-19 2000-01-11 Fanuc Ltd ロボット制御システム
JP2003127080A (ja) * 2001-10-24 2003-05-08 Tokyo Inst Of Technol 組込み型制御用計算機
JP2006312209A (ja) * 2005-05-09 2006-11-16 Toyota Motor Corp 脚式移動ロボット及び車輪移動式人型ロボット
JP2008238382A (ja) * 2007-03-29 2008-10-09 Daihen Corp 搬送ロボットの制御方法
WO2008154958A1 (en) * 2007-06-21 2008-12-24 Abb Technology Ab A control system for controlling at least one industrial robot
JP2015095221A (ja) * 2013-11-14 2015-05-18 オムロン株式会社 エンコーダおよびサーボシステム
JP2016218867A (ja) * 2015-05-22 2016-12-22 株式会社安川電機 エンコーダ、コントローラ、モータ制御システム、ロボット制御システム、ロボット、データ送信方法、及び情報処理方法

Also Published As

Publication number Publication date
US20220152815A1 (en) 2022-05-19
DE112019007060T5 (de) 2022-01-20
JP6837621B1 (ja) 2021-03-03
JPWO2020213161A1 (ja) 2021-05-06
CN113710437A (zh) 2021-11-26
DE112019007060B4 (de) 2023-03-16

Similar Documents

Publication Publication Date Title
US7266625B2 (en) Data communication system
JP6837621B1 (ja) ロボット
CN113194048B (zh) 一种动态切换cpu与gpu拓扑的装置及使用方法
JP2022123826A (ja) データ処理装置及びデータ処理システム
JP4346539B2 (ja) 制御装置
US7032061B2 (en) Multimaster bus system
US20130222121A1 (en) Remote control system capable of bidirectionally exchanging data by signal line and method thereof
TWI616754B (zh) 快捷外設互聯標準（PCIe）資料交換裝置及傳輸系統
JPH05316128A (ja) 信号転送方法
JPS6136859A (ja) インタフエ−ス制御装置
JP2019004400A (ja) アドレス設定装置およびシステム
CN114579501A (zh) 数据传输
JPS5992653A (ja) デ−タ伝送装置
JPH0439819B2 (ja)
JPH04139935A (ja) シリアルインタフェース方式
JPH02105016A (ja) アブソリュートエンコーダのインターフェース回路
JP2005056086A (ja) インターフェイス装置
JPH0540516A (ja) Ｎｃ装置通信システム及びｎｃ装置
JPH01296828A (ja) 状態信号伝送方式
JPH0385660A (ja) 入出力制御システム
JPH09293047A (ja) マイクロコンピュータのデータ転送装置
JP2000078226A (ja) 多入力通信アダプタ―
JPS61118045A (ja) シリアル転送システム
JPH03269660A (ja) データ転送方式
JPH0282342A (ja) データ通信装置

Legal Events

Date Code Title Description
ENP Entry into the national phase

Ref document number: 2020564691

Country of ref document: JP

Kind code of ref document: A

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

Ref document number: 19924660

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 19924660

Country of ref document: EP

Kind code of ref document: A1