Robot arm control device, control method, system, and program

The control device for robot arms enables independent gravity compensation, addressing the dependency issue in conventional systems, ensuring accurate positioning and reduced vibration through separate weight support.

JP7624850B2Active Publication Date: 2025-01-31SUMITOMO HEAVY IND LTD
View PDF 14 Cites 0 Cited by

Patent Information

Application Number
JP2021035319
Authority / Receiving Office
JP · JP
Patent Type
Patents
Current Assignee / Owner
Filing Date
2021-03-05
Publication Date
2025-01-31
Estimated Expiration
2041-03-05

AI Technical Summary

Technical Problem

Conventional robot arm systems face issues with gravity compensation being dependent on inertia compensation, leading to improper functioning of positioning accuracy due to incomplete or incorrect weight compensation of held objects.

Method used

A control device for robot arms that allows independent setting of gravity compensation, separate from inertia compensation, using a support device to hold the weight of the object, enabling appropriate inertial compensation regardless of gravity compensation.

Benefits of technology

Ensures accurate positioning and reduced vibration by allowing independent gravity compensation, improving the functionality of robot arms with flexible driving mechanisms.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 0007624850000001
    Figure 0007624850000001
  • Figure 0007624850000002
    Figure 0007624850000002
  • Figure 0007624850000003
    Figure 0007624850000003
Patent Text Reader

Abstract

To make inertia compensation of a robotic arm to function more properly irrespective of the need of gravity compensation.SOLUTION: A device for controlling a robotic arm is configured so as to be capable of setting gravity compensation relative to a holding object of the robotic arm independently from setting of inertia compensation relative to the holding object.SELECTED DRAWING: Figure 1
Need to check novelty before this filing date? Find Prior Art

Description

[Technical field]

[0001] The present invention relates to a control device, a control method, a system, and a program for a robot arm. [Background technology]

[0002] It is known that parameters related to an object held by a robot arm are set, and inertia compensation and gravity compensation are performed based on the set parameters. Patent Document 1 discloses a technology related to a power-assisted assisting arm that has a mechanism that acts on the arm to balance the weight of a workpiece with gravity, and drives the arm according to the magnitude of the force acting on the workpiece. Patent Document 2 discloses a technology that switches between impedance control and force control of a power assisting device according to conditions, such as an operating state. Patent Document 3 discloses a technology that supports the weight of an object held by a robot arm with a weight compensation device. [Prior art documents] [Patent documents]

[0003] [Patent Document 1] Japanese Patent Application Publication No. 11-198077 [Patent Document 2] JP 2005-306546 A [Patent Document 3] JP 2000-198091 A Summary of the Invention [Problem to be solved by the invention]

[0004] In the conventional technology, when a robot arm holds an object, if the weight of the object is supported by another device, not by the robot arm, there is no need for the robot arm to perform gravity compensation for the object. However, in the conventional technology, the gravity compensation function of the robot arm cannot be stopped independently of inertia compensation. Furthermore, if the weight of the object is set to zero, for example, to set parameters related to the object on the premise that gravity compensation will not be performed, gravity compensation will not be performed, but since the weight of the object is not actually zero, inertia compensation may not function properly. In particular, there are concerns about a decrease in positioning static stability due to inertia compensation not functioning properly and a decrease in positioning accuracy due to gravity compensation after inertia compensation adjustment.

[0005] One object of the present invention is to provide a technique for enabling inertia compensation of a robot arm to function more appropriately, regardless of whether gravity compensation is required. [Means for solving the problem]

[0006] A control device for a robot arm according to one embodiment of the present invention is configured to be able to set gravity compensation for an object held by the robot arm independently of setting inertia compensation for the object.

[0007] A method for setting control of a robot arm according to one embodiment of the present invention includes receiving a setting of gravity compensation for an object held by the robot arm independently of a setting of inertia compensation for the object.

[0008] A system according to one embodiment of the present invention includes a multi-joint robot arm that holds an object held by the robot arm, a control device for the robot arm, and a support device that supports the weight of the object held by the robot arm, and the control device performs inertia compensation for the object held by the robot arm without performing gravity compensation.

