WO2014037999A1 - ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置 - Google Patents

ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置 Download PDF

Info

Publication number
WO2014037999A1
WO2014037999A1 PCT/JP2012/072486 JP2012072486W WO2014037999A1 WO 2014037999 A1 WO2014037999 A1 WO 2014037999A1 JP 2012072486 W JP2012072486 W JP 2012072486W WO 2014037999 A1 WO2014037999 A1 WO 2014037999A1
Authority
WO
WIPO (PCT)
Prior art keywords
robot
parameter
hole
viscosity
adjustment
Prior art date
Application number
PCT/JP2012/072486
Other languages
English (en)
French (fr)
Inventor
拓也 福田
慎悟 安藤
Original Assignee
株式会社安川電機
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社安川電機 filed Critical 株式会社安川電機
Priority to CN201280075625.3A priority Critical patent/CN104602873B/zh
Priority to JP2014534068A priority patent/JP5971342B2/ja
Priority to EP12884342.2A priority patent/EP2896487A1/en
Priority to PCT/JP2012/072486 priority patent/WO2014037999A1/ja
Publication of WO2014037999A1 publication Critical patent/WO2014037999A1/ja
Priority to US14/637,272 priority patent/US20150174760A1/en

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1602—Programme controls characterised by the control system, structure, architecture
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1679—Programme controls characterised by the tasks executed
    • B25J9/1687—Assembly, peg and hole, palletising, straight line, weaving pattern movement
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39342—Adaptive impedance control
    • 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/39—Robotics, robotics to robotics hand
    • G05B2219/39343—Force based impedance control
    • 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/40032—Peg and hole insertion, mating and joining, remote center compliance
    • Y—GENERAL 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
    • Y10—TECHNICAL SUBJECTS COVERED BY FORMER USPC
    • Y10S—TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y10S901/00—Robots
    • Y10S901/02—Arm motion controller

