WO2021256355A1 - ロボット制御装置 - Google Patents

ロボット制御装置 Download PDF

Info

Publication number
WO2021256355A1
WO2021256355A1 PCT/JP2021/021984 JP2021021984W WO2021256355A1 WO 2021256355 A1 WO2021256355 A1 WO 2021256355A1 JP 2021021984 W JP2021021984 W JP 2021021984W WO 2021256355 A1 WO2021256355 A1 WO 2021256355A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
torque
torque sensor
control device
arm
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.)
Ceased
Application number
PCT/JP2021/021984
Other languages
English (en)
French (fr)
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.)
Fanuc Corp
Original Assignee
Fanuc 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 Fanuc Corp filed Critical Fanuc Corp
Priority to DE112021003252.6T priority Critical patent/DE112021003252T5/de
Priority to CN202180042535.3A priority patent/CN115916488A/zh
Priority to JP2022531726A priority patent/JP7392149B2/ja
Priority to US17/906,574 priority patent/US12275133B2/en
Publication of WO2021256355A1 publication Critical patent/WO2021256355A1/ja
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/081—Touching devices, e.g. pressure-sensitive
    • B25J13/084—Tactile sensors
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00—Controls for manipulators
    • B25J13/08—Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085—Force or torque sensors
    • 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/02—Sensing devices
    • B25J19/04—Viewing devices
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Program-controlled manipulators
    • B25J9/16—Program controls
    • B25J9/1602—Program controls characterised by the control system, structure, architecture
    • B25J9/1605—Simulation of manipulator lay-out, design, modelling of manipulator
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Program-controlled manipulators
    • B25J9/16—Program controls
    • B25J9/1674—Program controls characterised by safety, monitoring, diagnostic
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B2219/00—Program-control systems
    • G05B2219/30—Nc systems
    • G05B2219/40—Robotics, robotics mapping to robotics vision
    • G05B2219/40599—Force, torque sensor integrated in joint