[0009] A program according to one embodiment of the present invention causes a computer to execute a control setting method that includes accepting a gravity compensation setting for an object held by a robot arm independently of an inertia compensation setting for the object. Effect of the Invention

[0010] According to the present invention, it is possible to provide a technique for making the inertia compensation of a robot arm function more appropriately, regardless of whether gravity compensation is required. [Brief description of the drawings]

[0011] [Figure 1] FIG. 1 is a diagram illustrating a configuration of a robot system according to an embodiment. [Diagram 2] FIG. 1 is a schematic side view of a robot arm according to an embodiment. [Diagram 3] FIG. 1 is a schematic side view of a robot system according to an embodiment. [Figure 4] FIG. 1 is a schematic side view of a robot system according to an embodiment. [Diagram 5] 1 is a flowchart showing a process in a robot system according to an embodiment. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS

[0012] The present invention will be described below through the embodiments of the invention with reference to the drawings, but the following embodiments do not limit the invention according to the claims, and all combinations of features described in the embodiments are not necessarily essential to the solution of the invention. The same or equivalent components, parts, and processes shown in each drawing are given the same reference numerals, and duplicated descriptions are omitted as appropriate.

[0013] The configuration of a robot system according to this embodiment will be described with reference to Fig. 1 to Fig. 3. Fig. 1 is a diagram showing functional blocks of the robot system according to this embodiment. Fig. 2 is a diagram showing a schematic diagram of an example of a robot arm. Fig. 3 is a diagram showing a schematic diagram of an example of a robot system that holds an object.

[0014] The robot system 100 includes a robot arm 20, a control device 10 that controls the robot arm 20, a display device 60, an input device 62, and a support device 70.

[0015] In the robot system 100 according to this embodiment, the support device 70 is a device that supports the weight of the held object W. The support device 70 includes a self-weight support device 71 and an operation jig 72. The self-weight support device 71 is configured to include a support (assist structure) fixed to a base (not shown). The operation jig 72 is configured to be able to hold the held object W. The operation jig 72 includes a balance tool (balancer) that includes, for example, an elastic body, a motor, or an air cylinder. The operation jig 72 is connected to the self-weight support device 71. The self-weight support device 71 is configured to support the weight of the held object held by the operation jig 72 via the operation jig 72. The support device 70 is operated by the robot arm 20 via the operation jig 72 in order to transport the held object. That is, the robot arm 20 operates to transport the held object W by holding (grasping) the held object or the operation jig 72 of the support device 70. In the following description, the robot arm 20 may be said to hold an object even when the robot arm 20 does not hold the object directly, but indirectly holds the object by holding the support device 70.

[0016] For example, as shown in FIG. 3, the operation jig 72 is supported near one end (first end) in the longitudinal direction of the operation jig 72 so as to be rotatable about the longitudinal direction (vertical direction) of the weight support device 71 as an axis. An operation unit 73 is provided on the upper surface of the operation jig 72 near the other end (second end). The held object W is held on the lower surface of the operation jig 72 near the second end. The held object W is held by any method. For example, the held object W may be held by a suction pad provided on the lower surface of the operation jig 72 near the second end, or may be held by electromagnetic force. The robot arm 20 grasps the operation unit 73 and operates to rotate the operation jig 72 in the d1 direction, for example, about the longitudinal direction of the weight support device 71 as an axis, thereby being able to transport the held object W held by the operation jig 72. That is, the operation jig 72 (including a balance tool) operates in synchronization with the operation of the robot arm 20, thereby being able to transport the held object W.

[0017] In addition, the robot arm 20 can also transport the object W held by the operating jig 72 by directly grasping the object W instead of using the operating unit 73 and operating to rotate the operating jig 72 in the direction d1 around the self-weight support device 71 as an axis.