Definitions

  • the present invention relates to a robot control parameter adjustment method, a robot system, and a robot control apparatus.
  • Patent Document 1 describes a force control device that can prevent an excessive force from acting when a displacement occurs while switching the force limit value and the compliance control parameter during operation to speed up the operation.
  • the robot In an insertion operation in which the robot inserts a component (insertion workpiece) into a hole formed in the workpiece to be inserted, the robot observes the force sensor signal output from the force sensor mounted on the tip of the arm, and The operation is controlled by impedance control so that the force generated by the contact with the inserted workpiece matches the target value.
  • the impedance parameter which determines the characteristic of impedance control is adjusted based on the following viewpoints. 1) In order to reduce the reaction force when the part reaches the bottom of the hole, it is necessary to set the viscosity parameter to be large (or to reduce the pressing force of the part). 2) In order to increase the insertion speed and shorten the tact time, it is necessary to set the viscosity parameter small (or increase the pressing force of the parts). In general, in order not to damage the component and the workpiece to be inserted, the parameters are adjusted based on the above-mentioned viewpoint 1). As a result, the tact time is extended.
  • An object of the present invention is to provide a robot control parameter adjustment method, a robot system, and a robot control device that can reduce the time required to insert a part into a hole. It is another object of the present invention to provide a robot control parameter adjustment method, a robot system, and a robot control device that can reduce the reaction force when a component reaches the bottom of a hole from a predetermined size. To do.
  • a robot having a force sensor for detecting a force applied from the outside is provided in a hole in which a plurality of sections in the depth direction are set based on impedance control.
  • a robot control parameter adjusting method for adjusting the viscosity parameter in each section is applied.
  • a robot that performs an insertion operation of inserting a part into a hole in which a plurality of sections in the depth direction are set;
  • a robot control device for controlling the operation of the robot,
  • the robot control device includes a control unit for impedance control of the insertion work performed by the robot;
  • a robot system having a parameter adjustment unit that adjusts the viscosity parameter of the impedance control that is set in stages according to the amount of insertion of the component is applied.
  • a control unit for impedance control of an operation of a robot that performs an insertion operation of inserting a component into a hole in which a plurality of sections in the depth direction is set;
  • a robot control device including a parameter adjustment unit that adjusts the viscosity parameter of the impedance control stepwise according to the amount of insertion of the component is applied.
  • the present invention it is possible to reduce the time required to insert a component into the hole. Further, the reaction force when the part inserted by the robot reaches the bottom of the hole can be reduced from a predetermined size.
  • the robot system 10 includes a robot 20 and a robot controller 30 that controls the operation of the robot 20 as shown in FIG.
  • the robot 20 corrects the position of the hand 202 by impedance control based on the impedance control model. Specifically, the robot 20 grips a predetermined location of, for example, a cylindrical part P with the hand 202 and performs an insertion operation of inserting the part P into a hole H formed in the workpiece W to be inserted. be able to.
  • the robot 20 is, for example, a 6-axis articulated robot.
  • the robot 20 includes a force sensor FS that detects a force applied from the outside between the wrist portion 204 and the hand 202. This force sensor FS is, for example, a six-axis force sensor.
  • the force sensor FS can measure forces in the directions of the X axis, the Y axis, and the Z axis of the tool coordinate system fixed to the hand 202. Further, the force sensor FS can measure moments around the X-axis, Y-axis, and Z-axis of the tool coordinate system. That is, the force sensor FS can detect an external force acting on the hand 202 of the robot 20.
  • the robot control device 30 can switch the viscosity parameter of the impedance control step by step according to the insertion amount of the component P, and can control the operation of the robot 20 by the impedance control.
  • the viscosity parameter is a viscosity parameter related to the direction in which the component P is inserted, and may be simply referred to as a viscosity parameter hereinafter.
  • the robot control device 30 can adjust the viscosity parameter in each section (see FIG. 7) set in the depth direction of the hole H.
  • the robot control device 30 includes a force signal processing unit 302, a parameter storage unit 304, a parameter adjustment unit 306, an execution program storage unit 310, and a control unit 312.
  • the external force detected by the force sensor FS is input to the force signal processing unit 302 as an electric signal.
  • the force signal processing unit 302 processes this electric signal and outputs it as a force feedback value Ffb.
  • the parameter storage unit 304 is used by the parameter adjustment unit 306 to adjust the impedance parameter Pins necessary for impedance control of the robot 20, the setting parameter Ps set by the operator to adjust the viscosity parameter, and the viscosity parameter.
  • the internal parameter Pi to be stored can be stored.
  • the parameter adjustment unit 306 stores the parameter based on the force feedback value Ffb input from the force signal processing unit 302 and the position information POS obtained by forward conversion of the encoder value of the servo motor that drives each axis of the robot 20.
  • the viscosity parameter in each section stored in the unit 304 can be adjusted. That is, the parameter adjustment unit 306 can adjust the viscosity parameter for impedance control that is set stepwise according to the amount of insertion of the component P.
  • the execution program storage unit 310 can store an execution program prg that defines the operation of the robot 20.
  • the execution program storage unit 310 is configured by, for example, a flash memory or a hard disk drive.
  • the control unit 312 interprets the execution program prg stored in the execution program storage unit 310 and can control the impedance of the robot 20 based on the force feedback value Ffb and the impedance parameter Pins.
  • the robot 20 performs an insertion operation based on impedance control.
  • the control unit 312 includes an impedance controller 312a, a coordinate converter 312b, and a position controller 312c.
  • the impedance controller 312a outputs a position correction amount ⁇ P in the robot coordinate system (orthogonal coordinate system fixed to the base of the robot 20) by impedance control based on the force feedback value Ffb and the force command value Fref.
  • the impedance control model is expressed by the following equation (1) using the inertia parameter M, the viscosity parameter D, the stiffness parameter K, and the Laplace operator s.
  • a value corresponding to the section through which the tip of the component P passes is used.
  • the section is identified based on the position information POS.
  • the coordinate converter 312b converts the position correction amount ⁇ P in the robot coordinate system into a correction amount ⁇ for each joint axis.
  • the position controller 312c outputs a torque T to the robot 20 based on the correction amount ⁇ of each joint axis.
  • a teach pendant 40 is connected to the robot control device 30 as an input device (see FIG. 1).
  • the teach pendant 40 is provided with an execution program input unit 402 and a parameter input unit 404.
  • the operator can create an execution program prg in which the operation is described by the execution program input unit 402 while causing the robot 20 to perform a desired operation.
  • the created execution program prg is stored in the execution program storage unit 310.
  • the operator can select a desired execution program prg stored in the execution program storage unit 310 by the execution program input unit 402 and operate the robot 20 based on the selected execution program prg.
  • the operator can set the setting parameter Ps stored in the parameter storage unit 304 from the parameter input unit 404.
  • the robot control device 30 of the robot system 10 adjusts the viscosity parameter Dz in the direction in which the component P is inserted for each section set in the depth direction of the hole H by a control parameter adjustment method described later.
  • the robot control device 30 performs impedance control on the robot 20 based on the viscosity parameter Dz adjusted for each section.
  • the robot 20 inserts the gripped component P into the hole H. That is, the robot system 10 inserts the component P into the hole H by switching the viscosity parameter Dz according to the insertion amount of the component P.
  • control parameter adjustment method includes a step of performing pre-adjustment, an insertion operation of inserting a part P after the pre-adjustment is performed, and parameter update as work for adjusting the viscosity parameter Dz. And repeating steps.
  • the robot 20 is repeatedly brought into contact with the part P for adjustment, the viscosity parameter is adjusted, and the initial value Dini of the viscosity parameter is obtained.
  • the inertia parameter M is fixed and the stiffness parameter K is zero.
  • the viscosity parameter D shown in Expression (1) the smaller the viscosity parameter D, the faster the response, but the vibration becomes unstable when the component P contacts, and becomes unstable. Conversely, when the viscosity parameter D is increased, the vibration is less and stable, but the response is slow.
  • the viscosity parameter (D in FIG. 5B) is set so that the settling time of the speed response is minimized when a step-like force command is given as shown in FIG. 5B and the part P is brought into contact with the adjustment work Wadj.
  • This adjustment is performed for the six directions of translation and rotation.
  • the adjustment of the viscosity parameter related to the translation direction is performed by translating the part P in each axial direction and bringing it into contact with the adjustment work Wadj.
  • Adjustment of the viscosity parameter regarding the rotation direction is performed by rotating the component P around each axis and bringing the component P into contact with the adjustment work Wadj.
  • an initial value Dini of the viscosity parameter is obtained so that the settling time at the time of contact is minimized.
  • the robot 20 inserts the gripped part P into the hole H with the pressing force Fins based on the force command value Fref_z (see FIG. 6).
  • the part P receives a reaction force CF.
  • the viscosity parameter is set for each of a plurality of sections set in the depth direction of the hole H based on the reaction force received by the robot 20 during the insertion operation.
  • Dz is updated (reduced).
  • the viscosity parameter Dz is updated by the parameter adjustment unit 306 according to an adjustment algorithm described later.
  • the viscosity parameter Dz has a peak value Fpeak1 of the reaction force received before the part P reaches the bottom of the hole H and a peak value Fpeak2 of the reaction force received after the part P reaches the bottom of the hole H, respectively.
  • first threshold value Fthre1 and the threshold value (second threshold value) Fthre2 are exceeded and the viscosity parameter does not reach the preset lower limit value, it is determined every time the parameter update operation is executed. It will be reduced by the size.
  • the force command value Fref_z is kept constant regardless of the position of the component P during the insertion operation.
  • the force command value Fref_z is kept constant even when the viscosity parameter Dz is updated.
  • the viscosity parameter Dz is not updated and is maintained at a value adjusted by the pre-adjustment.
  • the reason why the viscosity parameter Dz for the section including the bottom of the hole H is not subject to update is that the viscosity parameter has already been set so that the settling time when the part P contacts the workpiece W is reduced in the pre-adjustment. This is because it has been adjusted. Note that until the tip of the component P is securely fitted in the hole H, the robot 20 is impedance controlled using the viscosity parameter set in the pre-adjustment.
  • the reaction force received by the robot 20 is monitored so as not to be excessive, and the viscosity parameter Dz is reduced for each section.
  • the response of the insertion operation of the robot 20 is improved, and the time required to insert the component P is shortened.
  • Impedance parameter Pins (1) Viscosity parameter D (2) Inertia parameter M (3) Rigidity parameter K B.
  • each parameter is initialized. Specifically, a variable Flg_Cnt indicating the number of Dz (i) that can be updated is set to N-1. A variable i_old indicating the previous target section is set to 1. A variable i indicating the current target section is set to 1.
  • the current viscosity parameters Dz (1) to Dz (N-1) are set to the initial value Dzini of the viscosity parameter obtained by the above-described pre-adjustment.
  • the previous viscosity parameters OldDz (1) to OldDz (N ⁇ 1) are respectively set to the initial values Dzini of the viscosity parameters obtained by the above-described pre-adjustment.
  • Flags Flg (1) to Flg (N-1) indicating whether or not the viscosity parameters Dz (1) to Dz (N-1) can be updated are set to "on" indicating that the viscosity parameters Dz (1) to Dz (N-1) can be updated.
  • Step S102 It is determined whether or not the flag Flg (i) is “on”. If it is “on”, the process proceeds to step S103. If it is “off” indicating that updating is impossible, the process proceeds to step S203.
  • Step S103 An insertion operation is executed, and the robot 20 inserts the component P into the hole H (see FIG. 7).
  • Step S104 As a first determination step, when the peak value Fpeak1 of the reaction force received until the part P reaches the bottom of the hole H is equal to or less than the threshold value Fthre1, the process proceeds to step S105. Otherwise, the process proceeds to step S204.
  • the reaction force peak value Fpeak1 is obtained from the force feedback value Ffb output from the force signal processing unit 302.
  • Step S105 As a second determination step, when the peak value Fpeak2 of the reaction force received after the part P reaches the bottom of the hole H is equal to or less than the threshold value Fthre2, the process proceeds to step S106. Otherwise, the process proceeds to step S204.
  • the reaction force peak value Fpeak2 is obtained from the force feedback value Ffb output from the force signal processing unit 302.
  • Step S106 If the variable Flg_Cnt is greater than 0, the process proceeds to step S107. If the variable Flg_Cnt is 0, the adjustment ends.
  • Step S107 The viscosity parameter Dz (i) is stored in the viscosity parameter OldDz (i). A value obtained by subtracting the viscosity parameter reduction amount (update amount) ⁇ Dz from the viscosity parameter Dz (i) is set as a new viscosity parameter Dz (i). Let the variable i_old be i.
  • Step S108 As a third determination step, when the new viscosity parameter Dz (i) is equal to or lower than the lower limit value Dzmin of the viscosity parameter, the process proceeds to step S109. Otherwise, the process proceeds to step S110.
  • Step S109 The viscosity parameter Dz (i) is set to the lower limit value Dzmin of the viscosity parameter.
  • the flag Flg (i) is set to “off” indicating that updating is not possible.
  • the variable Flg_Cnt indicating the number of Dz (i) that can be updated is reduced by one.
  • Step S110 If the variable i is smaller than N ⁇ 1, the variable i is incremented by 1. Otherwise, the variable i is set to 1. That is, since the variable i does not become N in the subsequent steps, the section N is excluded from the viscosity parameter update target. Thereafter, the process returns to step S102.
  • Step S203 If the variable i is smaller than N ⁇ 1, the variable i is incremented by 1. Otherwise, the variable i is set to 1. That is, in the flow from step S102 to step S203, the section in which the flag Flg (i) is “off” is excluded from the update target of the viscosity parameter Dz (i). Further, since the variable i does not become N in the subsequent steps, the section N is excluded from the viscosity parameter update target. Thereafter, the process returns to step S102.
  • Step S204 The end state of the insertion operation executed in step S103 is determined. If the insertion operation is a normal end, the process proceeds to step S205. If it is stopped halfway, the adjustment is terminated. That is, according to the flow from step S103, S104 to step S204, when the component P is clogged and stopped in the hole H during the insertion, and the peak value Fpeak1 of the reaction force exceeds the threshold value Fthre1, an abnormality has occurred. It is judged and adjustment is completed.
  • step S103 If the flow from step S103, S104, S105 to step S204 does not stabilize the vibration after the part P reaches the bottom of the hole H, and the reaction force peak value Fpeak2 exceeds the threshold value Fthre2, It is determined that an abnormality has occurred and the adjustment ends.
  • Step S205 The current viscosity parameter Dz (i_old) in the previous target section is returned to the previous viscosity parameter OldDz (i_old) in the previous target section. That is, the viscosity parameter Dz (i_old) is returned to the value before update for the update target section updated immediately before.
  • the flag Flg (i_old) is set to “off” indicating that updating is not possible.
  • the variable Flg_Cnt indicating the number of Dz (i) that can be updated is reduced by one.
  • Step S206 If the variable Flg_Cnt is greater than 0, the process proceeds to step S207. If the variable Flg_Cnt is 0, the adjustment ends.
  • Step S207 If the variable i is smaller than N ⁇ 1, i is incremented by 1. Otherwise, the variable i is set to 1. That is, since the variable i does not become N in the subsequent steps, the section N is excluded from the viscosity parameter update target. Thereafter, the process returns to step S102.
  • the viscosity parameter Dz (i) of each section is determined.
  • the update may cause the insertion operation to be executed by sudden acceleration / deceleration, cause the part P to be clogged in the hole H, or cause the reaction force to be excessive.
  • the present adjustment algorithm can implement a smooth insertion operation because the update target section i changes with the ring numbers such as 1, 2,..., N-1, 1, 2,. That is, in the present adjustment algorithm, the viscosity parameter in the section adjacent to the section that was the last update target is the update target. It should be noted that the update target section i may not be changed by being shifted by one. That is, it is sufficient that the same section is not continuously updated.
  • FIG. 10 the horizontal axis represents the number of updates of the viscosity parameter Dz.
  • the left vertical axis represents the insertion time.
  • the vertical axis on the right represents the magnitude of the reaction force.
  • FIG. 11 is a graph showing the relationship between the reaction force and the insertion position of the component P.
  • the upper graph shows the reaction force.
  • the lower graph shows the insertion position of the component P.
  • the insertion position of the component P is displayed so that the value becomes smaller as the component P is inserted into the hole H.
  • the horizontal axis represents time.
  • the insertion time Tim and the reaction force peak values Fpeak1 and Fpeak2 are as shown in FIG.
  • the insertion operation was repeated 21 times, and the insertion time Tim and the reaction force peak values Fpeak1 and Fpeak2 each changed as shown in FIG.
  • the horizontal axis represents the number of times the viscosity parameter Dz is updated.
  • the left vertical axis represents the insertion time.
  • the vertical axis on the right represents the magnitude of the reaction force.
  • the insertion time for inserting the component P into the hole is shortened. Further, according to the robot system 10, the reaction force when the component P inserted by the robot 20 reaches the bottom of the hole H can be suppressed to a set threshold value or less.
  • the present invention is not limited to the above-described embodiments, and modifications can be made without changing the gist of the present invention.
  • a case where the invention is configured by combining some or all of the above-described embodiments and modifications is also included in the technical scope of the present invention.
  • the reaction force peak that is an internal parameter and the lower limit value of the viscosity parameter in the insertion direction that is a setting parameter may be varied according to the interval.