Definitions

  • the present invention relates to a robot provided with a joint arm, and more particularly to a robot having a torque sensor in the joint arm.
  • Patent Document 1 describes an image of a joint arm of a robot captured by a camera and an icon of a torque detected by torque detection provided in the joint arm being displayed on a display unit.
  • the torque sensor that detects the torque received from the outside by the joint arm of the robot usually includes an error within an allowable range from the manufacturing stage, and the value of the output torque has an offset.
  • the value of the offset amount may increase as the deterioration occurs due to the usage time of the torque sensor. Therefore, conventionally, as a product specification of the torque sensor, an allowable value of the torque offset amount is determined in advance, and the torque sensor is replaced when the offset amount detected by the user exceeds the allowable value.
  • the robot control device of the present disclosure is a robot control device equipped with a sensor that detects an external force torque around a joint, and is assembled with a deteriorated torque sensor together with 3D graphics of the robot body. It is a robot control device equipped with a display device that displays a warning icon in color at a location and changes the color according to the degree of deterioration.
  • the user can intuitively grasp information on which joint of the joint arm of the robot and how much the torque sensor has deteriorated.
  • FIG. 1 is a configuration diagram of a robot system common to each embodiment of the present disclosure.
  • the robot 1 shown in FIG. 1 is an articulated robot in which an articulated arm 10 such as a 6-axis vertical articulated robot or a 4-axis vertical articulated robot extends from the body 11.
  • the articulated arm 10 is moved by a servomotor 12 (FIG. 2) built in the robot 1 so as to be associated with each joint, and the articulated arm 10 lifts and moves an object, or It receives torque from the outside by coming into contact with other members.
  • the torque received from the outside is distributed to each joint of the articulated arm 10 according to the form of the articulated arm 10 at that time and the direction of the received torque.
  • Each joint of the articulated arm 10 is provided with torque sensors 101, 102, 103 so that the torque received by each joint can be detected (measured).
  • the control device 2 controls the operation of the robot 1 and also controls the display contents of the display device 3.
  • An operation command of the robot 1 created by the control device 2 is given to the robot 1, and a servomotor 12 (FIG. 2) built in the robot 1 is operated to move the articulated arm 10 to perform various operations.
  • the output values from the torque sensors 101, 102, 103 arranged in each joint of the articulated arm 10 are sent to the control device 2 for processing, and the resulting data is sent to the display device 3 for display.
  • FIG. 2 is a block line showing a signal transfer relationship between the control device 2 and the robot 1, between the control device 2 and the display device 3, and inside each of the robot 1, the control device 2, and the display device 3. It is a figure.
  • the control device 2 includes a processing unit (CPU) 21 including a microprocessor and the like, a storage unit 22 including memory members such as RAM, ROM, EEPROM, and flash memory, and a transmission / reception unit 23.
  • the articulated arm movement teaching unit 213 and the servomotor operating amount calculation unit 214 in the processing unit 21 of the control device 2 calculate the operating amount (rotation number) of each servomotor 12 from the teaching data of the movement of the articulated arm 10.
  • Each servomotor 12 of the robot 1 operates in response to an operation command from the control device 2, and feeds back data (rotational speed) of the operation result to the control device 2 via the transmission / reception device 13 of the robot 1. Further, the output data of the torque sensors 101, 102, 103 arranged in each joint of the articulated arm 10 of the robot 1 is sent to the control device 2 via the transmission / reception device 13 of the robot 1.
  • the torque sensor offset amount calculation unit 211 calculates the torque sensor offset amount using the output data sent from the torque sensors 101, 102, 103 of the robot 1. Then, the torque sensor deterioration degree determination unit 212 determines the color indicating the deterioration degree of each torque sensor displayed on the display device 3 based on the calculated torque sensor offset amount.
  • each torque sensor sent from the robot 1 to the control device 2 The output value of each torque sensor sent from the robot 1 to the control device 2, the torque sensor offset amount calculated by the torque sensor offset amount calculation unit 211 of the processing unit 21 of the control device 2, and the processing unit 21 of the control device 2.
  • Each data about the result determined by the torque sensor deterioration degree determination unit 212 is sent to the display device 3 via the transmission / reception unit 23.
  • Each data sent to the display device 3 is sent to the display unit 31 via the transmission / reception unit 32, and is based on the data sent in the torque value display unit 311 and the torque sensor deterioration degree display unit 312 of the display unit 31. Is displayed.
  • the method for identifying the offset amount is to identify from the data of the arm position and the output torque of the torque sensor acquired at a plurality of places by moving only one axis (one arm) of the articulated arm 10 of the robot 1. .. Specifically, each operation / calculation is performed as follows.
  • FIG. 3 shows one example of identification of D using the acquired data of ⁇ and T using this equation as a model.
  • each of ⁇ indicates the acquired data of ⁇ and T, and the offset amount D in which the horizontal line ( ⁇ ) is identified.
  • FIG. 4 shows an example of identifying an arm to which torque due to gravity is not applied.
  • each torque sensor 101, 102, 103 is determined by performing a self-test periodically separately from the operation of the robot in normal operation. In the self-test, each arm is moved independently, and the arm positions (angles) and the output torque of the torque sensor are recorded at multiple locations. The values of those recorded data are substituted into the above equation (2), and the offset amount of each torque sensor 101, 102, 103 is calculated by the least squares method.
  • FIG. 5 shows an example of a graph in which the offset amount is recorded in a graph showing the criteria of warning and caution.
  • each torque sensor 101, 102, 103 is shown in the outline view of the main body (articulated arm 10 and body 11) of the robot 1. Since it is displayed, it is necessary to grasp the positions of the torque sensors 101, 102, and 103 in the robot 1 main body.
  • the positions of the torque sensors 101, 102, and 103 are design information and are known. Then, it is also stored as a parameter related to the mechanism in the control software stored in the storage unit 22 of the control device 2.
  • Each arm in the articulated arm 10 of the robot 1 has a coordinate system, and the positions of the torque sensors 101, 102, and 103 are represented by the coordinates of those coordinate systems.
  • the position of each arm in the articulated arm 10 is also known information in the control software, and the location where each torque sensor 101, 102, 103 is assembled in each arm is also stored in the control software. Therefore, the position of each torque sensor 101, 102, 103 with respect to the outline view of the robot 1 can be displayed on the torque sensor deterioration degree display unit 312 of the display unit 31 of the display device 3.
  • the torque offset amount is detected (measured) for each of the torque sensors 101, 102, 103.
  • the offset amount of the torque of the torque sensor 101 is smaller than the threshold value of the caution level, it is determined that the deterioration degree has not reached the caution level, and in that case, no particular display is made. That is, the warning icon is not displayed at the position of the torque sensor 101 on the figure of the robot 1.
  • the torque offset amount of the torque sensor 102 is equal to or higher than the caution level threshold value and smaller than the warning level threshold value, the deterioration degree has not reached the warning level but has reached the caution level.
  • the warning icon is displayed in yellow at the position of the torque sensor 102 on the figure of the robot 1. Further, for example, when the torque offset amount of the torque sensor 103 is equal to or higher than the warning level threshold value and a warning is given, it is determined that the deterioration degree has reached the warning level. In that case, the figure of the robot 1 The warning icon is displayed in red in color at the position of the torque sensor 103 above.
  • Examples of the embodiment of the figure of the robot 1 displayed on the display device 3 include the 3D graphics of the robot 1 and the form of the captured image of the robot 1.
  • FIG. 6 shows a figure in which the captured image of the robot 1 is adopted as the form of the figure of the robot 1.
  • a warning icon is displayed at the position of the torque sensor.
  • the upper warning icon is displayed in yellow, for example, and the lower warning icon is displayed in red, for example.
  • FIG. 7 the procedure for displaying the degree of deterioration of the torque sensor in the present disclosure is shown in FIG. 7 as a flow chart.
  • the user first, apart from the normal operation operation, the user performs an operation of moving only one axis (one arm) of the articulated arm 10 of the robot 1 a plurality of times (step ST1).
  • the torque sensor offset amount calculation unit 211 of the processing device 21 of the control device 2 calculates the torque offset amount of each torque sensor 101, 102, 103 (step ST2).
  • the degree of deterioration of each torque sensor 101, 102, 103 is determined from the calculated torque offset amount of each torque sensor 101, 102, 103, and the determination result is displayed. Specifically, a color icon is displayed at the position of each torque sensor 101, 102, 103 on the outline drawing of the robot 1 on the torque sensor deterioration degree display unit 312 of the display unit 31 of the display device 3, and the display color thereof. Displays the degree of deterioration.
  • step ST3 it is determined whether the calculated torque offset amount of each of the torque sensors 101, 102, 103 does not exceed the caution level threshold value and is smaller than the caution level threshold value. .. If the determination result is YES, that is, if the offset amount is smaller than the threshold value of the attention level, it is determined that the deterioration degree has not reached the attention level, and the determined torque sensors 101, 102, 103 of the robot The color icon is not displayed at the position on the outline drawing of No. 1 (step ST4). And this flow ends.
  • step ST3 determines whether the offset amount is equal to or greater than the threshold value of the caution level. If the determination result in step ST3 is NO, that is, if the offset amount is equal to or greater than the threshold value of the caution level, then the calculated torque offset amount of each torque sensor 101, 102, 103 is determined. It is determined whether the warning level threshold value is not exceeded and is smaller than the warning level threshold value (step ST5).
  • step ST5 determines whether the offset amount is smaller than the threshold value of the warning level. If the determination result in step ST5 is YES, that is, if the offset amount is smaller than the threshold value of the warning level, the degree of deterioration is determined to be at the caution level although it has not reached the warning level.
  • a yellow color icon is displayed at the position of the torque sensors 101, 102, and 103 on the outline drawing of the robot 1 (step ST6). And this flow ends.
  • step ST5 determines whether the offset amount is equal to or greater than the warning level threshold value, the deterioration degree is determined to exceed the warning level, and the determined torque sensors 101, 102, 103. A red color icon is displayed at that position on the outline drawing of the robot 1 (step ST7). And this flow ends.
  • the user displays information on which joint of the joint arm of the robot and how much the torque sensor has deteriorated by displaying a color icon on the outline drawing of the robot. Depending on the color, it can be grasped at first glance and sensuously.
  • the outline of the robot various forms such as 3D graphics of the robot and captured images of the robot can be selected, and the user can easily see the outline of the robot according to the form of the robot and the characteristics of the display device.
  • the position of the torque sensor deteriorated in the form and the degree of deterioration thereof can be known at a glance.
  • a transparent display can be selected in addition to a normal liquid crystal display or organic EL display, and the position of the torque sensor deteriorated in an easy-to-see display state and the position of the torque sensor according to the environment in which the robot is used. You can see the degree of deterioration at a glance.
  • Robot 10 Articulated arm 101, 102, 103 Torque sensor 11 (Robot) body 12 Servo motor 13 (Robot) transmitter / receiver 2 Control device 21 Processing unit 211 Torque sensor offset amount calculation unit 212 Torque sensor deterioration degree determination unit 213 Articulated arm movement teaching unit 214 Servo motor operation calculation unit 22 Storage unit 23 (control device) transmission / reception unit 3 Display device 31 Display unit 311 Torque value display unit 312 Torque sensor deterioration degree display unit 33 (display device) transmission / reception unit

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

