Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP7703331B2 - Control device and industrial robot - Google Patents
[go: Go Back, main page]

JP7703331B2 - Control device and industrial robot - Google Patents

Control device and industrial robot Download PDF

Info

Publication number
JP7703331B2
JP7703331B2 JP2021015058A JP2021015058A JP7703331B2 JP 7703331 B2 JP7703331 B2 JP 7703331B2 JP 2021015058 A JP2021015058 A JP 2021015058A JP 2021015058 A JP2021015058 A JP 2021015058A JP 7703331 B2 JP7703331 B2 JP 7703331B2
Authority
JP
Japan
Prior art keywords
detection results
characteristic
characteristic detection
units
acceleration
Prior art date
Legal status (The legal status 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 status listed.)
Active
Application number
JP2021015058A
Other languages
Japanese (ja)
Other versions
JP2022118490A5 (en
JP2022118490A (en
Inventor
直之 野口
正吾 百瀬
和博 中村
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nidec Instruments Corp
Original Assignee
Nidec Instruments Corp
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 Nidec Instruments Corp filed Critical Nidec Instruments Corp
Priority to JP2021015058A priority Critical patent/JP7703331B2/en
Priority to CN202210070685.1A priority patent/CN114833819B/en
Priority to KR1020220011566A priority patent/KR102869311B1/en
Publication of JP2022118490A publication Critical patent/JP2022118490A/en
Publication of JP2022118490A5 publication Critical patent/JP2022118490A5/ja
Application granted granted Critical
Publication of JP7703331B2 publication Critical patent/JP7703331B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1602Program controls characterised by the control system, structure, architecture
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00Program-control systems
    • G05B19/02Program-control systems electric
    • G05B19/04Program control other than numerical control, i.e. in sequence controllers or logic controllers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/087Controls for manipulators by means of sensing devices, e.g. viewing or touching devices for sensing other physical parameters, e.g. electrical or chemical properties
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/02Program-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type
    • B25J9/04Program-controlled manipulators characterised by movement of the arms, e.g. cartesian coordinate type by rotating at least one arm, excluding the head movement itself, e.g. cylindrical coordinate type or polar coordinate type
    • B25J9/041Cylindrical coordinate type
    • B25J9/042Cylindrical coordinate type comprising an articulated arm
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Program-controlled manipulators
    • B25J9/16Program controls
    • B25J9/1694Program controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Human Computer Interaction (AREA)
  • Arrangements For Transmission Of Measured Signals (AREA)
  • Manipulator (AREA)

Description

本発明は、制御装置及び産業用ロボットに関する。 The present invention relates to a control device and an industrial robot.

従来、駆動部における所定の第1特性を検出する第1特性検出部による検出結果に基づいて、駆動制御のための所定の演算処理を実行する演算処理部を有する制御装置を備える産業用ロボットが知られている。 Conventionally, industrial robots are known that are equipped with a control device having a calculation processing unit that executes predetermined calculation processing for drive control based on the detection results of a first characteristic detection unit that detects a predetermined first characteristic in the drive unit.

例えば、特許文献1に記載の産業用ロボットは、駆動部たるモータと、第1特性検出部たる温度センサと、制御装置とを備える。温度センサは、第1特性たるモータ温度を検出する。制御装置は、演算処理部としてのCPU(Central Processing Unit)により、モータの駆動を制御するための演算処理を温度センサによる検出結果に基づいて実行する。 For example, the industrial robot described in Patent Document 1 includes a motor as a drive unit, a temperature sensor as a first characteristic detection unit, and a control device. The temperature sensor detects the motor temperature as the first characteristic. The control device uses a central processing unit (CPU) as an arithmetic processing unit to execute arithmetic processing for controlling the drive of the motor based on the detection result by the temperature sensor.

特開平5-88731号公報Japanese Patent Application Publication No. 5-88731

産業用ロボットの技術革新が進められる近年においては、産業ロボットの複数の駆動部のそれぞれにおける温度等の特性を個別に検出する複数のセンサを、産業用ロボットに設けることが一般的である。加えて、産業用ロボットの制御装置から、生産施設にある主制御装置へと、センサによる検出結果を送信することで、生産施設全体のシステム管理を行うことが考えられる。 In recent years, as technological innovation in industrial robots advances, it is common for industrial robots to be equipped with multiple sensors that individually detect the temperature and other characteristics of each of the robot's multiple driving parts. In addition, it is conceivable that the system management of the entire production facility can be performed by transmitting the detection results from the sensors from the industrial robot's control device to a main control device in the production facility.

このような場合に、産業用ロボットの制御装置において、CPUと、複数のセンシングデータのそれぞれを主制御装置に個別に出力するための出力部との間の通信を、共通の通信回線を介して行って低コスト化を図るとする。すると、共通の通信回線において多量の通信データを短時間で処理するために、通信速度を高速化する必要が生じ、通信回線における耐ノイズ性を低下させてしまう。この結果、ノイズ混入を抑えるために、通信距離を長く確保することができなくなるという課題が生じる。 In such a case, in the control device for the industrial robot, communication between the CPU and an output section for individually outputting each of the multiple pieces of sensing data to the main control device is carried out via a common communication line to reduce costs. However, in order to process a large amount of communication data in a short period of time on the common communication line, it becomes necessary to increase the communication speed, which reduces the noise resistance of the communication line. As a result, there is a problem that it becomes impossible to ensure a long communication distance in order to suppress noise interference.

本発明は、以上の背景に鑑みてなされたものであり、その目的とするところは、次のような制御装置、及びこれを備える産業用ロボットを提供することである。即ち、通信速度を高速化させることなく、演算処理部と、複数の特性検出部(例えば温度センサ)による検出結果を主制御装置などの外部装置に個別に出力する出力部との間における通信を共通の通信回線で行うことができる制御装置等である。 The present invention has been made in view of the above background, and has as its object to provide the following control device and an industrial robot equipped with the same. That is, the control device etc. is capable of communicating over a common communication line between a calculation processing unit and an output unit that individually outputs the detection results of multiple characteristic detection units (e.g., temperature sensors) to an external device such as a main control unit, without increasing the communication speed.

上記目的を達成するために、本発明は、産業用ロボットの駆動部における所定の第1特性を検出する第1特性検出部による検出結果である第1特性検出結果に基づいて駆動制御のための所定の演算処理を実行する演算処理部を備える制御装置であって、複数の前記駆動部におけるそれぞれの前記第1特性を個別に検出する複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果を外部装置に向けて個別に出力する第1出力部と、複数の前記駆動部におけるそれぞれの第2特性を個別に検出する複数の第2特性検出部によるそれぞれの検出結果である第2特性検出結果を外部装置に向けて個別に出力する第2出力部と、複数の前記駆動部におけるそれぞれの第3特性を個別に検出する複数の第3特性検出部によるそれぞれの検出結果である第3特性検出結果を外部装置に向けて個別に出力する第3出力部と、を備え、前記演算処理部が、複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果をアナログ/デジタル変換し、デジタル信号からなる前記第1特性検出結果を前記駆動部毎に前記第1出力部に格納した後、デジタル信号からなる前記第1特性検出結果を個別に更新するための複数の更新信号をそれぞれ互いに異なるタイミングで前記第1出力部に出力して、前記第1出力部における複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果の更新を個別に行わせ、複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果をアナログ/デジタル変換し、デジタル信号からなる前記第2特性検出結果を前記駆動部毎に前記第2出力部に格納した後、デジタル信号からなる前記第2特性検出結果を個別に更新するための複数の更新信号をそれぞれ互いに異なるタイミングで前記第2出力部に出力して、前記第2出力部における複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果の更新を個別に行わせ、複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果をアナログ/デジタル変換し、デジタル信号からなる前記第3特性検出結果を前記駆動部毎に前記第3出力部に格納した後、デジタル信号からなる前記第3特性検出結果を個別に更新するための複数の更新信号をそれぞれ互いに異なるタイミングで前記第3出力部に出力して、前記第3出力部における複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果の更新を個別に行わせ、複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果を個別に更新するための複数の更新信号と、複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果を個別に更新するための複数の更新信号と、複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果を個別に更新するための複数の更新信号とを、互いに異なるタイミングで出力し、前記第1特性が、温度であり、前記第2特性が、電流であり、前記第3特性が、加速度であり、前記演算処理部が、複数の前記第3特性検出部としての、複数の加速度検出部によるそれぞれの加速度検出結果の更新周期を、複数の前記第1特性検出部としての、複数の温度検出部によるそれぞれの温度検出結果の更新周期、及び複数の前記第2特性検出部としての、複数の電流検出部によるそれぞれの電流検出結果の更新周期の何れよりも短くし、複数の前記加速度検出部のそれぞれによって得られる複数の前記加速度検出結果について、先行する前記加速度検出結果と、後続の前記加速度検出結果とを連続的に出力する、ことを特徴とするものである。 In order to achieve the above object, the present invention provides a control device including an arithmetic processing unit that executes predetermined arithmetic processing for drive control based on a first characteristic detection result that is a detection result by a first characteristic detection unit that detects a predetermined first characteristic of a drive unit of an industrial robot, the control device including a first output unit that outputs, to an external device, each of the first characteristic detection results by a plurality of the first characteristic detection units that individually detect the first characteristics of each of the plurality of drive units, a second output unit that outputs, to an external device, each of the second characteristic detection results that are detection results by a plurality of the second characteristic detection units that individually detect the second characteristics of each of the plurality of drive units, and a third output unit that outputs, to an external device, each of the third characteristic detection results that are detection results by a plurality of the third characteristic detection units that individually detect the third characteristics of each of the plurality of drive units. and a unit, wherein the arithmetic processing unit performs analog/digital conversion on the first characteristic detection results by the plurality of first characteristic detection units, stores the first characteristic detection results consisting of digital signals in the first output unit for each of the driving units, and then outputs a plurality of update signals to the first output unit at different timings to individually update the first characteristic detection results consisting of digital signals , thereby causing the first output unit to individually update the first characteristic detection results by the plurality of first characteristic detection units, and performs analog/digital conversion on the second characteristic detection results by the plurality of second characteristic detection units, stores the second characteristic detection results consisting of digital signals in the second output unit for each of the driving units, and then outputs a plurality of update signals to the first output unit at different timings to individually update the second characteristic detection results consisting of digital signals . and outputting a plurality of update signals to the third output section at different timings to update the third characteristic detection results individually, the third characteristic detection results by the plurality of second characteristic detection sections in the second output section being individually updated, the third characteristic detection results by the plurality of third characteristic detection sections being analog-to-digital converted, the third characteristic detection results consisting of digital signals being stored in the third output section for each of the driving sections, and then outputting a plurality of update signals to the third output section at different timings to update the third characteristic detection results by the plurality of third characteristic detection sections in the third output section individually, the third characteristic detection results by the plurality of third characteristic detection sections being individually updated, and the first characteristic is temperature , the second characteristic is current, and the third characteristic is acceleration; the arithmetic processing unit sets an update period for each of the acceleration detection results by the multiple acceleration detection units as the multiple third characteristic detection units to be shorter than either an update period for each of the temperature detection results by the multiple temperature detection units as the multiple first characteristic detection units, or an update period for each of the current detection results by the multiple current detection units as the multiple second characteristic detection units; and for the multiple acceleration detection results obtained by each of the multiple acceleration detection units, a preceding acceleration detection result and a succeeding acceleration detection result are successively output .

本発明によれば、通信速度を高速化させることなく、演算処理部と、複数の第1特性検出部による検出結果を外部装置に個別に出力する第1出力部との間における通信を共通の通信回線で行うことができるという優れた効果を奏する。 The present invention has the excellent effect of enabling communication between the calculation processing unit and the first output unit, which individually outputs the detection results of the multiple first characteristic detection units to an external device, to be performed over a common communication line without increasing the communication speed.

実施形態に係る産業用ロボットを示す斜視図である。FIG. 1 is a perspective view showing an industrial robot according to an embodiment. 同産業用ロボットを示す平面図である。FIG. 2 is a plan view showing the industrial robot. 同産業用ロボットの電気回路の要部を示すブロック図である。FIG. 2 is a block diagram showing a main part of an electrical circuit of the industrial robot. 同産業用ロボットにおけるSCハーネス57、及び出力回路部65の電気回路を示すブロック図である。13 is a block diagram showing an electric circuit of an SC harness 57 and an output circuit unit 65 in the industrial robot. FIG. 同産業用ロボットにおける各種の信号の出力タイミングを示すタイミングチャートである。4 is a timing chart showing output timings of various signals in the industrial robot. 図5における加速度検出結果の出力タイミングをより詳細に示すタイミングチャートである。6 is a timing chart showing in more detail the output timing of the acceleration detection result in FIG. 5 . 同各種の信号の波形を示す波形図である。3 is a waveform diagram showing waveforms of various signals. FIG.

以下、図面を参照しながら、本発明の実施形態に係る制御装置及び産業用ロボットの一実施形態について説明する。なお、以下の図面においては、各構成をわかり易くするために、実際の構造、並びに、各構造における縮尺及び数、などを異ならせる場合がある。 Below, an embodiment of a control device and an industrial robot according to the present invention will be described with reference to the drawings. Note that in the following drawings, the actual structure, as well as the scale and number of each structure, may be different in order to make each configuration easier to understand.

図1は、実施形態に係る産業用ロボット1を示す斜視図である。図2は、産業用ロボット1を示す平面図である。産業用ロボット1は、ガラス基板を搬送するためのロボットであり、アーム2、架台3、及び昇降部4を備える。昇降部4は、架台3に保持され、不図示の昇降モータの駆動によって上下方向(図1の矢印方向)に昇降する。アーム2は、ガラス基板を載せる手部2A、前腕部2B、及び上腕部2Cを備え、昇降部4によって保持される。 Figure 1 is a perspective view showing an industrial robot 1 according to an embodiment. Figure 2 is a plan view showing the industrial robot 1. The industrial robot 1 is a robot for transporting glass substrates, and includes an arm 2, a stand 3, and a lifting unit 4. The lifting unit 4 is held by the stand 3, and is raised and lowered in the vertical direction (the direction of the arrow in Figure 1) by driving a lifting motor (not shown). The arm 2 includes a hand 2A, a forearm 2B, and an upper arm 2C on which the glass substrate is placed, and is held by the lifting unit 4.

上腕部2Cにおける昇降部4との接続部である肩関節2Dは、第1モータ22Aの駆動によって水平方向に沿って回動することが可能である。具体的には、第1モータ22Aの回転駆動力が第1ベルト2Eを介して肩関節2Dに伝達されることで、肩関節2Dが水平方向に回動する。また、上腕部2Cと前腕部2Bとの接続部である肘関節2Fは、第2モータ22Bの駆動によって水平方向に沿って回動することが可能である。具体的には、第2モータ22Bの回転駆動力が第2ベルト2Gを介して肘関節2Fに伝達されることで、肘関節2Fが水平方向に回動する。また、前腕部2Bと手部2Aとの接続部である手首関節は、第2モータ22Bの駆動力をベルトを介して受けることで、水平方向に沿って回動することが可能である。 The shoulder joint 2D, which is the connection part of the upper arm 2C with the lifting part 4, can rotate in the horizontal direction by driving the first motor 22A. Specifically, the rotational driving force of the first motor 22A is transmitted to the shoulder joint 2D via the first belt 2E, so that the shoulder joint 2D rotates in the horizontal direction. In addition, the elbow joint 2F, which is the connection part between the upper arm 2C and the forearm 2B, can rotate in the horizontal direction by driving the second motor 22B. Specifically, the rotational driving force of the second motor 22B is transmitted to the elbow joint 2F via the second belt 2G, so that the elbow joint 2F rotates in the horizontal direction. In addition, the wrist joint, which is the connection part between the forearm 2B and the hand 2A, can rotate in the horizontal direction by receiving the driving force of the second motor 22B via the belt.

図1における昇降部4は、昇降モータの正転、逆転により、図中矢印方向に昇降することが可能である。 The lifting unit 4 in FIG. 1 can be raised and lowered in the direction of the arrow by rotating the lifting motor forward and backward.

図3は、産業用ロボット1の電気回路の要部を示すブロック図である。産業用ロボット1は、制御装置50、第1駆動部31、第2駆動部32、第3駆動部33、第4駆動部34、第5駆動部35、第6駆動部36、第7駆動部37、及び第8駆動部38を備える。 Figure 3 is a block diagram showing the main parts of the electrical circuit of the industrial robot 1. The industrial robot 1 includes a control device 50, a first drive unit 31, a second drive unit 32, a third drive unit 33, a fourth drive unit 34, a fifth drive unit 35, a sixth drive unit 36, a seventh drive unit 37, and an eighth drive unit 38.

第1駆動部31は、上述の第1モータ(図2の22A)を備える。また、第1駆動部31は、第1モータの温度を検出する第1温度センサ(TpS1)31aと、第1モータに流れる電流値を検出する第1電流センサ(EcS1)31bと、第1モータの加速度を検出する第1加速度センサ(AcS1)31cとを備える。第1温度センサ31aは、第1モータの温度検出結果である第1温度検出結果を出力する。第1電流センサ31bは、第1モータに流れる電流値の検出結果である第1電流検出結果を出力する。第1加速度センサ31cは、第1モータの加速度検出結果である第1加速度検出結果を出力する。 The first drive unit 31 includes the first motor (22A in FIG. 2). The first drive unit 31 also includes a first temperature sensor (TpS1) 31a that detects the temperature of the first motor, a first current sensor (EcS1) 31b that detects the value of the current flowing through the first motor, and a first acceleration sensor (AcS1) 31c that detects the acceleration of the first motor. The first temperature sensor 31a outputs a first temperature detection result that is the result of detecting the temperature of the first motor. The first current sensor 31b outputs a first current detection result that is the result of detecting the value of the current flowing through the first motor. The first acceleration sensor 31c outputs a first acceleration detection result that is the result of detecting the acceleration of the first motor.

なお、温度は、本発明における駆動部の第1特性の一例である。また、電流値は、本発明における駆動部の第2特性の一例である。また、加速度は、本発明における駆動部の第3特性の一例である。また、温度センサは、本発明における第1特性検出部の一例である。また、電流値センサは、本発明における第2特性検出部の一例である。また、加速度センサは、本発明における第3特性検出部の一例である。 The temperature is an example of the first characteristic of the drive unit in the present invention. The current value is an example of the second characteristic of the drive unit in the present invention. The acceleration is an example of the third characteristic of the drive unit in the present invention. The temperature sensor is an example of the first characteristic detection unit in the present invention. The current value sensor is an example of the second characteristic detection unit in the present invention. The acceleration sensor is an example of the third characteristic detection unit in the present invention.

第2駆動部32は、上述の第2モータ(図2の22B)を備える。また、第2駆動部32は、第2モータの温度を検出する第2温度センサ(TpS2)32aと、第2モータに流れる電流値を検出する第2電流センサ(EcS2)32bと、第2モータの加速度を検出する第2加速度センサ(AcS2)32cとを備える。第2温度センサ32aは、第2モータの温度検出結果である第2温度検出結果を出力する。第2電流センサ32bは、第2モータに流れる電流値の検出結果である第2電流検出結果を出力する。第2加速度センサ32cは、第2モータの加速度検出結果である第2加速度検出結果を出力する。 The second drive unit 32 includes the second motor (22B in FIG. 2). The second drive unit 32 also includes a second temperature sensor (TpS2) 32a for detecting the temperature of the second motor, a second current sensor (EcS2) 32b for detecting the value of the current flowing through the second motor, and a second acceleration sensor (AcS2) 32c for detecting the acceleration of the second motor. The second temperature sensor 32a outputs a second temperature detection result which is the result of detecting the temperature of the second motor. The second current sensor 32b outputs a second current detection result which is the result of detecting the value of the current flowing through the second motor. The second acceleration sensor 32c outputs a second acceleration detection result which is the result of detecting the acceleration of the second motor.

第3駆動部33は、上述の昇降モータを備える。また、第3駆動部33は、昇降モータの温度を検出する第3温度センサ(TpS3)33aと、昇降モータに流れる電流値を検出する第3電流センサ(EcS3)33bと、昇降モータの加速度を検出する第3加速度センサ(AcS3)33cとを備える。第3温度センサ33aは、上述の昇降モータの温度検出結果である第3温度検出結果を出力する。第3電流センサ33bは、昇降モータに流れる電流値の検出結果である第3電流検出結果を出力する。第3加速度センサ33cは、昇降モータの加速度検出結果である第3加速度検出結果を出力する。 The third drive unit 33 includes the lift motor described above. The third drive unit 33 also includes a third temperature sensor (TpS3) 33a that detects the temperature of the lift motor, a third current sensor (EcS3) 33b that detects the value of the current flowing through the lift motor, and a third acceleration sensor (AcS3) 33c that detects the acceleration of the lift motor. The third temperature sensor 33a outputs a third temperature detection result that is the result of detecting the temperature of the lift motor described above. The third current sensor 33b outputs a third current detection result that is the result of detecting the value of the current flowing through the lift motor. The third acceleration sensor 33c outputs a third acceleration detection result that is the result of detecting the acceleration of the lift motor.

第4駆動部34は、ギヤ等から構成される駆動機構としての肩関節(図2の2D)と、肩関節の温度を検出する第4温度センサ(TpS4)34aとを備える。また、第4駆動部34は、第4電流センサ(EcS4)34bと、肩関節における肩部に対する上腕部の加速度を検出する第4加速度センサ(AcS4)34cとを備える。第4温度センサ34aは、温度検出結果たる第4温度検出結果を出力する。第4電流センサ34bは、電流の検出結果たる第4電流検出結果を出力するが、実施形態に係る産業用ロボットでは、第4電流センサ34bには電流検出対象が接続されていないため、第4電流センサ34bは、第4電流検出結果としてゼロを出力する。第4加速度センサ34cは、加速度検出結果たる第4加速度検出結果を出力する。 The fourth drive unit 34 includes a shoulder joint (2D in FIG. 2) as a drive mechanism including gears and the like, and a fourth temperature sensor (TpS4) 34a for detecting the temperature of the shoulder joint. The fourth drive unit 34 also includes a fourth current sensor (EcS4) 34b and a fourth acceleration sensor (AcS4) 34c for detecting the acceleration of the upper arm relative to the shoulder at the shoulder joint. The fourth temperature sensor 34a outputs a fourth temperature detection result as a temperature detection result. The fourth current sensor 34b outputs a fourth current detection result as a current detection result, but in the industrial robot according to the embodiment, since no current detection target is connected to the fourth current sensor 34b, the fourth current sensor 34b outputs zero as the fourth current detection result. The fourth acceleration sensor 34c outputs a fourth acceleration detection result as an acceleration detection result.

第5駆動部35は、ギヤ等から構成される駆動機構としての肘関節(図2の2F)と、肘関節の温度を検出する第5温度センサ(TpS5)35aとを備える。また、第5駆動部35は、第5電流センサ(EcS5)35bと、上腕部に対する前腕部の加速度を検出する第5加速度センサ(AcS5)35cとを備える。第5温度センサ35aは、温度検出結果たる第5温度検出結果を出力する。第5電流センサ35bは、電流の検出結果たる第5電流検出結果を出力するが、実施形態に係る産業用ロボットでは、第5電流センサ35bには電流検出対象が接続されていないため、第5電流センサ35bは、第5電流検出結果としてゼロを出力する。第5加速度センサ35cは、加速度検出結果たる第5加速度検出結果を出力する。 The fifth drive unit 35 includes an elbow joint (2F in FIG. 2) as a drive mechanism including gears and the like, and a fifth temperature sensor (TpS5) 35a for detecting the temperature of the elbow joint. The fifth drive unit 35 also includes a fifth current sensor (EcS5) 35b and a fifth acceleration sensor (AcS5) 35c for detecting the acceleration of the forearm relative to the upper arm. The fifth temperature sensor 35a outputs a fifth temperature detection result as a temperature detection result. The fifth current sensor 35b outputs a fifth current detection result as a current detection result, but in the industrial robot according to the embodiment, since no current detection target is connected to the fifth current sensor 35b, the fifth current sensor 35b outputs zero as the fifth current detection result. The fifth acceleration sensor 35c outputs a fifth acceleration detection result as an acceleration detection result.

第6駆動部36は、ギヤ等から構成される駆動機構としての手首関節(前腕部3Bと手部2Aとの関節)と、手首関節の温度を検出する第6温度センサ(TpS6)36aとを備える。また、第6駆動部36は、第6電流センサ(EcS6)36bと、前腕部に対する手部の回転の加速度を検出する第6加速度センサ(AcS6)36cとを備える。第6温度センサ36aは、温度検出結果たる第6温度検出結果を出力する。第6電流センサ36bは、電流検出結果たる第6電流検出結果を出力するが、実施形態に係る産業用ロボットでは、第6電流センサ36bには電流検出対象が接続されていないため、第6電流センサ36bは、第6電流検出結果としてゼロを出力する。第6加速度センサ36cは、加速度検出結果たる第6加速度検出結果を出力する。 The sixth drive unit 36 includes a wrist joint (the joint between the forearm 3B and the hand 2A) as a drive mechanism including gears and the like, and a sixth temperature sensor (TpS6) 36a for detecting the temperature of the wrist joint. The sixth drive unit 36 also includes a sixth current sensor (EcS6) 36b and a sixth acceleration sensor (AcS6) 36c for detecting the acceleration of the rotation of the hand relative to the forearm. The sixth temperature sensor 36a outputs a sixth temperature detection result as a temperature detection result. The sixth current sensor 36b outputs a sixth current detection result as a current detection result, but in the industrial robot according to the embodiment, since no current detection target is connected to the sixth current sensor 36b, the sixth current sensor 36b outputs zero as the sixth current detection result. The sixth acceleration sensor 36c outputs a sixth acceleration detection result as an acceleration detection result.

第7駆動部37は、昇降部(図1の4)の駆動機構としての第1ボールネジと、第1ボールネジの温度を検出する第7温度センサ(TpS7)37aとを備える。また、第7駆動部37は、第7電流センサ(EcS7)37bと、第1ボールネジの伸縮の加速度を検出する第7加速度センサ(AcS7)37cとを備える。第7温度センサ37aは、温度検出結果たる第7温度検出結果を出力する。第7電流センサ37bは、電流検出結果たる第7電流検出結果を出力するが、実施形態に係る産業用ロボットでは、第7電流センサ37bには電流検出対象が接続されていないため、第7電流センサ37bは、第7電流検出結果としてゼロを出力する。第7加速度センサ37cは、加速度検出結果たる第7加速度検出結果を出力する。 The seventh drive unit 37 includes a first ball screw as a drive mechanism for the lift unit (4 in FIG. 1) and a seventh temperature sensor (TpS7) 37a that detects the temperature of the first ball screw. The seventh drive unit 37 also includes a seventh current sensor (EcS7) 37b and a seventh acceleration sensor (AcS7) 37c that detects the acceleration of the expansion and contraction of the first ball screw. The seventh temperature sensor 37a outputs a seventh temperature detection result that is a temperature detection result. The seventh current sensor 37b outputs a seventh current detection result that is a current detection result, but in the industrial robot according to the embodiment, since a current detection target is not connected to the seventh current sensor 37b, the seventh current sensor 37b outputs zero as the seventh current detection result. The seventh acceleration sensor 37c outputs a seventh acceleration detection result that is an acceleration detection result.

第8駆動部38は、昇降部(図1の4)の駆動機構としての第2ボールネジと、第2ボールネジの温度を検出する第8温度センサ(TpS8)38aとを備える。また、第8駆動部38は、第8電流センサ(EcS8)38bと、第2ボールネジの伸縮の加速度を検出する第8加速度センサ(AcS8)38cとを備える。第8温度センサ38aは、温度検出結果たる第8温度検出結果を出力する。第8電流センサ38bは、電流検出結果たる第8電流検出結果を出力するが、実施形態に係る産業用ロボットでは、第8電流センサ38bには電流検出対象が接続されていないため、第8電流センサ38bは、第8電流検出
結果としてゼロを出力する。第8加速度センサ38cは、加速度検出結果たる第8加速度検出結果を出力する。
The eighth drive unit 38 includes a second ball screw as a drive mechanism for the lift unit (4 in FIG. 1) and an eighth temperature sensor (TpS8) 38a for detecting the temperature of the second ball screw. The eighth drive unit 38 also includes an eighth current sensor (EcS8) 38b and an eighth acceleration sensor (AcS8) 38c for detecting the acceleration of the expansion and contraction of the second ball screw. The eighth temperature sensor 38a outputs an eighth temperature detection result as a temperature detection result. The eighth current sensor 38b outputs an eighth current detection result as a current detection result, but in the industrial robot according to the embodiment, since a current detection target is not connected to the eighth current sensor 38b, the eighth current sensor 38b outputs zero as the eighth current detection result. The eighth acceleration sensor 38c outputs an eighth acceleration detection result as an acceleration detection result.

制御装置50は、CPU51、RAM(Random Access Memory)52、ROM(Read Only Memory)53、第1のI/Oユニット54、及び第2のI/Oユニット55を備える。また、制御装置50は、SC(Serial Communication)ハーネス57、及び出力回路部65を備える。 The control device 50 includes a CPU 51, a RAM (Random Access Memory) 52, a ROM (Read Only Memory) 53, a first I/O unit 54, and a second I/O unit 55. The control device 50 also includes a SC (Serial Communication) harness 57, and an output circuit section 65.

出力回路部65は、第1出力部たる第1デジタル・アナログコンバータ(DAC1)61、第2出力部たる第2デジタル・アナログコンバータ(DAC2)62、及び第3出力部たる第3デジタル・アナログコンバータ(DAC3)63を備える。以下、デジタル・アナログコンバータを、D/Aコンバータと言う。 The output circuit section 65 includes a first digital-to-analog converter (DAC1) 61 as a first output section, a second digital-to-analog converter (DAC2) 62 as a second output section, and a third digital-to-analog converter (DAC3) 63 as a third output section. Hereinafter, the digital-to-analog converter is referred to as a D/A converter.

8つの駆動部(31~38)におけるそれぞれの温度センサ(TpS1~8)による温度検出結果は、第1のI/Oユニット54を介してCPU51に入力される。また、8つの駆動部(31~38)におけるそれぞれの電流センサ(EcS1~8)による電流検出結果は、第1のI/Oユニット54を介してCPU51に入力される。また、8つの駆動部(31~38)におけるそれぞれの加速度センサ(AcS1~8)による加速度検出結果は、第1のI/Oユニット54を介してCPU51に入力される。各種特性の検出結果に基づいて、第1モータ(図2の22A)の駆動と、第2モータ(図2の22B)の駆動と、昇降モータの駆動とを個別に制御するための演算処理を行う。前述の各種特性の検出結果は、具体的には、8つの温度センサ(31a~38a)のそれぞれによる温度検出結果、8つの電流センサ(31b~38b)のそれぞれによる電流検出結果、及び8つの加速度センサ(31c~38c)のそれぞれによる検出結果である。 The temperature detection results by the temperature sensors (TpS1-8) in the eight drive units (31-38) are input to the CPU 51 via the first I/O unit 54. In addition, the current detection results by the current sensors (EcS1-8) in the eight drive units (31-38) are input to the CPU 51 via the first I/O unit 54. In addition, the acceleration detection results by the acceleration sensors (AcS1-8) in the eight drive units (31-38) are input to the CPU 51 via the first I/O unit 54. Based on the detection results of the various characteristics, calculation processing is performed to individually control the drive of the first motor (22A in FIG. 2), the drive of the second motor (22B in FIG. 2), and the drive of the lift motor. Specifically, the detection results of the various characteristics mentioned above are the temperature detection results from each of the eight temperature sensors (31a to 38a), the current detection results from each of the eight current sensors (31b to 38b), and the detection results from each of the eight acceleration sensors (31c to 38c).

8つの温度センサ(31a~38a)のそれぞれから個別に出力される温度検出結果(第1温度検出結果~第8温度検出結果)は、第1のI/Oユニット54を介してCPU51に個別に入力される。CPU51は、入力された第1温度検出結果~第8温度検出結果のそれぞれを、デジタル信号として出力する。出力された第1温度検出結果~第8温度検出結果のそれぞれは、第2のI/Oユニット55を介して出力回路部65に入力される。 The temperature detection results (first to eighth temperature detection results) output individually from each of the eight temperature sensors (31a to 38a) are input individually to the CPU 51 via the first I/O unit 54. The CPU 51 outputs each of the input first to eighth temperature detection results as a digital signal. Each of the output first to eighth temperature detection results is input to the output circuit section 65 via the second I/O unit 55.

8つの電流センサ(31b~38b)のそれぞれから個別に出力される電流検出結果(第1電流検出結果~第8電流検出結果)は、第1のI/Oユニット54を介してCPU51に個別に入力される。CPU51は、入力された第1電流検出結果~第8電流検出結果のそれぞれを、デジタル信号として出力する。出力された第電流検出結果~第8電流検出結果のそれぞれは、第2のI/Oユニット55を介して出力回路部65に入力される。 The current detection results (first to eighth current detection results) output individually from each of the eight current sensors (31b to 38b) are input individually to the CPU 51 via the first I/O unit 54. The CPU 51 outputs each of the input first to eighth current detection results as a digital signal. Each of the output first to eighth current detection results is input to the output circuit section 65 via the second I/O unit 55.

8つの加速度センサ(31c~38c)のそれぞれから個別に出力される加速度検出結果(第1加速度検出結果~第8加速度検出結果)は、第1のI/Oユニット54を介してCPU51に個別に入力される。CPU51は、入力された第1加速度検出結果~第8加速度検出結果のそれぞれを、デジタル信号として出力する。出力された第1加速度検出結果~第8加速度検出結果のそれぞれは、第2のI/Oユニット55を介して出力回路部65に入力される。 The acceleration detection results (first to eighth acceleration detection results) output individually from each of the eight acceleration sensors (31c to 38c) are input individually to the CPU 51 via the first I/O unit 54. The CPU 51 outputs each of the input first to eighth acceleration detection results as a digital signal. Each of the output first to eighth acceleration detection results is input to the output circuit section 65 via the second I/O unit 55.

図4は、SCハーネス57、及び出力回路部65の電気回路を示すブロック図である。出力回路部65は、第1出力部たる第1D/Aコンバータ61と、第2出力部たる第2D/Aコンバータ62と、第3出力部たる第3D/Aコンバータ63とを備える。第1D/Aコンバータ61は、デジタル信号からなる第1温度検出結果~第8温度検出結果のそれぞれを個別に記憶する8つのメモリチップを備える。また、第1D/Aコンバータ61は、8つのメモリチップのそれぞれに個別に記憶している温度検出結果のそれぞれを、個別にアナログ信号(Tp1~Tp8)に変換して出力する。アナログ信号として個別に出力された8つの温度検出結果(Tp1~Tp8)は、個別の信号線を通じて外部の主制御装置に送信される。 Figure 4 is a block diagram showing the SC harness 57 and the electrical circuit of the output circuit unit 65. The output circuit unit 65 includes a first D/A converter 61 as a first output unit, a second D/A converter 62 as a second output unit, and a third D/A converter 63 as a third output unit. The first D/A converter 61 includes eight memory chips that individually store the first to eighth temperature detection results, which are digital signals. The first D/A converter 61 also converts each of the temperature detection results individually stored in the eight memory chips into an analog signal (Tp1 to Tp8) and outputs it. The eight temperature detection results (Tp1 to Tp8) individually output as analog signals are transmitted to an external main control device through individual signal lines.

第2D/Aコンバータ62は、デジタル信号からなる第1電流検出結果~第8電流検出結果のそれぞれを個別に記憶する8つのメモリチップを備える。また、第2D/Aコンバータ62は、8つのメモリチップのそれぞれに個別に記憶している電流検出結果のそれぞれを、個別にアナログ信号(Ec1~Ec8)に変換して出力する。アナログ信号として個別に出力された8つの電流検出結果(Ec1~Ec8)は、個別の信号線を通じて外部の主制御装置に送信される。 The second D/A converter 62 has eight memory chips that individually store the first to eighth current detection results, which are digital signals. The second D/A converter 62 also converts each of the current detection results individually stored in the eight memory chips into an analog signal (Ec1 to Ec8) and outputs it. The eight current detection results (Ec1 to Ec8) individually output as analog signals are transmitted to an external main control device via individual signal lines.

第3D/Aコンバータ63は、デジタル信号からなる第1加速度検出結果~第8加速度検出結果のそれぞれを個別に記憶する8つのメモリチップを備える。また、第3D/Aコンバータ63は、8つのメモリチップのそれぞれに個別に記憶している加速度検出結果のそれぞれを、個別にアナログ信号(Ac1~Ac8)に変換して出力する。アナログ信号として個別に出力された8つの加速度検出結果(Ac1~Ac8)は、個別の信号線を通じて外部の主制御装置に送信される。 The third D/A converter 63 has eight memory chips that individually store the first to eighth acceleration detection results, which are digital signals. The third D/A converter 63 also converts each of the acceleration detection results individually stored in each of the eight memory chips into an analog signal (Ac1 to Ac8) and outputs it. The eight acceleration detection results (Ac1 to Ac8) individually output as analog signals are transmitted to an external main control device via individual signal lines.

第2のI/Oユニット55と、第1D/Aコンバータ61とは、SCハーネス57を介したSPI(Serial Peripheral Interface)による通信を行う。1つのD/Aコンバータに対してSPIによる通信を行うためには、5芯のSCハーネスを用いるのが一般的である。5芯のうちの1芯は、チップセレクト(CS)信号の送信に用いるものである。また、他の1芯は、クロック(SCLK)信号の送信に用いるものである。また、他の1芯は、データ送信(MOSI)信号の送信に用いるものである。また、他の1芯は、データ受信信号(MISO)の送信に用いるものである。また、他の1芯は、レファレンス電圧(VREF)の印加に用いるものである。実施形態においては、3つのD/Aコンバータ(61~63)を搭載しているため、5芯×5=15芯のSCハーネスを用いるのが一般的であるが、芯数が多くなることから、コスト高になってしまう。 The second I/O unit 55 and the first D/A converter 61 communicate with each other by SPI (Serial Peripheral Interface) via the SC harness 57. To communicate with one D/A converter by SPI, a five-core SC harness is generally used. One of the five cores is used to transmit a chip select (CS) signal. The other core is used to transmit a clock (SCLK) signal. The other core is used to transmit a data transmission (MOSI) signal. The other core is used to transmit a data reception signal (MISO). The other core is used to apply a reference voltage (VREF). In the embodiment, since three D/A converters (61 to 63) are mounted, a 5-core x 5 = 15-core SC harness is generally used, but the increased number of cores results in higher costs.

CS信号は、D/Aコンバータにおける8つのメモリチップのうち、何れにデータを記憶させるのかを選択するための信号であり、本発明における更新信号(メモリチップ内のデータを更新するための信号)として機能する。3つのD/Aコンバータ(61~63)において、CS信号を除く4つの信号のそれぞれを共通の通信線で通信する場合には、SCハーネスの芯数を4芯+3芯=7芯に低減して、低コスト化を図ることができる。しかしながら、共通の通信線において多量の通信データを短時間で処理するために、通信速度を高速化する必要が生じ、通信線における耐ノイズ性を低下させてしまう。この結果、ノイズ混入を抑えるために、通信距離を長く確保することができなくなるという課題が生じる。 The CS signal is a signal for selecting which of the eight memory chips in the D/A converter is to store the data, and functions as an update signal (a signal for updating the data in the memory chip) in the present invention. In the three D/A converters (61-63), if each of the four signals excluding the CS signal is communicated over a common communication line, the number of cores in the SC harness can be reduced to 4 cores + 3 cores = 7 cores, thereby reducing costs. However, in order to process a large amount of communication data in a short time over the common communication line, it becomes necessary to increase the communication speed, which reduces the noise resistance of the communication line. As a result, there is a problem that it becomes impossible to ensure a long communication distance in order to suppress noise interference.

そこで、実施形態に係る産業用ロボット1においては、以下に説明する特徴的な構成を備える。
産業用ロボット1の制御装置50は、3つのD/Aコンバータ(61~63)において、CS信号を除く4つの信号のそれぞれを共通の通信線で通信する。これにより、SCハーネス57の芯数を7芯に低減して、低コスト化を図ることができる。7芯のうちの1芯は、温度検出結果を出力する第1D/Aコンバータ61用の第1CS信号(CS1信号)を送信するためのものである。また、他の1芯は、電流検出結果を出力する第2D/Aコンバータ62用の第2CS信号(CS2信号)を送信するためのものである。また、他の1芯は、加速度検出結果を出力する第3D/Aコンバータ63用の第3CS信号(CS3信号)を送信するためのものである。また、他の1芯は、3つのD/Aコンバータ(61~63)に対してSCLK信号を共通して送信するための共通信号線である。また、他の1芯は、3つのD/Aコンバータ(61~63)に対してMOSI信号を共通して送信するための共通信号線である。また、他の1芯は、3つのD/Aコンバータ(61~63)のそれぞれから、第2のI/Oユニット55へMISO信号を共通して送信するための共通信号線である。また、他の1芯は、3つのD/Aコンバータ(61~63)のそれぞれにVREFを共通して印加するための共通信号線である。
Therefore, the industrial robot 1 according to the embodiment has a characteristic configuration which will be described below.
In the control device 50 of the industrial robot 1, the three D/A converters (61 to 63) communicate each of the four signals, except for the CS signal, through a common communication line. This allows the number of cores of the SC harness 57 to be reduced to seven, thereby reducing costs. One of the seven cores is for transmitting a first CS signal (CS1 signal) for the first D/A converter 61 that outputs the temperature detection result. The other core is for transmitting a second CS signal (CS2 signal) for the second D/A converter 62 that outputs the current detection result. The other core is for transmitting a third CS signal (CS3 signal) for the third D/A converter 63 that outputs the acceleration detection result. The other core is a common signal line for commonly transmitting an SCLK signal to the three D/A converters (61 to 63). The other core is a common signal line for commonly transmitting a MOSI signal to the three D/A converters (61 to 63). The remaining core is a common signal line for commonly transmitting a MISO signal from each of the three D/A converters (61 to 63) to the second I/O unit 55. The remaining core is a common signal line for commonly applying VREF to each of the three D/A converters (61 to 63).

図5は、各種の信号の出力タイミングを示すタイミングチャートである。また、図6は、図5における加速度検出結果の出力タイミングをより詳細に示すタイミングチャートである。図7は、各種の信号の波形を示す波形図である。図5及び図6において、温度のch1~ch89は、第1温度検出結果~第8温度検出結果を意味する。また、電流のch1~ch8は、第1電流検出結果~第8電流検出結果を意味する。また、加速度のch1~ch8は、第1温度検出結果~第8温度検出結果を意味する。 Figure 5 is a timing chart showing the output timing of various signals. Also, Figure 6 is a timing chart showing in more detail the output timing of the acceleration detection results in Figure 5. Figure 7 is a waveform diagram showing the waveforms of various signals. In Figures 5 and 6, ch1 to ch89 for temperature refer to the first to eighth temperature detection results. Also, ch1 to ch8 for current refer to the first to eighth current detection results. Also, ch1 to ch8 for acceleration refer to the first to eighth temperature detection results.

図6~図7に示されるように、CPU51は、温度のch1~ch8(8つの温度検出結果)を、それぞれに応じた互いに異なるタイミングで出力する。これにより、8つの温度検出結果のそれぞれを、共通の信号線(SCLK信号用の1芯と、MOSI信号用の1芯と、MISO用の1芯と、VREF用の1芯との組み合わせ)によって出力することを可能にしつつ、温度検出結果の通信速度の高速化を回避することができる。 As shown in Figures 6 and 7, the CPU 51 outputs temperature ch1 to ch8 (eight temperature detection results) at different timings according to the respective results. This makes it possible to output each of the eight temperature detection results through a common signal line (a combination of one core for the SCLK signal, one core for the MOSI signal, one core for the MISO signal, and one core for the VREF signal), while avoiding the need to increase the communication speed of the temperature detection results.

温度の各chにおいて、温度検出結果の更新周期は、8.00〔msec〕である。一般的な温度センサからの温度検出結果の出力周波数は、数kHzであることから、温度検出結果の更新周期が8.00〔msec〕であることで、温度変化が精度よく検出される。 For each temperature channel, the update period for the temperature detection result is 8.00 [msec]. Since the output frequency of the temperature detection result from a typical temperature sensor is several kHz, an update period for the temperature detection result of 8.00 [msec] allows for accurate detection of temperature changes.

CPU51は、図6~図7に示されるように、電流のch1~ch8(8つの電流検出結果)を、それぞれに応じた互いに異なるタイミングで出力する。これにより、8つの電流検出結果のそれぞれを、共通の信号線(SCLK信号用の1芯と、MOSI信号用の1芯と、MISO用の1芯と、VREF用の1芯との組み合わせ)によって出力することを可能にしつつ、電流検出結果の通信速度の高速化を回避することができる。 As shown in Figures 6 and 7, the CPU 51 outputs current ch1 to ch8 (eight current detection results) at different timings according to the respective results. This makes it possible to output each of the eight current detection results through a common signal line (a combination of one core for the SCLK signal, one core for the MOSI signal, one core for the MISO signal, and one core for the VREF signal), while avoiding the need to increase the communication speed of the current detection results.

電流の各chにおいて、電流検出結果の更新周期は、8.00〔msec〕である。一般的な電流センサからの電流検出結果の出力周波数は、1〔kHz〕程度であることから、電流検出結果の更新周期が8.00〔msec〕であることで、電流変化が精度よく検出される。図5及び図6では、初めの1.0〔msec〕の期間で、加速度、温度、及び電流の3つの特性値が出力されるが、温度及び電流の更新周期のそれぞれは8.0〔msec〕である。よって、図示されていない2.0~7.0〔msec〕の期間では、温度及び電流はCPU91から出力されず、加速度だけがCPU91から出力される。 For each current channel, the update period of the current detection result is 8.00 [msec]. Since the output frequency of the current detection result from a typical current sensor is about 1 [kHz], a current detection result update period of 8.00 [msec] allows current changes to be detected with high accuracy. In Figures 5 and 6, three characteristic values, acceleration, temperature, and current, are output during the first 1.0 [msec] period, but the update period for temperature and current is 8.0 [msec]. Therefore, during the period of 2.0 to 7.0 [msec] not shown, temperature and current are not output from the CPU 91, and only acceleration is output from the CPU 91.

なお、CPU51は、温度のch1~ch8(8つの温度検出結果)のそれぞれを個別に更新するための更新信号であるCS1信号と、電流のch1~ch8(8つの電流検出結果)のそれぞれを個別に更新するためのCS2信号とを、互いに異なるタイミングで出力する。これにより、温度のch1~ch8と、電流のch1~ch8とを、互いに異なるタイミングで出力することで、温度検出結果の通信速度の高速化の回避と、電流検出結果の通信速度の高速化の回避とを両立させることができる。 The CPU 51 outputs a CS1 signal, which is an update signal for individually updating each of ch1 to ch8 of the temperature (eight temperature detection results), and a CS2 signal for individually updating each of ch1 to ch8 of the current (eight current detection results), at different times. By outputting ch1 to ch8 of the temperature and ch1 to ch8 of the current at different times, it is possible to avoid both an increase in the communication speed of the temperature detection results and an increase in the communication speed of the current detection results.

CPU51は、図6に示されるように、加速度のch1~ch8(第1加速度検出結果~第8加速度検出結果)を個別に更新するための更新信号であるCS1信号を、加速度検出結果に応じた互いに異なるタイミングで出力する。これにより、8つの加速度検出結果のそれぞれを、共通の信号線(SCLK信号用の1芯と、MOSI信号用の1芯と、MISO用の1芯と、VREF用の1芯との組み合わせ)によって出力することを可能にしつつ、加速度検出結果の通信速度の高速化を回避することができる。 As shown in FIG. 6, the CPU 51 outputs the CS1 signal, which is an update signal for individually updating acceleration ch1 to ch8 (first acceleration detection result to eighth acceleration detection result), at different timings according to the acceleration detection result. This makes it possible to output each of the eight acceleration detection results through a common signal line (a combination of one core for the SCLK signal, one core for the MOSI signal, one core for the MISO signal, and one core for the VREF signal), while avoiding the need to increase the communication speed of the acceleration detection results.

なお、CPU51は、温度のch1~ch8のそれぞれを更新するためのCS1信号と、電流のch1~ch8のそれぞれを更新するためのCS2信号と、加速度のch1~ch8のそれぞれを更新するためのCS3信号とを、互いに異なるタイミングで出力する。これにより、温度のch1~ch8と、電流のch1~ch8と、加速度のch1~ch8とを、互いに異なるタイミングで出力する。かかる構成によれば、温度検出結果の通信速度の高速化の回避、電流検出結果の通信速度の高速化の回避、及び加速度検出結果の通信速度の高速化の回避、の3つを何れも達成することができる。 The CPU 51 outputs a CS1 signal for updating each of ch1 to ch8 for temperature, a CS2 signal for updating each of ch1 to ch8 for current, and a CS3 signal for updating each of ch1 to ch8 for acceleration, at different times. This allows ch1 to ch8 for temperature, ch1 to ch8 for current, and ch1 to ch8 for acceleration to be output at different times. With this configuration, it is possible to achieve all three goals: avoiding an increase in the communication speed of the temperature detection results, avoiding an increase in the communication speed of the current detection results, and avoiding an increase in the communication speed of the acceleration detection results.

加速度のch1~ch8の更新周期は、温度のch1~ch8の更新周期、及び電流のch1~ch8の更新周期の何れよりも短い。加速度の各chにおいて、加速度検出結果の更新周期は、0.05〔msec〕である。一般的な加速度センサからの加速度検出結果の出力周波数は、10〔kHz〕程度であることから、加速度検出結果の更新周期が0.05〔msec〕であることで、加速度変化が精度よく検出される。 The update period for acceleration ch1 to ch8 is shorter than both the update period for temperature ch1 to ch8 and the update period for current ch1 to ch8. For each acceleration channel, the update period for the acceleration detection result is 0.05 msec. Since the output frequency of the acceleration detection result from a typical acceleration sensor is around 10 kHz, an update period for the acceleration detection result of 0.05 msec allows acceleration changes to be detected with high accuracy.

CPU51は、図6に示されるように、加速度のch1~ch8について、先行するch(例えばch1)と、後続のch(例えばch2)とを連続的に出力する。更新周期が短い加速度のch1~ch8の各チャンネルを連続的に出力することで、加速度の通信速度の高速化を効率よく回避することができる。 As shown in FIG. 6, the CPU 51 continuously outputs the preceding channel (e.g., ch1) and the following channel (e.g., ch2) for acceleration channels 1 to 8. By continuously outputting each of acceleration channels 1 to 8, which have short update periods, it is possible to efficiently avoid increasing the communication speed of acceleration.

CPU51は、加速度のch1~ch8の群である検出結果群について、先行する検出結果群と、後続の検出結果群とを断続的に出力する。加えて、CPU51は、先行する検出結果群の出力タイミングと、後続の検出結果群の出力タイミングとの間に、温度のch1~ch8(第1温度検出結果~第8温度検出結果)、及び電流のch1~ch8(第1電流検出結果~第8電流検出結果)の中から、何れか1つを選択して出力する。加速度についての先行する検出結果群と、後続の検出結果群との間に生じる僅かな時間を利用して、何れか1つの温度検出結果を出力したり、何れか1つの電流検出結果を出力したりすることを繰り返すことで、次のことが可能になる。即ち、所定の周期(実施形態では、8.00〔msec〕)毎に全ての温度検出結果及び電流検出結果を出力することができる。 The CPU 51 intermittently outputs the preceding detection result group and the following detection result group for the group of acceleration ch1 to ch8. In addition, the CPU 51 selects and outputs one of the temperature ch1 to ch8 (first temperature detection result to eighth temperature detection result) and the current ch1 to ch8 (first current detection result to eighth current detection result) between the output timing of the preceding detection result group and the output timing of the following detection result group. By repeatedly outputting one of the temperature detection results or one of the current detection results by utilizing the short time that occurs between the preceding detection result group and the following detection result group for acceleration, the following becomes possible. That is, all the temperature detection results and the current detection results can be output every predetermined period (8.00 [msec] in this embodiment).

なお、実施形態に係る制御装置50によれば、温度のch1~ch8のそれぞれについて、信号線の共通化を図ることで、ch1~ch8のノイズのそれぞれのノイズを除去するためのローパスフィルタの数を低減して低コスト化を図ることもできる。加えて、制御装置50によれば、電流のch1~ch8のそれぞれについて、信号線の共通化を図ることで、ch1~ch8のノイズのそれぞれのノイズを除去するためのローパスフィルタの数を低減して低コスト化を図ることもできる。加えて、制御装置50によれば、加速度のch1~ch8のそれぞれについて、信号線の共通化を図ることで、ch1~ch8のノイズのそれぞれのノイズを除去するためのローパスフィルタの数を低減して低コスト化を図ることもできる。 In addition, according to the control device 50 of the embodiment, by sharing signal lines for each of the temperature channels 1 to 8, the number of low-pass filters for removing noise from each of the channels 1 to 8 can be reduced, thereby reducing costs. In addition, according to the control device 50, by sharing signal lines for each of the current channels 1 to 8, the number of low-pass filters for removing noise from each of the channels 1 to 8 can be reduced, thereby reducing costs. In addition, according to the control device 50, by sharing signal lines for each of the acceleration channels 1 to 8, the number of low-pass filters for removing noise from each of the channels 1 to 8 can be reduced, thereby reducing costs.

以上、本発明の好ましい実施形態について説明したが、本発明は、実施形態に限定されず、その要旨の範囲内で種々の変形および変更が可能である。実施形態は、発明の範囲及び要旨に含まれると同時に、特許請求の範囲に記載された発明とその均等の範囲に含まれる。 Although the preferred embodiment of the present invention has been described above, the present invention is not limited to the embodiment, and various modifications and changes are possible within the scope of the gist of the invention. The embodiment is included within the scope and gist of the invention, and is also included within the scope of the invention and its equivalents described in the claims.

本発明は、以下の態様毎に特有の効果を奏する。
〔第1態様〕
第1態様は、駆動部における所定の第1特性(例えば温度)を検出する第1特性検出部による検出結果である第1特性検出結果(例えば温度検出結果)に基づいて、駆動制御のための所定の演算処理を実行する演算処理部(例えばCPU51)を備える制御装置(例えば制御装置50)であって、複数の前記駆動部(例えば第1駆動部31~第8駆動部38)におけるそれぞれの前記第1特性を個別に検出する複数の前記第1特性検出部(例えば温度センサ31a~38a)によるそれぞれの前記第1検出結果を外部装置(例えば主制御装置)に向けて個別に出力する第1出力部(例えば第1D/Aコンバータ61)を備え、前記演算処理部が、複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果(例えば第1温度検出結果~第8温度検出結果)を個別に更新するための複数の更新信号(例えばCS1信号)を、それぞれの前記第1特性検出結果に応じた互いに異なるタイミングで出力する、ことを特徴とする制御装置である。
The present invention exhibits unique effects for each of the following aspects.
[First aspect]
The first aspect is a control device (e.g., control device 50) including an arithmetic processing unit (e.g., CPU 51) that executes predetermined arithmetic processing for drive control based on a first characteristic detection result (e.g., temperature detection result), which is a detection result by a first characteristic detection unit that detects a predetermined first characteristic (e.g., temperature) in a drive unit, and is characterized in that the control device includes a first output unit (e.g., first D/A converter 61) that individually outputs the first detection results by a plurality of first characteristic detection units (e.g., temperature sensors 31a to 38a) that individually detect the first characteristics of each of the plurality of drive units (e.g., first drive unit 31 to eighth drive unit 38) to an external device (e.g., main control unit), and the arithmetic processing unit outputs a plurality of update signals (e.g., CS1 signals) for individually updating the first characteristic detection results (e.g., first temperature detection result to eighth temperature detection result) by the plurality of first characteristic detection units, at different timings according to each of the first characteristic detection results.

第1態様によれば、複数の第1特性検出部のそれぞれによる第1特性検出結果を、共通の信号線によって出力することを可能にして低コスト化を図りつつ、第1特性検出結果の通信速度の高速化を回避することができる。 According to the first aspect, it is possible to output the first characteristic detection results from each of the multiple first characteristic detection units via a common signal line, thereby reducing costs while avoiding the need to increase the communication speed of the first characteristic detection results.

〔第2態様〕
第2態様は、第1態様の構成と、複数の前記駆動部におけるそれぞれの第2特性を個別に検出する複数の第2特性検出部によるそれぞれの検出結果である第2特性検出結果を外部装置に向けて個別に出力する第2出力部とを備え、前記演算処理部が、複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果を個別に更新するための複数の更新信号を、それぞれの前記第2特性検出結果に応じた互いに異なるタイミングで出力する、ことを特徴とする制御装置である。
[Second aspect]
A second aspect is a control device comprising the configuration of the first aspect and a second output section which individually outputs to an external device second characteristic detection results which are detection results by a plurality of second characteristic detection sections which individually detect the second characteristics of each of the plurality of drive sections, and is characterized in that the arithmetic processing section outputs a plurality of update signals for individually updating each of the second characteristic detection results by the plurality of second characteristic detection sections at mutually different timings according to each of the second characteristic detection results.

第2態様によれば、複数の第2特性検出部のそれぞれによる第2特性検出結果を、共通の信号線によって出力することを可能にして低コスト化を図りつつ、第2特性検出結果の通信速度の高速化を回避することができる。 According to the second aspect, it is possible to output the second characteristic detection results from each of the multiple second characteristic detection units via a common signal line, thereby reducing costs while avoiding the need to increase the communication speed of the second characteristic detection results.

〔第3態様〕
第3態様は、第2態様の構成を備え、且つ前記演算処理部が、複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果を個別に更新するための複数の更新信号と、複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果を個別に更新するための複数の更新信号とを、互いに異なるタイミングで出力する、ことを特徴とする制御装置である。
[Third aspect]
A third aspect is a control device having the configuration of the second aspect, and characterized in that the calculation processing unit outputs, at different timings, a plurality of update signals for individually updating each of the first characteristic detection results by the plurality of first characteristic detection units, and a plurality of update signals for individually updating each of the second characteristic detection results by the plurality of second characteristic detection units.

第3態様によれば、複数の第1特性検出結果と、複数の第2特性検出結果とを、互いに異なるタイミングで出力することで、第1特性検出結果の通信速度の高速化の回避と、第2特性検出結果の通信速度の高速化の回避とを両立させることができる。 According to the third aspect, by outputting a plurality of first characteristic detection results and a plurality of second characteristic detection results at different times, it is possible to avoid both increasing the communication speed of the first characteristic detection results and increasing the communication speed of the second characteristic detection results.

〔第4態様〕
第4態様は、第3態様の構成と、複数の前記駆動部におけるそれぞれの第3特性を個別に検出する複数の第3特性検出部によるそれぞれの検出結果である第3特性検出結果を外部装置に向けて個別に出力する第3出力部とを備え、前記演算処理部が、複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果を個別に更新するための更新信号を、それぞれの前記第3特性検出結果に応じた互いに異なるタイミングで出力する、ことを特徴とする制御装置である。
[Fourth aspect]
A fourth aspect is a control device comprising the configuration of the third aspect and a third output section which individually outputs to an external device third characteristic detection results which are detection results by a plurality of third characteristic detection sections which individually detect the respective third characteristics of a plurality of the driving sections, and is characterized in that the arithmetic processing section outputs update signals for individually updating the respective third characteristic detection results by the plurality of third characteristic detection sections at mutually different timings according to the respective third characteristic detection results.

第4態様によれば、複数の第3特性検出部による特性検出結果のそれぞれを、共通の信号線によって出力することを可能にして低コスト化を図りつつ、第3特性検出結果の通信速度の高速化を回避することができる。 According to the fourth aspect, it is possible to output each of the characteristic detection results from the multiple third characteristic detection units via a common signal line, thereby reducing costs while avoiding the need to increase the communication speed of the third characteristic detection results.

〔第5態様〕
第5態様は、第4態様の構成を備え、且つ、前記演算処理部が、複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果を個別に更新するための複数の更新信号と、複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果を個別に更新するための複数の更新信号と、複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果を個別に更新するための複数の更新信号とを、互いに異なるタイミングで出力する、ことを特徴とする制御装置である。
[Fifth aspect]
A fifth aspect is a control device having the configuration of the fourth aspect, characterized in that the arithmetic processing unit outputs, at different timings, a plurality of update signals for individually updating each of the first characteristic detection results by the plurality of first characteristic detection units, a plurality of update signals for individually updating each of the second characteristic detection results by the plurality of second characteristic detection units, and a plurality of update signals for individually updating each of the third characteristic detection results by the plurality of third characteristic detection units.

第5態様においては、複数の第1特性検出部のそれぞれによる第1特性検出結果と、複数の第2特性検出部のそれぞれによる第2特性検出結果と、複数の第3特性検出部のそれぞれによる第3特性検出結果とを、互いに異なるタイミングで出力する。かかる構成によれば、第1特性検出結果の通信速度の高速化の回避、第2特性検出結果の通信速度の高速化の回避、及び第3特性検出結果の通信速度の高速化の回避、の3つを何れも達成することができる。 In the fifth aspect, the first characteristic detection result by each of the multiple first characteristic detection units, the second characteristic detection result by each of the multiple second characteristic detection units, and the third characteristic detection result by each of the multiple third characteristic detection units are output at different times. With this configuration, it is possible to achieve all three of the following: avoiding an increase in the communication speed of the first characteristic detection result, avoiding an increase in the communication speed of the second characteristic detection result, and avoiding an increase in the communication speed of the third characteristic detection result.

〔第6態様〕
第6態様は、第5態様の構成を備え、且つ前記第1特性が、温度であり、前記第2特性が、電流であり、前記第3特性が、加速度であり、前記演算処理部が、複数の前記第3特性検出部としての、複数の加速度検出部によるそれぞれの加速度検出結果の更新周期を、複数の前記第1特性検出部としての、複数の温度検出部によるそれぞれの温度検出結果の更新周期、及び複数の前記第2特性検出部としての、複数の電流検出部によるそれぞれの電流検出結果の更新周期の何れよりも短くし、複数の前記加速度検出部のそれぞれによって得られる複数の前記加速度検出結果について、先行する前記加速度検出結果と、後続の前記加速度検出結果とを連続的に出力する、ことを特徴とする制御装置である。
[Sixth aspect]
A sixth aspect is a control device having the configuration of the fifth aspect, wherein the first characteristic is temperature, the second characteristic is current, and the third characteristic is acceleration, and the arithmetic processing unit sets an update period of each of the acceleration detection results by a plurality of acceleration detection units as the plurality of third characteristic detection units to be shorter than either an update period of each of the temperature detection results by a plurality of temperature detection units as the plurality of first characteristic detection units, or an update period of each of the current detection results by a plurality of current detection units as the plurality of second characteristic detection units, and continuously outputs a preceding acceleration detection result and a succeeding acceleration detection result for the multiple acceleration detection results obtained by each of the multiple acceleration detection units.

第6態様によれば、更新周期が短周期である複数の加速度検出結果の通信速度の高速化を効率よく回避することができる。 According to the sixth aspect, it is possible to efficiently avoid increasing the communication speed of multiple acceleration detection results that have a short update cycle.

〔第7態様〕
第7態様は、第6態様の構成を備え、前記演算処理部が、複数の前記加速度検出部のそれぞれによって得られた複数の前記加速度検出結果を連続的に出力した検出結果群について、先行する前記検出結果群と、後続の前記検出結果群とを断続的に出力し、先行する前記検出結果群の出力タイミングと、後続の前記検出結果群の出力タイミングとの間に、複数の前記温度検出部のそれぞれによって得られる複数の前記温度検出結果、及び複数の前記電流検出部のそれぞれによって得られる複数の前記電流検出結果の中から、何れか1つを選択して出力する、ことを特徴とする制御装置である。
[Seventh aspect]
A seventh aspect is a control device having the configuration of the sixth aspect, characterized in that the arithmetic processing unit intermittently outputs a preceding group of detection results and a succeeding group of detection results for a group of detection results in which a plurality of acceleration detection results obtained by each of a plurality of the acceleration detection units are continuously output, and selects and outputs one of a plurality of the temperature detection results obtained by each of the plurality of the temperature detection units and a plurality of the current detection results obtained by each of the plurality of the current detection units between the output timing of the preceding group of detection results and the output timing of the succeeding group of detection results.

第7態様によれば、複数の温度検出部のそれぞれによる温度検出結果、複数の電流検出部のそれぞれによる電流検出結果、及び複数の加速度検出部のそれぞれによる加速度検出結果の全てを、所定の周期毎に出力することができる。
〔第8態様〕
第8態様は、制御装置を備える産業用ロボット(例えば産業用ロボット1)であって、複数の前記駆動部と、複数の前記第1特性検出部とを備え、前記制御装置が、第1態様~第8態様の何れかの制御装置である、ことを特徴とするものである。
According to the seventh aspect, the temperature detection results from each of the multiple temperature detection sections, the current detection results from each of the multiple current detection sections, and the acceleration detection results from each of the multiple acceleration detection sections can all be output at a predetermined period.
[Eighth aspect]
An eighth aspect is an industrial robot (e.g., industrial robot 1) equipped with a control device, characterized in that the robot includes a plurality of the drive units and a plurality of the first characteristic detection units, and the control device is any of the control devices of the first to eighth aspects.

1・・・産業用ロボット、 31・・・第1駆動部、 31a・・・第1温度センサ(第1特性検出部)、 31b・・・第1電流センサ(第2特性検出部)、 31c・・・第1加速度センサ(第3特性検出部)、 32・・・第2駆動部、 32a・・・第2温度センサ(第1特性検出部)、 32b・・・第2電流センサ(第2特性検出部)、 32c・・・第2加速度センサ(第3特性検出部)、 33・・・第3駆動部、 33a・・・第3温度センサ(第1特性検出部)、 33b・・・第3電流センサ(第2特性検出部)、 31c・・・第1加速度センサ(第3特性検出部)、 34・・・第4駆動部、 34a・・・第4温度センサ(第1特性検出部)、 34b・・・第4電流センサ(第2特性検出部)、 34c・・・第4加速度センサ(第3特性検出部)、 35・・・第5駆動部、 35a・・・第5温度センサ(第1特性検出部)、 35b・・・第5電流センサ(第2特性検出部)、 35c・・・第5加速度センサ(第3特性検出部)、 36・・・第6駆動部、 36a・・・第6温度センサ(第1特性検出部)、 36b・・・第6電流センサ(第2特性検出部)、 36c・・・第6加速度センサ(第3特性検出部)、37・・・第7駆動部、 37a・・・第7温度センサ(第1特性検出部)、 37b・・・第7電流センサ(第2特性検出部)、 37c・・・第7加速度センサ(第3特性検出部)、 38・・・第8駆動部 38a・・・第8温度センサ(第1特性検出部)、 38b・・・第8電流センサ(第2特性検出部)、 31c・・・第8加速度センサ(第3特性検出部)、 50・・・制御装置、 51a・・・CPU(演算処理部)

1... industrial robot, 31... first drive unit, 31a... first temperature sensor (first characteristic detection unit), 31b... first current sensor (second characteristic detection unit), 31c... first acceleration sensor (third characteristic detection unit), 32... second drive unit, 32a... second temperature sensor (first characteristic detection unit), 32b... second current sensor (second characteristic detection unit), 32c... second acceleration sensor (third characteristic detection unit), 33... third drive unit, 33a... third temperature sensor (first characteristic detection unit), 33b... third current sensor (second characteristic detection unit), 31c... first acceleration sensor (third characteristic detection unit), 34... fourth drive unit, 34a... fourth temperature sensor (first characteristic detection unit), 34b... fourth current sensor (second characteristic detection unit), 34c... fourth acceleration sensor (third characteristic detection unit), 35... fifth drive unit, [0033] 35a...5th temperature sensor (first characteristic detection section), 35b...5th current sensor (second characteristic detection section), 35c...5th acceleration sensor (third characteristic detection section), 36...6th drive section, 36a...6th temperature sensor (first characteristic detection section), 36b...6th current sensor (second characteristic detection section), 36c...6th acceleration sensor (third characteristic detection section), 37...7th drive section, 37a...7th temperature sensor (first characteristic detection section), 37b...7th current sensor (second characteristic detection section), 37c...7th acceleration sensor (third characteristic detection section), 38...8th drive section, 38a...8th temperature sensor (first characteristic detection section), 38b...8th current sensor (second characteristic detection section), 31c...8th acceleration sensor (third characteristic detection section), 50...control device, 51a...CPU (arithmetic processing section)

Claims (3)

産業用ロボットの駆動部における所定の第1特性を検出する第1特性検出部による検出結果である第1特性検出結果に基づいて駆動制御のための所定の演算処理を実行する演算処理部を備える制御装置であって、
複数の前記駆動部におけるそれぞれの前記第1特性を個別に検出する複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果を外部装置に向けて個別に出力する第1出力部と、
複数の前記駆動部におけるそれぞれの第2特性を個別に検出する複数の第2特性検出部によるそれぞれの検出結果である第2特性検出結果を外部装置に向けて個別に出力する第2出力部と、
複数の前記駆動部におけるそれぞれの第3特性を個別に検出する複数の第3特性検出部によるそれぞれの検出結果である第3特性検出結果を外部装置に向けて個別に出力する第3出力部と、を備え、
前記演算処理部が、
複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果をアナログ/デジタル変換し、デジタル信号からなる前記第1特性検出結果を前記駆動部毎に前記第1出力部に格納した後、デジタル信号からなる前記第1特性検出結果を個別に更新するための複数の更新信号をそれぞれ互いに異なるタイミングで前記第1出力部に出力して、前記第1出力部における複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果の更新を個別に行わせ、
複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果をアナログ/デジタル変換し、デジタル信号からなる前記第2特性検出結果を前記駆動部毎に前記第2出力部に格納した後、デジタル信号からなる前記第2特性検出結果を個別に更新するための複数の更新信号をそれぞれ互いに異なるタイミングで前記第2出力部に出力して、前記第2出力部における複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果の更新を個別に行わせ、
複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果をアナログ/デジタル変換し、デジタル信号からなる前記第3特性検出結果を前記駆動部毎に前記第3出力部に格納した後、デジタル信号からなる前記第3特性検出結果を個別に更新するための複数の更新信号をそれぞれ互いに異なるタイミングで前記第3出力部に出力して、前記第3出力部における複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果の更新を個別に行わせ、
複数の前記第1特性検出部によるそれぞれの前記第1特性検出結果を個別に更新するための複数の更新信号と、複数の前記第2特性検出部によるそれぞれの前記第2特性検出結果を個別に更新するための複数の更新信号と、複数の前記第3特性検出部によるそれぞれの前記第3特性検出結果を個別に更新するための複数の更新信号とを、互いに異なるタイミングで出力し、
前記第1特性が、温度であり、
前記第2特性が、電流であり、
前記第3特性が、加速度であり、
前記演算処理部が、複数の前記第3特性検出部としての、複数の加速度検出部によるそれぞれの加速度検出結果の更新周期を、複数の前記第1特性検出部としての、複数の温度検出部によるそれぞれの温度検出結果の更新周期、及び複数の前記第2特性検出部としての、複数の電流検出部によるそれぞれの電流検出結果の更新周期の何れよりも短くし、複数の前記加速度検出部のそれぞれによって得られる複数の前記加速度検出結果について、先行する前記加速度検出結果と、後続の前記加速度検出結果とを連続的に出力する、
ことを特徴とする制御装置。
A control device including a calculation processing unit that executes a predetermined calculation process for drive control based on a first characteristic detection result, which is a detection result by a first characteristic detection unit that detects a predetermined first characteristic in a drive unit of an industrial robot,
a first output section configured to output, to an external device, each of the first characteristic detection results obtained by the first characteristic detection sections configured to individually detect the first characteristics of each of the driving sections;
a second output section configured to output, to an external device, second characteristic detection results that are detection results by a plurality of second characteristic detection sections that individually detect the second characteristics of the plurality of drive sections;
a third output unit configured to output, to an external device, third characteristic detection results that are detection results by a plurality of third characteristic detection units that individually detect the third characteristics of the plurality of drive units ,
The arithmetic processing unit,
performing analog/digital conversion on the first characteristic detection results by the plurality of first characteristic detection units, storing the first characteristic detection results consisting of digital signals in the first output unit for each of the driving units, and then outputting a plurality of update signals for individually updating the first characteristic detection results consisting of digital signals to the first output unit at mutually different timings, thereby individually updating the first characteristic detection results by the plurality of first characteristic detection units in the first output unit;
performing analog/digital conversion on the second characteristic detection results by the plurality of second characteristic detection units, storing the second characteristic detection results constituted by digital signals in the second output unit for each of the driving units, and then outputting a plurality of update signals for individually updating the second characteristic detection results constituted by digital signals to the second output unit at different timings, thereby individually updating the second characteristic detection results by the plurality of second characteristic detection units in the second output unit;
performing analog-to-digital conversion on the third characteristic detection results by the plurality of third characteristic detection units, storing the third characteristic detection results constituted by digital signals in the third output unit for each of the driving units, and then outputting a plurality of update signals for individually updating the third characteristic detection results constituted by digital signals to the third output unit at different timings, thereby individually updating the third characteristic detection results by the plurality of third characteristic detection units in the third output unit;
outputting, at different timings, a plurality of update signals for individually updating the first characteristic detection results by the plurality of first characteristic detection units, a plurality of update signals for individually updating the second characteristic detection results by the plurality of second characteristic detection units, and a plurality of update signals for individually updating the third characteristic detection results by the plurality of third characteristic detection units ;
the first property is temperature;
the second characteristic is a current;
the third characteristic is acceleration;
the arithmetic processing unit sets an update period of each of the acceleration detection results by the multiple acceleration detection units as the multiple third characteristic detection units to be shorter than any of an update period of each of the temperature detection results by the multiple temperature detection units as the multiple first characteristic detection units and an update period of each of the current detection results by the multiple current detection units as the multiple second characteristic detection units, and successively outputs a preceding acceleration detection result and a succeeding acceleration detection result for the multiple acceleration detection results obtained by each of the multiple acceleration detection units.
A control device comprising:
前記演算処理部が、複数の前記加速度検出部のそれぞれによって得られた複数の前記加速度検出結果を連続的に出力した検出結果群について、先行する前記検出結果群と、後続の前記検出結果群とを断続的に出力し、先行する前記検出結果群の出力タイミングと、後続の前記検出結果群の出力タイミングとの間に、複数の前記温度検出部のそれぞれによって得られる複数の前記温度検出結果、及び複数の前記電流検出部のそれぞれによって得られる複数の前記電流検出結果の中から、何れか1つを選択して出力する、
ことを特徴とする請求項に記載の制御装置。
the arithmetic processing unit intermittently outputs a preceding group of detection results and a succeeding group of detection results for a group of detection results obtained by successively outputting a plurality of the acceleration detection results obtained by each of the plurality of acceleration detection units, and selects and outputs one of the plurality of temperature detection results obtained by each of the plurality of temperature detection units and the plurality of current detection results obtained by each of the plurality of current detection units between the output timing of the preceding group of detection results and the output timing of the succeeding group of detection results;
The control device according to claim 1 .
制御装置を備える産業用ロボットであって、
複数の前記駆動部と、複数の前記第1特性検出部とを備え、
前記制御装置が、請求項1または2に記載の制御装置である、
ことを特徴とする産業用ロボット。
An industrial robot having a control device,
A plurality of the driving units and a plurality of the first characteristic detecting units are provided,
The control device is the control device according to claim 1 or 2 .
1. An industrial robot comprising:
JP2021015058A 2021-02-02 2021-02-02 Control device and industrial robot Active JP7703331B2 (en)

Priority Applications (3)

Application Number Priority Date Filing Date Title
JP2021015058A JP7703331B2 (en) 2021-02-02 2021-02-02 Control device and industrial robot
CN202210070685.1A CN114833819B (en) 2021-02-02 2022-01-21 Control devices and industrial robots
KR1020220011566A KR102869311B1 (en) 2021-02-02 2022-01-26 Control device and industrial robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021015058A JP7703331B2 (en) 2021-02-02 2021-02-02 Control device and industrial robot

Publications (3)

Publication Number Publication Date
JP2022118490A JP2022118490A (en) 2022-08-15
JP2022118490A5 JP2022118490A5 (en) 2024-01-26
JP7703331B2 true JP7703331B2 (en) 2025-07-07

Family

ID=82562619

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021015058A Active JP7703331B2 (en) 2021-02-02 2021-02-02 Control device and industrial robot

Country Status (3)

Country Link
JP (1) JP7703331B2 (en)
KR (1) KR102869311B1 (en)
CN (1) CN114833819B (en)

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002044758A (en) 2000-07-31 2002-02-08 Yaskawa Electric Corp Control system and control method
JP2016189159A (en) 2015-03-30 2016-11-04 日本電産サンキョー株式会社 Electronic equipment device and data transmission method
JP2020505671A (en) 2017-01-30 2020-02-20 アーベーベー・シュバイツ・アーゲー Method and apparatus for collecting motion data for industrial robot applications

Family Cites Families (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2906773B2 (en) 1991-09-26 1999-06-21 株式会社安川電機 Industrial robot controller
JPH05233052A (en) * 1992-02-20 1993-09-10 Tokico Ltd Teaching device for robot
JPH064808U (en) * 1992-06-15 1994-01-21 神鋼電機株式会社 Industrial robot
JP3269004B2 (en) * 1997-05-12 2002-03-25 川崎重工業株式会社 Robot controller
CN1319701C (en) * 2004-02-18 2007-06-06 中国科学院沈阳自动化研究所 Underwater robot control device adopting distributed node network
JP2008194760A (en) 2007-02-08 2008-08-28 Toyota Motor Corp Robot arm and control method thereof
JP5830755B2 (en) * 2009-10-21 2015-12-09 日本電産サンキョー株式会社 Robot system
JP4983897B2 (en) * 2009-11-30 2012-07-25 カシオ計算機株式会社 Light source device, projection device, and projection method
CN104608125B (en) * 2013-11-01 2019-12-17 精工爱普生株式会社 Robots, controls and robotic systems
JP6915395B2 (en) * 2017-06-16 2021-08-04 セイコーエプソン株式会社 Control device, robot system, table creation method and robot control method
JP6911672B2 (en) * 2017-09-25 2021-07-28 オムロン株式会社 Proximity sensor manufacturing method and proximity sensor manufacturing system
JP6621059B2 (en) * 2017-11-28 2019-12-18 株式会社安川電機 Mechanical equipment control system, mechanical equipment control device, and mechanical equipment control method
KR102203829B1 (en) * 2019-05-27 2021-01-15 정용비 Coding board apparatus and method for generating an algorithm for controlling a coding robot using a coding card

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2002044758A (en) 2000-07-31 2002-02-08 Yaskawa Electric Corp Control system and control method
JP2016189159A (en) 2015-03-30 2016-11-04 日本電産サンキョー株式会社 Electronic equipment device and data transmission method
JP2020505671A (en) 2017-01-30 2020-02-20 アーベーベー・シュバイツ・アーゲー Method and apparatus for collecting motion data for industrial robot applications

Also Published As

Publication number Publication date
CN114833819B (en) 2023-10-31
KR20220111665A (en) 2022-08-09
JP2022118490A (en) 2022-08-15
CN114833819A (en) 2022-08-02
KR102869311B1 (en) 2025-10-14

Similar Documents

Publication Publication Date Title
Zhang et al. Torque estimation for robotic joint with harmonic drive transmission based on position measurements
CN104954021B (en) Gradually compare type analog-digital converter and physics quantity detection sensor
US7319418B2 (en) Sensor with multiplex data output
US4535405A (en) Control and force-sensing method and apparatus for motors
TWI828543B (en) Method for providing digital output code to represent analog input value and analog-to-digital converter
JP7703331B2 (en) Control device and industrial robot
US8265792B2 (en) Method and apparatus for calibrating multi-axis load cells in a dexterous robot
US9716498B2 (en) Impedance-to-digital converter, impedance-to-digital converting device, and method for adjustment of impedance-to-digital converting device
CN113664869A (en) Manipulator, manipulator control method and system
US20190222222A1 (en) Analog-to-digital converter
JP2006519116A (en) Multi-axis robot with control system
US10778241B2 (en) Optical encoder systems and methods
US6980141B2 (en) Analog input for electronic circuit
EP3569986B1 (en) Position sensing device
US20070138382A1 (en) Optical encoder
JP2011199443A (en) Successive approximation a/d converter and comparison-time detection method for the same
JPH04275890A (en) Multiple hand device
KR100320434B1 (en) Analog to digital converter
CN1340922A (en) Charge Integral Circular Operation Analog-to-Digital Converter and Its Conversion Method
EP4009003B1 (en) Sensor system and method for measuring a process value of a physical system
JP2942154B2 (en) 2-step flash AD converter
RU1802412C (en) Method of calibration of linearity of digital-to-analog converter
CN120773023A (en) Motion track compensation method and device for mechanical arm, mechanical arm and storage medium
JPH09246968A (en) Measuring method for characteristic of d/a converter and measuring unit for characteristic of d/a converter
SU1480117A1 (en) Multithreshold logic element

Legal Events

Date Code Title Description
RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20221012

RD04 Notification of resignation of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7424

Effective date: 20221021

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20240118

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20240118

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20240820

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20241016

A02 Decision of refusal

Free format text: JAPANESE INTERMEDIATE CODE: A02

Effective date: 20241217

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20250307

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20250603

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20250625

R150 Certificate of patent or registration of utility model

Ref document number: 7703331

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150