[0018] A support device 70a, which is a modified example of the support device 70, will be described with reference to Fig. 4. The support device 70a is a crane-type support device. The support device 70a includes a support pillar 711a, an arm 712a, and an operation jig 72a. The support pillar 711a and the arm 712a constitute a self-weight support device. The operation jig 72a includes a balance tool (balancer) that includes one or more of an elastic body, a motor, a hanging mechanism, or an air cylinder.

[0019] The lower end of the column 711a in the longitudinal direction is fixed to a base (not shown). One end of the arm 712a is supported near the upper end of the column 711a with its longitudinal direction extending horizontally. One end of the operation jig 72a is provided with an attachment mechanism for attaching the operation jig 72a to a rail (not shown) provided on the lower surface of the arm 712a. The attachment mechanism is made of any member and includes, for example, a hook. The operation jig 72a is connected to the arm 712a via the attachment mechanism. The operation jig 72a is detachable from the arm 712a (i.e., from the support device 70). The other end of the operation jig 72a is provided with a holding mechanism configured to be able to hold the object W. The holding mechanism is made of any member and includes, for example, a hook.

[0020] The robot arm 20 operates to grip the operation jig 72a and move it in the direction d2. In synchronization with the operation of the robot arm 20, the attachment mechanism of the operation jig 72a moves along the rail of the arm 712a in the direction d2, whereby the entire operation jig 72a moves and the held object W is transported in the direction d2.

[0021] Returning to the description of Fig. 1 to Fig. 3, the robot arm 20 is, for example, a vertical articulated robot, and includes a base (not shown), a plurality of links 20L, a plurality of joints 20J, an end effector 20E, one or more drive units 30, one or more series elastic actuators 40, and a pressure detection unit 50. The robot arm 20 holds and operates a support device 70 (operation jig 72) via the end effector 20E. The robot arm 20 is not limited to a vertical articulated robot, and may be, for example, a horizontal articulated robot device or a parallel link robot device.

[0022] Link 20L is made of a rigid member and includes, for example, link 20L corresponding to a torso rotatably attached to a base, link 20L corresponding to a lower arm rotatably attached to the torso, link 20L corresponding to an upper arm rotatably attached to the lower arm, and link 20L (not shown) corresponding to a wrist rotatably attached to the upper arm.

[0023] The end effector 20E (an example of a "holding mechanism") has a function of holding an object (for example, a held object or a support device 70). The end effector 20E is attached to the tip of a link 20L corresponding to a wrist portion, and is configured to be able to hold an object by sandwiching it between movable plates 20E1 and 20E2 that are opened and closed by an actuator, for example. However, the end effector 20E is not limited to this, and may be, for example, an end effector that includes a plurality of suction pads for holding the surface of the object and an actuator that generates negative pressure on the suction pads based on a control signal transmitted from the control device 10, or an end effector that holds the object by electromagnetic force. The robot arm 20 shown as an example in this embodiment can perform a tracing operation by a drive mechanism that is distinct from the holding mechanism.

[0024] The robot arm 20 according to this embodiment includes a series elastic actuator 40 provided in at least one joint 20J that connects the links 20L to each other, and in a joint 20J that connects the link 20L and a held object W. For example, the series elastic actuator 40 is provided in all of the joints 20J of the robot arm 20.

[0025] The series elastic actuator 40 (one example of a "flexible drive mechanism") is composed of, for example, a drive unit 42 and an elastic body 44 connected to the drive unit 42. The drive unit 42 is composed of, for example, a servo motor. The elastic body 44 is composed of, for example, a mechanical spring (e.g., a leaf spring). Leaf springs have high torsional rigidity and are therefore suitable for the tracing operation in this embodiment. The power output from the drive unit 42 in the series elastic actuator 40 is transmitted via the elastic body 44 to the output side link 20L, causing it to rotate. Furthermore, the series elastic actuator 40 according to this embodiment is equipped with a sensor (not shown) for acquiring the amount of displacement of the mechanical spring.

[0026] The pressure detection unit 50 detects the contact pressure when the target object is brought into contact with the surface of some object by the robot arm 20. By controlling the contact pressure detected by the pressure detection unit 50 to be substantially constant, a tracing operation can be performed in which the target object traces the surface of some object.