ロボットの関節アームに備えられたトルクセンサについて、ユーザが、一見して、関節アームのいずれかのトルクセンサに、どの程度の劣化度が生じたのかを知ることができるようにすることを目的とする。　関節まわりの外力トルクを検知するセンサを備えたロボットの制御装置において、ロボット本体の３Ｄグラフィックスと共に、劣化したトルクセンサの組付箇所に警告アイコンをカラー表示し、劣化度合いに応じてその色を変更する、表示装置を備えることにより上記目的を達成する。

Description

ロボット制御装置
　本発明は、関節アームを備えたロボットに関し、特に、関節アームにトルクセンサを有するロボットに関する。
　従来より、関節アームを備えたロボットにおいて、ロボットの関節アームが外部から受けるトルクを検知し、操作者が、関節アームが外部から受けるトルクを考慮して的確に操作することができるようする開発がなされてきた。特許文献１には、カメラにより撮像されたロボットの関節アームの画像とともに、関節アームに備えられたトルク検出により検出されたトルクのアイコンを表示部に表示するものが記載されている。
特開２０１９－８１２０９号公報
　ロボットの関節アームが外部から受けるトルクを検知するトルクセンサは、通常、製作段階から、許容される範囲での誤差を含み、出力するトルクの値にはオフセットが乗っている。また、トルクセンサの使用時間により劣化が生じるにつれ、オフセット量の値も大きくなってくることがある。そこで、従来は、トルクセンサの製品仕様としてトルクのオフセット量の許容値を予め決めておき、ユーザが検知したオフセット量が許容値を超えたときにトルクセンサを交換する仕様としていた。
　従来のユーザが検知したオフセット量が許容値を超えたときにトルクセンサを交換する仕様としていた方法では、ユーザが定期的にオフセット量を検知（計測）する必要があり、ユーザの作業量が増えて非効率的であった。また、関節アーム全体としてのトルクのオフセット量は把握できたとしても、どこの関節でトルクのオフセット量が許容値を超えたのか、すなわち、どこの関節のトルクセンサが劣化したのかが、一見しただけではわかりにくいという課題が生じていた。
　したがって、ロボットの関節アームに備えられたトルクセンサについて、ユーザが、一見して、関節アームのいずれかのトルクセンサに、どの程度の劣化度が生じたのかを知ることができるようにすることを目的とする。
　　上記の課題を解決するため、本開示のロボット制御装置は、関節まわりの外力トルクを検知するセンサを備えたロボットの制御装置であり、ロボット本体の３Ｄグラフィックスと共に、劣化したトルクセンサの組付箇所に警告アイコンをカラー表示し、劣化度合いに応じてその色を変更する、表示装置を備えた、ロボット制御装置である。
　本開示のロボット制御装置によれば、ユーザが、ロボットの関節アームのどの関節のトルクセンサがどの程度に劣化したかという情報を、一見して感覚的に把握することができる。
本開示のロボットシステムの構成図である。 本開示のロボット制御の際の信号の授受関係を示すブロック線図である。 オフセット量の同定の例を示すグラフの図である。 重力によるトルクが掛からないアームのオフセット量の同定の例を示すグラフの図である。 劣化度合いの注意レベル、警告レベルを示すグラフの図である。 ロボット１の撮像画像に警告アイコンを表示した表示例を示す図である。 本開示のトルクセンサ劣化度の表示の手順を示すフロー図である。
　以下、本開示の実施形態について、図面を参照して、詳細に説明する。
　図１は、本開示の各実施形態に共通のロボットシステムの構成図である。図１に示すロボット１は、胴体１１から６軸垂直多関節又は４軸垂直多関節などの多関節アーム１０が延びる多関節型ロボットである。多関節アーム１０は、ロボット１に内蔵された、関節ごとに対応付けられて配置されたサーボモータ１２（図２）によって動かされ、多関節アーム１０が物を持ち上げて移動させることにより、あるいは、他部材と接触することにより、外部からトルクを受ける。外部から受けたトルクは、そのときの多関節アーム１０の形態や、受けたトルクの方向に応じて、多関節アーム１０の各関節に配分されることになる。多関節アーム１０の各関節には、トルクセンサ１０１，１０２，１０３が備えられ、各関節で受けたトルクを検知（計測）できるようになっている。
　制御装置２は、ロボット１の動作を制御するとともに、表示装置３の表示内容を制御する。制御装置２で作成されたロボット１の動作指令をロボット１に与え、ロボット１に内蔵されたサーボモータ１２（図２）を作動させて多関節アーム１０を動かし各種の作業を行う。多関節アーム１０の各関節に配置されたトルクセンサ１０１，１０２，１０３からの出力値は、制御装置２に送られて処理され、その結果のデータが表示装置３に送られて表示される。
　図２は、制御装置２とロボット１の間、及び、制御装置２と表示装置３の間、並びに、ロボット１、制御装置２及び表示装置３それぞれの内部での信号の授受関係を示すブロック線図である。制御装置２は、ハード構成として、マイクロプロセッサなどからなる処理ユニット（ＣＰＵ）２１と、ＲＡＭ、ＲＯＭ、ＥＥＰＲＯＭ、フラッシュメモリなどのメモリ部材を含む記憶ユニット２２及び送受信ユニット２３から構成される。制御装置２の処理ユニット２１における多関節アーム移動教示部２１３とサーボモータ作動量算出部２１４とで、多関節アーム１０の移動の教示データから各サーボモータ１２の作動量（回転数）を算出し、ロボット１の各サーボモータ１２に対する作動指令を作成して、送受信ユニット２３を介してロボット１に送る。ロボット１の各サーボモータ１２は、制御装置２からの作動指令に応じて作動し、作動した結果のデータ（回転数）を、ロボット１の送受信装置１３を介して制御装置２にフィードバックする。また、ロボット１の多関節アーム１０の各関節に配設されたトルクセンサ１０１，１０２，１０３の出力データは、ロボット１の送受信装置１３を介して制御装置２に送られる。
　制御装置２の処理ユニット２１では、ロボット１のトルクセンサ１０１，１０２，１０３から送られた出力データを用いて、トルクセンサオフセット量算出部２１１においてトルクセンサオフセット量を算出する。そして、算出されたトルクセンサオフセット量によって、表示装置３で表示される各トルクセンサの劣化度を表す色について、トルクセンサ劣化度判定部２１２で判定する。
　制御装置２にロボット１から送られた各トルクセンサの出力値、制御装置２の処理ユニット２１のトルクセンサオフセット量算出部２１１において算出されたトルクセンサオフセット量、及び、制御装置２の処理ユニット２１のトルクセンサ劣化度判定部２１２で判定された結果についての各データは、送受信ユニット２３を介して表示装置３に送られる。表示装置３に送られた各データは、送受信部３２を介して表示部３１に送られ、表示部３１のトルク値表示部３１１及びトルクセンサ劣化度表示部３１２において、送られてきたデータに基づいた表示がなされる。
　次に、トルクセンサ１０１，１０２，１０３のオフセット量の算出（同定）方法について説明する。オフセット量の同定の手法は、ロボット１の多関節アーム１０の１軸（1つのアーム）のみを動かして複数個所で取得した、アーム位置とトルクセンサの出力トルクのデータから、同定するものである。具体的には、次の各操作・計算で行う。
　ロボット１の多関節アーム１０の１軸のみを動かしてそのアーム位置を変化させると、アームの重心位置やその先に接続される他のアームや先端の負荷に応じて、各アーム位置で、重力とつり合うトルクをアームの回転軸で発生させることになる。又は、重力によるトルクが掛からない状態のアームでは、静止時にトルクは発生しない。よって、トルクセンサの出力Ｔは、トルクセンサのオフセット量をＤ、アーム位置をθとすると、次の式（１）で表される。
［数１］
 
