Robot system and control method thereof
The robot system replicates complex user movements and force applications by using a master-slave configuration with a control device that records and reproduces motion trajectories and force adjustments, enhancing the system's ability to mimic user operations.
Patent Information
- Application Number
- JP2020169900
- Authority / Receiving Office
- JP · JP
- Patent Type
- Patents
- Current Assignee / Owner
- Filing Date
- 2020-10-07
- Publication Date
- 2024-11-08
- Estimated Expiration
- 2040-10-07
AI Technical Summary
Existing robot systems cannot reproduce complex movements and force applications similar to those performed by a user, as they primarily operate with a constant force on an object.
A robot system comprising a master device operated by a user, a slave device with an action section, and a control device that records and reproduces the motion trajectory and force application of the user's operation, allowing the slave device to mimic the user's actions and adjust pressing force accordingly.
The system effectively reproduces complex robot movements and force applications, enabling the slave device to mimic user operations and adjust pressing force, thus imitating the user's actions more accurately.
Smart Images

Figure 0007579668000004 
Figure 0007579668000005 
Figure 0007579668000006
Abstract
Description
[Technical field]
[0001] The technology disclosed herein relates to a robot system and a control method thereof. [Background technology]
[0002] 2. Description of the Related Art Robot systems that act on an object by operating a robot are known.
[0003] For example, Patent Document 1 discloses a robot system that operates a robot to polish an object. In this robot system, the robot is operated so that the polishing force acting on the object is constant. [Prior art documents] [Patent documents]
[0004] [Patent Document 1] JP 2015-85496 A Summary of the Invention [Problem to be solved by the invention]
[0005] However, in the above-mentioned robot system, the robot only operates to keep the force acting on the object constant. When a user actually operates the robot to act on an object, the robot may move in a complex manner. In other words, the above-mentioned robot system cannot reproduce the complex robot movements that are observed when the user actually operates the robot.
[0006] The technology disclosed here has been developed in consideration of these points, and its purpose is to reproduce the complex robot movements that are actually performed by a user when operating a robot to act on an object. [Means for solving the problem]
[0007] The robot system disclosed herein includes a master device operated by a user, a slave device having an action unit that applies an action to an object and an action unit that operates the action unit, and a control device that controls the slave device, and the control device executes a first control in which the action unit applies an action to the object by controlling the action unit in response to an operation via the master device, and records trajectory information related to the action trajectory of the action unit, and a second control in which the action unit is moved so as to reproduce the action trajectory by controlling the action unit based on the trajectory information recorded by the first control, and the action unit applies an action to the object by the action unit, and in the second control, the control device controls the pressing force of the action unit against the object when controlling the action unit based on the trajectory information. Here, "reproduce" does not require strict reproducibility. In other words, "reproduce" means not only to reproduce strictly, but also to reproduce roughly. Effect of the Invention
[0008] According to the robot system, when the robot is operated to act on an object, it is possible to reproduce the complex movements of the robot as actually performed by a user. [Brief description of the drawings]
[0009] [Figure 1] FIG. 1 is a schematic diagram showing the configuration of a robot system according to an embodiment. [Diagram 2] FIG. 2 is a diagram illustrating a schematic hardware configuration of the robot control device. [Diagram 3] FIG. 3 is a diagram showing a schematic hardware configuration of the operation control device. [Figure 4] FIG. 4 is a diagram illustrating a schematic hardware configuration of the control device. [Diagram 5] FIG. 5 is a block diagram showing the configuration of a control system of the robot system. [Figure 6] FIG. 6 is a flowchart showing the operation of the robot system. [Figure 7] FIG. 7 is a schematic diagram showing the operation of the grinding machine under the damping control. [Figure 8] FIG. 8 is a schematic diagram showing the operation of the grinding machine in the attenuation control in which the control direction selection function is executed. [Figure 9] FIG. 9 is a schematic diagram showing the operation of the grinding device under elasticity control. [Figure 10] FIG. 10 is a schematic diagram showing the operation of the grinding device in another example of elasticity control. [Figure 11] FIG. 11 is a graph showing the change in stiffness coefficient with respect to the change in operating force and contact force. [Figure 12] FIG. 12 is a schematic diagram showing the operation of the grinding device in the second control according to the modified example. DETAILED DESCRIPTION OF THE PREFERRED EMBODIMENTS
[0010] Exemplary embodiments will now be described in detail with reference to the accompanying drawings.
[0011] In the present disclosure, the operations performed by the robot do not include teaching operations and operations for confirming and correcting teachings. Therefore, the operating device 2 in the following description does not include a teach pendant.
[0012] FIG. 1 is a schematic diagram showing the configuration of a robot system 100 according to an embodiment.
[0013] The robot system 100 includes a robot 1, an operation device 2 operated by a user, and a control device 3 that controls the robot 1. The robot system 100 configures a master-slave system. The operation device 2 functions as a master device, and the robot 1 functions as a slave device. The control device 3 controls the entire robot system 100 and performs bilateral control between the robot 1 and the operation device 2.
[0014] The robot 1 is, for example, an industrial robot. The robot 1 has an end effector 11 that applies an action to an object W, and a robot arm 12 that operates the end effector 11. The robot 1 operates, i.e., moves, the end effector 11 by the robot arm 12, and applies an action to the object W by the end effector 11. For example, the action is processing.
[0015] The robot 1 may further include a contact force sensor 13 that detects a reaction force (hereinafter referred to as a "contact force") that the end effector 11 receives from an object. The robot 1 may further include a base 10 that supports the robot arm 12, and a robot control device 14 that controls the entire robot 1.
[0016] A robot coordinate system with three orthogonal axes is defined for the robot 1. For example, a Z axis is set in the vertical direction, and an X axis and a Y axis are set in the horizontal direction, each of which is orthogonal to each other.
[0017] The end effector 11 has a grinding device 11a and applies grinding as an action to the object W. For example, the object W is a large steel plate or the wall of a large tank. Note that the action applied by the end effector 11 to the object W may be grinding or polishing instead of grinding. The end effector 11 is an example of an action unit.
[0018] For example, the grinding device 11a may be a grinder, an orbital sander, a random orbit sander, a delta sander, a belt sander, or the like. The grinder may be a type that rotates a disk-shaped grinding wheel, a type that rotates a conical or cylindrical grinding wheel, or the like. Here, the grinding device 11a is a grinder.
[0019] The robot arm 12 changes the position of the grinding device 11a. Furthermore, the robot arm 12 may change the attitude of the grinding device 11a. The robot arm 12 is a vertical multi-joint type robot arm. The robot arm 12 has a plurality of links 12a, joints 12b connecting the plurality of links 12a, and a servo motor 15 (see FIG. 2) that rotates and drives the plurality of joints 12b. The robot arm 12 is an example of a moving unit.
[0020] The robot arm 12 may be a horizontal articulated type, a parallel link type, a rectangular coordinate type, or a polar coordinate type robot arm, or the like.
[0021] In this example, the contact force sensor 13 is provided between the robot arm 12 and the end effector 11 (specifically, at the connection between the robot arm 12 and the end effector 11). The contact force sensor 13 detects forces in three orthogonal axial directions and moments around the three axes. The contact force sensor 13 is an example of a contact force detection unit.
[0022] The contact force detection unit is not limited to the contact force sensor 13. For example, the contact force sensor 13 may detect forces only in one, two or three axial directions. Alternatively, the contact force detection unit may be a current sensor that detects a current of the servo motor 15 of the robot arm 12, a torque sensor that detects the torque of the servo motor 15, or the like.
[0023] 2 is a diagram showing a schematic hardware configuration of the robot control device 14. The robot control device 14 controls the servo motor 15 of the robot arm 12 and the grinding device 11a. The robot control device 14 receives a detection signal from the contact force sensor 13. The robot control device 14 transmits and receives information, commands, data, etc. to and from the control device 3. The robot control device 14 has a control unit 16, a storage unit 17, and a memory 18.
[0024] The control unit 16 controls the entire robot control device 14. The control unit 16 performs various types of arithmetic processing. For example, the control unit 16 is formed of a processor such as a CPU (Central Processing Unit). The control unit 16 may also be formed of an MCU (Micro Controller Unit), an MPU (Micro Processor Unit), an FPGA (Field Programmable Gate Array), a PLC (Programmable Logic Controller), or the like.
[0025] The storage unit 17 stores various data and programs executed by the control unit 16. The storage unit 17 is formed of a non-volatile memory, a hard disc drive (HDD), a solid state drive (SSD), or the like.
[0026] The memory 18 temporarily stores data, etc. For example, the memory 18 is formed of a volatile memory.
[0027] 1, the operation device 2 has an operation unit 21 operated by a user, and an operation force sensor 23 that detects the operation force applied by the user to the operation unit 21. The operation device 2 accepts input for manually operating the robot 1, and outputs operation information, which is the input information, to the control device 3. Specifically, the user holds the operation unit 21 to operate the operation device 2. At that time, the force applied to the operation unit 21 is detected by the operation force sensor 23. The operation force detected by the operation force sensor 23 is output to the control device 3 as operation information.
[0028] The operation device 2 may further include a base 20, a support mechanism 22 provided on the base 20 and supporting the operation unit 21, and an operation control device 24 for controlling the entire operation device 2. The operation device 2 applies a reaction force against the operation force to the user under the control of the control device 3. Specifically, the operation control device 24 receives a command from the control device 3 and controls the support mechanism 22 to cause the user to sense the reaction force.
[0029] An operation coordinate system of three orthogonal axes is defined for the operation device 2. The operation coordinate system corresponds to the robot coordinate system. That is, the Z axis is set in the vertical direction, and the X and Y axes, which are orthogonal to each other, are set in the horizontal direction.
[0030] The support mechanism 22 has a plurality of links 22a, joints 22b connecting the plurality of links 22a, and a servo motor 25 (see FIG. 3) that rotationally drives the plurality of joints 22b. The support mechanism 22 supports the operation unit 21 so that the operation unit 21 can take any position and posture in three-dimensional space. The servo motor 25 rotates in response to the position and posture of the operation unit 21. The amount of rotation of the servo motor 25, i.e., the rotation angle, is uniquely determined.
[0031] In this example, the operating force sensor 23 is provided between the operating unit 21 and the support mechanism 22 (specifically, at the connection between the operating unit 21 and the support mechanism 22). The operating force sensor 23 detects forces in three orthogonal axial directions and moments around the three axes. The operating force sensor 23 is an example of an operating force detection unit.
[0032] The operating force detection unit is not limited to the operating force sensor 23. For example, the operating force sensor 23 may detect only one-axis, two-axis, or three-axis force. Alternatively, the operating force detection unit may be a current sensor that detects a current of the servo motor 25 of the support mechanism 22, a torque sensor that detects the torque of the servo motor 25, or the like.
[0033] 3 is a diagram showing a schematic hardware configuration of the operation control device 24. The operation control device 24 operates the support mechanism 22 by controlling the servo motor 25. The operation control device 24 receives a detection signal from the operation force sensor 23. The operation control device 24 transmits and receives information, commands, data, etc. to and from the control device 3. The operation control device 24 has a control unit 26, a storage unit 27, and a memory 28.
[0034] The control unit 26 controls the entire operation control device 24. The control unit 26 performs various types of arithmetic processing. For example, the control unit 26 is formed of a processor such as a CPU (Central Processing Unit). The control unit 26 may be formed of an MCU (Micro Controller Unit), an MPU (Micro Processor Unit), an FPGA (Field Programmable Gate Array), a PLC (Programmable Logic Controller), or the like.
[0035] The storage unit 27 stores various data and programs executed by the control unit 26. The storage unit 27 is formed of a non-volatile memory, a hard disc drive (HDD), a solid state drive (SSD), or the like.
[0036] The memory 28 temporarily stores data, etc. For example, the memory 28 is formed of a volatile memory.
[0037] The control device 3 controls the robot 1 and the operation device 2. The control device 3 executes a first control and a second control. The first control is a control for controlling the robot arm 12 in response to an operation via the operation device 2 to cause the end effector 11 to act on the object W, and for recording trajectory information related to the movement trajectory of the end effector 11. The second control is a control for moving the end effector 11 so as to reproduce the movement trajectory by controlling the robot arm 12 based on the trajectory information recorded by the first control, and for causing the end effector 11 to act on the object W. In the second control, the control device 3 controls the pressing force of the end effector 11 against the object W when controlling the robot arm 12 based on the trajectory information.
[0038] 4 is a diagram showing a schematic hardware configuration of the control device 3. The control device 3 transmits and receives information, commands, data, etc. to and from the robot control device 14 and the operation control device 24. The control device 3 has a control unit 31, a storage unit 32, and a memory 33.
[0039] The control unit 31 controls the entire control device 3. The control unit 31 performs various arithmetic processing. For example, the control unit 31 is formed of a processor such as a CPU (Central Processing Unit). The control unit 31 may be formed of an MCU (Micro Controller Unit), an MPU (Micro Processor Unit), an FPGA (Field Programmable Gate Array), a PLC (Programmable Logic Controller), or the like.
[0040] The storage unit 32 stores various data and programs executed by the control unit 31. The storage unit 32 is formed of a non-volatile memory, a hard disc drive (HDD), a solid state drive (SSD), or the like.
[0041] The memory 33 temporarily stores data, etc. For example, the memory 33 is formed of a volatile memory.
[0042] FIG. 5 is a block diagram showing the configuration of a control system of the robot system 100.
[0043] The control unit 16 of the robot control device 14 realizes various functions by reading out the programs from the storage unit 17 into the memory 18 and developing them. Specifically, the control unit 16 functions as an input processing unit 41 and an operation control unit 42.
[0044] The input processing unit 41 outputs information, data, commands, etc. received from the contact force sensor 13 and the servo motor 15 to the control device 3. Specifically, the input processing unit 41 receives a six-axis force detection signal from the contact force sensor 13, and outputs the detection signal to the control device 3. The input processing unit 41 also receives detection signals of a rotation sensor (e.g., an encoder) and a current sensor from the servo motor 15. The input processing unit 41 outputs the detection signal to the operation control unit 42 for feedback control of the robot arm 12 by the operation control unit 42. The input processing unit 41 also outputs the detection signal to the control device 3 as position information of the robot arm 12.
[0045] The operation control unit 42 receives the command position xds from the control device 3 and generates a control command for operating the robot arm 12 according to the command position xds. The operation control unit 42 outputs the control command to the servo motor 15 to operate the robot arm 12 and move the grinding device 11a to a position corresponding to the command position. At this time, the operation control unit 42 feedback-controls the operation of the robot arm 12 based on the detection signal of the rotation sensor and / or current sensor of the servo motor 15 from the input processing unit 41. The operation control unit 42 also outputs a control command to the grinding device 11a to operate the grinding device 11a. As a result, the grinding device 11a grinds the target object W.
[0046] The control unit 26 of the operation control device 24 realizes various functions by reading out a program from the storage unit 27 into the memory 28 and developing the program.
[0047] The input processing unit 51 outputs information, data, commands, etc. received from the operating force sensor 23 to the control device 3. Specifically, the input processing unit 51 receives six-axis force detection signals from the operating force sensor 23 and outputs the detection signals to the control device 3. The input processing unit 51 also receives detection signals of a rotation sensor (e.g., an encoder) and a current sensor from the servo motor 25. The input processing unit 51 outputs the detection signals to the operation control unit 52 for feedback control of the support mechanism 22 by the operation control unit 52.
[0048] The operation control unit 52 receives the command position xdm from the control device 3 and generates a control command for operating the support mechanism 22 according to the command position xdm. The operation control unit 52 outputs the control command to the servo motor 25 to operate the support mechanism 22 and move the operation unit 21 to a position corresponding to the command position. At this time, the operation control unit 52 feedback-controls the operation of the support mechanism 22 based on the detection signal of the rotation sensor and / or current sensor of the servo motor 25 from the input processing unit 51. This provides a reaction force against the operating force applied by the user to the operation unit 21. As a result, the user can operate the operation unit 21 while virtually feeling the reaction force from the object W from the operation unit 21.
[0049] The control unit 31 of the control device 3 realizes various functions by reading out the programs from the storage unit 32 into the memory 33 and expanding them. Specifically, the control unit 31 functions as an operation force acquisition unit 61, a contact force acquisition unit 62, an addition unit 63, a force / velocity conversion unit 64, a first velocity / position conversion unit 65, and a second velocity / position conversion unit 66.
[0050] The operating force acquisition unit 61 receives a detection signal from the operating force sensor 23 via the input processing unit 51, and acquires the operating force fm based on the detection signal. The operating force acquisition unit 61 inputs the operating force fm to the adder 63.
[0051] The contact force acquiring unit 62 receives the detection signal of the contact force sensor 13 via the input processing unit 41, and acquires the contact force fs based on the detection signal. The contact force acquiring unit 62 inputs the contact force fs to the adding unit 63.
[0052] The adder 63 calculates the sum of the operating force fm input from the operating force acquisition unit 61 and the contact force fs input from the contact force acquisition unit 62. Here, the operating force fm and the contact force fs are forces in opposite directions, and therefore have different positive and negative signs. In other words, the absolute value of the operating force fm becomes smaller by adding the operating force fm and the contact force fs.
[0053] The force / velocity conversion unit 64 converts a resultant force fm+fs, which is the sum of the operation force fm and the contact force fs, into a command velocity xd'. The force / velocity conversion unit 64 calculates the command velocity xd' using a motion model based on a motion equation including an inertia coefficient, a viscosity coefficient (damper coefficient), and a stiffness coefficient (spring coefficient). Specifically, the force / velocity conversion unit 64 calculates the command velocity xd' based on the following motion equation.
[0054]
number
[0055] Equation (1) is a linear differential equation, and solving equation (1) for xd' gives equation (2).
[0056]
number
[0057] Equation (2) is stored in the memory unit 32. The force / velocity conversion unit 64 reads out equation (2) from the memory unit 32 to obtain a command velocity xd', and outputs the obtained command velocity xd' to a first velocity / position conversion unit 65 and a second velocity / position conversion unit 66. The command velocity xd' is an example of position related information related to the position of the end effector 11.
[0058] The first speed / position conversion unit 65 converts the coordinate-converted command speed xd' into a command position xds for the robot 1 with reference to the robot coordinate system. For example, when a ratio of the movement amount of the robot 1 to the movement amount of the operation device 2 is set, the first speed / position conversion unit 65 multiplies the command position xd calculated from the command speed xd' in accordance with the movement ratio to calculate the command position xds. The first speed / position conversion unit 65 outputs the calculated command position xds to the robot control device 14, specifically, to the operation control unit 42.
[0059] The second speed / position conversion unit 66 converts the command speed xd' into a command position xdm for the operation device 2 with reference to the operation coordinate system. The second speed / position conversion unit 66 outputs the determined command position xdm to the operation control device 24, specifically, to the motion control unit 52. The command position xdm is determined based on the command speed xd', similar to the command position xds for the end effector 11. Therefore, the command position xdm is related to the command position xds.
[0060] [Robot system operation] Next, the operation of the robot system 100 configured as above will be described. FIG. 6 is a flowchart showing the operation of the robot system 100. The robot system 100 executes a first control in step S1, and then executes a second control in step S2. In both the first control and the second control, the actual work of grinding the target object W is performed by the grinding device 11a. However, in the first control, the user manually controls the operation of the robot 1 via the operation device 2. On the other hand, in the second control, the control device 3 basically controls the operation of the robot 1 automatically.
[0061] In the first control, trajectory information related to the movement trajectory of the end effector 11 (that is, the grinding device 11a) when the end effector 11 grinds the target object W is recorded.
[0062] In the second control, the robot arm 12 is controlled based on the trajectory information so that the end effector 11 reproduces the motion trajectory of the first control. At this time, the pressing force of the end effector 11 against the target object W is controlled.
[0063] The first control and the second control will be described in detail below.
[0064] <First control> In the first control, the user operates the operation device 2 to cause the robot 1 to perform an actual task on the object W. That is, the user operates the operation device 2 to cause the robot 1 to perform grinding on the object W. An operation force applied by the user to the operation unit 21 as an operation via the operation device 2 by the user is detected by the operation force sensor 23. The robot arm 12 is controlled in accordance with the operation force.
[0065] Specifically, when the user operates the operating device 2, the operating force sensor 23 detects the operating force applied by the user via the operating unit 21. The operating force detected by the operating force sensor 23 is input to the control device 3 as a detection signal by the input processing unit 51. In the control device 3, the operating force acquisition unit 61 inputs the operating force fm based on the detection signal to the addition unit 63.
[0066] At this time, the contact force detected by the contact force sensor 13 of the robot 1 is input as a detection signal to a contact force acquisition unit 62 of the control device 3 via the input processing unit 41. The contact force acquisition unit 61 inputs a contact force fs based on the detection signal to an addition unit 63.
[0067] The adder 63 inputs the resultant force fm+fs to the force / speed conversion unit 64. The force / speed conversion unit 64 uses the resultant force fm+fs to determine a command speed xd' based on equation (2).
[0068] For the robot 1, the first speed / position conversion unit 65 obtains a command position xds from the command speed xd'. The operation control unit 42 of the robot control device 14 operates the robot arm 12 according to the command position xds, and controls the position of the grinding device 11a. As a result, the object W is ground by the grinding device 11a while a pressing force corresponding to the operating force fm is applied to the object W.
[0069] Meanwhile, for the operation device 2, the second speed / position conversion unit 66 obtains a command position xdm from the command speed xd'. The operation control unit 52 of the operation control unit 24 operates the support mechanism 22 according to the command position xdm, and controls the position of the operation unit 21. As a result, the user senses a reaction force corresponding to the contact force fs.
[0070] The user continues the actual work based on the operation of the operation device 2, and the control device 3 records the trajectory data xu during that time in the storage unit 32.
[0071] Here, the trajectory data xu is trajectory information related to the motion trajectory of the end effector 11 (i.e., the grinding device 11a). In the control device 3, the command position xdm, the command position xds, and the command velocity xd' are trajectory information related to the motion trajectory of the end effector 11. In this example, the control device 3 records the command position xdm as the trajectory data xu in the storage unit 32. Note that the command position xds or the command velocity xd' may be recorded in the storage unit 32 as the trajectory data xu.
[0072] Furthermore, when recording the trajectory data xu, the control device 3 also records the operating force detected by the operating force sensor 23. In this example, the operating force fm from the operating force acquisition unit 61 is recorded as the operating force detected by the operating force sensor 23. The control device 3 links the trajectory data xu and the operating force fm to each other and records them in the storage unit 32 as an operation history.
[0073] <Second control> The second control is executed after the first control is completed. For example, the first control is executed on a part of the object W, or on one of the multiple objects W. For example, when grinding a large steel plate as the object W, the actual work is performed on a part of the steel plate by the first control. Then, the actual work is performed on the remaining part of the steel plate by the second control. When grinding a relatively small object W, the actual work is performed on one object W by the first control. Then, the actual work is performed on another object W by the second control.
[0074] In the second control, the control device 3 controls the robot arm 12 based on the trajectory information and the operating force. In this example, the operating force fm used to control the robot arm 12 is the operating force fm recorded in the first control (hereinafter referred to as the "history operating force fm").
[0075] Specifically, in the second control, the control device 3 generates a command position xds for the robot 1 based on the trajectory data xu and the historical operating force fm. At this time, the operation of the operating device 2 is not performed by the user.
[0076] Specifically, the force / velocity conversion unit 64 converts the trajectory data xu into a historical velocity xu' and substitutes it into equation (2) to obtain a command velocity xd'. At this time, the force / velocity conversion unit 64 also substitutes the historical operating force fm into equation (2). Note that the contact force fs is the actual contact force fs when the robot 1 actually operates, that is, the current contact force fs.
[0077] Based on the command speed xd' thus obtained, a command position xds is finally generated. The robot control device 14 controls the robot 1 based on the generated command position xds, and performs position control of the grinding device 11a.
[0078] It should be noted that the control device 3 does not generate or output a command position xdm for the operation device 2. In other words, the operation device 2 does not control the position of the operation unit 21.
[0079] Thus, in the second control, the end effector 11, i.e., the grinding device 11a, moves to reproduce the trajectory data xu while being influenced by the historical operating force fm, and grinds the object W. In other words, the grinding device 11a does not simply reproduce the trajectory data xu, but is pressed against the object W with a pressing force according to the historical operating force fm. As a result, the robot system 100 can operate the grinding device 11a by easily imitating the complicated operations and complicated force adjustments performed by an actual user.
[0080] <Various functions in the second control> Based on such control, the robot system 100 has various functions. The various functions of the robot system 100 will be described below.
[0081] As one function, the robot system 100 is configured to be able to select whether or not to include a stiffness coefficient kd in formula (1). That is, whether or not to include an elastic force in the motion model of the end effector 11 and the robot arm 12 is selected. When the stiffness coefficient kd=0, the action of the damping force in the motion model becomes large. Hereinafter, control when the stiffness coefficient kd=0 is referred to as damping control, and control when the stiffness coefficient kd is not 0 is referred to as elastic control. That is, the robot system 100 can switch between damping control and elastic control.
[0082] Damping Control First, a basic damping control will be described. FIG. 7 is a schematic diagram showing the operation of the grinding device 11a in damping control. For example, the operation of the grinding device 11a when grinding the target object W shown in FIG. 7 will be described. It is assumed that the trajectory data xu is a linear trajectory in which the Y component and Z component are constant and only the X component changes. In contrast, it is assumed that a bulge w1 exists on the surface of the target object W.
[0083] In the second control, the robot 1 moves the grinding device 11a so as to reproduce the trajectory data xu and the historical operating force fm. In a portion away from the trajectory data xu, such as the bulging portion w1, the grinding device 11a moves to trace the surface of the bulging portion w1 according to the historical operating force fm, or moves while slowing down the speed in the X direction, due to the influence of the viscosity coefficient kd, i.e., the action of the viscous force. In other words, the grinding device 11a moves so as to realize a pressing force according to the historical operating force fm, although it deviates slightly from the trajectory data xu.
[0084] In addition, when only the trajectory data xu is reproduced without considering the operating force fm, the grinding device 11a moves faithfully following the trajectory data xu. Therefore, even if the grinding device 11a contacts the bulging portion w1, the robot 1 tries to make the grinding device 11a faithfully follow the trajectory data xu. As a result, there is a risk that an excessive contact force fs will act on the grinding device 11a.
[0085] In this manner, in the damping control, the grinding device 11a moves, i.e., grinds, so as to follow the shape of the bulging portion w1 while slowing down, thereby preventing an excessive contact force fs from acting on the grinding device 11a.
[0086] <Control direction selection> Here, the damping control will be taken as an example to explain another function of the robot system 100. The robot system 100 is configured to be capable of selecting a directional component for reproducing the trajectory data xu and a directional component for controlling the hysteretic operating force fm from among a plurality of directional components included in the trajectory data xu and the hysteretic operating force fm.
[0087] That is, the trajectory data xu and the historical operating force fm each include an X-direction component, a Y-direction component, a Z-direction component, an X-axis rotation component, a Y-axis rotation component, and a Z-axis rotation component as a plurality of directional components. The control device 3 is configured to be able to select a directional component to be used for controlling the robot arm 12 from among the plurality of directional components included in the trajectory data xu and the plurality of directional components included in the historical operating force fm in the second control. That is, in reproducing the trajectory data xu, it is possible to set which directional component of the trajectory data xu is to be reproduced from among the plurality of directional components. Similarly, in controlling the pressing force of the grinding device 11a against the object W, it is possible to set which directional component of the pressing force is to be controlled from among the plurality of directional components.
[0088] For example, in the second control, the control device 3 uses some directional components (e.g., the Z-axis component) of the multiple directional components included in the historical operating force fm to control the robot arm 12, and uses directional components other than some of the directional components of the historical operating force fm (e.g., components other than the Z-axis component) of the multiple directional components included in the trajectory data xu to control the robot arm 12. In other words, the grinding device 11a moves in a direction other than the Z-axis direction so as to reproduce the trajectory data xu, and moves in the Z-axis direction according to the historical operating force fm.
[0089] Here, the control direction selection function will be described using attenuation control as an example, but the control direction selection function is not limited to attenuation control.
[0090] Fig. 8 is a schematic diagram showing the operation of the grinding machine 11a in the attenuation control in which the control direction selection function is executed. For example, as shown in Fig. 8, the trajectory data xu is a linear trajectory in which the Y component and the Z component are constant and only the X component changes. The surface of the target object W has an uneven shape in the Z direction.
[0091] In this case, the grinding device 11a moves in the XY directions so as to follow the trajectory data xu while reproducing the hysteretic operating force fm in the Z direction. The grinding device 11a operates in the Z direction so that the hysteretic operating force fm+contact force fs=0 due to the influence of the viscosity coefficient cd in formula (1). As a result, the grinding device 11a moves in the XY directions according to the trajectory data xu while absorbing the error in the Z direction between the trajectory data xu and the actual surface of the target object W.
[0092] In this way, by controlling the pressing force only in the Z direction and reproducing the trajectory data xu in the XY directions, it is possible to absorb individual differences in the target object W in the Z direction while operating the grinding device 11a in the XY directions according to the trajectory data xu.
[0093] Elasticity Control First, basic elasticity control will be described. FIG. 9 is a schematic diagram showing the operation of the grinding device 11a in elasticity control. For example, the operation of the grinding device 11a when grinding the object W shown in FIG. 9 will be described. The surface of the object W has a shape having unevenness in the Z direction across the X direction. The trajectory data xu is a trajectory with a constant Y component that moves up and down in the Z component with a change in the X component, and has a wavy shape in the Z direction like the surface of the object W. However, the vertical movement of the trajectory data xu in the Z direction is smaller than the vertical movement of the surface of the object W in the Z direction.
[0094] In this case, the robot 1 operates based on the influence of the stiffness coefficient kd in addition to the influence of the viscosity coefficient cd. Specifically, as shown in Fig. 9, the grinding device 11a moves along the surface of the object W, and in a portion where the difference between the surface of the object W and the trajectory data xu is large, the pressing force against the object W becomes large and the object W tries to move to a position close to the trajectory data xu. As a result, the cutting depth of the grinding device 11a becomes large, and the object W is ground so as to approach the shape of the trajectory data xu.
[0095] As another example, a case where an object W shown in FIG. 10 is ground will be described. FIG. 10 is a schematic diagram showing the operation of the grinding device 11a in another example of elasticity control. FIG. 10 is a diagram of the object W extending on the XY plane as viewed in the Z direction. The trajectory data xu has a substantially arc-like shape as viewed in the Z direction. An obstacle S exists on the trajectory data xu on the surface of the object W.
[0096] In this case, when the grinding device 11a moves according to the trajectory data xu and reaches the obstacle S, the pressing force against the obstacle S becomes stronger so as to approach the shape of the trajectory data xu, based on the influence of the stiffness coefficient kd. At the same time, the influence of the viscosity coefficient cd also comes into play, so that the grinding device 11a advances while being strongly pressed against the obstacle S, following the surface of the obstacle S. When the grinding device 11a passes the obstacle S, the shape approaches the shape of the trajectory data xu, based on the influence of the stiffness coefficient kd. Finally, the grinding device 11a moves according to the trajectory data xu.
[0097] In this way, in the elastic control, the elastic force and the damping force cooperate with each other to control the grinding device 11a. Even if a disturbance such as an obstacle S exists, the grinding device 11a can move by following the trajectory data xu while appropriately avoiding the disturbance.
[0098] <Change in stiffness coefficient> Next, as an additional function in the elasticity control, the robot system 100 can change the stiffness coefficient kd in the elasticity control according to the hysteretic operating force fm and the contact force fs. This function can be switched ON / OFF by setting.
[0099] For example, the stiffness coefficient kd is calculated based on the following formula:
[0100]
number
[0101] Equation (3) is stored in the storage unit 32. The force / velocity conversion unit 64 reads out equation (3) together with equation (2) from the storage unit 32 to obtain the command velocity xd'.
[0102] According to formula (3), the stiffness coefficient kd changes as shown in FIG. 11. FIG. 11 is a graph showing the stiffness coefficient kd with respect to the changes in the hysteretic operation force fm and the contact force fs. For example, if the upward direction of the Z axis in the operation coordinate system and the robot coordinate system is positive and the downward direction of the Z axis is negative, the hysteretic operation force fm is usually a negative value and the contact force fs is usually a positive value. Similarly, the limit value fm-maxm is also a negative value and the limit value fs-max is also a positive value. In FIG. 11, the hysteretic operation force fm and the contact force fs are each expressed by absolute values. The horizontal axis in the graph does not have a specific meaning. For example, the horizontal axis may be time. In the graph, the absolute value of the hysteretic operation force fm is represented by a two-dot chain line, the absolute value of the contact force fs is represented by a dashed line, and the stiffness coefficient kd is represented by a solid line. This graph is intended to show the change in the stiffness coefficient kd with respect to the change in the absolute value of the hysteretic operation force fm and the change in the stiffness coefficient kd with respect to the change in the absolute value of the contact force fs. The changes in the hysteretic operating force fm and the contact force fs in the graph do not represent the actual changes in the hysteretic operating force fm and the contact force fs.
[0103] First, assume that the absolute value of the contact force fs is constant at 0 and the hysteretic operating force fm increases linearly in the negative direction, that is, the absolute value of the hysteretic operating force fm increases linearly. In this case, the stiffness coefficient kd increases as shown in the graph. When the absolute value of the hysteretic operating force fm reaches the absolute value of the limit value fm-max, the stiffness coefficient kd becomes maximum.
[0104] Next, assume that the absolute value of the hysteretic operating force fm is constant at the absolute value of the limit value fm-max, and the contact force fs increases linearly in the positive direction, that is, the absolute value of the contact force fs increases linearly. In this case, the stiffness coefficient kd decreases as shown in the graph. When the absolute value of the contact force fs reaches the absolute value of the limit value fs-max, the stiffness coefficient kd becomes 0.
[0105] As can be seen from this graph, as the absolute value of the hysteretic operating force fm increases, that is, as the hysteretic operating force fm increases as a force, the rigidity coefficient kd tends to increase. As a result, the grinding device 11a is pressed strongly against the object W. On the other hand, as the absolute value of the contact force fs increases, that is, as the contact force fs increases as a force, the rigidity coefficient kd tends to decrease. In other words, when the contact force fs becomes excessively large, the pressing force of the grinding device 11a decreases.
[0106] In this way, by changing the stiffness coefficient kd in the elastic control according to the hysteretic operating force fm and the contact force fs, the pressing force of the grinding device 11a against the object W can be appropriately changed according to the hysteretic operating force fm and the contact force fs.
[0107] Furthermore, since the historical operation force fm at this time is recorded as the operation history, the stiffness coefficient kd is adjusted according to the historical operation force fm in the actual work of the user. For example, in a portion where the user strongly pressed the grinding device 11a in the actual work, the stiffness coefficient kd also becomes large in the second control, and the pressing force of the grinding device 11a becomes large.
[0108] <Modification of the second control> Next, a modified example of the second control will be described. Fig. 12 is a schematic diagram showing the operation of the grinding device 11a in the second control according to the modified example.
[0109] In the second control according to the modified example, the control device 3 also generates a command position xds for the robot 1 based on the trajectory data xu and the operating force fm. The operating force fm used at that time is the operating force fm detected by the operating force sensor 23 based on the operation of the operation unit 21 during the second control. In other words, the user operates the operation device 2 during the second control. The control device 3 uses the operating force fm detected by the operating force sensor 23 in real time during the second control to generate the command position xds.
[0110] Specifically, the control device 3 generates a command position xds for the robot 1 based on the trajectory data xu as described above. The force / velocity conversion unit 64 converts the trajectory data xu into a history velocity xu' and substitutes it into equation (2) to obtain a command velocity xd'. At this time, if an operating force fm is recorded as the operation history, the force / velocity conversion unit 64 substitutes the recorded operating force fm into equation (2).
[0111] Based on the command speed xd' thus obtained, a command position xds is finally generated. The robot control device 14 controls the robot 1 based on the generated command position xds, and the position of the grinding device 11a is controlled.
[0112] As a result, the grinding device 11a performs grinding while following the trajectory data xu. If the operational force fm is recorded in the operation history, the grinding device 11a moves while being further influenced by the operational force fm.
[0113] The user can add an operating force fm by operating the operation device 2 during reproduction of an operation history such as the trajectory data xu.
[0114] For example, a case where an object W as shown in Fig. 12 is ground will be described. Fig. 12 is a schematic diagram showing the operation of the grinding device 11a in the second control according to the modified example. The surface of the object W has a shape having unevenness in the Z direction across the X direction. The trajectory data xu is a trajectory in which the Y component is constant and moves up and down in the Z component with a change in the X component, and has a wavy shape in the Z direction similar to the surface of the object W.
[0115] Usually, the grinding device 11a performs grinding so as to follow the trajectory data xu. If the user wishes to increase the pressing force of the grinding device 11a against the object W while observing the grinding operation of the grinding device 11a, the user can operate the operation device 2 to add an operating force fm. When determining the command speed xd' based on the formula (2), the control device 3 also substitutes the additional operating force fm into the formula (2). This adjusts the command position xds so that the pressing force of the grinding device 11a is increased. In this way, the pressing force of the grinding device 11a is adjusted in real time.
[0116] In this example, during the second control, the control device 3 does not generate or output a command position xdm for the operation device 2. That is, the operation unit 21 of the operation device 2 is stopped. The user operates the stopped operation unit 21 as necessary. Since the operation unit 21 is stopped, the user can easily adjust the operation force fm to be added.
[0117] However, the control device 3 may generate a command position xdm for the operation device 2 and output the command position xdm to the operation device 2. In this case, the user can sense the reaction force from the object W by gripping the operation unit 21. That is, the user can add an operation force fm while sensing the reaction force from the object W.
[0118] As described above, the robot system 100 includes an operating device 2 (master device) operated by a user, a robot 1 (slave device) having an end effector 11 (acting unit) that acts on an object W and a robot arm 12 (operating unit) that operates the end effector 11, and a control device 3 that controls the robot 1. The control device 3 controls the robot arm 12 in response to operation via the operating device 2 to cause the end effector 11 to act on the object W, and also executes a first control that records trajectory information related to the movement trajectory of the end effector 11, i.e., trajectory data xu, and a second control that controls the robot arm 12 based on the trajectory data xu recorded by the first control, thereby moving the end effector 11 to reproduce the movement trajectory, thereby causing the end effector 11 to act on the object W. In the second control, the control device 3 controls the pressing force of the end effector 11 against the object W when controlling the robot arm 12 based on the trajectory data xu.
[0119] In other words, a control method for a robot system 100 including a robot 1 having an operating device 2 operated by a user, an end effector 11 that applies an action to an object W, and a robot arm 12 that operates the end effector 11 includes executing a first control for controlling the robot arm 12 in response to operation via the operating device 2 to cause the end effector 11 to apply an action to the object W and recording trajectory information related to the movement trajectory of the end effector 11, i.e., trajectory data xu, and executing a second control for moving the end effector 11 to reproduce the movement trajectory by controlling the robot arm 12 based on the trajectory data xu recorded by the first control, thereby causing the end effector 11 to apply an action to the object W, and in the second control, when controlling the robot arm 12 based on the trajectory data xu, controlling the pressing force of the end effector 11 against the object W.
[0120] According to these configurations, in the first control, the robot arm 12 is controlled in response to the user's operation of the operation device 2, so that the end effector 11 acts on the object W, and the trajectory data xu of the end effector 11 at this time is recorded. Then, in the second control, the robot arm 12 is controlled based on the trajectory data xu recorded in the first control, so that the end effector 11 acts on the object W. At this time, the end effector 11 moves so as to generally reproduce the movement trajectory while the pressing force of the end effector 11 on the object W is controlled. As a result, the end effector 11 moves so as to generally reproduce the movement trajectory when the user manually controls the robot arm 12 via the operation device 2 in the first control, and the pressing force of the end effector 11 on the object W at that time is controlled. As a result, the robot system 100 can reproduce the operation of the grinding device 11a that easily imitates the complicated operation and complicated force application by an actual user.
[0121] The operating device 2 also has an operating unit 21 operated by the user, and an operating force sensor 23 (operating force detection unit) that detects the operating force applied by the user to the operating unit 21. In the first control, the control device 3 controls the robot arm 12 in response to the operating force detected by the operating force sensor 23 as an operation via the operating device 2, and in the second control, controls the robot arm 12 based on the operating force in addition to the trajectory data xu.
[0122] According to this configuration, in the second control, the pressing force of the end effector 11 against the object W is controlled by taking into consideration the operating force from the user in addition to the trajectory data xu. The operating force is a force that is directly linked to the pressing force of the end effector 11 against the object W, and is therefore used for controlling the robot arm 12 in the first control. In other words, by taking the operating force into consideration in the control of the robot arm 12 in the second control, it becomes easier to control the pressing force of the end effector 11 against the object W.
[0123] As an example, when recording the trajectory data xu in the first control, the control device 3 also records the operating force fm detected by the operating force sensor 23, and the operating force fm used to control the robot arm 12 in the second control is the operating force fm recorded by the first control.
[0124] According to this configuration, the operating force fm used for controlling the robot arm 12 in the second control is the operating force fm of the operating force sensor 23 recorded when the trajectory data xu is recorded in the first control. That is, in the second control, the pressing force of the end effector 11 against the target object W is controlled using the operating force fm when the trajectory data xu to be reproduced in the second control is generated. As a result, in the second control, the trajectory data xu and the operating force fm in the first control are reproduced.
[0125] Furthermore, the trajectory data xu and the operating force fm each include multiple directional components, and the control device 3 is configured to be able to select, in the second control, a directional component to be used for controlling the robot arm 12 from among the multiple directional components included in the trajectory data xu and the multiple directional components included in the operating force fm.
[0126] According to this configuration, it is possible to select the direction in which the trajectory data xu is reproduced and the direction in which the pressing force of the end effector 11 is controlled by the operating force fm. That is, it is possible to give priority to reproducing the trajectory data xu in one direction, give priority to controlling the pressing force of the end effector 11 in another direction, and both reproduce the trajectory data xu and control the pressing force of the end effector 11 in another direction. Depending on the object W and the work content, there are cases in which the direction in which the trajectory data xu is to be reproduced with priority and the direction in which the pressing force of the end effector 11 is to be controlled with priority are determined. The robot system 100 can flexibly respond to such situations.
[0127] As another example of using the operating force fm to control the robot arm 12 in the second control, the operating force fm used to control the robot arm 12 in the second control may be an operating force fm detected by the operating force sensor 23 based on the operation of the operating device 2 during the second control.
[0128] According to this configuration, when the position of the end effector 11 is controlled to reproduce the trajectory data xu in the second control, the pressing force of the end effector 11 against the target object W is adjusted based on the operating force fm input in real time by operating the operating device 2. In other words, the user can adjust the pressing force of the end effector 11 in real time by operating the operating device 2 as necessary while observing the position control of the end effector 11 based on the operation history in the first control.
[0129] In addition, the robot system 100 further includes a contact force sensor 13 (contact force detection unit) that detects a contact force fs, which is a reaction force acting from the object W to the end effector 11, and the control device 3 is configured to control the robot arm 12 in accordance with the operating force fm and the contact force fs by using a motion model of the end effector 11 and the robot arm 12 based on a motion equation including an inertia coefficient md, a viscosity coefficient cd, and a stiffness coefficient kd in the first control and the second control.
[0130] According to this configuration, the robot arm 12 can be controlled while taking into consideration the virtual inertia, viscosity, and elasticity of the end effector 11 and the robot arm 12.
[0131] For example, the control device 3 is configured to be able to select whether or not to use the stiffness coefficient kd in the second control.
[0132] According to this configuration, it is possible to select whether or not to consider the elasticity of the end effector 11 and the robot arm 12 in the motion model. For example, when the elasticity is not considered, the motion model is a model in which the damping force based on the viscosity coefficient cd is dominant. In such a model, when there is a difference between the surface of the object W and the trajectory indicated by the trajectory data xu, the grinding device 11a moves so as to follow the surface of the object W according to the operating force fm.
[0133] Furthermore, in the second control, the control device 3 changes the stiffness coefficient kd in response to the operation force fm and the contact force fs.
[0134] According to this configuration, by changing the stiffness coefficient kd according to the operation force fm and the contact force fs, the pressing force of the end effector 11 can be controlled to correspond to the operation force fm and the contact force fs. Specifically, the pressing force of the end effector 11 can be increased by increasing the stiffness coefficient kd as the operation force fm is larger and / or the contact force fs is smaller. Conversely, the pressing force of the end effector 11 can be decreased by decreasing the stiffness coefficient kd as the operation force fm is smaller and / or the contact force fs is larger. Furthermore, by limiting the stiffness coefficient kd according to the operation force fm and the contact force fs, it is possible to prevent damage to the end effector 11 when the contact force fm or the contact force fs is too large.
[0135] The robot system 100 further includes a contact force sensor 13 that detects a contact force, which is a reaction force acting from the object 2 to the end effector 11. The control device 3 calculates position-related information regarding the position of the end effector 11, for example, a command velocity xd', based on the operating force fm and the contact force fs, generates a command position xds of the end effector 11 and a command position xdm of the operating unit 21 related to the command position xds of the end effector 11 based on the position-related information, and controls the robot arm 12 based on the command position xds of the end effector 11 while controlling the operating device 2 based on the command position xdm of the operating unit 21. The trajectory information is at least one of the position-related information, the command position xds of the end effector 11, and the command position xdm of the operating unit 21.
[0136] Other Embodiments As described above, the above embodiment has been described as an example of the technology disclosed in this application. However, the technology in this disclosure is not limited to this, and can be applied to embodiments in which modifications, replacements, additions, omissions, etc. are appropriately performed. In addition, it is also possible to combine the components described in the above embodiment to form a new embodiment. In addition, among the components described in the attached drawings and detailed description, not only components essential for solving the problem but also components that are not essential for solving the problem in order to exemplify the technology may be included. Therefore, the fact that these non-essential components are described in the attached drawings and detailed description should not immediately be taken to mean that these non-essential components are essential.
[0137] For example, in the second control, the operating force used to control the pressing force of the end effector 11 against the object W is not limited to the historical operating force fm by the first control and the operating force fm based on the operation of the operating unit 21 during the second control. For example, a preset operating force fm may be used to control the pressing force of the end effector 11 against the object W, that is, substituted into formula (2). In other words, the operating force used to control the pressing force of the end effector 11 against the object W may be a set operating force, rather than an operating force via the operating device 2.
[0138] Furthermore, the trajectory data xu recorded in the first control is not limited to the command position xdm, and may be a command position xds or a command velocity xd'. Furthermore, the trajectory data xu recorded in the first control may be position-related information related to the position of the end effector 11. In the above example, the command velocity xd' is calculated from the resultant force fm+fs, and the command velocity xd' corresponds to the position-related information. However, when the command velocity command position xd is calculated from the resultant force fm+fs, the command position xd corresponds to the position-related information.
[0139] The above-described method of calculating the command position xds and the command position xdm from the resultant force fm+fs is merely an example. For example, the motion model is merely an example, and a different motion model may be used.
[0140] The above-described block diagram is an example, and multiple blocks may be realized as one block, one block may be divided into multiple blocks, or some functions may be moved to another block.
[0141] The technology of the present disclosure may be a program for executing the control method, or a non-transitory computer-readable recording medium having the program recorded therein. Also, the program may be one that can be distributed via a transmission medium such as the Internet.
[0142] The functions of the configurations disclosed in the present embodiment may be implemented using electrical circuits or processing circuits. The processor is a processing circuit including transistors and other circuits. In the present disclosure, a unit, controller, or means is hardware or programmed to perform the described functions. Here, the hardware is hardware disclosed in the present embodiment or known hardware configured or programmed to perform the functions disclosed in the present embodiment. When the hardware is a processor or controller, the circuit, means, or unit is a combination of hardware and software, and the software is used to configure the hardware and / or the processor. [Explanation of symbols]
[0143] 100 Robot System 1 Robot (slave device) 11 End effector (action part) 12 Robot arm (moving part) 13 Contact force sensor (contact force detection part) 2 Operation device (master device) 21 Control section 23 Operational force sensor (operational force detection unit) 3. Control device W Object
Claims
1. a master device operated by a user; a slave device having an action unit that applies an action to an object and an action unit that operates the action unit; a control device for controlling the slave device, the master device has an operation unit operated by the user and an operation force detection unit that detects an operation force applied by the user to the operation unit, The control device includes: a first control that controls the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, thereby causing the action unit to apply an action to the object, and records trajectory information related to a motion trajectory of the action unit; a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object; The trajectory information and the operational force each include components in a plurality of directions, In the second control, the control device controls a pressing force of the action unit against the object when controlling the operation unit based on the trajectory information, The control device is a robot system configured to allow a user to select a directional component to be used for controlling the operating unit from among a plurality of directional components contained in the trajectory information and a plurality of directional components contained in the operating force, in the second control.
2. 2. The robot system according to claim 1, The control device, in the first control, when recording the trajectory information, also records the operation force detected by the operation force detection unit, A robot system in which the operational force used to control the operating unit in the second control is the operational force recorded by the first control.
3. 2. The robot system according to claim 1, In the second control, the control device uses some directional components out of a plurality of directional components contained in the operating force to control the operating unit, and uses directional components other than the some directional components of the operating force out of a plurality of directional components contained in the trajectory information to control the operating unit.
4. a master device operated by a user; a slave device having an action unit that applies an action to an object and an action unit that operates the action unit; a control device for controlling the slave device, the master device has an operation unit operated by the user and an operation force detection unit that detects an operation force applied by the user to the operation unit, The control device includes: a first control that controls the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, thereby causing the action unit to apply an action to the object, and records trajectory information related to a motion trajectory of the action unit; a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object; In the second control, the control device controls a pressing force of the action unit against the object when controlling the operation unit based on the trajectory information, A robot system in which the operational force used to control the operating unit in the second control is an operational force detected by the operational force detection unit based on operation of the operating unit during the second control.
5. a master device operated by a user; a slave device having an action unit that applies an action to an object and an action unit that operates the action unit; A control device that controls the slave device; a contact force detection unit that detects a contact force that is a reaction force acting from the object to the action unit, the master device has an operation unit operated by the user and an operation force detection unit that detects an operation force applied by the user to the operation unit, The control device includes: a first control that controls the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, thereby causing the action unit to apply an action to the object, and records trajectory information related to a motion trajectory of the action unit; a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object; In the second control, the control device controls a pressing force of the action unit against the object when controlling the operation unit based on the trajectory information, The control device includes: In the first control and the second control, the operation unit is controlled in response to the operation force and the contact force by using a motion model of the operation unit and the action unit based on a motion equation including an inertia coefficient, a viscosity coefficient, and a stiffness coefficient; A robot system configured such that, in the second control, a user can select whether or not to use the stiffness coefficient.
6. a master device operated by a user; a slave device having an action unit that applies an action to an object and an action unit that operates the action unit; a control device for controlling the slave device, the master device has an operation unit operated by the user and an operation force detection unit that detects an operation force applied by the user to the operation unit, The control device includes: a first control that controls the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, thereby causing the action unit to apply an action to the object, and records trajectory information related to a motion trajectory of the action unit; a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object; In the second control, the control device controls a pressing force of the action unit against the object when controlling the operation unit based on the trajectory information, a contact force detection unit that detects a contact force that is a reaction force acting from the object to the action unit, The control device includes: In the first control and the second control, the operation unit is controlled in response to the operation force and the contact force by using a motion model of the operation unit and the action unit based on a motion equation including an inertia coefficient, a viscosity coefficient, and a stiffness coefficient; In the second control, the stiffness coefficient is changed in response to the operating force and the contact force.
7. a master device operated by a user; a slave device having an action unit that applies an action to an object and an action unit that operates the action unit; A control device that controls the slave device; a contact force detection unit that detects a contact force that is a reaction force acting from the object to the action unit, the master device has an operation unit operated by the user and an operation force detection unit that detects an operation force applied by the user to the operation unit, The control device includes: a first control that controls the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, thereby causing the action unit to apply an action to the object, and records trajectory information related to a motion trajectory of the action unit; a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object; In the second control, the control device controls a pressing force of the action unit against the object when controlling the operation unit based on the trajectory information, In the first control, the control device calculating position-related information relating to a position of the action portion based on the operation force and the contact force; generating a command position of the action unit and a command position of the operation unit related to the command position of the action unit based on the position relation information; controlling the operation unit based on a command position of the action unit, and controlling the master device based on a command position of the operation unit; A robot system in which the trajectory information is at least one of the position related information, a command position of the action unit, and a command position of the operation unit.
8. A control method for a robot system including a master device operated by a user, the master device having an operation unit operated by a user and an operation force detection unit that detects an operation force applied by the user to the operation unit, and a slave device having an action unit that applies an action to an object and an operation unit that operates the action unit, executing a first control for causing the action unit to apply an action to the object by controlling the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, and recording trajectory information related to a motion trajectory of the action unit; and executing a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object, The trajectory information and the operational force each include components in a plurality of directions, a control method for a robot system, in which, in the second control, when controlling the operating unit based on the trajectory information, a pressing force of the action unit against the target object is controlled, and a directional component to be used for controlling the operating unit from among a plurality of directional components included in the trajectory information and a plurality of directional components included in the operating force can be selected by a user.
9. 9. The method for controlling a robot system according to claim 8, In the first control, when the trajectory information is recorded, the operating force detected by the operating force detection unit is also recorded, A control method for a robot system, wherein the operational force used in controlling the operating unit in the second control is the operational force recorded by the first control.
10. 9. The method for controlling a robot system according to claim 8, A control method for a robot system, wherein in the second control, some directional components out of a plurality of directional components included in the operating force are used to control the operating unit, and directional components other than the some directional components of the operating force out of a plurality of directional components included in the trajectory information are used to control the operating unit.
11. A control method for a robot system including a master device operated by a user, the master device having an operation unit operated by a user and an operation force detection unit that detects an operation force applied by the user to the operation unit, and a slave device having an action unit that applies an action to an object and an operation unit that operates the action unit, executing a first control for causing the action unit to apply an action to the object by controlling the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, and recording trajectory information related to a motion trajectory of the action unit; and executing a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object, In the second control, when controlling the operation unit based on the trajectory information, a pressing force of the action unit against the object is controlled; A control method for a robot system, wherein the operational force used for controlling the operating unit in the second control is an operational force detected by the operational force detection unit based on operation of the operating unit during the second control.
12. A control method for a robot system including a master device operated by a user, the master device having an operation unit operated by a user and an operation force detection unit that detects an operation force applied by the user to the operation unit, and a slave device having an action unit that applies an action to an object and an operation unit that operates the action unit, executing a first control for causing the action unit to apply an action to the object by controlling the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, and recording trajectory information related to a motion trajectory of the action unit; and executing a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object, In the second control, when controlling the operation unit based on the trajectory information, a pressing force of the action unit against the object is controlled; The robot system further includes a contact force detection unit that detects a contact force that is a reaction force acting from the object to the action unit, In the first control and the second control, the operation unit is controlled in response to the operation force and the contact force by using a motion model of the operation unit and the action unit based on a motion equation including an inertia coefficient, a viscosity coefficient, and a stiffness coefficient; A control method for a robot system, wherein in the second control, a user can select whether or not to use the stiffness coefficient.
13. A control method for a robot system including a master device operated by a user, the master device having an operation unit operated by a user and an operation force detection unit that detects an operation force applied by the user to the operation unit, and a slave device having an action unit that applies an action to an object and an operation unit that operates the action unit, executing a first control for causing the action unit to apply an action to the object by controlling the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, and recording trajectory information related to a motion trajectory of the action unit; and executing a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object, In the second control, when controlling the operation unit based on the trajectory information, a pressing force of the action unit against the object is controlled; The robot system further includes a contact force detection unit that detects a contact force that is a reaction force acting from the object to the action unit, In the first control and the second control, the operation unit is controlled in response to the operation force and the contact force by using a motion model of the operation unit and the action unit based on a motion equation including an inertia coefficient, a viscosity coefficient, and a stiffness coefficient; In the second control, the stiffness coefficient is changed depending on the operating force and the contact force.
14. A control method for a robot system including a master device operated by a user, the master device having an operation unit operated by a user and an operation force detection unit that detects an operation force applied by the user to the operation unit, and a slave device having an action unit that applies an action to an object and an operation unit that operates the action unit, comprising: executing a first control for causing the action unit to apply an action to the object by controlling the action unit in response to an operational force detected by the operational force detection unit as an operation via the master device, and recording trajectory information related to a motion trajectory of the action unit; and executing a second control for controlling the operation unit based on the operation force in addition to the trajectory information recorded by the first control, thereby moving the action unit so as to reproduce the action trajectory, and causing the action unit to apply an action to the object, In the second control, when controlling the operation unit based on the trajectory information, a pressing force of the action unit against the object is controlled; The robot system further includes a contact force detection unit that detects a contact force that is a reaction force acting from the object to the action unit, In the first control, position-related information regarding a position of the action portion is calculated based on the operation force and the contact force; A command position of the action unit and a command position of the operation unit related to the command position of the action unit are generated based on the position relation information; the operating unit is controlled based on a command position of the action unit, while the master device is controlled based on a command position of the operation unit, A method for controlling a robot system, wherein the trajectory information is at least one of the position related information, a command position of the action unit, and a command position of the operation unit.
Citation Information
Patent Citations
Method of controlling manipulator
JP1982189779A
Grinding device for plane and curved surface
JP1994214633A
Control device for manipulator
JP1995032283A
Arm driving device
JP1996141961A
Master-slave manipulator and control method thereof
JP1996281573A