[0027] According to the above-described configuration of the robot arm 20, an equation of motion is established with parameters including the inertia, mass, and length of the part driven by the series elastic actuator 40, which corresponds to a flexible driving mechanism, external force, and the spring constant of the mechanical spring, which is the elastic body 44. For this reason, the control device 10 is configured to perform mechanical compliance control that controls impedance based on the spring constant and displacement of the mechanical spring.

[0028] The series elastic actuator 40 may be connected to the drive shaft of a servo motor, which is the drive unit 42, and may include a gear for transmitting power to a mechanical spring. Furthermore, the series elastic actuator 40 may include a damper mechanism that absorbs impacts based on viscosity, and a clutch mechanism for switching the transmission of power. When a viscous body, such as a damper mechanism having viscosity, is added, a viscosity constant is added as a parameter to the equation of motion. For example, an equation of motion is established in which the viscosity constant multiplied by the change in link angle over time is considered as the torque.

[0029] When there are links 20L other than the link 20L driven by the series elastic actuator 40, such links 20L are driven by a drive unit 30 constituted by, for example, a servo motor. The drive unit 30 rotates the output link 20L about a drive shaft. The drive unit 30 may be mounted on the link 20L. With the above-described configuration, it becomes possible to rotate a plurality of links 20L, and therefore to change the position and posture of the joint 20J corresponding to the tip of the link 20L.

[0030] In this embodiment, the control device 10 is configured to be able to set gravity compensation for the held object W independently of the setting of inertia compensation for the held object W of the robot arm 20. As a result, according to this embodiment, it is possible to make the inertia compensation of the robot arm 20 function more appropriately regardless of the necessity of gravity compensation.

[0031] Generally, in a robot arm having a flexible drive mechanism, problems may arise such as: (1) if inertia compensation does not function properly, positioning stability (vibration suppression function) decreases (flexible joints are prone to shaking), and (2) if gravity compensation does not function optimally in accordance with inertia compensation, the positioning position may not be optimal (the sinking of the robot arm due to flexibility is not optimally corrected). According to this embodiment, even if the robot arm 20 has a flexible drive mechanism, it is possible to make the inertia compensation of the robot arm 20 function more appropriately, regardless of the need for gravity compensation as described above.

[0032] As shown in FIG. 1, the control device 10 includes a compensation setting input unit 11, a control command acquisition unit 12, a compensation execution unit 13, a tracing operation execution unit 14, an error detection unit 16, and a determination unit 18.

[0033] The compensation setting input unit 11 accepts input of setting information for inertia compensation for the held object W by the robot arm 20 and setting information for gravity compensation for the held object W. The compensation setting input unit 11 accepts input of setting information for inertia compensation and gravity compensation for the held object W, for example, in response to a user operation. Furthermore, the compensation setting input unit 11 can independently accept input of setting information for inertia compensation and input of setting information for gravity compensation in response to a user operation. The setting information for inertia compensation and gravity compensation accepted by the compensation setting input unit 11 is converted into a control command and output to the control command acquisition unit 12.

[0034] The setting information for inertia compensation and the setting information for gravity compensation include any information for executing inertia compensation and gravity compensation. For example, the setting information for inertia compensation may include setting information on whether to execute inertia compensation. The setting information for gravity compensation may include setting information on whether to execute gravity compensation. Furthermore, the setting information for gravity compensation or inertia compensation may include parameter settings related to the held object W for gravity compensation or inertia compensation. The parameter settings related to the held object W for gravity compensation or inertia compensation may include, for example, parameter settings of the weight and center of gravity position information (or tool center point) of the held object W.

[0035] In this embodiment, gravity compensation refers to control for applying a force to the robot arm 20 that offsets (cancels) the gravity acting due to the weight of an object held by the robot arm 20. Inertia compensation refers to control for applying a force to the robot arm 20 that offsets the inertial force acting due to the weight of an object held by the robot arm 20. In this embodiment, gravity compensation and inertia compensation executed based on the setting information input via the compensation setting input unit 11 do not include control for offsetting the gravity and inertial force due to the own weight of the robot arm 20, unless otherwise specified.