　Ｔ＝Ｍ・sin（θ＋α）＋Ｄ　・・・・・式（１）
 
　ここで、Ｍはそのアームに掛かる重力トルクの最大値、αはアームの重心位置等に応じた位相のオフセットである。
　そして、アーム位置のθを変化させて、θ，Ｔを記録する、ということを複数回行い、それらのデータを使って最小二乗法によってＤを同定する。最小二乗法を使うため、式（１）を式（２）のように変形する。
［数２］
 
　Ｔ＝Ｍ１・sinθ＋Ｍ２・cosθ＋Ｄ　・・・・・式（２）
 
　ここで、Ｍ１＝Ｍ・cosα、Ｍ２＝Ｍ・sinαである。この式をモデルとして、取得したθ，Ｔのデータを使ったＤの同定の１つの例を図３に示す。図３のグラフにおいて、〇の１つ１つが、取得したθ，Ｔのデータ、横線（－）が同定されたオフセット量Ｄを示す。また、同定例として、重力によるトルクが掛からないアームについて同定した例を図４に示す。
　次に、上記のように同定（算出）した、各トルクセンサ１０１，１０２，１０３のオフセット量Ｄから各トルクセンサ１０１，１０２，１０３の劣化の度合いを判定する手法について説明する。各トルクセンサ１０１，１０２，１０３の劣化の度合いの判定は、ロボットの通常稼働での動作とは別に、定期的にセルフテストを行うことにより行う。セルフテストでは、各アームを、それぞれ単独で動かし、複数個所でのアーム位置（角度）とトルクセンサの出力トルクを記録する。それらの記録されたデータの値を、前述の式（２）に代入し、最小二乗法により各トルクセンサ１０１，１０２，１０３のオフセット量を算出する。そして、各トルクセンサ１０１，１０２，１０３に警告や注意の基準とするしきい値をあらかじめ決めておき、オフセット量がそれらを超えた場合に警告や注意のレベルに達したと判定する。警告や注意の基準を示したグラフ内にオフセット量を記録したグラフの例を図５に示す。
　表示装置３の表示部３１のトルクセンサ劣化度表示部３１２においては、ロボット１の本体（多関節アーム１０及び胴体１１）の外形図の中で、各トルクセンサ１０１，１０２，１０３の劣化度が表示されるため、ロボット１本体中での、各トルクセンサ１０１，１０２，１０３の位置を把握する必要がある。各トルクセンサ１０１，１０２，１０３の位置は、設計情報であり、既知である。そして、制御装置２の記憶ユニット２２に記憶された制御ソフトウエア内にも機構に関するパラメータとして記憶される。なお、ロボット１の多関節アーム１０における各アームにはそれぞれ座標系を持たせ、各トルクセンサ１０１，１０２，１０３の位置は、それらの座標系の座標で表される。多関節アーム１０における各アームの位置についても、制御ソフトウエアにおいて既知の情報であり、各トルクセンサ１０１，１０２，１０３が各アームのどこに組付けられるかについても制御ソフトウエア内に記憶されているので、ロボット１の外形図に対して、各トルクセンサ１０１，１０２，１０３がどの位置に存在するかを表示装置３の表示部３１のトルクセンサ劣化度表示部３１２において表示することができる。
　次に、各トルクセンサ１０１，１０２，１０３の劣化度を判定した結果を表示装置３に表示する実施形態について、説明する。
　上記の手法で、各トルクセンサ１０１，１０２，１０３それぞれについて、トルクのオフセット量を検出（計測）する。その結果、例えば、トルクセンサ１０１のトルクのオフセット量が注意レベルのしきい値より小さい場合には、劣化度は注意レベルに達していないと判定され、その場合には、特に表示はしない。すなわち、ロボット１の図形上でトルクセンサ１０１の位置に警告アイコンを表示するようなことはしない。一方、例えば、トルクセンサ１０２のトルクのオフセット量が注意レベルのしきい値以上で警告レベルのしきい値より小さい場合には、劣化度は警告レベルには達していないものの、注意レベルに達したと判定され、その場合には、ロボット１の図形上でトルクセンサ１０２の位置に警告アイコンを黄色でカラー表示する。さらに、例えば、トルクセンサ１０３のトルクのオフセット量が警告レベルのしきい値以上で警告となった場合には、劣化度は警告レベルに達したと判定され、その場合には、ロボット１の図形上でトルクセンサ１０３の位置に警告アイコンを赤色でカラー表示する。
　表示装置３に表示するロボット１の図形の実施形態としては、ロボット１の３Ｄグラフィックスやロボット１の撮像画像の形態がある。ロボット１の図形の形態としてロボット１の撮像画像を採用したものを図６に示す。トルクセンサのトルクのオフセット量が警告レベルのしきい値以上となった場合に、当該トルクセンサの位置に警告アイコンが表示される。図６の例では、上側の警告アイコンは、例えば、黄色で、下側の警告アイコンは、例えば、赤色で表示されている。なお、表示装置３の実施形態としては、通常のディスプレイの他、透明ディスプレイの形態もある。すなわち、操作者の視線が透明ディスプレイを通してロボットを捉えた際には、トルクセンサの組付箇所に相当する透明ディスプレイ上の投影位置に、警告アイコンを表示する。
　次に、本開示におけるトルクセンサ劣化度の表示の手順を図７にフロー図で示す。図７に示すように、まず、通常の稼働動作とは別に、ユーザがロボット１の多関節アーム１０の１軸（１つのアーム）のみを動かす動作を複数回行うことから始まる（ステップＳＴ１）。その結果として、制御装置２の処理装置２１のトルクセンサオフセット量算出部２１１において、各トルクセンサ１０１，１０２，１０３のトルクのオフセット量が算出される（ステップＳＴ２）。
　次に、算出された各トルクセンサ１０１，１０２，１０３のトルクのオフセット量から各トルクセンサ１０１，１０２，１０３の劣化度を判定し、その判定結果を表示する。具体的には、表示装置３の表示部３１のトルクセンサ劣化度表示部３１２に、ロボット１の外形図上の各トルクセンサ１０１，１０２，１０３の位置に、カラーアイコンを表示し、その表示色によって、劣化度を表示する。
　まず、算出された各トルクセンサ１０１，１０２，１０３のそれぞれのトルクのオフセット量が、注意レベルのしきい値を超えておらず、注意レベルのしきい値より小さいかを判定する（ステップＳＴ３）。判定結果がＹＥＳの場合、すなわち、オフセット量が注意レベルのしきい値より小さい場合には、劣化度は注意レベルに達していないと判定され、判定されたトルクセンサ１０１，１０２，１０３の、ロボット１の外形図上のその位置には、カラーアイコンを表示しない（ステップＳＴ４）。そして、このフローは終了する。
　ステップＳＴ３の判定結果がＮＯの場合、すなわち、オフセット量が注意レベルのしきい値以上の場合には、次に、算出された各トルクセンサ１０１，１０２，１０３のそれぞれのトルクのオフセット量が、警告レベルのしきい値を超えておらず、警告レベルのしきい値より小さいかを判定する（ステップＳＴ５）。
　ステップＳＴ５の判定結果がＹＥＳの場合、すなわち、オフセット量が警告レベルのしきい値より小さい場合には、劣化度は、警告レベルには達していないものの、注意レベルにあると判定され、判定されたトルクセンサ１０１，１０２，１０３の、ロボット１の外形図上のその位置に、黄色のカラーアイコンを表示する（ステップＳＴ６）。そしてこのフローは終了する。
　ステップＳＴ５の判定結果がＮＯの場合、すなわち、オフセット量が警告レベルのしきい値以上の場合には、劣化度は、警告レベルを超えるものと判定され、判定されたトルクセンサ１０１，１０２，１０３の、ロボット１の外形図上のその位置に、赤色のカラーアイコンを表示する（ステップＳＴ７）。そしてこのフローは終了する。
　以上のとおりであり、本開示のロボット制御装置によれば、ユーザが、ロボットの関節アームのどの関節のトルクセンサがどの程度に劣化したかという情報を、ロボットの外形図上のカラーアイコンの表示色によって、一見して感覚的に把握することができるものである。
　そして、ロボットの外形図については、ロボットの３Ｄグラフィックスやロボットの撮影画像など種々の形態を選択することができ、ユーザは、ロボットの形態や表示装置の特性などに応じて、見やすいロボット外形の形態で劣化したトルクセンサの位置及びその劣化度を一見して知ることができる。
　また、表示装置の形態についても、通常の液晶や有機ＥＬなどのディスプレイに加え、透明ディスプレイを選択することができ、ロボットを使用する環境に応じて、見やすい表示状態で劣化したトルクセンサの位置及びその劣化度を一見して知ることができる。
　以上、本発明の実施に関して、実施態様について説明したが、本発明はこうした実施態様に何ら限定されるものではなく本発明の趣旨を逸脱しない範囲内において、種々なる態様で実施できるものであることは勿論である。
　１　ロボット
　１０　多関節アーム
　１０１，１０２，１０３　トルクセンサ
　１１　（ロボットの）胴体
　１２　サーボモータ
　１３　（ロボットの）送受信装置
　２　制御装置
　２１　処理ユニット
　２１１　トルクセンサオフセット量算出部
　２１２　トルクセンサ劣化度判定部
　２１３　多関節アーム移動教示部
　２１４　サーボモータ作動算出部
　２２　記憶ユニット
　２３　（制御装置の）送受信ユニット
　３　表示装置
　３１　表示部
　３１１　トルク値表示部
　３１２　トルクセンサ劣化度表示部
　３３　（表示装置の）送受信部