Landscapes

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

Abstract

　部品(P)を穴(H)に挿入するために要する時間を短縮できるロボット(20)の制御パラメータ調整方法、ロボットシステム(10)及びロボット制御装置(30)を提供する。また、部品(P)が穴(H)の底部に到達した際の反力を低減できるロボット(20)の制御パラメータ調整方法、ロボットシステム(10)及びロボット制御装置(30)を提供する。　ロボット(20)の制御パラメータ調整方法は、外部から加わる力を検出する力センサ(FS)を有するロボット(20)が、インピーダンス制御に基づいて、複数の深さ方向の区間が設定された穴(H)に部品(P)を挿入する挿入ステップと、連続して同一の区間が更新の対象とならないように、複数の区間のうち、いずれか１つの区間における粘性パラメータを低減するパラメータ更新ステップと、を含み、各区間における粘性パラメータを調整する。

Description

ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置
　本発明は、ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置に関する。
　特許文献１には、動作中に力制限値とコンプライアンス制御パラメータを切り替えることで、作業を高速化しながら、位置ずれ発生時に過大な力が作用することを防止できる力制御装置が記載されている。
特開２０１１－１０４７４０号公報
　ロボットが部品（挿入ワーク）を被挿入ワークに形成された穴に挿入する挿入作業において、ロボットは、アーム先端部に搭載された力センサから出力される力センサ信号を観測しながら、部品と被挿入ワークとの接触によって生じる力が目標値に一致するよう、インピーダンス制御によって動作が制御される。
　ここで、インピーダンス制御の特性を決定するインピーダンスパラメータは、以下の観点に基づいて調整される。
１）部品が穴底に到達した際の反力を低減するためには、粘性パラメータを大きく（又は部品の押し付け力を小さく）設定する必要がある。
２）挿入速度を大きくしてタクトタイムを短くするためには、粘性パラメータを小さく（又は部品の押し付け力を大きく）設定する必要がある。
　一般に、部品及び被挿入ワークを破損させないために、前述の１）の観点に基づいてパラメータが調整される。その結果、タクトタイムが延びてしまう。
　本発明は、部品を穴に挿入するために要する時間を短縮できるロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置を提供することを目的とする。また、本発明は、部品が穴の底部に到達した際の反力を、予め定められた大きさよりも低減できるロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置を提供することを目的とする。
　上記課題を解決するため、本発明の一の観点によれば、外部から加わる力を検出する力センサを有するロボットが、インピーダンス制御に基づいて、複数の深さ方向の区間が設定された穴に部品を挿入する挿入ステップと、
　連続して同一の区間が更新の対象とならないように、前記複数の区間のうち、いずれか１つの区間における粘性パラメータを低減するパラメータ更新ステップと、を含み、
　前記各区間における前記粘性パラメータを調整するロボットの制御パラメータ調整方法が適用される。
　また、他の観点によれば、複数の深さ方向の区間が設定された穴に部品を挿入する挿入作業を行うロボットと、
　前記ロボットの動作を制御するロボット制御装置と、を備え、
　前記ロボット制御装置は、前記ロボットが行う前記挿入作業をインピーダンス制御するための制御部と、
　前記部品の挿入量に応じて段階的に設定される前記インピーダンス制御の粘性パラメータを調整するパラメータ調整部と、を有するロボットシステムが適用される。
　また、他の観点によれば、複数の深さ方向の区間が設定された穴に部品を挿入する挿入作業を行うロボットの動作をインピーダンス制御するための制御部と、
　前記部品の挿入量に応じて段階的に前記インピーダンス制御の粘性パラメータを調整するパラメータ調整部と、を備えたロボット制御装置が適用される。
　本発明によれば、部品を穴に挿入するために要する時間を短縮できる。また、ロボットが挿入する部品が穴の底部に到達した際の反力を予め定められた大きさよりも低減できる。
本発明の一実施例に係るロボットシステムの構成図である。 同ロボットシステムによる挿入作業の模式図である。 同ロボットシステムのロボット制御装置が有する制御部のブロック図である。 同ロボットシステムの制御パラメータ調整方法の概要を示す説明図である。 同ロボットシステムが有するロボットの前調整における動作を示す説明図である。 同ロボットシステムが有するロボットの前調整における力指令を示す説明図である。 同ロボットシステムが有するロボットの挿入動作を示す説明図である。 同ロボットシステムが有するロボットが部品を挿入する穴を示す説明図である。 同ロボットシステムが有するロボット制御装置の調整アルゴリズムを示すフローチャートである。 第１の実験例における挿入開始姿勢を示す説明図である。 第１の実験例における反力ピーク値Ｆｐｅａｋ１、Ｆｐｅａｋ２と挿入時間Ｔｉｍの変化を示すグラフである。 挿入動作中の反力及び位置を示すグラフである。 第１の実験例における粘性パラメータの調整結果を示すグラフである。 第２の実験例における挿入開始姿勢を示す説明図である。 第２の実験例における反力ピーク値Ｆｐｅａｋ１、Ｆｐｅａｋ２と挿入時間Ｔｉｍの変化を示すグラフである。 第２の実験例における粘性パラメータの調整結果を示すグラフである。
　続いて、添付した図面を参照しつつ、本発明を具体化した実施例につき説明し、本発明の理解に供する。なお、各図において、説明に関連しない部分は図示を省略する場合がある。
　本発明の一実施例に係るロボットシステム１０は、図１に示すように、ロボット２０と、ロボット２０の動作を制御するロボット制御装置３０と、を備えている。
　ロボット２０は、図２に示すように、インピーダンス制御モデルに基づくインピーダンス制御により、ハンド２０２の位置が修正される。具体的には、ロボット２０は、ハンド２０２にて、例えば円柱状の部品Ｐの予め決められた箇所を把持し、部品Ｐを被挿入ワークＷに形成された穴Ｈに挿入する挿入作業を行うことができる。
　ロボット２０は、例えば６軸の多関節ロボットである。ロボット２０は、手首部２０４とハンド２０２との間に、外部から加わる力を検出する力センサＦＳを有している。この力センサＦＳは、例えば６軸の力センサである。力センサＦＳは、ハンド２０２に固定されたツール座標系のＸ軸、Ｙ軸、及びＺ軸の各軸の方向の力を計測できる。また、力センサＦＳは、ツール座標系のＸ軸、Ｙ軸、及びＺ軸の各軸回りのモーメントを計測できる。すなわち、力センサＦＳは、ロボット２０のハンド２０２に作用する外力を検出できる。
　ロボット制御装置３０（図１参照）は、部品Ｐの挿入量に応じて段階的にインピーダンス制御の粘性パラメータを切り替え、ロボット２０の動作をインピーダンス制御により制御できる。ここで、粘性パラメータは、部品Ｐを挿入する方向に関する粘性パラメータであり、以下、単に粘性パラメータという場合がある。
　また、ロボット制御装置３０は、穴Ｈの深さ方向に設定された各区間（図７参照）における粘性パラメータをそれぞれ調整できる。
　ロボット制御装置３０は、力信号処理部３０２と、パラメータ記憶部３０４と、パラメータ調整部３０６と、実行プログラム記憶部３１０と、制御部３１２と、を有している。
　力信号処理部３０２には、力センサＦＳが検出した外力が電気信号として入力される。力信号処理部３０２は、この電気信号を処理して、力フィードバック値Ｆｆｂとして出力する。
　パラメータ記憶部３０４は、ロボット２０をインピーダンス制御するために必要なインピーダンスパラメータＰｉｎｓ、粘性パラメータを調整するために操作者が設定する設定パラメータＰｓ、及び粘性パラメータを調整するためにパラメータ調整部３０６が使用する内部パラメータＰｉを記憶できる。
　パラメータ調整部３０６は、力信号処理部３０２から入力された力フィードバック値Ｆｆｂ、及びロボット２０の各軸を駆動するサーボモータのエンコーダ値を順変換して得られた位置情報ＰＯＳに基づき、パラメータ記憶部３０４に記憶された各区間における粘性パラメータを調整できる。すなわち、パラメータ調整部３０６は、部品Ｐの挿入量に応じて段階的に設定されるインピーダンス制御の粘性パラメータを調整できる。
　実行プログラム記憶部３１０は、ロボット２０の動作を規定する実行プログラムｐｒｇを記憶することができる。実行プログラム記憶部３１０は、例えば、フラッシュメモリやハードディスクドライブにより構成される。
　制御部３１２は、実行プログラム記憶部３１０に記憶された実行プログラムｐｒｇを解釈し、力フィードバック値Ｆｆｂ及びインピーダンスパラメータＰｉｎｓに基づいて、ロボット２０をインピーダンス制御できる。ロボット２０は、インピーダンス制御に基づいて、挿入作業を実行する。
　制御部３１２は、図３に示すように、インピーダンス制御器３１２ａ、座標変換器３１２ｂ、及び位置制御器３１２ｃとを有している。
　インピーダンス制御器３１２ａは、力フィードバック値Ｆｆｂ及び力指令値Ｆｒｅｆに基づいて、インピーダンス制御によりロボット座標系（ロボット２０のベースに固定された直交座標系）における位置修正量δＰを出力する。
　ここで、インピーダンス制御のモデルは、慣性パラメータＭ、粘性パラメータＤ、及び剛性パラメータＫ、及びラプラス演算子ｓを用いて次式（１）により表される。
Figure JPOXMLDOC01-appb-M000001
　ただし、挿入方向の粘性パラメータは、部品Ｐの先端部が通過する区間に応じた値が用いられる。区間は、位置情報ＰＯＳに基づいて識別される。
　座標変換器３１２ｂは、ロボット座標系における位置修正量δＰを各関節軸の修正量δθに変換する。
　位置制御器３１２ｃは、各関節軸の修正量δθに基づいて、ロボット２０に対してトルクＴを出力する。
　ロボット制御装置３０には、入力装置として、例えばティーチペンダント４０が接続される（図１参照）。ティーチペンダント４０には、実行プログラム入力部４０２、及びパラメータ入力部４０４が設けられている。
　操作者は、実行プログラム入力部４０２により、ロボット２０に所望の動作をさせつつ、その動作が記述された実行プログラムｐｒｇを作成できる。作成された実行プログラムｐｒｇは、実行プログラム記憶部３１０に記憶される。
　また、操作者は、実行プログラム入力部４０２により、実行プログラム記憶部３１０に記憶された所望の実行プログラムｐｒｇを選択し、選択した実行プログラムｐｒｇに基いて、ロボット２０を動作させることができる。
　更に、操作者は、パラメータ入力部４０４より、パラメータ記憶部３０４が記憶する設定パラメータＰｓを設定できる。
　次に、ロボットシステム１０の動作について説明する。
　まず、ロボットシステム１０のロボット制御装置３０は、後述する制御パラメータ調整方法により、穴Ｈの深さ方向に設定された各区間について、部品Ｐを挿入する方向の粘性パラメータＤｚを調整する。
　次に、ロボット制御装置３０は、区間ごとに調整された粘性パラメータＤｚに基づいて、ロボット２０をインピーダンス制御する。その結果、ロボット２０は把持した部品Ｐを穴Ｈに挿入する。つまり、ロボットシステム１０は、部品Ｐの挿入量に応じて粘性パラメータＤｚを切り替えて、部品Ｐを穴Ｈに挿入する。
　制御パラメータ調整方法は、粘性パラメータＤｚを調整する作業として、図４に示すように、前調整を実行するステップと、前調整が実行された後、部品Ｐを挿入する挿入動作とパラメータ更新とを繰り返すステップとを含んでいる。
　前調整においては、図５Ａに示すようにロボット２０に部品Ｐを調整用のワークＷａｄｊに繰り返し接触させ、粘性パラメータが調整され、粘性パラメータの初期値Ｄｉｎｉが求められる。なお、慣性パラメータＭは固定され、剛性パラメータＫは零である。
　前調整においては、式（１）に示した粘性パラメータＤを調整する際、粘性パラメータＤが小さいほど応答が速いが部品Ｐの接触時に振動的になり不安定になる。逆に、粘性パラメータＤを大きくすると振動が少なく安定だが応答は遅い。
　そこで、図５Ｂのようにステップ状の力指令を与えて部品Ｐを調整用のワークＷａｄｊに接触させた場合の、速度応答の整定時間が最短になるように粘性パラメータ（図５Ｂ中のＤ）を調整し、この調整を並進及び回転の６方向に対して行う。並進方向に関する粘性パラメータの調整は各軸方向について部品Ｐを並進させ調整用のワークＷａｄｊに接触させて行われる。回転方向に関する粘性パラメータの調整は、各軸回りに部品Ｐを回転させ、部品Ｐを調整用のワークＷａｄｊに接触させて行われる。
　前調整により、接触時の整定時間が最短になるような粘性パラメータの初期値Ｄｉｎｉが求められる。
　また、前調整では、図６に示すように、部品Ｐの先端が穴Ｈに嵌るよう、ロボット２０の位置姿勢が教示される。
　更に、前調整では、部品Ｐを挿入する方向の力指令値Ｆｒｅｆ＿ｚも与えられる。
　図４に示した挿入動作においては、挿入ステップとして、ロボット２０が、力指令値Ｆｒｅｆ＿ｚに基づく押し付け力Ｆｉｎｓにて、把持した部品Ｐを穴Ｈに挿入する（図６参照）。部品Ｐが穴Ｈの底部に到達すると、部品Ｐは反力ＣＦを受ける。
　パラメータ更新動作においては、図７に示すように、更新ステップとして、挿入動作中にロボット２０が受けた反力に基づいて、穴Ｈの深さ方向に設定された複数の区間ごとに、粘性パラメータＤｚが更新（低減）される。図７では一例として５つの区間に分けた場合を示している。粘性パラメータＤｚは、パラメータ調整部３０６により、後述する調整アルゴリズムに従って更新される。
　粘性パラメータＤｚは、原則として、部品Ｐが穴Ｈの底部に到達するまでに受ける反力のピーク値Ｆｐｅａｋ１及び部品Ｐが穴Ｈの底部に到達した後に受ける反力のピーク値Ｆｐｅａｋ２が、それぞれ予め決められた閾値（第１の閾値）Ｆｔｈｒｅ１及び閾値（第２の閾値）Ｆｔｈｒｅ２を超えず、粘性パラメータが予め設定された下限値に到達しない限り、パラメータ更新動作が実行される度に予め決められた大きさだけ低減されていく。
　パラメータ更新動作においては、挿入動作中、力指令値Ｆｒｅｆ＿ｚは、部品Ｐの位置に関係なく一定に保たれる。力指令値Ｆｒｅｆ＿ｚは、粘性パラメータＤｚが更新された場合であっても、一定に保たれる。
　また、図７に示す区間５のように、穴Ｈの底部を含む区間については、粘性パラメータＤｚは更新の対象とならず、前調整により調整された値に維持される。穴Ｈの底部を含む区間についての粘性パラメータＤｚが更新の対象とならない理由は、前調整にて、部品Ｐが被挿入ワークＷに接触した際の整定時間が低減されるよう、粘性パラメータがすでに調整されているためである。
　なお、部品Ｐの先端が穴Ｈに確実に嵌るまでは、前調整にて設定した粘性パラメータを用いて、ロボット２０がインピーダンス制御される。
　この調整アルゴリズムによれば、ロボット２０が受ける反力が過大にならないように監視され、各区間について粘性パラメータＤｚが低減される。その結果、ロボット２０の挿入動作の応答が向上し、部品Ｐを挿入するために要する時間が短縮される。
　次に、図８を参照して、パラメータ調整部３０６が実行する調整アルゴリズムについて、詳細に説明する。
　前述のパラメータ記憶部３０４に記憶されるインピーダンスパラメータＰｉｎｓ、粘性パラメータＤを調整するために操作者が設定する設定パラメータＰｓ、及び粘性パラメータＤを調整するためにパラメータ調整部３０６が使用する内部パラメータＰｉは、具体的には以下の通りである。
Ａ．インピーダンスパラメータＰｉｎｓ
（１）粘性パラメータＤ
（２）慣性パラメータＭ
（３）剛性パラメータＫ
Ｂ．設定パラメータＰｓ
（１）挿入方向の粘性パラメータの初期値Ｄｚｉｎｉ
（２）挿入方向の粘性パラメータの下限値Ｄｚｍｉｎ
（３）挿入方向の粘性パラメータの低減量（更新量）ΔＤｚ
（４）部品Ｐが穴Ｈの底部に到達するまでに受ける反力の閾値Ｆｔｈｒｅ１
（５）部品Ｐが穴Ｈの底部に到達した後に受ける反力の閾値Ｆｔｈｒｅ２
（６）区間の分割数Ｎ（自然数）
（７）部品Ｐを挿入する方向にハンド２０２を動かすための力指令値Ｆｒｅｆ＿ｚ
Ｃ．内部パラメータＰｉ
（１）粘性パラメータを更新する対象となる更新対象区間を示す変数ｉ（ただし、１≦ｉ≦Ｎ－１）
（２）前回の更新対象区間を示す変数ｉ＿ｏｌｄ（ただし、１≦ｉ＿ｏｌｄ≦Ｎ－１）
（３）更新対象区間ｉにおける挿入方向の粘性パラメータＤｚ（ｉ）
（４）前回の挿入方向の粘性パラメータＯｌｄＤｚ（ｉ）
（５）粘性パラメータＤｚ（ｉ）の更新可否を示すフラグＦｌｇ（ｉ）
（６）更新可能なＤｚ（ｉ）の数を示す変数Ｆｌｇ＿Ｃｎｔ（ただし、０≦Ｆｌｇ＿Ｃｎｔ≦Ｎ－１）
（７）部品Ｐが穴Ｈの底部に到達するまでに受ける反力のピーク値Ｆｐｅａｋ１（図１１参照）
（８）部品Ｐが穴Ｈの底部に到達した後に受ける反力のピーク値Ｆｐｅａｋ２（図１１参照）
（ステップＳ１０１）
　本ステップでは、各パラメータが初期設定される。具体的には、更新可能なＤｚ（ｉ）の数を示す変数Ｆｌｇ＿ＣｎｔがＮ－１に設定される。
　前回の対象区間を示す変数ｉ＿ｏｌｄが１に設定される。
　現在の対象の区間を示す変数ｉが１に設定される。
　現在の粘性パラメータＤｚ（１）～Ｄｚ（Ｎ－１）が、前述の前調整で得られた粘性パラメータの初期値Ｄｚｉｎｉに設定される。
　前回の粘性パラメータＯｌｄＤｚ（１）～ＯｌｄＤｚ（Ｎ－１）が、それぞれ前述の前調整で得られた粘性パラメータの初期値Ｄｚｉｎｉに設定される。
　粘性パラメータＤｚ（１）～Ｄｚ（Ｎ－１）の更新可否をそれぞれ示すフラグＦｌｇ（１）～Ｆｌｇ（Ｎ－１）が更新可能であることを示す「ｏｎ」に設定される。
（ステップＳ１０２）
　フラグＦｌｇ（ｉ）が、「ｏｎ」であるか否かが判断される。「ｏｎ」である場合には、ステップＳ１０３へ進む。更新不可能であることを示す「ｏｆｆ」である場合には、ステップＳ２０３へ進む。
（ステップＳ１０３）
　挿入動作が実行され、ロボット２０が部品Ｐを穴Ｈに挿入する（図７参照）。
（ステップＳ１０４）
　第１の判断ステップとして、部品Ｐが穴Ｈの底部に到達するまでに受ける反力のピーク値Ｆｐｅａｋ１が、閾値Ｆｔｈｒｅ１以下である場合には、ステップＳ１０５へ進む。そうでない場合には、ステップＳ２０４へ進む。
　なお、反力のピーク値Ｆｐｅａｋ１は、力信号処理部３０２が出力する力フィードバック値Ｆｆｂから求められる。
（ステップＳ１０５）
　第２の判断ステップとして、部品Ｐが穴Ｈの底部に到達した後に受ける反力のピーク値Ｆｐｅａｋ２が、閾値Ｆｔｈｒｅ２以下である場合には、ステップＳ１０６へ進む。そうでない場合には、ステップＳ２０４へ進む。
　なお、反力のピーク値Ｆｐｅａｋ２は、力信号処理部３０２が出力する力フィードバック値Ｆｆｂから求められる。
（ステップＳ１０６）
　変数Ｆｌｇ＿Ｃｎｔが０より大きい場合には、ステップＳ１０７へ進む。変数Ｆｌｇ＿Ｃｎｔが０である場合には、調整が終了する。
（ステップＳ１０７）
　粘性パラメータＤｚ（ｉ）を粘性パラメータＯｌｄＤｚ（ｉ）に保存する。粘性パラメータＤｚ（ｉ）から粘性パラメータの低減量（更新量）ΔＤｚを減じた値を新たな粘性パラメータＤｚ（ｉ）とする。変数ｉ＿ｏｌｄをｉとする。
（ステップＳ１０８）
　第３の判断ステップとして、新たな粘性パラメータＤｚ（ｉ）が粘性パラメータの下限値Ｄｚｍｉｎ以下である場合には、ステップＳ１０９へ進む。そうでない場合には、ステップＳ１１０へ進む。
（ステップＳ１０９）
　粘性パラメータＤｚ（ｉ）が粘性パラメータの下限値Ｄｚｍｉｎに設定される。
　フラグＦｌｇ（ｉ）が更新不可能であることを示す「ｏｆｆ」に設定される。更新可能なＤｚ（ｉ）の数を示す変数Ｆｌｇ＿Ｃｎｔを１減らす。
（ステップＳ１１０）
　変数ｉがＮ－１よりも小さい場合には、変数ｉを１増やし、そうでない場合には、変数ｉを１にする。つまり、後続のステップにおいて変数ｉはＮになることがないので、区間Ｎは粘性パラメータの更新対象外となる。
　その後、ステップＳ１０２に戻る。
（ステップＳ２０３）
　変数ｉがＮ－１よりも小さい場合には、変数ｉを１増やし、そうでない場合には、変数ｉを１にする。つまり、ステップＳ１０２から本ステップＳ２０３へと至るフローにより、フラグＦｌｇ（ｉ）が「ｏｆｆ」となった区間は、粘性パラメータＤｚ（ｉ）の更新対象から外されることになる。また、後続のステップにおいて変数ｉはＮになることがないので、区間Ｎは粘性パラメータの更新対象外となる。
　その後、ステップＳ１０２に戻る。
（ステップＳ２０４）
　ステップＳ１０３にて実行された挿入動作の終了状態が判断される。挿入動作が正常終了である場合には、ステップＳ２０５へ進む。途中停止である場合には、調整を終了する。すなわち、ステップＳ１０３、Ｓ１０４からステップＳ２０４へと至るフローにより、挿入途中で部品Ｐが穴Ｈに詰まって停止し、反力のピーク値Ｆｐｅａｋ１が閾値Ｆｔｈｒｅ１を超えた場合には、異常が発生したと判断され、調整が終了する。また、ステップＳ１０３、Ｓ１０４、Ｓ１０５からステップＳ２０４へと至るフローにより、部品Ｐが穴Ｈの底部に到達した後に振動が整定せず、反力のピーク値Ｆｐｅａｋ２が閾値Ｆｔｈｒｅ２を超えた場合には、異常が発生したと判断され、調整が終了する。
（ステップＳ２０５）
　前回の対象区間における現在の粘性パラメータＤｚ（ｉ＿ｏｌｄ）を、前回の対象区間における前回の粘性パラメータＯｌｄＤｚ（ｉ＿ｏｌｄ）に戻す。つまり、直前に更新した更新対象区間について、粘性パラメータＤｚ（ｉ＿ｏｌｄ）を更新前の値に戻す。
　フラグＦｌｇ（ｉ＿ｏｌｄ）が更新不可能であることを示す「ｏｆｆ」に設定される。更新可能なＤｚ（ｉ）の数を示す変数Ｆｌｇ＿Ｃｎｔを１減らす。
（ステップＳ２０６）
　変数Ｆｌｇ＿Ｃｎｔが０より大きい場合には、ステップＳ２０７へ進む。変数Ｆｌｇ＿Ｃｎｔが０である場合には、調整が終了する。
（ステップＳ２０７）
　変数ｉがＮ－１よりも小さい場合には、ｉを１増やし、そうでない場合には、変数ｉを１にする。つまり、後続のステップにおいて変数ｉはＮになることがないので、区間Ｎは粘性パラメータの更新対象外となる。
　その後、ステップＳ１０２に戻る。
　上記ステップを繰り返すことにより、各区間の粘性パラメータＤｚ（ｉ）が決定される。
　ここで、特定の区間のみ更新を繰り返すと、急な加減速で挿入動作が実行される要因になったり、部品Ｐが穴Ｈに詰まる要因になったり、反力が過大となる要因になったりする。この点、本調整アルゴリズムは、更新対象区間ｉが、１、２、・・・、Ｎ－１、１、２・・・のように輪番で変わるので、スムーズな挿入動作を実現できる。つまり、本調整アルゴリズムでは、前回更新の対象となった区間に隣接する区間における粘性パラメータが更新対象となる。なお、更新対象区間ｉは１ずつずれて変更されなくてもよい。すなわち、連続して同一の区間が更新の対象とならなければよい。
　次に、ロボット２０が把持した部品Ｐを挿入する実験例を示し、ロボットシステム１０について更に説明する。
（第１の実験例）
　前述の前調整の後、図９に示すように、部品Ｐの先端が被挿入ワークＷに１ｍｍ程度嵌った状態から挿入動作及びパラメータ更新を行った。
　部品Ｐ及び被挿入ワークＷの諸元並びに調整パラメータをそれぞれ、表１及び表２に示す。
Figure JPOXMLDOC01-appb-T000002
Figure JPOXMLDOC01-appb-T000003
　実験の結果、挿入動作は２１回繰り返され、挿入開始位置から穴底に到達するまでの所要時間（挿入時間）Ｔｉｍ、及び反力ピーク値Ｆｐｅａｋ１、Ｆｐｅａｋ２は、それぞれ、図１０に示すように推移した。なお、図１０において、横軸は粘性パラメータＤｚの更新回数を表している。左側の縦軸は挿入時間を表している。右側の縦軸は反力の大きさを表している。
　ここで、図１１は、反力と部品Ｐの挿入位置との関係を示したグラフである。上側のグラフは反力を示している。下側のグラフは部品Ｐの挿入位置を示している。部品Ｐの挿入位置は、部品Ｐが穴Ｈに挿入されるほど、値が小さくなるように表示されている。横軸は時間を表している。挿入時間Ｔｉｍ、反力ピーク値Ｆｐｅａｋ１、Ｆｐｅａｋ２は、それぞれ、図１１に示す通りである。
　図１０に示すように、全２１回の挿入を通して、反力ピークＦｐｅａｋ１、Ｆｐｅａｋ２は、それぞれ表２に示す閾値Ｆｔｈｒｅ１、Ｆｔｈｒｅ２を下回った。その結果、前述の調整アルゴリズム（図８参照）に従って、各区間の粘性パラメータＤｚ（１）からＤｚ（４）までの全てが粘性パラメータの下限値Ｄｍｉｎに到達して調整終了となった（図１２参照）。
　結果的に、挿入時間Ｔｉｍは、４．８秒（１回目の更新）から１．３秒（２１回目の更新）へと短縮された。
（第２の実験例）
　前述の前調整の後、図１３に示すように、ロボット２０が把持した部品ＰをＴＣＰ（Ｔｏｏｌ　Ｃｅｎｔｅｒ　Ｐｏｉｎｔ）を通るＹ軸回りに＋０．５度傾け、部品Ｐが傾いて穴Ｈに嵌った状態から挿入動作及びパラメータ更新を行った。
　部品Ｐの諸元及び調整パラメータは、第１の実験例と同一である（表１及び表２参照）。
　実験の結果、挿入動作は２１回繰り返され、挿入時間Ｔｉｍ、及び反力ピーク値Ｆｐｅａｋ１、Ｆｐｅａｋ２は、それぞれ、図１４に示すように推移した。なお、図１４において、横軸は粘性パラメータＤｚの更新回数を表している。左側の縦軸は挿入時間を表している。右側の縦軸は反力の大きさを表している。
　図１４に示すように、挿入動作１、２、４、５、６、７、１０回目では、挿入途中で部品Ｐが詰まり、穴底に到達せずに挿入動作を終了した。その際、反力Ｆｐｅａｋ１は閾値を下回ったのでパラメータが更新され、調整が継続された。また、２０回目ではＦｐｅａｋ１が閾値Ｆｔｈｒｅ１を超えたため、その際の調整結果が却下されてＤｚ（３）の更新が打ち切られた。最終的に採用された調整結果では、Ｄｚ（３）が粘性下限値Ｄｍｉｎに到達していない（図１５参照）。
　結果的に、挿入時間Ｔｉｍは、５．８秒（３回目の更新）が２．１秒（２１回目の更新）に短縮された。
　以上説明したように、ロボットシステム１０によれば、部品Ｐを穴に挿入する挿入時間が短縮される。また、ロボットシステム１０によれば、ロボット２０が挿入する部品Ｐが穴Ｈの底部に到達した際の反力が設定された閾値以下に抑えられる。
　本発明は、前述の実施例に限定されるものではなく、本発明の要旨を変更しない範囲での変更は可能である。例えば、前述の実施例や変形例の一部又は全部を組み合わせて発明を構成する場合も本発明の技術的範囲に含まれる。
　例えば、内部パラメータである反力のピークや設定パラメータである挿入方向の粘性パラメータの下限値を区間に応じて可変にしてもよい。
１０：ロボットシステム、２０：ロボット、３０：ロボット制御装置、４０：ティーチペンダント、２０２：ハンド、２０４：手首部、３０２：力信号処理部、３０４：パラメータ記憶部、３０６：パラメータ調整部、３１０：実行プログラム記憶部、３１２：制御部、３１２ａ：インピーダンス制御器、３１２ｂ：座標変換器、３１２ｃ：位置制御器、４０２：実行プログラム入力部、４０４：パラメータ入力部、ＦＳ：力センサ、Ｈ：穴、Ｐ：部品、Ｗ：被挿入ワーク、Ｗａｄｊ：調整用のワーク