[0036] The control command acquisition unit 12 acquires control commands for controlling the servo motors corresponding to the driving units 30 of the robot arm 20 and the servo motor of the series elastic actuator 40. The control commands are generated based on various information including, for example, a start position of a reference position of the robot arm 20 (for example, a center point of the joint 20J corresponding to the hand position. Hereinafter, also referred to as a "reference position") and its posture at that time, a target position and its posture at that time, an allowable range in which the reference position of the robot arm 20 can deviate from the target position with the target position as a reference, and a movement path connecting the start position and one or more target positions. As will be described later, in the operation method of the robot arm according to this embodiment, it is possible to acquire a path that moves the held object W held by the robot arm 20 along the surface of the object while the held object W is in contact with the object. The control command acquisition unit 12 acquires control commands for controlling the servo motors for moving the reference position along the path by arithmetic processing or the like. For example, the control command acquisition unit 12 calculates the rotation angle of each servo motor for positioning the reference position on the path by inverse kinematics, and generates a control command based on this.

[0037] The compensation execution unit 13 controls to execute inertia compensation and gravity compensation based on the control command related to inertia compensation and gravity compensation acquired by the control command acquisition unit 12. That is, the compensation execution unit 13 controls to execute inertia compensation and gravity compensation based on the setting information of inertia compensation for the held object and the setting information of gravity compensation for the held object received via the compensation setting input unit 11. For example, it is assumed that the setting information of inertia compensation indicates that inertia compensation is enabled, and the setting information of gravity compensation indicates that gravity compensation is disabled. In this case, the compensation execution unit 13 controls to execute inertia compensation and disable gravity compensation (do not execute gravity compensation) based on the setting information of inertia compensation for the held object and the setting information of gravity compensation for the held object received by the compensation setting input unit 11. Gravity compensation and inertia compensation are executed based on the driving of the drive unit 30 and the series elastic actuator 40.

[0038] In this embodiment, the weight of the held object W is supported by a support device 70, which is a device different from the robot arm 20. In this case, the robot arm 20 does not need to perform gravity compensation for the held object W. Therefore, in this embodiment, it is effective that the compensation execution unit 13 can be controlled to execute inertia compensation and not to execute gravity compensation based on the setting information of inertia compensation for the held object received by the compensation setting input unit 11 and the setting information of gravity compensation for the held object.

[0039] The tracing operation execution unit 14 elastically deforms the series elastic actuator 40 of the robot arm 20, thereby causing the robot arm 20 to perform a tracing operation in which the held object comes into contact with the target object and traces it. The tracing operation refers to moving the held object relative to the target object while keeping the held object in contact with the target object. Here, the relative movement is not limited to translational movement, but includes rotational movement of the held object relative to the target object. The tracing operation execution unit 14 is configured to elastically deform the elastic body 44 of the series elastic actuator 40 so that the contact pressure detected by the pressure detection unit 50 is substantially constant or within a predetermined range. This makes it possible to perform the assembly work while suppressing damage such as galling to the target object or the assembly part.

[0040] The error detection unit 16 detects error information based on the measured value of the contact pressure detected by the pressure detection unit 50 during the operation of the robot arm 20. For example, if the measured value of the contact pressure during the tracing operation by the pressure detection unit 50 exceeds a threshold value, the error detection unit 16 determines that there is some kind of defect in the held object or the target object and detects error information.