Claims (5)

  1. 　関節まわりの外力トルクを検知するトルクセンサを備えたロボットの制御装置であって、
    　前記ロボットの本体の３Ｄグラフィックスと共に、劣化した前記トルクセンサの組付箇所に警告アイコンをカラー表示し、劣化度合いに応じてその色を変更させる、表示装置を備えた、
    　ロボット制御装置。
  2. 　関節まわりの外力トルクを検知するトルクセンサを備えたロボットの制御装置であって、
    　実物の前記ロボットの本体の撮影画像と共に、劣化した前記トルクセンサの組付箇所に警告アイコンをカラー表示し、劣化度合いに応じてその色を変更させる、表示装置を備えた、
    　ロボット制御装置。
  3. 　関節まわりの外力トルクを検知するトルクセンサを備えたロボットを視野に捉えた際に、
    　前記ロボットの劣化した前記トルクセンサの組付箇所に相当する透明ディスプレイ上の投影位置に、警告アイコンをカラー表示し、劣化度合いに応じてその色を変更させる、拡張現実表示デバイスを備えた、
    　ロボット制御装置。
  4. 　前記劣化度合いは、前記ロボットの１軸のみを動かして複数個所で取得した、アームの角度位置と前記トルクセンサの出力トルクのデータから同定した前記トルクセンサのオフセット量に基づいて判別する、
    　請求項１～３のいずれかに記載されたロボット制御装置。
  5. 　前記トルクセンサのオフセット量は、前記アームの角度位置θを変化させて出力トルクＴを測定し、複数組の前記アームの角度位置θ、出力トルクＴを記録し、前記アームの角度位置θ、出力トルクＴ及び前記トルクセンサのオフセット量Ｄの関係を表す次の式（１）を用いて、最小二乗法により、前記トルクセンサのオフセット量Ｄを求めるものである、
    　請求項４に記載されたロボット制御装置。
    ［数１］
     
    　Ｔ＝Ｍ・ｓｉｎ（θ+α）+Ｄ　・・・・・・　式（１）
     
    　ここで、Ｍは前記アームに掛かる重力トルクの最大値、αは前記アームの重心位置に応じた位相のオフセットである。
