WO2017006636A1 - ロボットアームの制御システム - Google Patents
ロボットアームの制御システム Download PDFInfo
- Publication number
- WO2017006636A1 WO2017006636A1 PCT/JP2016/065125 JP2016065125W WO2017006636A1 WO 2017006636 A1 WO2017006636 A1 WO 2017006636A1 JP 2016065125 W JP2016065125 W JP 2016065125W WO 2017006636 A1 WO2017006636 A1 WO 2017006636A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- torque
- robot arm
- control
- motor
- external force
- 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
Links
Images
Classifications
-
- 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/1628—Program controls characterised by the control loop
- B25J9/1633—Program 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
- 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/0008—Balancing devices
-
- 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/06—Safety devices
- B25J19/068—Actuating means with variable stiffness
-
- 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
- B25J9/1676—Avoiding collision or forbidden zones
-
- 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/37—Measurements
- G05B2219/37624—Detect collision, blocking by measuring change of velocity or torque
-
- 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/39322—Force and position 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/40201—Detect contact, collision with human
-
- 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/41—Servomotor, servo controller till figures
- G05B2219/41259—Coupling, clutch
-
- 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/50—Machine tool, machine tool null till machine tool work handling
- G05B2219/50196—Monitor clutch or belt drive
Definitions
- the present invention relates to a robot arm control system, and more particularly to a robot arm control system capable of performing position control and force control of a robot arm in consideration of safety by simple arithmetic processing.
- a compliance function is required to alleviate the collision when the robot unexpectedly collides with a person or object in the environment while performing a desired motion.
- a compliance function generally, a robot arm or the like that is a movable part of the robot is attached with an elastic element such as a spring for shock reduction at the time of collision.
- an elastic element such as a spring for shock reduction at the time of collision.
- the spring is used for cushioning, for example, it is necessary to adjust the elasticity of the spring during the operation of the robot, such as increasing the cushioning by weakening the spring at the time of collision. It becomes one factor to make it difficult.
- an elastic element such as a spring not only makes it difficult to speed up the acceleration operation of the robot, but also causes vibrations during the operation of the robot.
- Patent Document 1 discloses a robot having a collision torque buffering mechanism that releases a force acting on an object or the like when the robot hand collides with another object or the like with an external force larger than a predetermined magnitude. Yes.
- This collision torque buffering mechanism fills the connecting portion between the robot hand side and the robot arm side with a lubricant, and even if a certain amount of external force acts on the robot arm side due to the viscosity of the lubricant, the robot hand side The robot arm side is kept connected, but when an external force exceeding that level is applied, the robot hand side and the robot arm side are allowed to rotate relative to each other so that the force acting on the object can be buffered. It has become.
- the torque value that allows relative rotation between the robot hand side and the robot arm side is determined by the viscosity of the lubricant and is set to a constant value for each product. Therefore, in order to make the torque value variable according to the operation mode of the robot, for example, the torque transmitted from the robot arm side operated by a motor or the like to the robot hand side is electrically applied to the configuration of Patent Document 1.
- an electromagnetic clutch that connects the robot hand side and the robot arm side may be used instead. However, in this case, it is necessary to maintain the connection state between the robot hand side and the robot arm side from the viewpoint of safety even when the power supply to the electromagnetic clutch is stopped. Countermeasures are required.
- the present invention has been devised in order to solve such problems, and the object of the present invention is to control a robot arm that can realize position control and force control of the robot arm in consideration of safety with a simple configuration. To provide a system.
- the present invention mainly includes a robot arm that is movable in a predetermined space, a motor that operates the robot arm, and a transmission torque transmitted from the motor to the robot arm.
- a robot arm control system comprising a torque adjustment device that operates in an adjustable manner, and a control device that controls the operation of the robot arm
- the robot arm is provided with a gravity compensation mechanism for canceling the influence of gravity by the robot arm
- the control device adopts a configuration in which the adjustment of the transmission torque by the torque adjusting device is instructed without considering the influence of the gravity of the robot arm.
- the torque adjusting device provided to be able to adjust the transmission torque transmitted from the motor to the robot arm and the gravity compensation mechanism for canceling the influence of the gravity of the robot arm are used in combination.
- the position adjustment and the adjustment of the transmission torque by the torque adjustment device can be performed by simple arithmetic processing that does not consider the influence of the gravity of the robot arm.
- the robot arm position control is performed by motor drive adjustment without complicatedly relating the robot arm position adjustment and force adjustment, and the robot arm force control considering compliance and the like is performed by a torque adjustment device. This can be done by adjusting the transmission torque, and the robot arm position control and force control can be performed simply.
- FIG. 1 is a block diagram schematically showing the configuration of a control system for a robot arm according to an embodiment. The block diagram similar to FIG. 1 which concerns on a modification.
- FIG. 1 is a block diagram schematically showing the configuration of the robot arm control system according to the present embodiment.
- the control system 10 is provided so as to be movable in a predetermined space, a robot arm 11 for performing a predetermined work in the space, a robot arm 11, and the gravity of the robot arm 11.
- the gravity compensation mechanism 12 that cancels the influence, the motor 14 that is rotationally driven as the power of the robot arm 11, and the robot 14 is arranged between the robot arm 11 and the motor 14, and the transmission torque transmitted from the motor 14 to the robot arm 11 is adjusted.
- the torque adjustment device 16 that operates as possible, the sensor 17 that detects the displacement state of the input side and the output side of the torque adjustment device 16, and the control device 19 that controls the operation of the robot arm 11 are configured.
- the gravity compensation mechanism 12, the motor 14, the torque adjustment device 16, and the sensor 17 are provided in the vicinity of the robot arm 11, such as the joint portion and the periphery thereof.
- the robot arm 11 comprises a known power transmission mechanism that can move within a predetermined space while rotating the joint portion by the power from the motor 14. Since the detailed structure of the robot arm 11 is not an essential part of the present invention, illustration and detailed description of the structure are omitted. Note that the robot arm 11 has a cantilevered multi-joint type structure having an object gripping portion at the tip, and an object (grip object) gripped by the gripping portion in a predetermined space by a previously commanded operation. A movable configuration can be exemplified.
- the gravity compensation mechanism 12 is a known mechanism that can be adjusted so as to cancel the influence on the gravity of the entire robot arm 11 including the weight of the grasped object in its own weight.
- a spring balance type gravity compensation mechanism having a link structure using a spring is employed.
- the gravity compensation mechanism 12 in addition to the one in which the tension of the spring is adjusted in advance so as to compensate the weight of only the robot arm 11, the weight compensation mechanism including the weight of the gripped object is performed.
- An adjustable self-weight compensation mechanism is employed in which the tension of the spring can be dynamically adjusted according to the weight of the grasped object.
- the gravitational compensation mechanism 12 having various structures can be adopted as long as the same action can be achieved, such as a counterweight type.
- the torque adjustment device 16 connects the robot arm 11 side and the motor 14 side, and when the torque adjustment device 16 is equal to or less than a predetermined torque limit value, the input torque input from a rotating shaft (not shown) on the motor 14 side and the robot arm 11. While the output torque value output to the rotating shaft (not shown) on the side is made the same, the output torque value is made smaller than the input torque value when the torque limit value is exceeded. .
- the torque limit value can be adjusted by a command from the control device 19.
- the control device 19 has a predetermined function based on a relationship between a control command value such as current and voltage to the torque adjusting device 16 and an output torque with respect to an input torque including a torque limit value based on a preset model. Is remembered as
- the torque adjusting device 16 is constituted by a clutch, and is connected to the motor 14 side and is rotatable by being driven by the motor 14 and connected to the robot arm 11 side. And an output unit 22 provided between the input unit 21 and the output unit 22, and a transmission unit 23 provided to transmit power from the input unit 21 to the output unit 22. .
- the output unit 22 rotates integrally with the input unit 21 when the input torque due to the rotation of the input unit 21 is equal to or less than the torque limit value controlled by the control device 19, while the input torque is the torque limit. When the value is exceeded, a slip operation that allows relative rotation with respect to the input unit 21 occurs.
- a friction clutch that electrically adjusts the frictional force of the transmission unit 23, or the transmission unit 23 is made of a magnetic fluid, and the viscosity of the magnetic fluid is adjusted electrically.
- various clutches, torque limiters, brakes, and the like can be used as long as the transmission torque from the input unit 21 to the output unit 22 can be adjusted as described above.
- the clutch can adjust the transmission torque by further considering the static frictional force and dynamic frictional force in the transmission unit 23, and the relative rotational speeds of the input unit 21 and the output unit 22 during the slip operation of the torque adjusting device 16 By further considering the slip speed, it is possible to employ one that can adjust the transmission torque.
- the sensor 17 is not particularly limited as long as it can detect information for performing control described later by the control device 19.
- encoders provided on the input and output sides of the torque adjusting device 16 are used as the sensors 17.
- the input-side encoder 17A disposed on the input side of the torque adjusting device 16 detects the rotational angular displacement of the input unit 21, while the output-side encoder 17B disposed on the same output side detects the rotational angular displacement of the output unit 22.
- the detection values of the encoders 17A and 17B are sequentially transmitted to the control device 19.
- the control device 19 is constituted by a computer including an arithmetic processing device such as a CPU and a storage device such as a memory and a hard disk, and the operation control of the torque adjusting device 16 is performed without considering the influence of gravity by the robot arm 11. Is supposed to do. Further, here, the control in the first control mode for controlling the position of the robot arm 11 in consideration of safety and the control of the force of the robot arm 11 by adjusting the magnitude of the output torque with respect to the input torque are performed. The torque adjustment device 16 adjusts the transmission torque based on the selection of either control in the second control mode.
- the control device 19 includes a setting unit 25 that artificially and / or automatically sets a target operation and an operation mode of the robot arm 11, a motor control unit 26 that controls the drive of the motor 14, and a torque adjustment device 16.
- a clutch control means 27 for performing operation control is provided.
- the motor control means 26 specifies the target position of the robot arm 11 over time according to the target action of the robot arm 11 set by the setting means 25, so that the target rotation value of the joint part of the robot arm 11 with respect to time ( Target rotation angle, target rotation speed, and target rotation acceleration). Further, the rotation angle from the output-side encoder 17B corresponding to the current position information of the robot arm 11 is fed back, and the target rotation value of the robot arm 11, the current position information, and a known inertia tensor of the robot arm 11 and the like. Then, a target torque, which is an output torque from the torque adjusting device 16 required by the rotation operation of the robot arm 11, is obtained by calculation. Then, a drive command is issued to the motor 14 so that the target torque is obtained, and the position control of the robot arm 11 is performed.
- the torque limit value of the torque adjusting device 16 is adjusted as follows.
- a torque slightly larger than the target torque corresponding to the driving of the motor 14 determined by the position control of the robot arm 11 is applied to the torque adjusting device 16, the relative of the output unit 22 with respect to the input unit 21.
- the torque limit value is determined so as to allow rotation and cause the torque adjusting device 16 to slip. That is, the torque limit value is obtained by multiplying the target torque by a predetermined gain, and the operation of the torque adjusting device 16 is adjusted based on the above-described model so that the slip operation occurs at the torque limit value.
- the torque limit value here is set slightly larger than the target torque in consideration of the addition of the model error, electrical noise, and the like.
- the robot arm 11 In the first control mode, when the robot arm 11 is moved to a desired position, the robot arm 11 is unexpectedly moved when an object such as a person or an obstacle in the environment is not in contact with or collides with the robot arm 11.
- the input unit 21 rotates with the target torque determined based on the above-described position control. Since the target torque is lower than the torque limit value set in this mode, the input unit 21 and the output unit 22 rotate together, so that the target torque value substantially matches the output torque value. Is transmitted from the unit 22 to the robot arm 11 and desired position control of the robot arm 11 is performed.
- the robot arm 11 when an external force is applied to the robot arm 11 due to a collision of a person or an object, the robot arm 11 does not reach a predetermined position, and the robot arm 11 is moved by position control based on feedback of position information of the robot arm 11. In order to promote, the driving torque of the motor 14 is increased. However, the value of the input torque to the input unit 21 that increases with this exceeds the set torque limit value, so that the torque adjusting device 16 performs a slip operation, and the increased input torque is applied to the robot arm. 11 is not transmitted as it is, and the robot arm 11 can mitigate the impact given to a person or an object.
- the torque adjusting device 16 when the robot arm 11 unexpectedly collides with a person or an object in the environment during the position control of the robot arm 11, the torque adjusting device 16 is caused to perform a slip operation.
- the impact force at the time of collision can be alleviated, and the safety during operation of the position-controlled robot arm 11 can be ensured.
- torque transmission from the input unit 21 to the output unit 22 can be interrupted, and the output unit 22 can be freely rotated according to an external force.
- the motor control unit 26 controls the position of the robot arm 11 in the same procedure as in the first control mode.
- the clutch control unit 27 controls the robot arm 11 in the environment.
- the operation of the torque adjusting device 16 is controlled so that a desired torque is output from the robot arm 11 even when the person or object is touched.
- a torque limit value lower than the input torque value to the input unit 21 by driving the motor 14 is set, and the torque adjusting device 16 can perform the slip operation.
- an electrical command based on the model is given to the transmission unit 23, and the output torque of the output unit 22 connected to the robot arm 11 is changed to an input unit by the action of the transmission unit 23 such as viscosity adjustment and friction increase / decrease.
- the desired force control is performed on the robot arm 11 by adjusting to a desired value within a range lower than the input torque 21.
- the setting unit 25 sets a desired operation state of the robot arm 11 when it contacts a person or an object
- the target torque at the time of the rotation operation of the robot arm 11 corresponding to the operation state is specified.
- the clutch control means 27 a command is given to the torque adjustment device 16 so that the output torque of the output unit 22 becomes substantially the same value as the target torque, and the robot arm 11 rotates with the target torque. It will be.
- the slip speed of the torque adjusting device 16 is obtained based on the detected values from the input side encoder 17A and the output side encoder 17B, and based on the slip speed, the actual robot arm 11 is actually operated.
- the operation control of the torque adjusting device 16 may be performed.
- a configuration may be adopted in which a torque sensor capable of measuring the actual torque value of the robot arm 11 is provided and the measured value is fed back to the clutch control means 27.
- the clutch control means 27 calculates the slip speed obtained from the detected values from the input side encoder 17A and the output side encoder 17B. In consideration of the slip speed, the torque adjusting device 16 is controlled so that the robot arm 11 operates at the target torque.
- the robot arm 11 In the second control mode, for example, even when an obstacle comes into contact with the robot arm 11 as in the case where the robot arm 11 is used for crushing a building, the robot arm 11 is brought into a desired position as it is.
- the torque adjustment device 16 has a hard state in which the connection state between the input unit 21 and the output unit 22 is strengthened so as to reduce the loss of torque transmitted from the input unit 21 to the output unit 22.
- the input unit 21 and the output unit are connected to the torque adjustment device 16 so as to increase the loss of torque transmitted from the input unit 21 to the output unit 22.
- 22 is set to a soft state in which the connection state is weakened.
- various control modes by the control device 19 can be adopted.
- a rehabilitation robot for a human having a movement disorder an external force is applied to the robot arm 11 by using a body part such as an arm or a leg in which the motor 14 is not driven, without driving the motor 14.
- the operation of the torque adjusting device 16 may be adjusted so as to change the strength of the connection state between the input unit 21 and the output unit 22 according to the degree of recovery.
- the target torque can be determined.
- the power transmission by the torque adjusting device 16 is cut off, and when the motor 14 reaches a certain number of rotations.
- the power transmission by the torque adjusting device 16 can be gradually performed.
- an external force that detects an external force acting on the robot arm 11 based on the operation of the torque adjustment device 16 with respect to the configuration of the embodiment.
- a detection device 35 may be further provided.
- the external force detection device 35 may be provided in the same computer as the computer of the control device 19 or may be provided separately.
- control in the third control mode for controlling the operation of the motor 14 and the torque adjusting device 16 can be further selected for the external force detection by the external force detection device 35.
- the torque adjusting device 16 is slipped, and the external force acting on the robot arm 11 and the weight of the grasped object can be obtained by any one of the following first to third methods.
- the motor control means 26 and the clutch control means 27 do not change the rotation state of the input unit 21 from the state where the input unit 21 and the output unit 22 of the torque adjustment device 16 rotate integrally. Operation control of the motor 14 and the torque adjusting device 16 is performed so as to gradually decrease the torque limit value. Then, in the external force detection device 35, when the relative rotation of the input unit 21 and the output unit 22 is started, that is, from the torque limit value when the slip operation of the torque adjusting device 16 is started, the external force is calculated as follows. It comes to ask for.
- the torque limit value at this time can be specified from the model by detecting a control command value such as a current or a voltage added to the clutch control means 27, and is equal to the total acting torque value acting on the entire robot arm 11 at the present time. . Further, the size and inertia tensor of the robot arm 11 are known, and the rotation angle, rotation angular velocity, rotation angle acceleration, etc. of the robot arm 11 are specified based on the detection of the output side encoder 17B, and by calculation using these, An internal torque value by the operation of the robot arm 11 itself is obtained. Therefore, by subtracting the internal torque value from the torque limit value corresponding to the total applied torque value, an external torque value generated by the robot arm 11 coming into contact with the outside is obtained. Then, the external force and the weight of the gripping object are obtained by calculation from the external torque value.
- a control command value such as a current or a voltage added to the clutch control means 27, and is equal to the total acting torque value acting on the entire robot arm 11 at the present time. .
- the motor control unit 26 and the clutch control unit 27 control the operation of the motor 14 and the torque adjustment device 16 so that the torque adjustment device 16 performs a slip operation while maintaining the rotation state of the input unit 21. Is done.
- the slip speed of the torque adjusting device 16 changes, and the output side encoder 17B rotates the rotation angle of the robot arm 11 at that time. Acceleration is detected.
- the total applied torque value is calculated from the rotational angular acceleration of the robot arm 11 and the known moment of inertia of the robot arm 11, and the internal torque is calculated from the total applied torque value as in the first method.
- the external torque value is obtained by subtracting the value, and the external force and the weight of the grasped object are obtained.
- the motor control unit 26 and the clutch control unit 27 control the operation of the motor 14 and the torque adjustment device 16 so that the torque adjustment device 16 performs a slip operation while maintaining the rotation state of the input unit 21. Is done. Then, when the torque limit value and the total action torque value are in an equilibrium state and the slip speed of the torque adjusting device 16 becomes constant, the torque limit value at this time is specified as the total action torque value, The external torque value is obtained in the same manner as the method, and the external force and the weight of the grasped object are obtained.
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Human Computer Interaction (AREA)
- Manipulator (AREA)
Abstract
本発明に係る制御システム10は、所定の空間内で移動可能に設けられたロボットアーム11と、ロボットアーム11を動作させるモータ14と、モータ14からロボットアーム11に伝達される伝達トルクを調整可能に動作するトルク調整装置16と、ロボットアーム11の動作制御を行う制御装置19とを備えている。ロボットアーム11には、ロボットアーム11による重力の影響をキャンセルする重力補償機構12が設けられており、制御装置19では、ロボットアーム11の重力の影響を考慮せずに、トルク調整装置16での伝達トルクの調整を指令するようになっている。
Description
本発明は、ロボットアームの制御システムに係り、更に詳しくは、簡単な演算処理により、安全性を考慮したロボットアームの位置制御及び力制御を行うことのできるロボットアームの制御システムに関する。
ロボットと人間とが共生する環境下においては、当該環境に対するロボットの安全対策が重要になる。この安全対策として、ロボットが所望の動作を行っている最中に環境中の人間や物体に不意に衝突した場合に、当該衝突を緩和するコンプライアンス機能が必要になる。当該コンプライアンス機能としては、ロボットの可動部であるロボットアーム等に衝突時の衝撃緩和用のばね等の弾性要素を取り付けたものが一般的である。しかしながら、当該ばねを衝撃緩和用として用いる場合、例えば、衝突時にばねを弱めることでクッション性を高める等、ロボットの動作中にばねの弾性を調整する必要があり、このことがロボットアームの位置制御を難しくする一要因になる。また、ばね等の弾性要素は、ロボットの加速動作をスピーディーにしにくくするばかりか、ロボットの動作時における振動発生要因にもなる。
ところで、特許文献1には、ロボットハンドが所定以上の大きさの外力で他の物体等に衝突した際に、当該物体等に作用する力を逃がす衝突トルク緩衝機構を備えたロボットが開示されている。この衝突トルク緩衝機構は、ロボットハンド側とロボットアーム側との間の接続部分に潤滑剤を充填し、当該潤滑剤の粘性によって、ロボットアーム側にある程度までの外力が作用してもロボットハンド側とロボットアーム側の連結状態を維持する一方で、それを超える外力が作用したときに、ロボットハンド側とロボットアーム側の相対回転を許容することで、衝突時に物体に作用する力を緩衝するようになっている。
前記特許文献1の衝突トルク緩衝機構において、ロボットハンド側とロボットアーム側の相対回転を許容するトルク値は、潤滑剤の粘性によって決まり、製品毎に一定値に設定される。そこで、ロボットの動作モードに応じて、前記トルク値を可変にするには、特許文献1の構成に対し、例えば、モータ等によって動作するロボットアーム側からロボットハンド側に伝達されるトルクを電気的に調整可能となるように、ロボットハンド側とロボットアーム側とを接続する電磁クラッチを代替的に用いることも考えられる。しかしながら、この場合、電磁クラッチへの給電が停止したときでも、安全上の観点から、ロボットハンド側とロボットアーム側との間の接続状態を維持する必要があり、このために更なる構造上の対策が必要になる。また、電磁クラッチへの動作指令に際し、前記トルク値を所望の状態に制御するために、ロボットの動作に基づく物理的演算が必要となるが、ロボットの自重の影響を考慮したモーメント計算、すなわち、ロボットの姿勢や動作に応じて異なる煩雑な演算が必要になり、ロボットの位置制御や力制御が非常に難しくなるという問題がある。
本発明は、このような課題を解決するために案出されたものであり、その目的は、簡単な構成で、安全性を考慮したロボットアームの位置制御や力制御を実現できるロボットアームの制御システムを提供することにある。
前記目的を達成するため、主として、本発明は、所定の空間内で移動可能に設けられたロボットアームと、当該ロボットアームを動作させるモータと、当該モータから前記ロボットアームに伝達される伝達トルクを調整可能に動作するトルク調整装置と、前記ロボットアームの動作制御を行う制御装置とを備えたロボットアームの制御システムにおいて、
前記ロボットアームには、当該ロボットアームによる重力の影響をキャンセルする重力補償機構が設けられ、
前記制御装置では、前記ロボットアームの重力の影響を考慮せずに、前記トルク調整装置での伝達トルクの調整を指令する、という構成を採っている。
前記ロボットアームには、当該ロボットアームによる重力の影響をキャンセルする重力補償機構が設けられ、
前記制御装置では、前記ロボットアームの重力の影響を考慮せずに、前記トルク調整装置での伝達トルクの調整を指令する、という構成を採っている。
本発明によれば、モータからロボットアームに伝達される伝達トルクを調整可能に設けられたトルク調整装置と、ロボットアームの重力の影響をキャンセルする重力補償機構とを併用したことから、ロボットアームの位置調整と、トルク調整装置による伝達トルクの調整とを、ロボットアームの重力の影響を考慮しない簡単な演算処理により行うことができる。また、ロボットアームの位置調整と力調整とを複雑に関連させることなく、ロボットアームの位置制御は、モータの駆動調整にて行い、コンプライアンス等を考慮したロボットアームの力制御は、トルク調整装置による伝達トルクの調整にて行うことができ、ロボットアームの位置制御と力制御をシンプルに行うことができる。更に、トルク調整装置により、モータとロボットアームとの接続状態を意図的にスリップ可能にすることで、ロボットアームに作用した外力や、ロボットアームで把持している物体の重量を検出することも可能となる。また、重力補償機構により、ロボットアームの重量が補償されるため、重力補償機構が無い場合に比べ、トルク調整装置でのトルクリミット値を同一条件下で小さくすることができる。
以下、本発明の実施形態について図面を参照しながら説明する。
図1には、本実施形態に係るロボットアームの制御システムの構成を概略的に表したブロック図が示されている。この図において、前記制御システム10は、所定の空間内で移動可能に設けられ、当該空間内で所定の作業を行うためのロボットアーム11と、ロボットアーム11に設けられ、ロボットアーム11による重力の影響をキャンセルする重力補償機構12と、ロボットアーム11の動力として回転駆動するモータ14と、ロボットアーム11とモータ14との間に配置され、モータ14からロボットアーム11に伝達される伝達トルクを調整可能に動作するトルク調整装置16と、トルク調整装置16の入力側と出力側の変位状態を検出するセンサ17と、ロボットアーム11の動作制御を行う制御装置19とを備えて構成されている。なお、特に限定されるものではないが、重力補償機構12、モータ14、トルク調整装置16、センサ17は、その関節部分やその周囲等、ロボットアーム11の近傍に設けられている。
前記ロボットアーム11は、モータ14からの動力により、関節部分を回転運動させながら所定の空間内で移動可能にする公知の動力伝達機構からなる。当該ロボットアーム11の詳細な構造については、本発明の本質部分ではないため、構造の図示及び詳細な説明を省略する。なお、ロボットアーム11としては、先端に物体の把持部を備えた片持ち状の多関節型の構造により、予め指令した動作によって、前記把持部で把持した物体(把持物体)を所定空間内で移動可能な構成を例示できる。
前記重力補償機構12は、ロボットアーム11の自重に前記把持物体の重量を含めたロボットアーム11全体の重力への影響をキャンセルするように調整可能な公知の機構からなる。本実施形態では、ばねを使ったリンク構造からなるスプリングバランス式の重力補償機構が採用されている。ここでの重力補償機構12としては、ロボットアーム11のみの自重を補償するように、ばねの張力が事前に調整されるものの他に、前記把持物体の重量も含めた自重補償を行う場合には、ばねの張力が把持物体の重量に応じて動的に調整可能なアジャスタブル自重補償機構が採用される。その他、本発明はこれに限定されるものではなく、カウンターウエイト式のもの等、同一の作用を奏する限りにおいて、種々の構造の重力補償機構12を採用することができる。
前記トルク調整装置16は、ロボットアーム11側とモータ14側とを連結するとともに、所定のトルクリミット値以下のときに、モータ14側の図示しない回転軸から入力された入力トルクと、ロボットアーム11側の図示しない回転軸に出力される出力トルクの値とを同一にする一方、前記トルクリミット値を超えたときに、前記入力トルクの値よりも前記出力トルクの値を小さくするように動作する。また、前記トルクリミット値は、制御装置19からの指令によって調整可能になっている。ここで、制御装置19には、予め設定されたモデルに基づき、トルク調整装置16への電流や電圧等の制御指令値と、トルクリミット値を含む入力トルクに対する出力トルクとの関係が所定の関数として記憶されている。
本実施形態において、前記トルク調整装置16は、クラッチにより構成されており、モータ14側に繋がってモータ14の駆動によって回転可能に設けられた入力部21と、ロボットアーム11側に繋がって回転可能に設けられた出力部22と、これら入力部21と出力部22との間に配置されるとともに、入力部21から出力部22に動力を伝達可能に設けられた伝達部23とを備えている。
前記出力部22は、入力部21の回転による入力トルクが、制御装置19で制御されたトルクリミット値以下のときに、当該入力部21と一体的に回転する一方、前記入力トルクが前記トルクリミット値を超えたときに、入力部21に対する相対回転を許容するスリップ動作が発生する。なお、トルク調整装置16としては、例えば、伝達部23の摩擦力の調整を電気的に行う摩擦クラッチや、伝達部23を磁性流体によって構成し、当該磁性流体の粘性の調整を電気的に行う磁性流体クラッチを採用できる他、入力部21から出力部22への伝達トルクを前述のように調整できる限りにおいて、種々のクラッチ、トルクリミッタ、ブレーキ等を採用することができる。特に、クラッチとしては、伝達部23での静摩擦力や動摩擦力を更に考慮して伝達トルクを調整できるものや、トルク調整装置16のスリップ動作時における入力部21と出力部22の相対回転速度となるスリップ速度を更に考慮することで、伝達トルクを調整できるもの等を採用することができる。
前記センサ17としては、制御装置19による後述の制御を行うための情報を検出可能なものであれば、特に限定されるものではない。本実施形態においては、センサ17として、トルク調整装置16の入出力側それぞれに設けられたエンコーダが用いられている。トルク調整装置16の入力側に配置された入力側エンコーダ17Aは、入力部21の回転角度変位を検出する一方、同出力側に配置された出力側エンコーダ17Bは、出力部22の回転角度変位を検出するようになっており、各エンコーダ17A、17Bの検出値は、制御装置19に逐次伝送される。
前記制御装置19は、CPU等の演算処理装置及びメモリやハードディスク等の記憶装置等からなるコンピュータによって構成されており、ロボットアーム11による重力の影響を考慮せずに、トルク調整装置16の動作制御を行うようになっている。また、ここでは、安全性を考慮したロボットアーム11の位置制御を行う第1の制御モードによる制御と、入力トルクに対する出力トルクの大きさを調整することで、ロボットアーム11の力制御を行う第2の制御モードによる制御との何れかの選択に基づいて、トルク調整装置16による伝達トルクの調整が行われる。
この制御装置19は、ロボットアーム11の目標動作や動作モード等を人為的及び/又は自動的に設定する設定手段25と、モータ14の駆動制御を行うモータ制御手段26と、トルク調整装置16の動作制御を行うクラッチ制御手段27とを備えて構成されている。
前記第1の制御モードでは、次の制御が行われる。
前記モータ制御手段26では、設定手段25によって設定されたロボットアーム11の目標動作に応じ、ロボットアーム11の経時的な目標位置を特定するため、時間に対するロボットアーム11の関節部分の目標回転値(目標回転角度、目標回転速度、及び目標回転加速度)が求められる。更に、ロボットアーム11の現在位置情報に対応する出力側エンコーダ17Bからの回転角度がフィードバックされ、ロボットアーム11の前記目標回転値と前記現在位置情報と、ロボットアーム11等の既知の慣性テンソルとから、ロボットアーム11の回転動作で要求されるトルク調整装置16からの出力トルクである目標トルクが演算によって求められる。そして、当該目標トルクが得られるように、モータ14に駆動指令が行われ、ロボットアーム11の位置制御が行われる。
前記クラッチ制御手段27では、次のように、トルク調整装置16の前記トルクリミット値が調整される。ここでは、前述のロボットアーム11の位置制御によって決定されたモータ14の駆動に対応した前記目標トルクよりも若干大きなトルクがトルク調整装置16に作用した時点で、入力部21に対する出力部22の相対回転を許容し、トルク調整装置16をスリップ動作させるように、トルクリミット値が決定される。すなわち、前記目標トルクに対して所定のゲインを乗じてトルクリミット値が求められ、当該トルクリミット値でスリップ動作が発生するように、前述したモデルに基づいて、トルク調整装置16の動作が調整される。ここでのトルクリミット値は、前記モデルの誤差や電気的なノイズ等の付加を考慮して、前記目標トルクよりも若干大きく設定される。
この第1の制御モードでは、所望の位置にロボットアーム11を動作させる際に、環境中の人間や障害物等の物体がロボットアーム11に接触、衝突していないとき等、ロボットアーム11に不意の外力が付加されていない場合には、前述の位置制御に基づいて決定された目標トルクで入力部21が回転する。当該目標トルクは、このモードで設定されたトルクリミット値よりも低いため、入力部21と出力部22が一体回転することで、目標トルクの値が出力トルクの値にほぼ一致した状態で、出力部22からロボットアーム11に伝達され、ロボットアーム11の所望の位置制御がなされる。一方で、人間や物体の衝突によってロボットアーム11に外力が付加されると、ロボットアーム11が予定の位置に達しなくなり、ロボットアーム11の位置情報のフィードバックによる位置制御により、ロボットアーム11の移動を促進させるためにモータ14の駆動トルクを増加させてしまう。ところが、これに伴って増加した入力部21への入力トルクの値は、設定されたトルクリミット値を超えてしまうことになって、トルク調整装置16がスリップ動作し、増加した入力トルクがロボットアーム11側にそのまま伝達されなくなり、ロボットアーム11によって人間や物体に与える衝撃を緩和させることが可能になる。
以上の第1のモードによれば、ロボットアーム11の位置制御を行う過程で、ロボットアーム11が不意に環境中の人間や物体等に衝突したときに、トルク調整装置16をスリップ動作させることで、衝突時における衝撃力を緩和し、位置制御されたロボットアーム11の動作時の安全性を確保することができる。なお、トルク調整装置16のスリップ動作を検出したときに、入力部21から出力部22へのトルク伝達を遮断し、出力部22を外力に応じてフリー回転させることもできる。
前記第2の制御モードでは、次の制御が行われる。
第2の制御モードが選択されると、モータ制御手段26では、第1の制御モードと同様の手順でロボットアーム11の位置制御が行われるが、クラッチ制御手段27では、ロボットアーム11が環境中の人間や物体に接触したときでも、ロボットアーム11から所望のトルクを出力させるように、トルク調整装置16の動作を制御する。このとき、クラッチ制御手段27では、モータ14の駆動による入力部21への入力トルク値よりも低いトルクリミット値が設定され、トルク調整装置16がスリップ動作可能になる。その上で、伝達部23に対して前記モデルに基づく電気的な指令がなされ、粘性調整や摩擦増減等の伝達部23の作用により、ロボットアーム11に繋がる出力部22の出力トルクが、入力部21の入力トルクよりも低い範囲内での所望の値に調整され、ロボットアーム11に対して所望とする力制御が行われる。換言すると、設定手段25において、人間や物体に接触したときのロボットアーム11の所望の動作状態が設定されると、当該動作状態に応じたロボットアーム11の回転動作時における目標トルクが特定される。そして、前記クラッチ制御手段27では、出力部22の出力トルクが前記目標トルクとほぼ同一の値になるように、トルク調整装置16に指令がなされ、ロボットアーム11は、前記目標トルクで回転動作することになる。
この第2の制御モードでは、入力側エンコーダ17Aと出力側エンコーダ17Bからの検出値に基づき、トルク調整装置16のスリップ速度を求め、当該スリップ速度に基づき、実際のロボットアーム11の動作時における実トルク値を特定し、当該実トルク値をクラッチ制御手段27にフィードバックした上で、トルク調整装置16の動作制御を行っても良い。また、この場合、ロボットアーム11の前記実トルク値を計測可能なトルクセンサを設け、その計測値をクラッチ制御手段27にフィードバックする構成を採用することもできる。
また、トルク調整装置16として、前記スリップ速度に応じて伝達トルクが変化する性質のものを採用した場合、入力側エンコーダ17Aと出力側エンコーダ17Bからの検出値から求めたスリップ速度をクラッチ制御手段27に入力し、スリップ速度をも考慮して、ロボットアーム11が前記目標トルクで動作するように、トルク調整装置16が制御される。
この第2の制御モードでは、例えば、ロボットアーム11を使って建築物の破砕作業を行わせるときのように、ロボットアーム11に障害物が接触しても、ロボットアーム11をそのまま所望に位置に移動させるような条件を設定した場合、入力部21から出力部22への伝達トルクの損失を小さくするように、トルク調整装置16について、入力部21と出力部22の連結状態を強くした固い状態に設定される。一方、ティーチング動作等、ロボットアーム11を外力によって動かし易くしたい場合には、入力部21から出力部22への伝達トルクの損失を大きくするように、トルク調整装置16について、入力部21と出力部22の連結状態を弱くした柔らかい状態に設定される。
なお、本実施形態においては、制御装置19による種々の制御モードを採用することもできる。例えば、運動障害を生じている人間のリハビリ用ロボットとして、モータ14を駆動させずに、障害が生じている腕や脚等の体部位を使ってロボットアーム11に外力を与え、障害の程度や回復度に応じ、入力部21と出力部22の連結状態の強弱を変化させるように、トルク調整装置16の動作調整をしても良い。また、パワーアシストロボットのように、モータ14を駆動させない状態で、人間からロボットアーム11に外力を付加したときに、トルク調整装置16でのスリップ動作の状態から、ロボットアーム11を動作させるモータ14の目標トルクを定めることもできる。更に、モータ14の力を効果的に伝達するために、モータ14の回転開始時においては、トルク調整装置16での動力伝達を遮断した状態にし、モータ14がある程度の回転数になった時点で、トルク調整装置16での動力伝達を徐々に行うようにすることもできる。
次に、前記制御システム10の変形例としては、図2に示されるように、前記実施形態の構成に対し、トルク調整装置16の動作に基づいて、ロボットアーム11に作用する外力を検出する外力検出装置35を更に設けることもできる。この外力検出装置35は、制御装置19のコンピュータと同一のコンピュータに設けても良いし、それぞれ別に設けても良い。
当該変形例における制御装置19では、外力検出装置35での外力検出のために、モータ14とトルク調整装置16の動作制御を行う第3の制御モードによる制御を更に選択可能となっている。
本変形例では、トルク調整装置16をスリップ動作させ、次の第1~第3の何れかの手法によって、ロボットアーム11に作用する外力や把持物体の重量を求めることも可能になっている。
前記第1の手法では、モータ制御手段26及びクラッチ制御手段27により、トルク調整装置16の入力部21と出力部22とが一体回転する状態から、入力部21の回転状態を変化させずに、トルクリミット値を徐々に減少させるように、モータ14及びトルク調整装置16の動作制御が行われる。そして、外力検出装置35では、入力部21と出力部22の相対回転が開始されたとき、すなわち、トルク調整装置16のスリップ動作が始まったときのトルクリミット値から、次のようにして外力を求めるようになっている。このときのトルクリミット値は、クラッチ制御手段27に付加された電流や電圧等の制御指令値の検知によって前記モデルから特定でき、現時点でロボットアーム11全体に作用している総作用トルク値に等しい。また、ロボットアーム11のサイズや慣性テンソルは既知であり、ロボットアーム11の回転角度、回転角速度、回転角加速度等は、出力側エンコーダ17Bの検出に基づいて特定され、これらを用いた演算によって、ロボットアーム11自身の動作による内的トルク値が求められる。そこで、前記総作用トルク値に該当するトルクリミット値から、前記内的トルク値を減算することにより、ロボットアーム11が外部との接触によって発生する外的トルク値が求められる。そして、当該外的トルク値から外力や把持物体の重量が演算によって求められる。
前記第2の手法では、モータ制御手段26及びクラッチ制御手段27により、入力部21の回転状態を維持したまま、トルク調整装置16がスリップ動作するように、モータ14とトルク調整装置16の動作制御が行われる。そして、ロボットアーム11に外力が作用したり、所定の重量の把持物体を保持したときに、トルク調整装置16のスリップ速度が変化し、出力側エンコーダ17Bで、そのときのロボットアーム11の回転角加速度が検出される。外力検出装置35では、ロボットアーム11の回転角加速度とロボットアーム11の既知の慣性モーメントから前記総作用トルク値が演算され、前記第1の手法と同様に、総作用トルク値から前記内的トルク値を減算して前記外的トルク値が求められ、外力や把持物体の重量が求められる。
前記第3の手法では、モータ制御手段26及びクラッチ制御手段27により、入力部21の回転状態を維持したまま、トルク調整装置16がスリップ動作するように、モータ14とトルク調整装置16の動作制御が行われる。そして、トルクリミット値と総作用トルク値とが平衡状態となって、トルク調整装置16のスリップ速度が一定になったときに、このときのトルクリミット値を総作用トルク値として特定し、前記各手法と同様にして前記外的トルク値を求め、外力や把持物体の重量が求められる。
その他、本発明における装置各部の構成は図示構成例に限定されるものではなく、実質的に同様の作用を奏する限りにおいて、種々の変更が可能である。
10 制御システム
11 ロボットアーム
12 重力補償機構
14 モータ
16 トルク調整装置
17 センサ
19 制御装置
21 入力部
22 出力部
23 伝達部
35 外力検出装置
11 ロボットアーム
12 重力補償機構
14 モータ
16 トルク調整装置
17 センサ
19 制御装置
21 入力部
22 出力部
23 伝達部
35 外力検出装置
Claims (6)
- 所定の空間内で移動可能に設けられたロボットアームと、当該ロボットアームを動作させるモータと、当該モータから前記ロボットアームに伝達される伝達トルクを調整可能に動作するトルク調整装置と、前記ロボットアームの動作制御を行う制御装置とを備えたロボットアームの制御システムにおいて、
前記ロボットアームには、当該ロボットアームによる重力の影響をキャンセルする重力補償機構が設けられ、
前記制御装置では、前記ロボットアームの重力の影響を考慮せずに、前記トルク調整装置での伝達トルクの調整を指令することを特徴とするロボットアームの制御システム。 - 前記トルク調整装置は、前記モータ側に繋がって当該モータの駆動により回転可能に設けられた入力部と、前記ロボットアーム側に繋がって回転可能に設けられた出力部と、これら入力部と出力部との間に配置されるとともに、前記入力部から前記出力部に動力を伝達可能に設けられた伝達部とを備え、前記入力部の回転による入力トルクが所定のトルクリミット値以下のときに、前記入力部と前記出力部が一体的に回転して、前記出力部の回転による出力トルクの値を前記入力トルクの値とほほ同一にする一方、前記入力トルクが前記トルクリミット値を超えたときに、前記入力部と前記出力部の相対回転を許容するスリップ動作により、前記出力トルクの値を前記入力トルクの値から低減させるように設けられ、
前記制御装置では、前記ロボットアームの所望の動作モードに応じて、前記伝達トルクを調整するように前記トルク調整装置に指令することを特徴とする請求項1記載のロボットアームの制御システム。 - 前記制御装置では、安全性を考慮した前記ロボットアームの位置制御を行う第1の制御モードによる制御と、前記入力トルクに対する前記出力トルクの大きさを調整することで、前記ロボットアームの力制御を行う第2の制御モードによる制御とを選択可能に設けられ、
前記第1の制御モードでは、前記ロボットアームの位置制御に必要となる前記モータの回転による前記入力トルクよりもやや大きい値を前記トルクリミット値に設定し、
前記第2の制御モードでは、前記ロボットアームの動作における目標トルクが得られるように、前記伝達トルクを調整することを特徴とする請求項2記載のロボットアームの制御システム。 - 前記ロボットアームに作用する外力を検出する外力検出装置を更に備え、
前記制御装置では、前記外力検出装置での外力の検出のために前記モータと前記トルク調整装置の動作制御を行う第3の制御モードによる制御を更に選択可能に設けられ、
前記外力検出装置では、前記第3の制御モードによる制御による前記トルク調整装置のスリップ動作に基づいて、前記外力を求めることを特徴とする請求項3記載のロボットアームの制御システム。 - 前記制御装置では、前記入力部と前記出力部が一体的に回転する状態から、前記入力部の回転状態を変化させずに、前記トルクリミット値を徐々に減少させるように、前記モータと前記トルク調整装置の動作制御を行い、
前記外力検出装置では、前記スリップ動作の開始時の前記トルクリミット値から、前記外力を演算で求めることを特徴とする請求項4記載のロボットアームの制御システム。 - 前記制御装置では、前記入力部の回転状態を維持したまま、当該入力部と前記出力部とが相対回転するように、前記モータと前記トルク調整装置の動作制御を行い、
前記外力検出装置では、前記スリップ動作の相対回転速度に基づいて、前記外力を演算で求めることを特徴とする請求項4記載のロボットアームの制御システム。
Priority Applications (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| US15/741,353 US10730184B2 (en) | 2015-07-04 | 2016-05-23 | Robot arm control system |
| EP16821107.6A EP3318373B1 (en) | 2015-07-04 | 2016-05-23 | Robot arm control system |
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| JP2015134828A JP6699843B2 (ja) | 2015-07-04 | 2015-07-04 | ロボットアームの制御システム |
| JP2015-134828 | 2015-07-04 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| WO2017006636A1 true WO2017006636A1 (ja) | 2017-01-12 |
Family
ID=57684999
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| PCT/JP2016/065125 Ceased WO2017006636A1 (ja) | 2015-07-04 | 2016-05-23 | ロボットアームの制御システム |
Country Status (4)
| Country | Link |
|---|---|
| US (1) | US10730184B2 (ja) |
| EP (1) | EP3318373B1 (ja) |
| JP (1) | JP6699843B2 (ja) |
| WO (1) | WO2017006636A1 (ja) |
Families Citing this family (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP6866981B2 (ja) * | 2017-03-19 | 2021-04-28 | 学校法人早稲田大学 | トルクリミッタ |
| JP7028410B2 (ja) * | 2017-03-21 | 2022-03-02 | 学校法人早稲田大学 | 機械装置の動力伝達システム |
| EP3825077A4 (en) * | 2018-07-17 | 2021-09-01 | Sony Group Corporation | CONTROL DEVICE, CONTROL PROCESS, AND CONTROL SYSTEM |
| JP2020023032A (ja) * | 2018-08-08 | 2020-02-13 | ファナック株式会社 | 協働ロボット |
| FI130012B (en) | 2018-08-29 | 2022-12-30 | Ponsse Oyj | Determination of a condition of a structural part in a working machine |
| DE102019108652B3 (de) | 2019-04-03 | 2020-01-09 | Schaeffler Technologies AG & Co. KG | Kupplungsvorrichtung für ein Robotergelenk sowie Roboter mit einer solchen Kupplungsvorrichtung |
| JP7845815B2 (ja) * | 2019-09-03 | 2026-04-14 | ファナック株式会社 | アームを有するロボットの制御装置 |
| KR102279329B1 (ko) * | 2020-01-30 | 2021-07-21 | 한국과학기술연구원 | 로봇 교시 시스템 |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH08323663A (ja) * | 1995-06-06 | 1996-12-10 | Meidensha Corp | 産業用マニプレータ |
| JP2013169628A (ja) * | 2012-02-22 | 2013-09-02 | Nikon Corp | トルク制限機構、駆動装置及びロボット装置 |
Family Cites Families (11)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US5994864A (en) * | 1995-09-11 | 1999-11-30 | Kabushiki Kaisha Yaskawa Denki | Robot controller |
| WO2005009692A1 (ja) * | 2003-07-29 | 2005-02-03 | Matsushita Electric Industrial Co., Ltd. | ロボットアームの制御方法および制御装置 |
| JP5013083B2 (ja) | 2007-07-02 | 2012-08-29 | 株式会社安川電機 | 衝突トルク緩衝機構を備えた基板搬送ロボット |
| US9566715B2 (en) * | 2009-10-09 | 2017-02-14 | The University Of Western Ontario | Magneto- and electro-rheological based actuators for human friendly manipulators |
| CN102821918A (zh) * | 2010-03-24 | 2012-12-12 | 株式会社安川电机 | 机器人手和机器人装置 |
| JP5966294B2 (ja) * | 2011-09-26 | 2016-08-10 | 株式会社ニコン | 異常判定装置、駆動装置及びロボット装置 |
| DE102011054910B4 (de) * | 2011-10-28 | 2013-10-10 | Ovesco Endoscopy Ag | Magnetischer Endeffektor und Einrichtung zur Führung und Positionierung desselben |
| JP2013163223A (ja) * | 2012-02-09 | 2013-08-22 | Nikon Corp | トルク制限機構、駆動装置及びロボット装置 |
| US9447849B1 (en) * | 2013-04-19 | 2016-09-20 | Redwood Robotics, Inc. | Robot manipulator with modular torque controlled links |
| JP5905443B2 (ja) * | 2013-12-25 | 2016-04-20 | ファナック株式会社 | 人協調型産業用ロボットの外力判定方法および外力判定装置 |
| JP6305283B2 (ja) * | 2014-09-09 | 2018-04-04 | 本田技研工業株式会社 | 動力装置の制御システム |
-
2015
- 2015-07-04 JP JP2015134828A patent/JP6699843B2/ja active Active
-
2016
- 2016-05-23 EP EP16821107.6A patent/EP3318373B1/en active Active
- 2016-05-23 WO PCT/JP2016/065125 patent/WO2017006636A1/ja not_active Ceased
- 2016-05-23 US US15/741,353 patent/US10730184B2/en active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH08323663A (ja) * | 1995-06-06 | 1996-12-10 | Meidensha Corp | 産業用マニプレータ |
| JP2013169628A (ja) * | 2012-02-22 | 2013-09-02 | Nikon Corp | トルク制限機構、駆動装置及びロボット装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| EP3318373B1 (en) | 2020-09-16 |
| US20180370031A1 (en) | 2018-12-27 |
| EP3318373A1 (en) | 2018-05-09 |
| EP3318373A4 (en) | 2018-09-26 |
| JP2017013207A (ja) | 2017-01-19 |
| JP6699843B2 (ja) | 2020-05-27 |
| US10730184B2 (en) | 2020-08-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| JP6699843B2 (ja) | ロボットアームの制御システム | |
| US9308645B2 (en) | Method of inferring intentions of an operator to move a robotic system | |
| JP6121351B2 (ja) | 直列弾性アクチュエータの力およびインピーダンスのロバスト制御のための構成 | |
| JP4148189B2 (ja) | 柔軟関節ロボットアームの制御装置 | |
| JP6238021B2 (ja) | ロボット、ロボットの制御装置及び制御方法、並びに、ロボット用制御プログラム | |
| JP6664138B2 (ja) | 制御方法、及びロボット装置 | |
| JP5910491B2 (ja) | ロボットアーム教示システム及びロボットアーム教示方法 | |
| CN103034165B (zh) | 具有能运动的机械结构的振动补偿装置的加工机床及其运行方法 | |
| JP6305283B2 (ja) | 動力装置の制御システム | |
| JP2007098507A (ja) | 作業補助装置 | |
| JP6417034B2 (ja) | コボティックマニピュレーター | |
| WO2013018205A1 (ja) | 運動装置、モータ制御装置およびモータ制御方法 | |
| JP5869991B2 (ja) | 駆動装置 | |
| US9209740B2 (en) | Actuating apparatus | |
| KR20230054471A (ko) | 전류 제한 장치, 로봇 시스템 및 전류 제한 방법 | |
| JP2006167820A (ja) | ロボットアームの制御方法 | |
| JP7028410B2 (ja) | 機械装置の動力伝達システム | |
| JP2021030341A (ja) | ロボットハンド | |
| JP2013163223A (ja) | トルク制限機構、駆動装置及びロボット装置 | |
| JP2013163224A (ja) | トルク制限機構、駆動装置及びロボット装置 | |
| JP7502781B2 (ja) | ロボットアームの制御システム | |
| JP2015058519A (ja) | ロボットハンド | |
| JP2016109141A (ja) | 駆動装置及びマニピュレータ装置 | |
| US20250100151A1 (en) | Control method of robot and robot system | |
| KR102693378B1 (ko) | 재활 로봇 시스템 및 재활 로봇의 제어방법 |
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: 16821107 Country of ref document: EP Kind code of ref document: A1 |
|
| NENP | Non-entry into the national phase |
Ref country code: DE |