[0041] The determination unit 18 determines the operation of the robot arm 20 after the error based on the error content of the error information detected by the error detection unit 16. Specifically, if the first error information occurs for the first time during the tracing operation, the determination unit 18 causes the robot arm 20 to perform the tracing operation again after replacing the object held by the robot arm 20. On the other hand, if the second error information occurs during the tracing operation again after the object held has already been replaced, the determination unit 18 stops the operation of the robot arm 20. If the first error information is received, it is highly likely that the object held alone is abnormal, such as a foreign object adhering to the object held, and therefore the error problem may be resolved by causing the robot arm 20 to perform the tracing operation again. On the other hand, if the second error information is received, it is highly likely that the object held is abnormal in a manufacturing lot unit or an assembly portion itself, and therefore the error problem may not be resolved even if the object held is replaced. Therefore, in such a case, the operation of the robot arm 20 is stopped. Note that the second error information is not limited to the second error, and may be the third or subsequent error. Information according to the type of error determined by the determining unit 18 of the control device 10 (particularly the second error information) may be displayed on the display device 60 to notify the user.

[0042] Regarding the hardware configuration, the control device 10 can be configured from a computer including a processor such as a central processing unit (CPU) or a graphical processing unit (GPU), a volatile memory (storage unit) such as a static random access memory (SRAM) or a dynamic random access memory (DRAM), a non-volatile memory (storage unit) such as a NOR flash memory, a NAND flash memory, or a hard disk drive (HDD), and a communication means such as a bus connecting these. The non-volatile memory element stores, for example, a computer program for executing each process shown in this embodiment. The volatile memory element temporarily stores at least a part of these computer programs and the results of the calculation process. However, at least a part of these calculation elements, non-volatile memory elements, etc. may be installed in a remote location connected to a communication network such as the Internet. For example, the calculation element may be configured to acquire the computer program or necessary data via the communication network.

[0043] The control device 10, the robot arm 20, the display device 60, and the input device 62 are each configured to be capable of transmitting and receiving information by wireless or wired communication means. A teaching device (not shown) for teaching the robot system 100 to operate may be connected to the control device 10. The teaching device may be a teaching device that follows online teaching, in which the robot arm 20 is actually moved on-site to teach the position and posture of a reference part at that time as a starting position, or a teaching device that follows offline teaching, such as a text type, simulator type, emulator type, or automatic teaching type, in which the position and posture of a reference part is taught as a starting position by a computer program.

[0044] The display device 60 and the input device 62 may be a computer equipped with a display section and an input section, or may be configured as an integrated device such as a touch panel.

[0045] The display device 60 displays a screen for making various settings for the control device 10 in accordance with data received from the control device 10. The input device 62 accepts input of various user operations and outputs data in accordance with the input to the control device 10. For example, the display device 60 can display a screen for separately (independently) setting inertia compensation for the held object W by the robot arm 20 and setting gravity compensation. The input device 62 can accept input of setting information for inertia compensation for the held object W by the robot arm 20 and setting information for gravity compensation for the held object W in accordance with user operations and output the same to the control device 10.

[0046] A process flow including a control setting method will be described as an example of a process flow in the control device 10 in this embodiment with reference to Fig. 5. Each process step described below is realized, for example, by the processor of the control device 10 reading and executing a computer program stored in a storage unit.

[0047] In step S501, the control device 10 receives settings for inertia compensation and gravity compensation for the held object W of the robot arm 20. At this time, the control device 10 can receive settings for gravity compensation for the held object W independently of settings for inertia compensation for the held object W.

[0048] In step S502, the control device 10 controls the operation of the robot arm 20 to start the transfer of the held object W. The operation of the robot arm 20 may be controlled according to teaching data previously stored or set in the control device 10, or may be controlled by the control device 10 according to a user operation.

[0049] In step S503, the control device 10 executes inertia compensation and gravity compensation based on the settings of inertia compensation and gravity compensation received in step S501.

[0050] In step S504, the control device 10 determines whether the operation of the robot arm 20 is complete, and if it is not complete (No in S504), the process proceeds to step S503. If it is complete (Yes in S504), the process shown in FIG. 5 ends.

[0051] As described above, according to this embodiment, the control device 10 is configured to be able to set gravity compensation for the held object W independently of the setting of inertia compensation for the held object W of the robot arm 20. As a result, it is possible to make the inertia compensation of the robot arm 20 function more appropriately, regardless of the necessity of gravity compensation.