PCT/JP2021/021984 2020-06-16 2021-06-09 ロボット制御装置 Ceased WO2021256355A1 (ja)

Priority Applications (4)

Application Number Priority Date Filing Date Title
DE112021003252.6T DE112021003252T5 (de) 2020-06-16 2021-06-09 Roboter-Steuervorrichtung
CN202180042535.3A CN115916488A (zh) 2020-06-16 2021-06-09 机器人控制装置
JP2022531726A JP7392149B2 (ja) 2020-06-16 2021-06-09 ロボット制御装置
US17/906,574 US12275133B2 (en) 2020-06-16 2021-06-09 Robot control device

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2020103676 2020-06-16
JP2020-103676 2020-06-16

Publications (1)

Publication Number Publication Date
WO2021256355A1 true WO2021256355A1 (ja) 2021-12-23

Family

ID=79267920

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/021984 Ceased WO2021256355A1 (ja) 2020-06-16 2021-06-09 ロボット制御装置

Country Status (5)

Country Link
US (1) US12275133B2 (ja)
JP (1) JP7392149B2 (ja)
CN (1) CN115916488A (ja)
DE (1) DE112021003252T5 (ja)
WO (1) WO2021256355A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE112021003252T5 (de) * 2020-06-16 2023-04-06 Fanuc Corporation Roboter-Steuervorrichtung

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011131335A (ja) * 2009-12-24 2011-07-07 Tadano Ltd 作業機械の操作支援装置
JP2012014295A (ja) * 2010-06-29 2012-01-19 Mitsubishi Heavy Ind Ltd 部品検索装置及び部品検索用コンピュータプログラム
JP2014201307A (ja) * 2013-04-02 2014-10-27 ザ・ボーイング・カンパニーＴｈｅＢｏｅｉｎｇ Ｃｏｍｐａｎｙ ３次元視覚化のためのロケータシステム
JP2016085501A (ja) * 2014-10-23 2016-05-19 横河電機株式会社 計装システム支援装置
JP2016146209A (ja) * 2013-12-25 2016-08-12 株式会社テイエルブイ プロセスシステムの管理システム、サーバ装置、管理プログラム及び管理方法
WO2016155787A1 (en) * 2015-03-31 2016-10-06 Abb Technology Ltd A method for controlling an industrial robot by touch
JP2018040621A (ja) * 2016-09-06 2018-03-15 株式会社日立ハイテクノロジーズ 自動分析装置