Claims (7)

  1. 　外部から加わる力を検出する力センサを有するロボットが、インピーダンス制御に基づいて、複数の深さ方向の区間が設定された穴に部品を挿入する挿入ステップと、
    　連続して同一の区間が更新の対象とならないように、前記複数の区間のうち、いずれか１つの区間における粘性パラメータを低減するパラメータ更新ステップと、を含み、
    　前記各区間における前記粘性パラメータを調整するロボットの制御パラメータ調整方法。
  2. 　請求項１記載のロボットの制御パラメータ調整方法において、
    　前記パラメータ更新ステップでは、前記穴の底部を含む前記区間における前記粘性パラメータを調整の対象としないロボットの制御パラメータ調整方法。
  3. 　請求項２記載のロボットの制御パラメータ調整方法において、
    　前記パラメータ更新ステップでは、前回調整の対象となった前記区間に隣接する前記区間における前記粘性パラメータが調整の対象となるロボットの制御パラメータ調整方法。
  4. 　請求項２又は３記載のロボットの制御パラメータ調整方法において、
    　前記部品が、前記穴の底に到達するまでの間に前記ロボットが受ける反力が予め決められた第１の閾値を超えたことを判断する第１の判断ステップと、
    　前記部品が、前記穴の底に到達した際に前記ロボットが受ける反力が予め決められた第２の閾値を超えたことを判断する第２の判断ステップと、
    　前記粘性パラメータが、予め設定された下限値に到達したことを判断する第３の判断ステップと、を更に含むロボットの制御パラメータ調整方法。
  5. 　複数の深さ方向の区間が設定された穴に部品を挿入する挿入作業を行うロボットと、
    　前記ロボットの動作を制御するロボット制御装置と、を備え、
    　前記ロボット制御装置は、前記ロボットが行う前記挿入作業をインピーダンス制御するための制御部と、
    　前記部品の挿入量に応じて段階的に設定される前記インピーダンス制御の粘性パラメータを調整するパラメータ調整部と、を有するロボットシステム。
  6. 　請求項５記載のロボットシステムにおいて、
    　前記パラメータ調整部は、前記ロボットが前記挿入作業を行った際の反力が予め決められた大きさを超えていない場合に、前記複数の区間のうち、前記穴の底部を含む前記区間を除き、いずれか１つの前記区間における前記粘性パラメータを予め決められた大きさだけ低減するロボットシステム。
  7. 　複数の深さ方向の区間が設定された穴に部品を挿入する挿入作業を行うロボットの動作をインピーダンス制御するための制御部と、
    　前記部品の挿入量に応じて段階的に前記インピーダンス制御の粘性パラメータを調整するパラメータ調整部と、を備えたロボット制御装置。