[0052] The present invention is not limited to the above-described embodiment, and can be modified in various ways. Any of the aspects described in the above-described embodiment and modifications can be combined with other aspects as long as it is not inconsistent with the understanding of a person skilled in the art.

[0053] In addition to the series elastic actuator, various other driving mechanisms can be used as the driving mechanism with flexibility. Here, "having flexibility" means having elasticity, viscosity, or elasticity and viscosity. Elasticity refers to the property of being deformed when stress is applied and returning to the original shape when the stress is removed, and is sometimes expressed as the term flexibility, which indicates the ease of elastic deformation. Viscosity refers to the property of generating stress that makes the flow speed of a fluid uniform. In order to impart viscosity and elasticity, magnetic fluids, mechanical springs (leaf springs, torsion coil springs), air springs, magnetic springs, vane motors, variable dampers using electrorheological fluids whose viscosity can be adjusted according to the applied voltage, and the like may be used.

[0054] The embodiments described through the above embodiments of the invention can be combined or modified or improved as appropriate depending on the application, and the present invention is not limited to the above-mentioned embodiments. It is clear from the claims that such combinations, modifications, or improvements are also included in the technical scope of the present invention. [Explanation of symbols]

[0055] 10...control device, 20...robot arm, 30...drive unit, 40...series elastic actuator, 70...support device, W...holding object

Claims

1. A control device for a robot arm, the control device being configured to be able to set gravity compensation for a held object independently of setting of inertia compensation for the held object of the robot arm, A control device configured to enable the weight of the held object in the inertia compensation setting to be set to a value different from the weight of the held object in the gravity compensation setting.

2. The control device according to claim 1 , further comprising an input unit that accepts a setting of the gravity compensation in response to a user operation, independently of the setting of the inertia compensation.

3. 3. The control device according to claim 2, further comprising a control unit that performs control so as to execute the inertia compensation and disable the gravity compensation based on the inertia compensation setting and the gravity compensation setting received via the input unit.

4. The control device according to claim 3 , wherein the setting of the inertia compensation includes parameter setting related to the holding object for the inertia compensation.

5. The control device according to claim 1 , wherein the weight of the held object is supported by a support device different from the robot arm.

6. The control system of claim 5 , wherein the support device comprises a balancing tool.

7. The control device according to claim 6 , wherein the balancing tool includes an elastic body, a motor, or an air cylinder.

8. The control device according to claim 1 , wherein the robot arm is provided with a flexible drive mechanism.

9. The control device of claim 8 , wherein the robot arm includes a series elastic actuator as the drive mechanism.

10. A multi-joint robot arm that holds an object; A control device for the robot arm; A support device for supporting the weight of the held object; Equipped with The control device is configured to be able to set gravity compensation for the held object independently of setting of inertia compensation for the held object, The system is configured such that the weight of the retained object in the inertia compensation setting can be set to a value different from the weight of the retained object in the gravity compensation setting.

11. the support apparatus includes a balancing tool; The system of claim 10 , wherein the balancing tool moves in synchronization with the movement of the robotic arm.

12. The system of claim 11 , wherein the balancing tool is removable from the support apparatus.

13. A control setting method for a robot arm, comprising: receiving a setting of gravity compensation for a held object independently of a setting of inertia compensation for the held object of the robot arm; A control setting method configured so that a weight of the held object in the inertia compensation setting can be set to a value different from a weight of the held object in the gravity compensation setting.

14. On the computer, receiving a setting of gravity compensation for the held object independently of a setting of inertia compensation for the held object of the robot arm; A program for executing a control setting method configured so that the weight of the held object in the inertia compensation setting can be set to a value different from the weight of the held object in the gravity compensation setting.

Citation Information

Patent Citations

  • Mold joint in power cable

    JP1988087113A

  • Transfer device for heavy body

    JP1992093189A

  • Control unit for robot

    JP1995093010A

  • Control method for power assisting device and device therefor

    JP1996019979A

  • Heavyweight workpiece conveying method

    JP1997001492A