Family Cites Families (29)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05158526A (ja) 1991-12-04 1993-06-25 Yaskawa Electric Corp ロボット関節負荷の表示方法
JP3726057B2 (ja) * 2001-12-28 2005-12-14 本田技研工業株式会社 脚式移動ロボットおよびその床反力検出装置
US10258425B2 (en) * 2008-06-27 2019-04-16 Intuitive Surgical Operations, Inc. Medical robotic system providing an auxiliary view of articulatable instruments extending out of a distal end of an entry guide
EP1955830B1 (en) * 2007-02-06 2014-04-09 Abb Research Ltd. A method and a control system for monitoring the condition of an industrial robot
US8864652B2 (en) * 2008-06-27 2014-10-21 Intuitive Surgical Operations, Inc. Medical robotic system providing computer generated auxiliary views of a camera instrument for controlling the positioning and orienting of its tip
JP5956169B2 (ja) * 2012-01-25 2016-07-27 ナブテスコ株式会社 潤滑油劣化センサーを備えた機械
JP5973786B2 (ja) * 2012-05-25 2016-08-23 ナブテスコ株式会社 産業用ロボットの集中監視装置、集中監視プログラムおよびメンテナンスシステム
US9092698B2 (en) * 2012-06-21 2015-07-28 Rethink Robotics, Inc. Vision-guided robots and methods of training them
JP6164948B2 (ja) * 2013-06-20 2017-07-19 キヤノン株式会社 ロボット装置及び部品の製造方法
KR101679835B1 (ko) * 2014-06-09 2016-11-28 고려대학교 산학협력단 로봇 머니퓰레이터 및 이의 제어 방법
JP6344084B2 (ja) * 2014-06-20 2018-06-20 オムロン株式会社 ロボット操作用の作業者端末
MX364634B (es) * 2015-05-22 2019-05-03 Nissan Motor Dispositivo de diagnóstico de falla y método de diagnóstico de falla.
ES2763004T3 (es) * 2015-05-25 2020-05-26 Nissan Motor Dispositivo de diagnóstico de fallos y método de diagnóstico de fallos
KR102486112B1 (ko) 2015-12-04 2023-01-09 대우조선해양 주식회사 이동형 로봇의 구동부 손상감지 방법
EP3317053B1 (en) * 2015-12-14 2022-03-16 Parker-Hannifin Corporation Safety monitoring and control system and methods for a legged mobility exoskeleton device
JP2017177290A (ja) 2016-03-30 2017-10-05 ソニー株式会社 アーム制御方法及びアーム制御装置
CN106737667A (zh) * 2016-12-05 2017-05-31 大族激光科技产业集团股份有限公司 一种内置控制器的机器人
JP6526098B2 (ja) * 2017-04-26 2019-06-05 ファナック株式会社 ロボットを操作するための操作装置、ロボットシステム、および操作方法
JP6977481B2 (ja) 2017-10-30 2021-12-08 株式会社Ihi マニピュレータ装置
DE112019003204T5 (de) * 2018-06-26 2021-03-11 Fanuc America Corporation Visualisierung und modifizierung von arbeitsrandbereichen unter verwendung von erweiterter realität
WO2020006142A1 (en) * 2018-06-26 2020-01-02 Fanuc America Corporation Automatic dynamic diagnosis guide with augmented reality
CN109732628A (zh) * 2018-12-26 2019-05-10 南京熊猫电子股份有限公司 机器人末端智能抓取控制装置及其智能抓取方法
JP6881479B2 (ja) * 2019-01-28 2021-06-02 株式会社安川電機 産業機器管理システム、産業機器管理方法、及びプログラム
US10974268B2 (en) * 2019-08-09 2021-04-13 GM Global Technology Operations LLC System and method for indicating degraded operation of a robotic paint station
KR102313620B1 (ko) * 2019-12-05 2021-10-19 주식회사 큐엔티 로봇의 이상 상태를 출력하는 방법 및 장치
DE112021003252T5 (de) * 2020-06-16 2023-04-06 Fanuc Corporation Roboter-Steuervorrichtung
JP7522340B2 (ja) * 2020-07-01 2024-07-25 株式会社デンソーウェーブ ロボット用状態表示装置及び産業用ロボット
JP2023003731A (ja) * 2021-06-24 2023-01-17 キヤノン株式会社 情報処理装置、情報処理方法、表示装置、表示方法、ロボットシステム、物品の製造方法、プログラム及び記録媒体
US12600035B2 (en) * 2022-07-05 2026-04-14 Canon Kabushiki Kaisha Information processing method, information processing apparatus, robot system, manufacturing method of product, and storage medium

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2011131335A (ja) * 2009-12-24 2011-07-07 Tadano Ltd 作業機械の操作支援装置
JP2012014295A (ja) * 2010-06-29 2012-01-19 Mitsubishi Heavy Ind Ltd 部品検索装置及び部品検索用コンピュータプログラム
JP2014201307A (ja) * 2013-04-02 2014-10-27 ザ・ボーイング・カンパニーＴｈｅＢｏｅｉｎｇ Ｃｏｍｐａｎｙ ３次元視覚化のためのロケータシステム
JP2016146209A (ja) * 2013-12-25 2016-08-12 株式会社テイエルブイ プロセスシステムの管理システム、サーバ装置、管理プログラム及び管理方法
JP2016085501A (ja) * 2014-10-23 2016-05-19 横河電機株式会社 計装システム支援装置
WO2016155787A1 (en) * 2015-03-31 2016-10-06 Abb Technology Ltd A method for controlling an industrial robot by touch
JP2018040621A (ja) * 2016-09-06 2018-03-15 株式会社日立ハイテクノロジーズ 自動分析装置