PCT/JP2012/072486 2012-09-04 2012-09-04 ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置 WO2014037999A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
CN201280075625.3A CN104602873B (zh) 2012-09-04 2012-09-04 机器人的控制参数调整方法、机器人系统及机器人控制装置
JP2014534068A JP5971342B2 (ja) 2012-09-04 2012-09-04 ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置
EP12884342.2A EP2896487A1 (en) 2012-09-04 2012-09-04 Method for adjusting robot control parameters, robot system, and robot control device
PCT/JP2012/072486 WO2014037999A1 (ja) 2012-09-04 2012-09-04 ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置
US14/637,272 US20150174760A1 (en) 2012-09-04 2015-03-03 Method for adjusting robot control parameters, robot system, and robot controller

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2012/072486 WO2014037999A1 (ja) 2012-09-04 2012-09-04 ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US14/637,272 Continuation US20150174760A1 (en) 2012-09-04 2015-03-03 Method for adjusting robot control parameters, robot system, and robot controller

Publications (1)

Publication Number Publication Date
WO2014037999A1 true WO2014037999A1 (ja) 2014-03-13

Family

ID=50236652

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2012/072486 WO2014037999A1 (ja) 2012-09-04 2012-09-04 ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置

Country Status (5)

Country Link
US (1) US20150174760A1 (ja)
EP (1) EP2896487A1 (ja)
JP (1) JP5971342B2 (ja)
CN (1) CN104602873B (ja)
WO (1) WO2014037999A1 (ja)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2019018340A (ja) * 2017-07-20 2019-02-07 キヤノン株式会社 作業用ロボット、作業用ロボットの制御方法
JP2020089961A (ja) * 2018-12-07 2020-06-11 セイコーエプソン株式会社 ロボットシステムおよび接続方法
JP2021035706A (ja) * 2019-08-30 2021-03-04 ソニー株式会社 ロボットアーム制御装置、ロボットアーム制御方法、プログラム及び電子機器の製造方法
CN114536321A (zh) * 2020-11-26 2022-05-27 精工爱普生株式会社 机器人系统及其控制方法和力控制参数的调整方法
JP7528709B2 (ja) 2020-10-16 2024-08-06 セイコーエプソン株式会社 力制御パラメーター調整方法

