Control device, control method, and control program
The control device adjusts operation commands based on detected reaction forces to synchronize follower robots with leader robots, ensuring precise and reliable operation by reducing speed or stopping operations when necessary, addressing the issue of reaction forces exceeding allowable values in master-slave systems.
Patent Information
- Application Number
- PCT/JP2025/016702
- Authority / Receiving Office
- WO · WO
- Patent Type
- Applications
- Current Assignee / Owner
- Filing Date
- 2025-05-07
- Publication Date
- 2026-11-12
AI Technical Summary
Existing master-slave robot systems fail to reliably perform operations requiring high accuracy when reaction forces on the slave arm exceed a preset allowable value, even if the force is slight, leading to inconvenience.
A control device that adjusts operation commands based on detected reaction forces using profile information and a processor to synchronize the follower robot with the leader robot, reducing operation speed or stopping operations when reaction forces exceed a threshold, ensuring precise task execution.
Ensures reliable and precise operation of the follower robot by adjusting commands in response to reaction forces, preventing excessive forces and protecting the robot and workpiece, even under varying conditions.
Smart Images

Figure JP2025016702_12112026_PF_FP_ABST
Abstract
Description
Control Device, Control Method, and Control Program
[0001] The present disclosure relates to a control device, a control method, and a control program.
[0002] A master-slave type robot system is disclosed that causes a slave arm to perform a predetermined operation by making the slave arm follow the motion of a master arm (see, for example, Patent Document 1). In this robot system, when a reaction force with a magnitude exceeding a preset allowable value acts on the slave arm, the follow-up motion of the slave arm is restricted.
[0003] Japanese Unexamined Patent Application Publication No. 2018-192600
[0004] In the case of the robot system as described above, even if a reaction force acts on the slave arm, the follow-up motion of the slave arm will continue as long as the reaction force does not exceed the allowable value. That is, when the slave arm performs an operation requiring high accuracy, inconvenience may occur even if the reaction force acting on the slave arm is slight. Accordingly, in systems adopting the leader-follower scheme as described above, it is desired that predetermined operations can be reliably performed regardless of the magnitude of the reaction force acting on the follower side.
[0005] One aspect of the present disclosure is a control device that controls a follower device that operates by following a leader device, the control device comprising at least one memory and at least one processor, wherein the memory stores profile information indicating a correspondence relationship between an assumed value for a reaction force generated in the follower device during the operation and a control command for causing the follower device to perform the operation, and the processor adjusts the control command based on the reaction force and the profile information.
[0006] This is a schematic diagram showing a control device according to one embodiment of the present disclosure and the configuration of a robot system to which the control device is applied. This is a block diagram conceptually subdivided the configuration of the control device shown in Figure 1 based on its function. This is an example of profile information stored in the memory of the control device shown in Figure 1. This is a flowchart of a control method according to one embodiment of the present disclosure. This is a graph for explaining the effect of the adjustment program executed by the control device shown in Figure 1. This is an example of a user interface to be displayed on a display device in a first modified example of the control device shown in Figure 1. This is a schematic diagram showing a modified robot system shown in Figure 1. This is a graph showing profile information of a second modified example of the control device shown in Figure 1.
[0007] A control device 10, a control method, and a control program (adjustment program) P3 according to one embodiment of this disclosure will be described below with reference to the drawings. The control device 10 according to this embodiment is, for example, a device for controlling a robot system 100 that constitutes a leader-follower system, as shown in Figure 1.
[0008] First, the configuration of the robot system 100 will be described. As shown in Figure 1, for example, the robot system 100 comprises a leader robot (leader device) 20, a follower robot (follower device) 30, and a control device 10 that controls the leader robot 20 and the follower robot 30. The robot system 100 performs a predetermined task by having the follower robot 30, which is positioned at a distance from the leader robot 20, follow the movements of the leader robot 20, which is operated by an operator.
[0009] The leader robot 20 is, for example, a 6-axis vertical articulated robot, and as shown in Figure 1, comprises a base 21 and a plurality of movable members 22 that are connected to each other so as to be rotatable relative to each other.
[0010] The movable member 22 is composed of, in order from the base 21 side, a rotating body 22a, a first arm 22b, a second arm 22c, and a three-axis wrist unit 22d. A servo motor (not shown) and a reduction gear (not shown) are arranged at the joints formed between adjacent pairs of movable members 22 to rotate the movable members 22 on each side relative to each other. An encoder (not shown) is also mounted at each joint to detect its rotation angle (position). An operating handle (not shown) is attached to the tip of the wrist unit 22d for the operator to directly grasp with their hand and guide the leader robot 20 to a desired posture.
[0011] Furthermore, in this embodiment, the leader robot 20 is located in a control room C that is different from the location where the follower robot 30, which will be described later, is positioned. Inside the control room C, there is a monitoring device (not shown) that displays the status of the follower robot 30, such as its posture, which is acquired by a camera (not shown) or the like that is placed near the follower robot 30.
[0012] Next, the follower robot 30 is a robot that actually performs predetermined tasks in a factory or other work site. The follower robot 30 illustrated in Figure 1 is a 6-axis vertical articulated robot and is configured to have a similar structure to the leader robot 20. More specifically, the follower robot 30 comprises a base 31 and a plurality of movable members 32 that are connected to each other so as to be rotatable relative to each other. In this case, the movable members 32 are composed of, in order from the base 31 side, a swivel body 32a, a first arm 32b, a second arm 32c, and a 3-axis wrist unit 32d.
[0013] Furthermore, the joints formed between adjacent pairs of movable members 32 are each equipped with a servo motor (not shown) for relative rotation of the movable members 32 on both sides, and a reduction gear (not shown) for reducing the rotation of each servo motor. In other words, each joint of the follower robot 30 operates when its respective servo motor is driven by an operation command transmitted from a control device 10, which will be described later.
[0014] The tip of the wrist unit 32d is provided with a flange 33 to which a tool (not shown) for a predetermined task performed by the follower robot 30 can be detachably attached. The wrist unit 32d is also equipped with a sensor 35 that detects the reaction force F acting when the tool attached to the flange 33 comes into contact with the workpiece of the predetermined task performed by the follower robot 30. In this case, the sensor 35 is, for example, a 6-axis force sensor. That is, the sensor 35 can detect the reaction force in the translational direction in the XYZ axis direction and the reaction force in the rotational direction around the XYZ axis acting on the tip of the wrist when the follower robot 30 performs a predetermined task.
[0015] The control device 10 is a device that controls the operation of the leader robot 20 and the follower robot 30, and as shown in Figure 2, it includes a memory 11 and a processor 12. The control device 10 is communicated with the leader robot 20 and the follower robot 30 by wired or wireless communication means.
[0016] The memory 11 includes, for example, a volatile storage medium such as RAM and a non-volatile storage medium such as ROM, HDD, or SSD. As shown in Figure 2, the memory 11 stores a system program P1, an operation program P2, an adjustment program (control program) P3, profile information D1, and a threshold D2.
[0017] In this embodiment, the system program P1 is a program that performs the basic functions of the control device 10 and is a program that is pre-stored in the non-volatile storage medium of the memory 11.
[0018] The operation program P2 is a program that causes the follower robot 30 to follow the movements of the leader robot 20, which is operated by the operator, and to perform a predetermined task. In other words, the operation program P2 is a program that acquires the detected values V of the encoders of each joint of the leader robot 20 and generates an operation command (control command) O1 that causes the follower robot 30 to perform a tracking movement based on each detected value V.
[0019] The motion command O1 is a command to operate the servo motors of each joint of the follower robot 30 so that the follower robot 30 follows the leader robot 20 in synchronization. For example, motion command O1 is a command to move the wrist tip (tool) of the follower robot 30 to a position corresponding to the position of the wrist tip of the leader robot 20. Specifically, motion command O1 is a command to move the wrist tip (tool) of the follower robot 30 at a speed obtained by multiplying the movement speed of the wrist tip of the leader robot 20 by a predetermined ratio. In this case, the predetermined ratio is a ratio determined based on information (shape information) regarding the difference in shape between the leader robot 20 and the follower robot 30.
[0020] For example, suppose the arm lengths of the first arm 32b and the second arm 32c of the follower robot 30 are twice the arm lengths of the first arm 22b and the second arm 22c of the leader robot 20, respectively. In this case, the movement speed of the wrist tip (tool) of the follower robot 30 is controlled to be twice the movement speed of the wrist tip of the leader robot 20. This allows the follower robot 30 to be synchronized with the leader robot 20 of different sizes, and to perform actions corresponding to the movements of the leader robot 20.
[0021] Next, the adjustment program P3 is a program for adjusting the command value for the operating speed of the follower robot 30 included in the operation command O1 according to the magnitude of the reaction force F acting on the follower robot 30. In other words, the adjustment program P3 is a program for generating and outputting an operation command O1' which is an adjusted version of the operation command O1, based on the reaction force F acquired by the sensor 35 and the profile information D1 described later.
[0022] Profile information D1 is a correspondence table that associates multiple assumed values d1 for the reaction force F with multiple scales d2 used when adjusting the operation command O1 according to the adjustment program P3, as shown in Figure 3, for example. In the example shown in Figure 3, when the assumed value d1 is 0N, 1.00 is associated with the scale d2. Furthermore, as the magnitude of the assumed value d1 increases, the magnitude of the corresponding scale d2 gradually decreases. When the magnitude of the assumed value d1 is a predetermined size, in this case 100N, the magnitude of the associated scale d2 is set to 0.
[0023] The threshold value D2 is determined by multiplying the smallest of the strength limits of each joint of the follower robot 30 and the tools attached to the flange 33 by a predetermined safety factor. In this embodiment, the magnitude of the threshold value D2 is set to 100 N.
[0024] The processor 12 is, for example, a CPU or PLC, and reads and executes the operation program P2 and the adjustment program P3 according to the system program P1 stored in the memory 11. Here, the processing content resulting from the execution of the operation program P2 and the adjustment program P3 by the processor 12 will be explained in more detail using a block diagram (Figure 2) that conceptually subdivides the processor 12 based on its functions.
[0025] The processor 12 can be thought of as being composed of multiple functional blocks. In this embodiment, the processor 12 is thought to have three functional blocks, namely a receiving unit 12a, an arithmetic unit 12b, and an output unit 12c. The receiving unit 12a receives information regarding the operation of the leader robot 20 operated by the operator, that is, the detected values V of the encoders of each joint, at a period according to the operation program P2. The receiving unit 12a also receives the reaction force F detected by the sensor 35 according to the adjustment program P3, at a period specified in the adjustment program P3.
[0026] The calculation unit 12b generates an operation command O1 that causes the follower robot 30 to follow the movement of the leader robot 20, according to the operation program P2. Specifically, the calculation unit 12b calculates the movement speed and direction of the wrist tip of the leader robot 20 operated by the operator, based on the detected values V of the encoders at each joint of the leader robot 20. The calculation unit 12b also calculates the movement direction of the wrist tip of the follower robot 30 that corresponds to the movement direction of the wrist tip of the leader robot 20, based on the coordinate systems set for the leader robot 20 and the follower robot 30, respectively. Next, the calculation unit 12b calculates a value (movement speed) by multiplying the calculated movement speed of the wrist tip of the leader robot 20 by a ratio based on the shape difference between the leader robot 20 and the follower robot 30. Then, it generates an operation command O1 that causes the wrist tip of the follower robot 30 to move in the calculated movement direction and at the calculated movement speed.
[0027] Furthermore, the calculation unit 12b is also a functional block that adjusts the operation command O1 for operating the follower robot 30 according to the adjustment program P3. Specifically, each time the receiving unit 12a acquires a reaction force F, the calculation unit 12b selects a scale d2 from the profile information D1 based on that reaction force F. In other words, the calculation unit 12b compares the acquired reaction force F with the profile information D1 and selects a scale d2 from the profile information D1 that is associated with an assumed value d1 that matches or approximates the magnitude of the acquired reaction force F. The calculation unit 12b also generates an operation command O1' in which the movement speed (command value) of the wrist tip of the follower robot 30, which is included in the operation command O1 generated immediately after the selection of the scale d2, is replaced with a value obtained by multiplying it by the selected scale d2.
[0028] The output unit 12c is a functional block that outputs the operation command O1 or operation command O1' generated by the calculation unit 12b to the follower robot 30.
[0029] The control method using the control device 10 configured in this embodiment will be described below. In the following description, we will explain using the flowchart shown in Figure 4 as an example, in which the follower robot 30 polishes a work object (not shown). In this case, it is assumed that a polishing tool (not shown) is attached to the flange 33 of the follower robot 30.
[0030] First, the operator checks the status of the follower robot 30 displayed on the monitoring device in the control room C, and operates the control handle at the tip of the leader robot 20. At this time, the processor 12 of the control device 10 executes the operation program P2 and the adjustment program P3. As a result, the receiving unit 12a acquires the detected values V of the encoders at each joint of the leader robot 20, that is, information regarding the operation of the leader robot 20 (step S1).
[0031] Next, the calculation unit 12b calculates the movement speed and direction of the wrist tip of the leader robot 20 based on the detected values V of each encoder acquired. The calculation unit 12b also calculates a speed by multiplying the calculated movement speed of the leader robot 20 by a ratio determined by the difference in shape between the leader robot 20 and the follower robot 30. Then, the calculation unit 12b generates an operation command O1 to move the follower robot 30 in the direction corresponding to the movement direction of the wrist tip of the leader robot 20 at the speed calculated based on the difference in shape between the two robots 20 and 30 (step S2).
[0032] Furthermore, the generated operation command O1 is output to the follower robot 30 by the output unit 12c (step S2). This allows the follower robot 30 to synchronize with the operation of the leader robot 20, thereby enabling it to perform polishing work on the workpiece.
[0033] Furthermore, while the follower robot 30 is performing polishing work, the polishing tool is pressed against the workpiece, and a reaction force F of the same magnitude but in the opposite direction acts on the tip of the follower robot 30's wrist via the polishing tool. This reaction force F is detected by a sensor 35 attached to the wrist unit 32d of the follower robot 30.
[0034] The detected reaction force F is acquired by the receiving unit 12a according to the adjustment program P3 executed by the processor 12 and passed to the calculation unit 12b (step S3). The calculation unit 12b then determines a scale d2 corresponding to the received reaction force F based on the received reaction force F and the profile information D1 stored in the memory 11 (step S4).
[0035] For example, if the reaction force F received from the receiving unit 12a is 20N and the profile information D1 is a correspondence table as shown in Figure 3, the calculation unit 12b selects a value that matches 20N from among the multiple assumed values d1 in the profile information D1. Then, the calculation unit 12b determines the scale d2 associated with the assumed value d1 selected from the profile information D1, which in this case is 0.90, as the scale d2 corresponding to the received reaction force F.
[0036] Next, the calculation unit 12b multiplies the determined scale d2 by the command value for the movement speed of the wrist tip of the follower robot 30 included in the motion command O1 output immediately after detecting the reaction force F. In other words, the calculation unit 12b adjusts the velocity command value in the motion command O1 immediately after the reaction force F acts on the follower robot 30 based on the magnitude of the scale d2 (step S5). Then, the motion command O1 with the adjusted velocity command value is output to the follower robot 30 as motion command O1' by the output unit 12c (step S6). With the above steps, the adjustment of the magnitude of the motion command O1 to the follower robot 30 by executing the adjustment program P3 is completed.
[0037] In other words, in this case, if no reaction force F acts on the follower robot 30, the motion command O1 is input to the follower robot 30 without adjustment. If a reaction force acts on the follower robot 30, the velocity command value in the motion command O1 is adjusted so that the larger the reaction force F becomes, the smaller the velocity command value in the motion command O1 becomes. When the reaction force F reaches the threshold D2 (100N), the velocity command value in the motion command O1 is multiplied by 0 as a scale d2, so the operation of the follower robot 30 stops.
[0038] For example, as shown by the solid line in Figure 5, if the polishing tool is brought into forceful contact with the workpiece, the reaction force F acting on the follower robot 30 increases rapidly. However, according to this embodiment, as the reaction force F acting on the follower robot 30 increases, the scale d2 multiplied by the command value for the operating speed of the follower robot 30 decreases. Therefore, as shown by the dashed line in Figure 5, the operating speed of the follower robot 30 can be reduced or stopped depending on the magnitude of the reaction force F acting on the follower robot 30. This prevents the follower robot 30 from being subjected to an excessive reaction force F.
[0039] Furthermore, according to this embodiment, as shown in Figure 5, the magnitude of the motion command O1 can be adjusted even before the reaction force F acting on the follower robot 30 exceeds the threshold D2 if the motion command O1 is not adjusted. Therefore, even if the magnitude of the reaction force F acting on the follower robot 30 is small, the speed command value in the motion command O1 can be adjusted by a ratio corresponding to that small reaction force F. Thus, even when the follower robot 30 is required to perform a task that requires higher precision, the task can be reliably performed.
[0040] Furthermore, according to this embodiment, if the reaction force F acting on the follower robot 30 exceeds the threshold D2, the operation command O1' is adjusted to become 0. In other words, if an excessive reaction force F exceeding the threshold D2 acts on the follower robot 30, the operation of the follower robot 30 is stopped rather than slowed down, thus more reliably protecting the follower robot 30 and the workpiece.
[0041] In this embodiment, the threshold D2 is a value pre-stored in memory 11, but instead, the threshold D2 may be any value input by the operator. In this case, the robot system 100 may be equipped with a display device 40 that displays a user interface 41 that enables input of the threshold D2 for the reaction force F, as shown in Figure 6.
[0042] Accordingly, even if the limit value of the reaction force F allowable for the follower robot 30 is changed due to a change in the tool attached to the follower robot 30 or the like, the value of the threshold D2 can be easily changed to match the limit value. That is, even for a slight change in the state of the follower robot 30, the magnitude of the threshold D2 can be appropriately changed in accordance with the change, and the follower robot 30 can be caused to perform a predetermined operation more reliably.
[0043] Further, the user interface 41 may allow input of not only the threshold D2 but also information related to the respective shapes of the leader robot 20 and the follower robot 30, for example, information related to the arm length of each movable member 22. Further, the user interface 41 may allow input of any parameter used for adjusting the operation command O1, such as information related to the respective operation ranges (operation range information) of the leader robot 20 and the follower robot 30.
[0044] Furthermore, in the present embodiment, when the sensor 35 can detect a plurality of directional components of the reaction force F, the threshold D2 may be set for each directional component. Accordingly, even if an external force from an unintended direction acts on the follower robot 30, the operation speed of the follower robot 30 can be reduced or stopped in accordance with the magnitude of the external force. Therefore, there is an advantage that the follower robot 30 can be protected more reliably.
[0045] Furthermore, in the present embodiment, a plurality of thresholds D2 may be set for the reaction force F in the same direction. For example, the memory 11 may store three thresholds D2 having mutually different magnitudes for the reaction force F in the same direction. In this case, when each of the plurality of thresholds D2 set for the reaction force F in the same direction is exceeded, the speed command value of the operation command O1 can be multiplied by a scale d2 of a different magnitude. Thereby, the operation command O1 can be adjusted more finely in accordance with the magnitude of the reaction force F. Accordingly, it is possible to enable highly accurate operation to be performed while minimizing deterioration in the efficiency of the work performed by the follower robot 30.
[0046] Further, in the present embodiment, when the detected reaction force F exceeds the threshold value D2, the operation of the follower robot 30 is stopped. Alternatively, when the detected reaction force F exceeds the threshold value D2, the operation direction of the follower robot 30 may be reversed.
[0047] That is, in the present embodiment, among the plurality of assumed values d1 in the profile information D1, the scale d2 associated with the assumed value d1 (100 N) that matches the magnitude of the threshold value D2 is set to 0. Alternatively, among the plurality of assumed values d1 in the profile information D1, the scale d2 associated with the assumed value d1 that matches the magnitude of the threshold value D2 may be set to a negative value. For example, when the threshold value D2 is 100 N, the scale d2 associated with the assumed value d1 of 100 N in the profile information D1 in FIG. 3 is set to -1.00. Accordingly, for example, when the tool at the tip of the follower robot 30 collides with a surrounding object and a reaction force F greatly exceeding the threshold value D2 acts on the follower robot 30, the follower robot 30 can be operated in the direction opposite to the collision direction. That is, the tool at the tip of the follower robot 30 can be pulled away from the collided object. Therefore, even if an excessive reaction force F acts on the follower robot 30, the reaction force F can be immediately removed, and the follower robot 30 and the tool can be more reliably protected.
[0048] Further, in the present embodiment, the speed command value of the follower robot 30 included in the operation command O1 is multiplied by the scale d2, but the target to be multiplied by the scale d2 is not limited to this. For example, when the operation command O1 specifies the movement amount of the wrist tip (tool) of the follower robot 30, the movement amount may be multiplied by the scale d2.
[0049] Furthermore, in this embodiment, the operation command O1 is generated based on information regarding the operation of the leader robot 20 and information regarding the difference in shape between the leader robot 20 and the follower robot 30. Alternatively, the operation command O1 may be generated based on information regarding the operation of the leader robot 20 and information regarding the difference in the operating range of the leader robot 20 and the follower robot 30 (operating range information). In this case, each operating range refers to, for example, the maximum stroke in each axial direction that is pre-set for both robots 20 and 30, or the stroke in each axial direction of both robots 20 and 30 that is arbitrarily set by the user.
[0050] For example, as shown in Figure 7, if the leader robot 20 and the follower robot 30 have different configurations, their ranges of motion will also differ significantly. In such cases, the operating speed of the follower robot 30 can be calculated based on the ratio of the amount of motion to the maximum stroke of each robot in their respective corresponding directions of motion. Specifically, the ratio (M / L) of the maximum stroke L of the leader robot 20 in one horizontal direction to the maximum stroke M of the follower robot 30 corresponding to that direction is multiplied by the operating speed of the leader robot 20. This value may then be used as the speed command value for the follower robot 30 in the motion command O1.
[0051] Furthermore, in this embodiment, the profile information D1 is a correspondence table that associates the assumed value d1 with the reaction force F and the scale d2. Alternatively, the profile information D1 may be a correspondence between the assumed value d1 and the speed command value or motion amount command value for the follower robot 30 included in the motion command O1. In this case, the adjusted operating speed or motion amount of the follower robot 30 can be obtained directly from the profile information D1, and the adjusted motion command O1' can be generated more easily.
[0052] Furthermore, in this embodiment, the profile information D1 may be a function that shows the relationship between an assumed value d1 for the reaction force F and the speed command value for the follower robot 30 included in the operation command O1. In this case, the adjustment amount of the operation command O1 can be uniquely determined by substituting the detected reaction force F into the assumed value d1 of the function in the profile information D1 and performing calculations. For example, as shown in Figure 8, an arbitrary function that shows the correspondence between the assumed value d1 and the scale d2 may be stored in the memory 11 as the profile information D1. In this case, a scale d2 suitable for the magnitude of the detected reaction force F can be extracted more reliably.
[0053] Furthermore, in this embodiment, the reaction force F acting on the follower robot 30 is exemplified as being detected by a sensor 35 attached to the wrist tip of the follower robot 30, but the method of detecting the reaction force F is not limited to this. For example, inverse kinematics may be applied to estimate the reaction force F acting on the wrist tip from the angles of each joint of the follower robot 30. Alternatively, the reaction force F may be estimated by observer control. That is, a mathematical model used to simulate the operation of the follower robot 30 is stored in the memory 11 in advance. As a result, the reaction force F acting on the wrist tip can be estimated by solving the mathematical model stored in the memory 11 based on the operation (operation command) of the follower robot 30. In such cases, the sensor 35 can be omitted from the follower robot 30.
[0054] Furthermore, in this embodiment, the control device 10 controls the operation of the follower robot 30 based on the operation of the leader robot 20. Alternatively, the control device 10 may control the operation of both the leader robot 20 and the follower robot 30.
[0055] For example, the control device 10 controls the follower robot 30 according to the operation command O1' adjusted by the method described above, and generates an operation command O2 (see Figure 2) that synchronizes the leader robot 20 with the operation of the follower robot 30. That is, the control device 10 multiplies the movement speed of the tool operating in accordance with the adjusted operation command O1' by a ratio based on the shape difference between the leader robot 20 and the follower robot 30. Then, based on the movement speed obtained by this calculation, it controls the movement of the wrist tip of the leader robot 20.
[0056] This allows the operator of the leader robot 20 to intuitively understand the movements of the follower robot 30, which operates according to the adjusted motion command O1', via the leader robot 20. Therefore, a sense of unity and operability between the leader robot 20 and the follower robot 30 can be achieved.
[0057] Furthermore, although the above embodiment described the control device 10 as controlling both the leader robot 20 and the follower robot 30, the control device 10 is not limited to this. For example, the control device 10 may be composed of two control devices that independently control the leader robot 20 and the follower robot 30. In this case, the two control devices that control the leader robot 20 and the follower robot 30 may be connected to each other by an Ethernet cable or the like. This allows information about the operation of the leader robot 20 to be acquired, and based on that information, the follower robot 30 to follow the operation of the leader robot 20. In addition, the operation of the follower robot 30 can be adjusted based on the reaction force F acting on the follower robot 30 and the profile information D1 that has been stored in advance.
[0058] Furthermore, in this embodiment, another device (such as a computer) different from the control device 10 may perform control to make the follower robot 30 follow the movement of the leader robot 20. In this case, the control device 10 may output a scale d2 determined based on the reaction force F acting on the follower robot 30 and the profile information D1 to the other device. This allows the other device to adjust the movement of the follower robot 30 in the same manner as described above.
[0059] Furthermore, in this embodiment, an example of an action command O1 is given that rotates each joint of the follower robot 30 by the same angle as the corresponding joint of the leader robot 20, but the action command O1 is not limited to this. For example, the action command O1 may be a command that rotates each joint of the follower robot 30 by an angle different from the rotation angle of the corresponding joint of the leader robot 20. Specifically, there are cases where the posture of the follower robot 30 is adjusted to match that of the leader robot 20 from a state where the postures of the leader robot 20 and the follower robot 30 are different. In such cases, the rotation angle of each joint of the follower robot 30 that operates according to the action command O1 must be different from the rotation angle of the corresponding joint of the leader robot 20.
[0060] In this embodiment, the operator moves the operating handle of the leader robot 20 by hand to cause the leader robot 20 to perform the desired action. Alternatively, if a controller is provided to control the operation of the leader robot 20, the operator may operate the controller to cause the leader robot 20 to perform the desired action.
[0061] Furthermore, in this embodiment, the leader robot 20 was a robot with a similar structure to the follower robot 30, but the configuration of the leader robot 20 is not limited to this. For example, the leader robot 20 may be a simple operating lever or the like, as long as it can receive input for the amount of movement in the direction corresponding to the movement direction of the follower robot 30.
[0062] Although embodiments of this disclosure have been described in detail above, this disclosure is not limited to the individual embodiments described above. These embodiments can be added, replaced, modified, partially deleted, etc., in any way that does not depart from the gist of the invention or from the spirit and intent of the invention derived from the claims and their equivalents. For example, the order of operations and processes in the embodiments described above are shown as examples only and are not limited thereto.
[0063] The following further notes are disclosed regarding the above embodiments and modifications. (Note 1) A control device for controlling a follower device that operates in accordance with a leader device, comprising at least one memory and at least one processor, wherein the memory stores profile information indicating a correspondence between an assumed value for the reaction force generated in the follower device during the operation and a control command for causing the follower device to perform the operation, and the processor adjusts the control command based on the reaction force and the profile information. (Note 2) The control device according to Note 1, wherein the reaction force is detected by a sensor provided in the follower device. (Note 3) The control device according to Note 1 or Note 2, wherein the memory stores a plurality of threshold values for the reaction force, and when the reaction force exceeds each of the threshold values, the processor adjusts the control command. (Note 4) The control device according to Note 1 or Note 2, wherein the memory stores a predetermined threshold for the reaction force, and the processor adjusts the control command to reduce the operating speed or amount of the follower device as the reaction force approaches the threshold. (Note 5) The control device according to Note 1 or Note 2, wherein the memory stores a predetermined threshold for the reaction force, and the processor adjusts the control command to reverse or stop the operating direction of the follower device when the reaction force is greater than or equal to the threshold. (Note 6) The control device according to any one of Notes 1 to 5, wherein the profile information indicates the correspondence between the assumed value and the scale multiplied by the control command. (Note 7) The control device according to any one of Notes 1 to 6, wherein the memory stores at least one of shape information indicating the difference in shape between the leader device and the follower device and operating range information indicating the difference in operating range, and the processor calculates a ratio based on at least one of the shape information and the operating range information, and generates the control command based on the ratio. (Note 8) The control device according to Note 7, wherein the processor causes a user interface on a display device that allows setting at least one of the shape information and the operating range information.(Note 9) The control device according to any one of Notes 3 to 5, wherein the processor causes a user interface to be displayed on a display device that allows setting at least one of the profile information and the threshold. (Note 10) A control method for controlling a follower device that operates in accordance with the operation of a leader device, wherein the control command is adjusted based on the reaction force generated in the follower device during the operation and profile information that shows the correspondence between an assumed value for the reaction force and a control command for causing the follower device to perform the operation. (Note 11) A control program used when controlling a follower device that operates in accordance with the operation of a leader device, wherein the program causes a computer to adjust the control command based on the reaction force generated in the follower device during the operation and profile information that shows the correspondence between an assumed value for the reaction force and a control command for causing the follower device to perform the operation.
[0064] 10 Control device 11 Memory 12 Processor 20 Leader robot (leader device) 30 Follower robot (follower device) 35 Sensor 40 Display device 41 User interface d1 Expected value D1 Profile information d2 Scale D2 Threshold F Reaction force O1 Operation command (control command) P3 Adjustment program (control program)
Claims
1. A control device for controlling a follower device that operates in accordance with a leader device, comprising at least one memory and at least one processor, wherein the memory stores profile information indicating the correspondence between an assumed value for the reaction force generated in the follower device during the operation and a control command for causing the follower device to perform the operation, and the processor adjusts the control command based on the reaction force and the profile information.
2. The control device according to claim 1, wherein the reaction force is detected by a sensor provided in the follower device.
3. The control device according to claim 1 or 2, wherein the memory stores a plurality of threshold values for the reaction force, and when the reaction force exceeds each of the threshold values, the processor adjusts the control command.
4. The control device according to claim 1 or 2, wherein the memory stores a predetermined threshold for the reaction force, and as the reaction force approaches the threshold, the processor adjusts the control command to reduce the operating speed or amount of the follower device.
5. The control device according to claim 1 or 2, wherein the memory stores a predetermined threshold for the reaction force, and when the reaction force is greater than or equal to the threshold, the processor adjusts the control command to reverse or stop the operating direction of the follower device.
6. The control device according to any one of claims 1 to 5, wherein the profile information indicates the correspondence between the assumed value and the scale multiplied by the control command.
7. The control device according to any one of claims 1 to 6, wherein the memory stores at least one of shape information indicating a difference in shape between the reader device and the follower device and operating range information indicating a difference in operating range, and the processor calculates a ratio based on at least one of the shape information and the operating range information, and generates the control command based on the ratio.
8. The control device according to claim 7, wherein the processor causes a user interface on a display device that allows setting at least one of the shape information and the operating range information.
9. The control device according to any one of claims 3 to 5, wherein the processor causes a user interface on a display device that allows setting at least one of the profile information and the threshold.
10. A control method for controlling a follower device that operates in accordance with the operation of a leader device, the method comprising adjusting the control command based on a reaction force generated in the follower device during the operation, and profile information indicating the correspondence between an assumed value for the reaction force and a control command for causing the follower device to perform the operation.
11. A control program used to control a follower device that operates in accordance with the operation of a leader device, wherein the control program causes a computer to adjust the control command based on the reaction force generated in the follower device during the operation, profile information showing the correspondence between an assumed value for the reaction force and a control command for causing the follower device to perform the operation.