Also Published As

Publication number Publication date
DE112021003252T5 (de) 2023-04-06
US20230131173A1 (en) 2023-04-27
US12275133B2 (en) 2025-04-15
JP7392149B2 (ja) 2023-12-05
CN115916488A (zh) 2023-04-04
JPWO2021256355A1 (ja) 2021-12-23

Similar Documents

Publication Publication Date Title
US11833696B2 (en) Vision-based sensor system and control method for robot arms
US11565427B2 (en) Robot system
JP5370128B2 (ja) ロボットの故障検出装置
CN111278380B (zh) 用于追踪目标对象的位置的系统
JP5722224B2 (ja) 空間照会のための手持ち型位置決めインタフェース
CN103402714B (zh) 主操作输入装置以及主-从机械手
KR20210034070A (ko) 교정 작업 지원 시스템
JP7359633B2 (ja) ロボットシステム
JPWO2006022201A1 (ja) ロボットの評価システム及び評価方法
JP6768865B2 (ja) 作業管理システム及び作業管理方法
US12280501B2 (en) Robot teaching method and robot working method
CN110505947A (zh) 机器人系统及其运行方法
US12259707B2 (en) Device for monitoring the position and/or attitude and/or movement of a tool
US20240269826A1 (en) Information processing apparatus for robot teaching, robot system for robot teaching, method for generating trajectory of specific part of robot, method for controlling robot in robot teaching, recording medium, and movable object
JP2019000923A (ja) 多関節ロボットの機構モデルパラメータ推定方法
EP3946825A1 (en) Method and control arrangement for determining a relation between a robot coordinate system and a movable apparatus coordinate system
WO2021256355A1 (ja) ロボット制御装置
CN112621751B (zh) 机器人的碰撞检测方法及装置、机器人
JP6948164B2 (ja) 作業用ロボットのアーム姿勢制御システムおよび方法
JP3754340B2 (ja) 位置検出装置
EP4382258A1 (en) Robot control device, robot control system, and robot control method
US20200356187A1 (en) High accuracy tracking system for interactive equipment for simulation or operational employment
RU2713570C1 (ru) Способ формирования изображения дополненной реальности и робототехническая система для его осуществления
JP2000094370A (ja) ロボットの作業表面の傾き測定方法およびその測定装置
JP7638110B2 (ja) 情報処理システム、情報処理装置、情報処理方法およびプログラム

Legal Events

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

Ref document number: 21824935

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2022531726

Country of ref document: JP

Kind code of ref document: A

122 Ep: pct application non-entry in european phase

Ref document number: 21824935

Country of ref document: EP

Kind code of ref document: A1

WWG Wipo information: grant in national office

Ref document number: 17906574

Country of ref document: US