Families Citing this family (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10272568B2 (en) 2015-09-17 2019-04-30 Canon Kabushiki Kaisha Robot apparatus, robot controlling method, program, recording medium, and assembly manufacturing method
JP2017159426A (ja) * 2016-03-11 2017-09-14 セイコーエプソン株式会社 ロボット制御装置、ロボット、及びロボットシステム
EP3448634A1 (de) 2016-04-24 2019-03-06 Franka Emika GmbH Verfahren zum fügen eines gegenstandes in eine gegenstandsaufnahme mittels eines robotermanipulators
JP6915239B2 (ja) * 2016-07-22 2021-08-04 セイコーエプソン株式会社 挿入方法
KR101925425B1 (ko) * 2017-01-24 2019-02-27 주식회사 레이언스 인트라오럴 x선 센서의 센서홀더
DE102017118981B4 (de) * 2017-04-23 2018-12-20 Franka Emika Gmbh Vorrichtung und Verfahren zum Einstecken einer Steckkarte in eine Steckkupplung
JP7086531B2 (ja) * 2017-05-18 2022-06-20 キヤノン株式会社 ロボットハンド、ロボット装置、ロボットハンドの制御方法、物品の製造方法、制御プログラム及び記録媒体
CN109794932B (zh) * 2017-11-16 2021-03-16 财团法人工业技术研究院 机械手臂加工系统及其加工方法
US10967510B2 (en) 2017-11-16 2021-04-06 Industrial Technology Research Institute Robot arm processing system and method thereof
JP6881361B2 (ja) * 2018-03-14 2021-06-02 オムロン株式会社 ロボットの制御装置、ロボットのおよび制御方法
JP7135408B2 (ja) * 2018-04-26 2022-09-13 セイコーエプソン株式会社 ロボット制御装置およびロボットシステム
US10953548B2 (en) 2018-07-19 2021-03-23 International Business Machines Corporation Perform peg-in-hole task with unknown tilt
TWI704434B (zh) 2019-12-03 2020-09-11 財團法人工業技術研究院 鑽削系統及其方法
US11318611B2 (en) 2020-04-14 2022-05-03 Fanuc Corporation Multi center impedance control
JP2022054725A (ja) * 2020-09-28 2022-04-07 株式会社日立製作所 把持物挿入装置及び方法
JP2022070451A (ja) * 2020-10-27 2022-05-13 セイコーエプソン株式会社 ロボットのパラメーターセットの調整を支援する方法、プログラム、および情報処理装置

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05150836A (ja) * 1991-11-26 1993-06-18 Kawasaki Heavy Ind Ltd ロボツトの制御装置
JP2001277162A (ja) * 2000-03-31 2001-10-09 Omron Corp インピーダンスパラメータ調整装置
JP2005028532A (ja) * 2003-07-08 2005-02-03 Fanuc Ltd 嵌合装置
JP2007136588A (ja) * 2005-11-16 2007-06-07 Yaskawa Electric Corp プログラミングペンダント
JP2011088225A (ja) * 2009-10-20 2011-05-06 Yaskawa Electric Corp インピーダンス制御パラメータの調整装置および調整方法
JP2011104740A (ja) 2009-11-19 2011-06-02 Mitsubishi Electric Corp 力制御装置

Family Cites Families (18)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4621332A (en) * 1983-06-20 1986-11-04 Hitachi, Ltd. Method and apparatus for controlling a robot utilizing force, position, velocity, spring constant, mass coefficient, and viscosity coefficient
BG41865A1 (en) * 1985-04-26 1987-09-15 Ivanov Method and device for scanning mounting of two- pieces entering one in the other
JP2515594B2 (ja) * 1989-07-20 1996-07-10 三菱電機株式会社 ロボットの力制御方法及び装置
DE69736348T2 (de) * 1996-10-24 2006-11-30 Fanuc Ltd. Roboterkraftsteuersystem mit visuellem sensor für zusammenfügungsarbeiten
JP3865158B2 (ja) * 1997-05-30 2007-01-10 株式会社安川電機 ロボットアームのインピーダンス制御装置
JP3504507B2 (ja) * 1998-09-17 2004-03-08 トヨタ自動車株式会社 適切反力付与型作業補助装置
US6522952B1 (en) * 1999-06-01 2003-02-18 Japan As Represented By Secretary Of Agency Of Industrial Science And Technology Method and system for controlling cooperative object-transporting robot
WO2004033159A1 (ja) * 2002-10-11 2004-04-22 Fujitsu Limited ロボット制御アルゴリズム構築装置、ロボット制御アルゴリズム構築プログラム、ロボット制御装置、ロボット制御プログラム、およびロボット
US7443115B2 (en) * 2002-10-29 2008-10-28 Matsushita Electric Industrial Co., Ltd. Apparatus and method for robot handling control
JP3961408B2 (ja) * 2002-11-21 2007-08-22 ファナック株式会社 組立て方法及び装置
JP3994956B2 (ja) * 2002-12-18 2007-10-24 ソニー株式会社 ロボット装置、並びに負荷吸収装置及び負荷吸収方法
US7181314B2 (en) * 2003-11-24 2007-02-20 Abb Research Ltd. Industrial robot with controlled flexibility and simulated force for automated assembly
CN101870108B (zh) * 2006-01-13 2011-09-28 松下电器产业株式会社 机械手臂的控制装置
CA2583107C (en) * 2006-03-31 2011-09-13 Universite De Sherbrooke High performance differential actuator for robotic interaction tasks
JP5171290B2 (ja) * 2007-02-02 2013-03-27 本田技研工業株式会社 脚式移動ロボット
JP2008188722A (ja) * 2007-02-06 2008-08-21 Fanuc Ltd ロボット制御装置
JP4896276B2 (ja) * 2010-01-04 2012-03-14 パナソニック株式会社 ロボット、ロボットの制御装置、制御方法、及び制御プログラム
JP4837113B2 (ja) * 2010-03-18 2011-12-14 ファナック株式会社 ロボットを用いた嵌合装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05150836A (ja) * 1991-11-26 1993-06-18 Kawasaki Heavy Ind Ltd ロボツトの制御装置
JP2001277162A (ja) * 2000-03-31 2001-10-09 Omron Corp インピーダンスパラメータ調整装置
JP2005028532A (ja) * 2003-07-08 2005-02-03 Fanuc Ltd 嵌合装置
JP2007136588A (ja) * 2005-11-16 2007-06-07 Yaskawa Electric Corp プログラミングペンダント
JP2011088225A (ja) * 2009-10-20 2011-05-06 Yaskawa Electric Corp インピーダンス制御パラメータの調整装置および調整方法
JP2011104740A (ja) 2009-11-19 2011-06-02 Mitsubishi Electric Corp 力制御装置

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2019018340A (ja) * 2017-07-20 2019-02-07 キヤノン株式会社 作業用ロボット、作業用ロボットの制御方法
JP7427358B2 (ja) 2017-07-20 2024-02-05 キヤノン株式会社 ロボットシステム、物品の製造方法、制御方法、制御プログラム、および記録媒体
JP2020089961A (ja) * 2018-12-07 2020-06-11 セイコーエプソン株式会社 ロボットシステムおよび接続方法
JP7167681B2 (ja) 2018-12-07 2022-11-09 セイコーエプソン株式会社 ロボットシステムおよび接続方法
JP2021035706A (ja) * 2019-08-30 2021-03-04 ソニー株式会社 ロボットアーム制御装置、ロボットアーム制御方法、プログラム及び電子機器の製造方法
JP7528709B2 (ja) 2020-10-16 2024-08-06 セイコーエプソン株式会社 力制御パラメーター調整方法
CN114536321A (zh) * 2020-11-26 2022-05-27 精工爱普生株式会社 机器人系统及其控制方法和力控制参数的调整方法
CN114536321B (zh) * 2020-11-26 2023-07-11 精工爱普生株式会社 机器人系统及其控制方法和力控制参数的调整方法
US12070862B2 (en) 2020-11-26 2024-08-27 Seiko Epson Corporation Robot system, control method for robot system, and adjustment method for force control parameters in robot system

Also Published As

Publication number Publication date
EP2896487A1 (en) 2015-07-22
JPWO2014037999A1 (ja) 2016-08-08
CN104602873A (zh) 2015-05-06
US20150174760A1 (en) 2015-06-25
CN104602873B (zh) 2016-07-06
JP5971342B2 (ja) 2016-08-17

Similar Documents

Publication Publication Date Title
JP5971342B2 (ja) ロボットの制御パラメータ調整方法、ロボットシステム、及びロボット制御装置
US9764462B2 (en) Robot apparatus and robot controlling method
CN107848113B (zh) 机器人系统及其运转方法
JP6696627B2 (ja) ロボットの動作調整装置
US20160091886A1 (en) Numerical control device
JP5890473B2 (ja) モータを制御するモータ制御装置
CN109954955B (zh) 机器人系统
JP5893664B2 (ja) 作用された力に応じて移動されるロボットを制御するロボット制御装置
JPWO2011111088A1 (ja) 数値制御装置及び数値制御装置の制御方法
US20130006394A1 (en) Numerical control device and numerical control method
JP2011110688A (ja) ロボットの教示装置、及びロボットの制御装置
JP2010231575A (ja) ロボットのオフライン教示装置、ロボットのオフライン教示方法、及びロボットシステム
US20190022859A1 (en) Robot apparatus, control method for the robot apparatus, assembly method using the robot apparatus, and recording medium
JP5980977B1 (ja) 絶対位置検出器を使用した機械座標値の再確立を行う数値制御装置
KR20180114837A (ko) 로봇의 이동 속도 제어 장치 및 방법
JP2020131314A (ja) ロボットの制御装置およびロボットの制御方法
JP6088601B2 (ja) 走行軸付きロボットにおけるツール先端の振れを抑制するロボット制御装置
JP5347421B2 (ja) 工作機械の数値制御装置およびｎｃデータ解析装置
JP2013158837A (ja) ロボット制御装置、およびロボット制御方法
JP6539989B2 (ja) ロボット制御装置
JP6429977B2 (ja) ロボット装置及びロボット制御方法
JP4528577B2 (ja) 工業用ロボット
WO2022244437A1 (ja) ロボットコントローラ、制御方法および制御プログラム
JP2008225632A (ja) Ｎｃ制御のサーボ駆動装置
JP7426333B2 (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: 12884342

Country of ref document: EP

Kind code of ref document: A1

ENP Entry into the national phase

Ref document number: 2014534068

Country of ref document: JP

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

REEP Request for entry into the european phase

Ref document number: 2012884342

Country of ref document: EP

WWE Wipo information: entry into national phase

Ref document number: 2012884342

Country of ref document: EP