Control device, control method and control system
By setting force sensors and torque sensors in the robot to detect and correct the torque command value, the problem of insufficient force control during contact is solved, and safe and high-precision operation and vibration suppression are achieved.
Patent Information
- Application Number
- CN201980046168.7
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Priority Date
- 2018-07-17
- Filing Date
- 2019-07-08
- Publication Date
- 2024-11-08
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The prior art cannot effectively control the force exerted by a robot when it comes into contact with a person or object, causing it to hurt or damage the object, and cannot suppress the vibration of the robot itself.
By setting a force sensor and a torque sensor in the robot, detecting and comparing external forces and torque, and correcting the torque command value based on the comparison results to control the operation of the robot during contact, achieving passive operation and suppressing vibration.
Accurate control of robot operation is achieved, ensuring that people do not harm or objects during contact, and improving the stability and safety of robot operation.
Smart Images

Figure CN112384341B_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to a control device, a control method, and a control system. Background Art
[0002] In recent years, technology related to robots that coexist and cooperate with humans has been attracting attention. As an example of this technology, technology for controlling the operation of robots has begun to spread.
[0003] Patent Document 1 discloses a technology of correcting the operation of a robot based on an external force applied to the robot detected by a sensor provided in the robot, etc., to suppress vibration occurring in the robot.
[0004] [Citation List]
[0005] [Patent Document]
[0006] [Patent Document 1] JP 2017-124455 A Summary of the Invention
[0007] [Technical Issues]
[0008] The above-mentioned technology can, for example, suppress vibrations that occur in a robot when it comes into contact with people, objects, or the like through position control. However, because this technology does not control the robot's force, it is impossible to suppress impacts applied by the robot to people, objects, or the like, and the robot could potentially injure people and damage surrounding objects. Therefore, it is desirable for the robot to perform operations that suppress impacts applied to people, objects, or the like when the robot comes into contact with them, either by controlling the robot's force or by having the robot perform passive operations.
[0009] Therefore, the present disclosure proposes a new and improved control device, control method, and control system that are capable of controlling the operation of a control target according to a detected external force.
[0010] [Solution to the problem]
[0011] According to the present disclosure, a control device is provided, including: a control unit that compares a first external force detected by a force sensor set in a control target and a second external force estimated based on a torque detected by a torque sensor in a movable part of an operating force sensor set in the control target, and the control unit corrects a torque command value based on the comparison result to control the operation of the control target.
[0012] According to the present disclosure, a control method executed by a processor is provided, comprising: comparing a first external force detected by a force sensor provided in a control target and a second external force estimated based on a torque detected by a torque sensor in a movable part of an operating force sensor provided in the control target, and correcting a torque command value based on the comparison result to control the operation of the control target.
[0013] According to the present disclosure, a control system is provided, comprising: an arm device including a movable part having an actuator, an arm part connected to a plurality of links through the movable part, a torque sensor for detecting a torque acting on the movable part, and a force sensor for detecting a first external force acting on an end portion of the arm part; and a control device including a control unit that compares the first external force and a second external force estimated based on the torque and corrects a torque command value based on the comparison result to control the operation of the arm device.
[0014] [Beneficial Effects of the Invention]
[0015] As described above, according to the present disclosure, the operation of the control target can be controlled according to the detected external force.
[0016] Note that the above effects are not necessarily restrictive. Together with or in place of the above effects, any effect described in this specification or other effects that can be understood from this specification can be achieved. BRIEF DESCRIPTION OF THE DRAWINGS
[0017] [ Figure 1 ] Figure 1 is a diagram illustrating an overall configuration of an arm device according to an embodiment of the present disclosure.
[0018] [ Figure 2 ] Figure 2 is a block diagram illustrating a functional configuration example of a control unit according to a comparative example.
[0019] [ Figure 3 ] Figure 3 is a block diagram showing a configuration example of a control system according to the first embodiment.
[0020] [ Figure 4 ] Figure 4 is a block diagram showing a functional configuration example of a control unit according to an embodiment.
[0021] [ Figure 5 ] Figure 5 is an explanatory diagram showing an example of continuous change in gain according to the embodiment.
[0022] [ Figure 6 ] Figure 6is an explanatory diagram illustrating an example of a step-like change in gain according to an embodiment.
[0023] [ Figure 7 ] Figure 7 is an explanatory diagram illustrating an example of a threshold value group according to an embodiment.
[0024] [ Figure 8 ] Figure 8 is a block diagram showing a configuration example of a processing block of a control unit according to an embodiment.
[0025] [ Figure 9 ] Figure 9 is a flowchart illustrating an operation example of the control device according to the embodiment.
[0026] [ Figure 10 ] Figure 10 is a block diagram showing a configuration example of a processing block of a control unit according to the second embodiment.
[0027] [ Figure 11 ] Figure 11 is a block diagram showing a configuration example of a processing block of a control unit according to the third embodiment.
[0028] [ Figure 12 ] Figure 12 is a block diagram showing a configuration example of a processing block of a control unit according to a fourth embodiment.
[0029] [ Figure 13 ] Figure 13 : is a block diagram illustrating a hardware configuration example of an arm device and a control device according to an embodiment of the present disclosure. DETAILED DESCRIPTION
[0030] Hereinafter, preferred embodiments of the present disclosure will be described in detail with reference to the accompanying drawings. Note that, in this specification and the drawings, structural elements that have substantially the same function and structure are denoted by the same reference numerals, and repeated explanation of these structural elements is omitted.
[0031] Note that the description will be provided in the following order.
[0032] 1. Overview
[0033] 2. First Implementation
[0034] Configuration Example
[0035] 2.2. Operation Example
[0036] 3. Second embodiment
[0037] Configuration Example
[0038] 3.2. Operation Examples
[0039] 4. Third Implementation
[0040] Configuration Example
[0041] 4.2. Operation Examples
[0042] 5. Fourth embodiment
[0043] Configuration Example
[0044] 5.2. Operation Examples
[0045] 6. Hardware Configuration Example
[0046] 7. Conclusion
[0047] 1. Overview
[0048] In the following, reference will be made to Figure 1 and Figure 2 An overview of an embodiment of the present disclosure is described. Hereinafter, an example will be described in which a control target of a control device according to an embodiment of the present disclosure is an arm device and the control device controls the operation of the arm device. The control target is not limited to the arm device.
[0049] <1.1. Overview of Arm Device>
[0050] Figure 1 1 is an explanatory diagram showing a schematic configuration of an arm device 100 according to an embodiment of the present disclosure. The arm device 100 includes a plurality of joints 102, a plurality of links 104, and a terminal portion 106. Figure 1 As shown, the arm device 100 includes four joints 102a to 102d, four links 104a to 104d and one terminal portion 106. The four links 104a to 104d connect the four joints 102a to 102d and the terminal portion 106. Specifically, as shown in FIG. Figure 1 As shown, link 104a connects joint 102a and joint 102b. Link 104b connects joint 102b and joint 102c. Link 104c connects joint 102c and joint 102d. Link 104d connects joint 102d and end portion 106.
[0051] The joint 102 has a function of rotatably connecting a plurality of links 104 to each other. For example, the joints 102a to 102d rotatably connect the links 104a to 104d to each other. The operation of the arm device 100 is controlled by rotating and operating the joints 102a to 102d. Here, in the following description, the position of each component member of the arm device 100 means the position (coordinate) in the space defined for the operation control, and the posture of each component member means the direction (angle) relative to an arbitrary axis in the space defined for the operation control. In the following description, the operation (or operation control) of the arm device 100 means changing (controlling the change) the position and posture of each component member of the arm device 100 by performing the operation (or operation control) of the joints 102a to 102d.
[0052] The joint 102 and the link 104 each have a movable portion that rotates relative to a predetermined rotation axis. For example, the joint 102 and the link 104 each have an actuator and rotate relative to the predetermined rotation axis by being driven by the actuator. When the rotation of the joint 102 and the link 104 is controlled, the operation of the arm device 100 is controlled, such as, for example, the extension, contraction (folding) and torsion of the arm device 100. The arm device 100 according to the present embodiment includes eight degrees of freedom (DoF) because the arm device 100 has movable portions in the four joints 102a to 102d and the four links 104a to 104d. Therefore, the arm device 100 is an arm device with redundant degrees of freedom because the arm device generally has six degrees of freedom (three degrees of freedom for position + three degrees of freedom) or more required for controlling the position and posture of the robot arm.
[0053] In the above example, the arm device 100 includes four joints 102, four links 104, and eight movable parts. However, the number of joints 102, links 104, and movable parts is not particularly limited. For example, the number of joints 102, links 104, and movable parts of the arm device 100 can be appropriately set so that the desired degree of freedom is achieved by considering the degree of freedom of the position and posture of the terminal portion 106. In addition, the shapes of the joints 102 and links 104, and the direction of the rotation axis of the joint 102 are not limited to Figure 1 The shape, direction, etc. can be appropriately set so that a desired degree of freedom is achieved by taking the degree of freedom of the position and posture of the tip portion 106 into consideration.
[0054] In an embodiment of the present disclosure, a virtual actuator (VA) is provided as an actuator provided in the joints 102a to 102d. The virtual actuator is an actuator unit in which a motor, an encoder, a reducer and a torque sensor are integrated. The virtual actuator can control (hereinafter also referred to as VA control) the operation of the joint so that the joints 102a to 102d perform an ideal response and a response can be obtained according to a theoretical model. In this way, the arm device 100 can perform an operation that is passive to the external force acting on the arm device 100. For details of the virtual actuator, see WO 2015 / 046081, which is a prior patent application of the applicant of the present application.
[0055] As described above, the joints 102a to 102d according to the present embodiment have a rotation mechanism. Therefore, in the following description, the operational control of the joints 102a to 102d specifically means controlling the joint angles of the joints 102a to 102d and / or the torque generated (the torque generated by the joints 102a to 102d). The torque generated can be detected by a torque sensor. For example, as in an embodiment of the present disclosure, when a virtual actuator is used as an actuator, the torque generated is detected by a torque sensor provided in the virtual actuator. On the other hand, when a conventional actuator is used, since the torque generated cannot be detected by itself, a torque sensor can be provided separately in the joints 102a to 102d.
[0056] The connecting rods 104a to 104e are rod-shaped members and are connected by the joint 102. For example, the joint 102a rotatably connects the connecting rod 104a and the connecting rod 104b. Furthermore, the joint 102b rotatably connects the connecting rod 104b and the connecting rod 104c. Furthermore, the joint 102c rotatably connects the connecting rod 104c and the connecting rod 104d. Furthermore, the joint 102d rotatably connects the connecting rod 104d and the connecting rod 104e.
[0057] Various terminal units may be provided at the terminal end 106 of the arm device 100. For example, in an embodiment of the present disclosure, a sensor device is provided as the terminal unit. The sensor device may include various sensors. For example, the sensor device may include a camera, a thermal camera, a depth sensor, a microphone (hereinafter also referred to as a microphone), a pressure sensor, an electrostatic sensor, a strain sensor, a force sensor, an inertial sensor, and a biosensor. The terminal end 106 may include one or a combination of these sensors as a sensor device, and may include a plurality of sensor devices of the same type. The terminal end 106 of an embodiment of the present disclosure includes a force sensor as a sensor device.
[0058] A camera is an imaging device such as an RGB camera that has a lens system, a drive system, and an imaging device and captures images (still images or moving images). A thermal camera is an imaging device that uses infrared rays or the like to capture images including information indicating the temperature of the imaging target. A depth sensor is a device that acquires depth information, such as an infrared rangefinder, an ultrasonic rangefinder, a laser imaging detection and ranging (LiDAR), or a stereo camera. A microphone is a device that collects ambient sound and outputs audio data converted into a digital signal via an amplifier and an analog-to-digital converter (ADC). A pressure sensor is a device that detects pressure applied from the outside. An electrostatic sensor is a device that detects changes in capacitance, for example, and is a device that can detect the approach of a human body or the like. A strain sensor is a device that detects extension or contraction caused by a tensile force or a compressive force applied from the outside. A force sensor is a device that detects force and torque. An inertial sensor is a device that detects acceleration and angular velocity. A biosensor is a device that detects biological information such as heartbeat and body temperature.
[0059] An end effector may be provided as an end unit at the end portion 106. The end effector may include, for example, a hand, a gripper, and the like.
[0060] Already referenced Figure 1 The schematic configuration of the arm device 100 is described. The operation of the joint 102 of the arm device 100 is controlled by a control device that controls the arm device 100 as a whole. The control device may be provided in the arm device 100, or may be provided as an external server or the like connected to the arm device 100 via a network. Figure 2 A control unit according to a comparative example is described.
[0061] <1.2. Control of Arm Device>
[0062] Hereinafter, before describing a control unit according to an embodiment of the present disclosure, a control unit according to a comparative example will be described first. Figure 2 : is a block diagram showing a functional configuration example of a control unit 310 according to a comparative example. Figure 2 The control unit 310 of the illustrated functional configuration is an example of a control unit that controls the arm device 100 as a whole. Figure 2 As shown, the control unit 310 includes a Cartesian space control unit 312 , a torque command value calculation unit 314 , a correction unit 315 , a VA control unit 316 , and a forward dynamics calculation unit 318 .
[0063] The control unit 310 includes a Cartesian space control unit 312 and a torque command value calculation unit 314 as upper blocks for calculating command values for controlling the control target 20 (arm assembly 100). Using these two modules, an all-axis coordinate control system for determining the position and posture of the entire arm assembly 100 is constructed. The Cartesian space control unit 312 calculates the position and posture of the arm assembly 100 based on the current position and posture x indicating the current position and posture of the arm assembly 100 and the target position and posture x indicating the target position and posture when operating the arm assembly 100. d , to calculate the command acceleration value in the Cartesian space (the second-order differential value of the current position posture x). The current position posture x is calculated by the forward dynamics calculation unit 318 based on the joint angle q of the joint 102 of the arm device 100. The torque command value calculation unit 314 converts the command acceleration value (the second-order differential value of the current position posture x) calculated by the Cartesian space control unit 312 into a command value τ in the joint space. a (hereinafter also referred to as torque command value τ a ).
[0064] The control unit 310 includes a correction unit 315 and a VA control unit 316 as a unit for correcting the torque command value τ calculated by the upper block. a The correction unit 315 uses the external torque τ applied from the outside detected by the torque sensor to control the lower block of the operation of the control target 20. e To correct the torque command value τ a Specifically, the correction unit 315 converts the external torque τ e and torque command value τ a Add to correct the torque command value τ a . The correction unit 315 outputs the corrected torque command value τ to the VA control unit 316. The VA control unit 316 outputs the torque command value τ (hereinafter also referred to as the final torque command value τ) in which the external torque is added and the passivity is taken into consideration to the motor command part of the arm device 100. The arm device 100 operates the joint 102 based on the final torque command value τ input from the VA control unit 316. The joint angle q after the operation of the joint 102 is output to the forward dynamics calculation unit 318. In this way, the arm device 100 can perform operations that are passive to external forces.
[0065] As described above, by performing VA control on the arm device 100, the stability of the operation of the arm device 100 is improved. However, in the configuration of the control unit 310, although the stability is improved by VA control, there is a problem that the accuracy of the operation of the arm device 100 is reduced. The main reason for the reduction in operation accuracy may be the external torque τ detected by the torque sensor. e This is because the external torque τe In the VA control system, it is the command value, while in the full-axis coordinate control system, it plays an interference role.
[0066] Another example of a cause of the reduction in operation accuracy is a design error or calculation error of the arm device 100. Based on the external torque τ detected by the torque sensor of the joint 102 e , the posture of the arm assembly 100, the configuration of the arm assembly 100, etc. Therefore, when errors occur in the calculated forces and moments due to design errors or calculation errors of the arm assembly 100, the operational accuracy of the arm assembly 100 decreases.
[0067] By focusing on this point, embodiments of the present disclosure are conceived. In embodiments of the present disclosure, a technology capable of controlling the operation of a control target based on a detected external force is proposed. For example, a control system capable of switching an operation mode when operating a control target based on a detected external force is proposed. Specifically, the control system controls switching between a high-precision mode in which the control target performs a high-precision operation (a first operation) and a high-safety mode in which the control target performs a high-safety operation (a second operation).
[0068] The control system includes an arm assembly 100 including a joint 102 having an actuator and a torque sensor for detecting torque, and an arm in which a plurality of links 104 are connected via the joint 102. In addition, a force sensor for detecting a measured value (first external force) of an external force acting on the end portion 106 is provided in the end portion 106 of the arm assembly 100. In addition, the control system includes a control device having a control unit for controlling the operation of the arm assembly 100. The control unit compares the measured value of the external force with an estimated value (second external force) of the external force estimated based on external torque and dynamic calculations, and corrects a torque command value calculated based on a movement purpose (control command) of the arm assembly 100 based on the comparison result to control the operation of the arm assembly 100.
[0069] Specifically, the control unit adjusts the gain based on the comparison result between the measured value of the external force and the estimated value of the external force, and corrects the torque command value by applying the gain. More specifically, the control unit applies the gain by multiplying the estimated torque estimated based on the torque, the posture of the arm assembly 100, and the dynamics calculation by the gain. The control unit corrects the torque command value based on the value obtained by multiplying the estimated torque by the gain.
[0070] Already referenced Figure 1 and Figure 2 An overview of the embodiments of the present disclosure has been described. Next, a first embodiment will be described.
[0071] <<2. First embodiment>>
[0072] Hereinafter, the first embodiment will be described. In the first embodiment, a high safety mode is achieved by VA control using data detected by a torque sensor. In addition, in the first embodiment, it is assumed that a high precision mode is achieved by impedance control using data detected by a force sensor.
[0073] <2.1. Configuration Example>
[0074] In the following, reference will be made to Figures 3 to 8 A configuration example according to the first embodiment is described.
[0075] <2.1.1. Configuration Example of Control System 10>
[0076] Figure 3 1 is a block diagram showing a configuration example of the control system 10 according to the first embodiment. Figure 3 As shown, the control system 10 may include an arm device 100 and a control device 200 .
[0077] (1) Arm device 100
[0078] like Figure 3 As shown, the arm apparatus 100 may include a sensor unit 110 and a joint operation unit 120 .
[0079] (1-1) Sensor Unit 110
[0080] The sensor unit 110 may include various sensors. Figure 3 As shown, the sensor unit 110 includes a force sensor 112 and a torque sensor 114. The force sensor 112 is provided in the distal end portion 106 of the arm assembly 100, and detects external forces and moments applied to the distal end portion 106. The distal end portion 106 of the arm assembly 100 is located at a position closer to a workspace where high-precision operations are required. Since the force sensor 112 is provided at this position, forces and moments can be detected with higher accuracy than when the force sensor is provided at another position of the arm assembly 100. The force sensor 112 detects three-dimensional to six-dimensional external forces and moments. In addition, when the joint 102 of the arm assembly 100 is operated and detects data, the force sensor 112 operates substantially in response to the operation of the arm assembly 100. Even when the joint 102 of the arm assembly 100 is stopped, the force sensor 112 can detect data. Furthermore, a torque sensor 114 is provided in each of the joints 102a to 102d of the arm apparatus 100 and detects torque acting on each of the joints 102a to 102d. The torque sensor 114 detects one-dimensional torque around the rotation axis of the joint 102.
[0081] (1-2) Joining Operation Unit 120
[0082] The engagement operation unit 120 has a function of operating the engagement portion 102. For example, the engagement operation unit 120 operates the engagement portion 102 based on the final torque command value τ input from the control device 200. The engagement operation unit 120 outputs the engagement angle q after the operation of the engagement portion 102 to the control device 200.
[0083] (2) Control device 200
[0084] like Figure 3 As shown, the control device 200 may include a control unit 210 - 1 and a storage unit 230 .
[0085] (2-1) Control Unit 210-1
[0086] The control unit 210-1 has a function of controlling the operation of the arm device 100. For example, the control unit 210-1 calculates information required for controlling the operation of the arm device 100 based on the data detected by the sensor unit 110 of the arm device 100. Specifically, the control unit 210-1 calculates the torque command value τ for the arm device 100 based on the data detected by the force sensor 112 and the torque sensor 114. In addition, the control unit 210-1 corrects the torque command value τ as needed based on the relationship between the data detected by the force sensor 112 and the torque sensor 114. For example, the control unit 210-1 corrects the torque command value using a value obtained by multiplying an estimated torque estimated based on the torque, posture (e.g., joint angle) and dynamics calculation of the arm device 100 by a gain. The control unit 210-1 outputs the final torque command value τ as the final torque command value to the joint operation unit 120 of the arm device 100, and causes the joint operation unit 120 to control the operation of the joint 102.
[0087] (2-2) Storage Unit 230
[0088] The storage unit 230 has the function of storing various data. For example, the storage unit 230 stores sensor data detected by the sensor unit 110 of the arm device 100. Furthermore, the storage unit 230 stores data output during control processing by the control unit 210-1. Furthermore, the storage unit 230 stores programs such as various applications and data. The data stored in the storage unit 230 is not limited to the above examples.
[0089] <2.1.2. Functional Configuration Example of Control Unit 210-1>
[0090] Figure 4 1 is a block diagram showing a functional configuration example of the control unit 210-1 according to the first embodiment. Figure 4As shown, the control unit 210 - 1 includes an omni-axis coordinate control unit 211 - 1 and a joint control unit 220 - 1 .
[0091] (1) All-axis coordinate control unit 211-1
[0092] like Figure 4 As shown, the all-axis coordinate control unit 211 - 1 includes a Cartesian space control unit 212 - 1 , a torque command value calculation unit 214 - 1 , an external force estimation unit 216 - 1 , an external torque adaptive control unit 218 - 1 , and a correction unit 219 - 1 .
[0093] (1-1) Cartesian space control unit 212-1
[0094] The Cartesian space control unit 212-1 has a function of calculating an instruction value in the Cartesian space. For example, the Cartesian space control unit 212-1 calculates the target position and posture x when operating the arm device 100 based on the target position and posture x. d and the external force F detected by the force sensor 112 at the distal end 106 of the arm assembly 100 s (measured value of external force) to calculate the command acceleration value in the Cartesian space (second-order differential value of the current position and posture x). The Cartesian space control unit 212-1 outputs the calculated command acceleration value in the Cartesian space to the torque command value calculation unit 214-1.
[0095] (1-2) Torque Command Value Calculation Unit 214-1
[0096] The torque command value calculation unit 214-1 has a function of converting the command acceleration value in the Cartesian space into the command value τ in the engagement space. a (Torque command value τ a ) function. For example, the torque command value calculation unit 214-1 calculates the angular acceleration of the joint 102 (the second-order differential value of the joint angle q) based on the command acceleration value (the second-order differential value of the current position posture x) calculated by the Cartesian space control unit 212-1. Subsequently, the torque command value calculation unit 214-1 calculates the torque command value τ based on the angular acceleration (the second-order differential value of the joint angle q). a The torque command value calculation unit 214-1 calculates the torque command value τ a Output to correction unit 219-1.
[0097] (1-3) External Force Estimation Unit 216-1
[0098] The external force estimation unit 216 - 1 has the function of calculating an estimated external force F to be applied to the distal end portion 106 of the arm apparatus 100 . ex(Estimated value of external force). For example, the external force estimation unit 216-1 performs inverse dynamics calculation based on the joint angle q, angular velocity (differential value of the joint angle q), and angular acceleration (second-order differential value of the joint angle q) of the joint 102 of the arm apparatus 100. The external force estimation unit 216-1 calculates the external torque τ as a function of estimating the external torque τ to be set. e The external torque (represented by τ^) is the torque (gravity, centrifugal force, etc.) generated by the operation of the arm device 100 in the joint. In the following description, the joint angle q, angular velocity (differential value of the joint angle q), and angular acceleration (second-order differential value of the joint angle q) are also collectively referred to as the current state of the joint 102. Subsequently, the external force estimation unit 216-1 calculates the external torque τ detected by the torque sensor. e The difference between the external torque (τ^) and the estimated external torque (estimated torque) τ ex Specifically, the external force estimation unit 216-1 calculates the external torque τ e Subtract the external torque (τ^) from the value to calculate the estimated external torque τ ex In this way, since the torque generated only by the operation of the arm apparatus 100 is canceled, the external force estimation unit 216-1 can calculate the external torque component generated by the collision with a person, the environment, etc. Subsequently, the external force estimation unit 216-1 calculates the external torque component based on the estimated external torque τ ex To calculate the estimated external force F ex The external force estimation unit 216-1 calculates the estimated external force F ex Output to the external torque adaptive control unit 218 - 1 .
[0099] (1-4) External torque adaptive control unit 218-1
[0100] The external torque adaptive control unit 218-1 has the function of switching between a high-precision mode and a high-safety mode. For example, the external torque adaptive control unit 218-1 converts the external force F s and the estimated external force F ex The comparison is performed to extract the difference ε, and the action state of the external force (third external force) acting on the entire arm device 100 is detected. In the following description, the external force applied to the entire arm device 100 is also referred to as the entire external force. Subsequently, the external torque adaptive control unit 218-1 switches between the high-precision mode and the high-safety mode according to the action state. The estimated external force F used to extract the difference ε ex The external torque component generated due to the collision with a person, the environment, etc. is calculated so that during the calculation of the external force estimation unit 216-1, the torque (gravity, centrifugal force, etc.) generated only due to the operation of the arm device 100 is offset. Therefore, when the difference ε is extracted, the external torque adaptive control unit 218-1 can process the estimated external force F at the same level.ex and the external force F detected by the force sensor s .
[0101] In an action state where an unexpected external force is applied to the arm device 100, for example, the external torque adaptive control unit 218-1 switches the operation mode to the high safety mode. This means that the two sensor systems of the force sensor 112 and the torque sensor 114 are determined to be inconsistent. Therefore, the external torque adaptive control unit 218-1 switches to a mode in which the external force F detected by the force sensor 112 is used. s and the external torque τ detected by the torque sensor 114 e A high safety mode is used to perform a high-stability force control. The external torque adaptive control unit 218-1 sets the high safety mode as the operation mode by, for example, adjusting the gain α to be close to a predetermined value (second value). Specifically, the external torque adaptive control unit 218-1 sets the gain α to be close to 1. The external torque adaptive control unit 218-1 sets the estimated external torque τ ex ατ obtained by multiplying by the gain α ex Output to the correction unit 219-1. The value indicated by the gain α is a value within the range of 0≤α≤1. In addition, an arbitrary value that satisfies the condition of 0≤α≤1 can be set as a predetermined value (second value).
[0102] In the action state in which the entire external force expected is applied to the arm device 100, the external torque adaptive control unit 218-1 switches the operation mode to, for example, the high-precision mode. This means that the two sensor systems of the force sensor 112 and the torque sensor 114 are determined to be consistent. Therefore, the external torque adaptive control unit 218-1 switches to a mode in which only the external force F detected by the force sensor 112 is used. s A high-precision mode for performing high-precision operations. The external torque adaptive control unit 218-1 sets the high-precision mode as the operating mode, for example, by adjusting the gain α to be close to a predetermined value (first value). Specifically, the external torque adaptive control unit 218-1 sets the gain α to be close to 0. In addition, when the two sensor systems of the force sensor 112 and the torque sensor 114 are consistent, the external torque adaptive control unit 218-1 can set the gain α to 0, and it is expected that the operation can be performed without the danger of contact with surrounding people or objects. In this way, the external torque adaptive control unit 218-1 can set 0 as ατ ex Output to the correction unit 219-1. That is, the external torque adaptive control unit 218-1 can make the external torque τ detected by the torque sensor e The input of is invalid. Any value that satisfies the condition of 0≤α≤1 can be set as the predetermined value (first value).
[0103] The action state is detected by the external torque adaptive control unit 218-1 based on a comparison between the difference ε and a predetermined threshold value. For example, when the difference ε is equal to or greater than the predetermined threshold value, the action state is an action state in which the entire unintended external force acts on the arm assembly 100. When the difference ε is not equal to or greater than the predetermined threshold value, the action state is an action state in which the entire intended external force acts on the arm assembly 100. The conditions for determining the action state are not limited to the above-described examples, and any conditions may be used.
[0104] External torque adaptive control unit 218-1 adjusts gain α using any method based on difference ε. For example, external torque adaptive control unit 218-1 changes gain α continuously. This allows external torque adaptive control unit 218-1 to continuously switch between the high-precision mode and the high-safety mode. Figure 5 is an explanatory diagram showing an example of continuous change in gain according to the first embodiment. Figure 5 Example 1 of continuous change of gain α on the left side shows an example in which the gain α changes continuously linearly. Figure 5 Example 2 shows an example in which the gain α continuously changes like a polynomial. Figure 5 Example 3 of continuous change of gain α on the right side shows an example in which the gain α continuously changes nonlinearly (table reference type). Figure 5 As shown in the various examples of , when the difference ε is a value within a predetermined range (for example, the range of threshold value THR1 to threshold value THR2), the external torque adaptive control unit 218-1 can continuously change the gain α from 0 to 1. When the difference ε is within the range of threshold value THR1 to threshold value THR2, the gain α can be continuously changed in a nonlinear function type or a learning type. In this way, by continuously switching the operating mode according to the continuous change of the gain α, the arm device 100 can smoothly change the operation during the switching of the operating mode. In the following description, multiple thresholds such as threshold value THR1 and threshold value THR2 are also collectively referred to as a threshold group.
[0105] The external torque adaptive control unit 218 - 1 may discontinuously change the gain α, thereby discontinuously switching between the high-precision mode and the high-safety mode. Figure 6 : is an explanatory diagram showing an example of a step-like change in gain according to the first embodiment. Figure 6 As shown in the example of the step-like change of the gain α in , the external torque adaptive control unit 218 - 1 may change the gain α in a step-like manner so that the gain α is 0 or 1, depending on whether the difference ε is equal to or greater than a predetermined threshold.
[0106] Assume that when the operation mode is the high safety mode, the difference ε decreases, and the unexpected external force F is determined. s does not act on the arm device 100. In this case, the external torque adaptive control unit 218-1 can seamlessly switch the operation mode from the high safety mode to the high precision mode. On the other hand, it is assumed that when the operation mode is the high precision mode, the difference ε increases, and it is determined that the unexpected external force F s is applied to the arm device 100. In this case, the external torque adaptive control unit 218-1 can seamlessly switch the operation mode from the high-precision mode to the high-safety mode.
[0107] The threshold set can be adaptively changed. Figure 7 1 is an explanatory diagram showing an example of a threshold value group according to an embodiment of the present disclosure. For example, the external torque adaptive control unit 218-1 changes the threshold value group according to the content of the task instructed to the arm device 100. Specifically, when the content of the task indicates interaction with a person and operation in a dynamic environment, since the arm device 100 is required to perform a highly safe operation, the external torque adaptive control unit 218-1 changes the threshold value group as shown in FIG. Figure 7 In addition, when the content of the task indicates an operation such as precision machining or liquid delivery, since the arm device 100 is required to perform high-precision operation, the external torque adaptive control unit 218-1 is set as in Example 1 of the threshold value group on the left side of . Figure 7 THR3 and THR4 are set as in Example 2 of the threshold group on the right side.
[0108] The threshold value group can be stored as a direct value in the table in the storage unit 230, or can be represented and stored by a function. When the threshold value group is stored as a direct value in the table, for example, the threshold value group is stored as {THR1, THR2}, {THR3, THR4}. In addition, when the threshold value group is represented by a function, for example, the threshold value group is represented as THR3 = f(THR1, THR2, param), THR4 = f'(THR1, THR2, param).
[0109] In the above example, the switching between the high-precision mode and the high-safety mode as the operation mode has been described. However, the operation mode can be switched to another mode according to the content of the operation of the arm device 100. For example, the operation mode can be switched to a mode in which the arm device 100 is relatively stable with respect to the unexpected external force F acting on the arm device 100. s Sensitive mode for performing sensitive operation. In the sensitive mode, the external torque adaptive control unit 218-1 sets the threshold value group so that the number of regions where the gain α is 1.0 increases. Thus, since the arm device 100 may be subjected to the estimated external torque τ exTherefore, the external torque adaptive control unit 218-1 can control the operation so that the arm device 100 is relatively stable relative to the external force F s Furthermore, the operation mode can be switched to one in which the arm device 100 is relatively stable with respect to an unexpected external force F acting on the arm device 100. s In the insensitive mode, the external torque adaptive control unit 218-1 sets the threshold value group so that the number of regions where the gain α is 0.0 increases. As a result, the arm device 100 is less likely to be affected by the estimated external torque τ ex Therefore, the external torque adaptive control unit 218-1 can control the operation so that the arm device 100 is relatively stable relative to the external force F s Less sensitive operation.
[0110] For example, the external torque adaptive control unit 218-1 may be configured to adaptively control the external force F based on the estimated external force F input from the external force estimation unit 216-1 in the past. ex Machine learning is performed based on the value of and the value of the gain α adjusted in the past, and the gain α can be adjusted based on the result of the machine learning.
[0111] (1-5) Correction Unit 219-1
[0112] The correction unit 219-1 has a function of calculating the final torque command value τ. For example, the correction unit 219-1 calculates the final torque command value τ based on ατ to which the gain α adjusted according to the high safety mode or the high precision mode is applied. ex To correct the torque command value τ a , and calculates the final torque command value τ. Specifically, when the operation mode is the high safety mode, the correction unit 219-1 calculates ατ ex and torque command value τ a Add to correct the torque command value τ a Thus, the correction unit 219-1 can calculate the final torque command value τ so that the arm apparatus 100 is based on the external force F detected by the force sensor 112. s and the external torque τ detected by the torque sensor 114 e The passive operation is performed. The correction unit 219-1 outputs the calculated final torque command value τ to the engagement control unit 220-1.
[0113] When the operation mode is the high-precision mode, the correction unit 219-1 uses τ as it is. a As the final torque command value τ, instead of using ατ ex Thus, the correction unit 219-1 can calculate the final torque command value τ so that the arm apparatus 100 is adjusted based only on the external force F detected by the force sensor 112. sThe correction unit 219-1 outputs the calculated final torque instruction value τ to the engagement control unit 220-1. Even when the operation mode is the high-precision mode, the correction unit 219-1 can also perform high-precision operation by a and ατ ex Add to correct the torque command value τ a To calculate the final torque command value τ.
[0114] (2) Engagement Control Unit 220-1
[0115] The engagement control unit 220-1 has a function of controlling the operation of the control target based on the final torque command value τ. When the final torque command value τ is input from the correction unit 219-1 in high safety mode, the engagement control unit 220-1 controls the operation of the joint 102 of the arm device 100 based on the final torque command value τ, so that the arm device 100 performs a passive operation. As a passive operation, for example, the engagement control unit 220-1 operates the joint 102 so that when the arm device 100 contacts a person, the arm device 100 performs an operation of moving in a direction opposite to the direction of contact with the person in order to separate from the person. When the final torque command value τ is input from the correction unit 219-1 in high precision mode, the engagement control unit 220-1 controls the operation of the joint 102 of the arm device 100 based on the final torque command value τ, so that the arm device 100 performs a high precision operation. When the external torque τ detected by the torque sensor is input from the correction unit 219-1 e When the final torque command value τ calculated after invalidation is invalidated, the joint control unit 220-1 can increase the control stiffness of the actuator of the joint portion 102 of the arm assembly 100. Thus, the joint control unit 220-1 can cause the distal end portion 106 of the arm assembly 100 to perform high-precision operations.
[0116] In the above, reference has been made to Figures 3 to 7 The functional configuration example of the control unit 210 - 1 according to the first embodiment is described. Next, the details of the processing of each constituent element of the control unit 210 - 1 according to the first embodiment will be described.
[0117] <2.1.3. Configuration Example of Processing Block of Control Unit 210-1>
[0118] Figure 8 1 is a block diagram showing a configuration example of a processing block of the control unit 210-1 according to the first embodiment. Figure 8As shown, the Cartesian space control unit 212-1 includes a processing block 212-1A. The torque command value calculation unit 214-1 includes a processing block 214-1A and a processing block 214-1B. The external force estimation unit 216-1 includes a processing block 216-1A, a processing block 216-1B, and a processing block 216-1C. The external torque adaptive control unit 218-1 includes a processing block 218-1A, a processing block 218-1B, and a processing block 218-1C. The engagement control unit 220-1 includes a processing block 220-1A.
[0119] (1) Processing block 212-1A
[0120] The processing block 212-1A performs processing to calculate the command acceleration value (second-order differential value of the current position and posture x) in the Cartesian space. For example, the processing block 212-1A is based on the target position and posture x d and the external force F detected by the force sensor 112 s To calculate the command acceleration value in Cartesian space (the second-order differential value of the current position and posture x). When the current position and posture of the arm device 100 is x, the measured value of the external force F s It is represented by the following formula (1).
[0121] [Mathematical formula 1]
[0122]
[0123] In equation (1), M indicates an inertia matrix in impedance control, D indicates a viscosity matrix in impedance control, and K indicates a stiffness matrix in impedance control.
[0124] The processing block 212-1A calculates the command acceleration value in the Cartesian space (the second-order differential value of the current position and posture x) by the following equation (2), which is modified from equation (1) to e=(x d ). The processing block 212-1A outputs the calculated command acceleration value in the Cartesian space (the second-order differential value in the current position posture x) to the processing block 214-1A.
[0125] [Mathematical formula 2]
[0126]
[0127] (2) Processing Block 214-1A
[0128] The processing block 214-1A performs processing to calculate the angular acceleration of the joint 102 (the second-order differential value of the joint angle q). For example, the processing block 214-1A uses the generalized inverse matrix J of the Jacobian matrix J +The angular acceleration of the joint 102 (the second-order differential value of the joint angle q) is calculated based on the command acceleration value (the second-order differential value of the current position posture x) in the Cartesian space. The processing block 214-1A outputs the calculated angular acceleration (the second-order differential value of the joint angle q) to the processing block 214-1B. The method of calculating the angular acceleration of the joint 102 (the second-order differential value of the joint angle q) in the processing block 214-1A is not limited to using the generalized inverse matrix J of the Jacobian matrix J. + For example, the angular acceleration of the joint 102 (the second-order differential value of the joint angle q) can be calculated by using a method of using a singular avoidance inverse matrix.
[0129] (3) Processing Block 214-1B
[0130] Processing block 214-1B performs calculation of torque command value τ a For example, the processing block 214-1B calculates the torque command value τ by performing inverse dynamics (ID) calculation based on the angular acceleration (second-order differential value of the engagement angle q). a The processing block 214-1B converts the calculated torque command value τ a Output to correction unit 219-1.
[0131] (4) Processing Block 216-1A
[0132] The processing block 216-1A performs a process of calculating the external torque (τ^). For example, the processing block 216-1A calculates the external torque (τ^) by performing an inverse dynamics calculation based on the engagement angle q of the joint 102. Specifically, the processing block 216-1A detects the current state of the joint 102 by calculating the angular velocity (differential value of the engagement angle q) and the angular acceleration (second-order differential value of the engagement angle q) according to the engagement angle q of the joint 102. The processing block 216-1A calculates the external torque (τ^) by performing an inverse dynamics calculation based on the current state. The processing block 216-1A outputs the calculated external torque (τ^) to the processing block 216-1B. The external torque (τ^) is calculated by the following formula (3).
[0133] [Mathematical formula 3]
[0134]
[0135] In equation (3), M^ indicates an inertia matrix, c^ indicates centrifugal force and Coriolis force, and g^ indicates a gravity term.
[0136] The external torque (τ^) can be calculated by modeling the friction, backlash, and harness torsion of the mechanical components. For example, when the mechanical components (e.g., the friction of the mechanical components) are modeled, the external torque (τ^) is calculated by the following equation (4) instead of equation (3).
[0137] [Formula 4]
[0138]
[0139] The term with h^ in Equation (4) indicates the friction term. When the Coulomb friction term is F c , the sign function is sgn(), and the viscous friction is D, the friction term is calculated by the following formula (5).
[0140] [Formula 5]
[0141]
[0142] The external torque (τ^) can be calculated by modeling the spring constant of an elastic actuator, a series elastic actuator (SEA). An elastic actuator is a mechanism provided with a spring, such as an elastic member between a motor and a connecting rod. When the motor-side engagement angle is θ, the spring engagement stiffness is K, and the connecting rod-side engagement angle is q, the external torque (τ^) is calculated using the following equation (6) instead of equations (3) and (4).
[0143] [Formula 6]
[0144]
[0145] (5) Processing Block 216-1B
[0146] Processing block 216-1B performs calculation of the estimated external torque τ ex For example, processing block 216-1B calculates the external torque τ detected by the torque sensor 114. e The external torque τ is calculated by subtracting the external torque (τ^) calculated by processing block 216-1A from the external torque τ ex Processing block 216 - 1B outputs the calculated external torque (τ̂) to processing block 216 - 1C and processing block 218 - 1C.
[0147] (6) Processing block 216-1C
[0148] Processing block 216-1C performs calculation to estimate the external force F ex For example, processing block 216-1C uses the Jacobian matrix J to calculate the estimated external torque τ ex To calculate the estimated external force F ex The processing block 216-1C converts the calculated estimated external force F ex Output to processing block 218-1A.
[0149] (7) Processing Block 218-1A
[0150] The processing block 218-1A performs a process of calculating the difference ε. For example, the processing block 218-1A calculates the difference ε by calculating the estimated external force F input from the processing block 216-1C. ex The external force F detected by the force sensor 112 is subtracted from s The processing block 218 - 1A outputs the calculated difference ε to the processing block 218 - 1B.
[0151] (8) Processing Block 218-1B
[0152] The processing block 218-1B performs a process of adjusting the gain α. For example, the processing block 218-1B adjusts the gain α based on the difference ε calculated by the processing block 218-1A. The processing block 218-1B outputs the adjusted gain α to the processing block 218-1C.
[0153] (9) Processing Block 218-1C
[0154] Processing block 218-1C performs the operation of applying a gain α to the estimated external torque τ ex For example, processing block 218-1C converts the estimated external torque τ input from processing block 216-1B into ex Multiplying by the gain α adjusted by processing block 218-1B calculates ατ ex Processing block 218-1C converts the calculated ατ ex Output to correction unit 219-1.
[0155] (10) Processing block 220-1A
[0156] The processing block 220-1A performs processing related to VA control. For example, when the final torque command value τ corrected based on the external torque detected by the torque sensor 114 is input from the correction unit 219-1, the processing block 220-1A controls the operation of the joint 102 so that the arm device 100 (control target 20) performs a passive operation.
[0157] In the above, reference has been made to Figures 3 to 8 The configuration example according to the first embodiment has been described. Next, an operation example according to the first embodiment will be described.
[0158] <2.2. Operation Example>
[0159] In the following, reference will be made to Figure 9 An operation example of the control device 200 according to the first embodiment is described. Figure 9 is a flowchart showing an operation example of the control device 200 according to the first embodiment.
[0160] like Figure 9As shown, first, the control device 200 obtains the external force F detected by the force sensor 112 s and the external torque τ detected by the torque sensor 114 e (Step S1000) The control device 200 uses the external torque τ based on the current state of the joint 102. e and inverse dynamics calculation to calculate the estimated external torque τ ex (Step S1002) The control device 200 calculates the estimated external force F ex , estimate the external force F ex Based on the estimated external torque τ ex is estimated (step S1004). The control device 200 calculates the estimated external force F ex The external force F detected by the force sensor 112 s The difference ε between them (step S1006).
[0161] After calculating the difference ε, the control device 200 sets a threshold value set for the difference ε (step S1008). In step S1008, the threshold value set may be determined based on any one of the distance information d, the instruction for the arm device 100, and the past operation history of the arm device 100. The control device 200 sets a gain α corresponding to the calculated difference ε based on the set threshold value set for the difference ε (step S1010). After setting the gain α, the control device 200 calculates the torque command value τ based on the control command value. a The correction is where the gain α is applied to the estimated external torque τ ex ατ ex , and calculates the final torque command value τ (step S1012). The control device 200 controls the operation of the arm device 100 by operating the joint 102 of the arm device 100 as the control target based on the final torque command value τ (step S1014), and ends the process.
[0162] In the above, reference has been made to Figure 9 An operation example of the control unit 210 - 1 according to the first embodiment has been described.
[0163] In the above, reference has been made to Figures 3 to 9 The first embodiment has been described. Next, the second to fourth embodiments will be described. The control systems 10 according to the second to fourth embodiments, which will be described later, differ from the control system 10 of the first embodiment only in the configuration of the processing blocks of the control unit 210. Therefore, in the following description, the configuration of the processing blocks of the control unit 210, which are matters that differ from those of the first embodiment, will be mainly described, and detailed descriptions of matters that overlap with those of the first embodiment will be omitted.
[0164] <<3. Second embodiment>>
[0165] In the following, reference will be made to Figure 10 The second embodiment will be described. In the first embodiment described above, an example will be described in which a high-precision mode is achieved by impedance control using data detected by a force sensor. In the second embodiment, an example will be described in which a high-precision mode is achieved by proportional-integral-derivative (PID) control. In the second embodiment, a different process from that of the first embodiment is performed in the processing block of the Cartesian space control unit 212-2 of the control unit 210-2. Below, the different process will be mainly described.
[0166] <3.1. Configuration Example>
[0167] <3.1.1. Configuration Example of Control System 10>
[0168] The configuration of the control system 10 according to the second embodiment is the same as the configuration of the control system 10 described in the first embodiment. Therefore, in this section, a detailed description of the configuration of the control system 10 will be omitted.
[0169] <3.1.2. Functional Configuration Example of Control Unit 210-2>
[0170] The functional configuration of the control unit 210-2 according to the second embodiment is the same as the functional configuration of the control unit 210-1 described in the first embodiment. Therefore, in this section, a detailed description of the functional configuration of the control unit 210-2 will be omitted.
[0171] <3.1.3. Processing Block Configuration Example of Control Unit 210-2>
[0172] Figure 10 2 is a block diagram showing a configuration example of a processing block of the control unit 210-2 according to the second embodiment. Figure 10 As shown, the processing block configuration of the control unit 210-2 according to the second embodiment is different from that of the first embodiment in that the processing of the processing block 212-2A is performed in the Cartesian space control unit 212-2. Therefore, in this section, only the processing block 212-2A will be described, and detailed descriptions of the other processing blocks will be omitted.
[0173] The processing block 212-2A performs processing to calculate the command acceleration value in the Cartesian space (the second-order differential value of the current position and posture x). For example, the processing block 212-2A is based on the target position and posture x dTo calculate the command acceleration value in Cartesian space (the second-order differential value in the current position and posture x). When the current position and posture of the arm device 100 is x, the command acceleration value in Cartesian space (the second-order differential value in the current position and posture x) is expressed by the following equation (7).
[0174] [Formula 7]
[0175]
[0176] In formula (7), K p Indicates the proportional gain of PID control, K d Indicates the differential gain of PID control, and K i Indicates the integral gain of PID control. When using e=xx d When simplifying Formula (7), s indicates differentiation and 1 / s indicates integration, Formula (7) is expressed as the following Formula (8).
[0177] [Formula 8]
[0178]
[0179] Processing block 212-2A calculates the command acceleration value in Cartesian space (the second-order differential value of the current position and posture x) according to equation (8). Processing block 212-2A outputs the calculated command acceleration value in Cartesian space (the second-order differential value of the current position and posture x) to processing block 214-1A.
[0180] As described above, the example in which the high-precision mode is implemented by impedance control in the first embodiment and the example in which the high-precision mode is implemented by PID control in the second embodiment have been described. However, the control method of the high-precision mode is not limited to the above examples. For example, the high-precision mode can be controlled by hybrid control.
[0181] In the above, reference has been made to Figure 10 The configuration example according to the second embodiment has been described. Next, an operation example according to the second embodiment will be described.
[0182] <3.2. Operation Example>
[0183] The operation of the control device 200 according to the second embodiment is the same as the operation of the control device 200 described in the first embodiment. Therefore, in this section, a detailed description of the operation example of the control device 200 will be omitted.
[0184] In the above, reference has been made to Figure 10 The second embodiment has been described. Next, the third embodiment will be described.
[0185] <<4. Third embodiment>>
[0186] In the following, reference will be made to Figure 11 The third embodiment will now be described. In the first embodiment, an example of using VA control for high-safety mode control has been described. In the third embodiment, an example of using VA control for high-precision position control will be described. In the third embodiment, processing blocks of the engagement angle command value calculation unit 214-3, the external force estimation unit 216-3, and the external torque adaptive control unit 218-3 of the control unit 210-3 perform processing different from that of the first embodiment. The following will primarily describe the different processing.
[0187] <4.1. Configuration Example>
[0188] <4.1.1. Configuration Example of Control System 10>
[0189] The configuration of the control system 10 according to the third embodiment is the same as the configuration of the control system 10 described in the first embodiment. Therefore, in this section, a detailed description of the configuration of the control system 10 will be omitted.
[0190] <4.1.2. Functional Configuration Example of Control Unit 210-3>
[0191] The functional configuration of the control unit 210-3 according to the third embodiment is the same as the functional configuration of the control unit 210-1 described in the first embodiment. Therefore, in this section, a detailed description of the functional configuration of the control unit 210-3 will be omitted.
[0192] <4.1.3. Configuration Example of Processing Block of Control Unit 210 - 3 >
[0193] Figure 11 2 is a block diagram showing a configuration example of a processing block of the control unit 210-3 according to the third embodiment. Figure 11As shown, the processing block configuration of control unit 210-3 according to the third embodiment differs from that of the first embodiment in that the processing block includes an engagement angle command value calculation unit 214-3 instead of a torque command value calculation unit 214-1. Furthermore, the processing block configuration of control unit 210-3 differs from that of the first embodiment in that the processing of processing block 216-3D, in addition to processing blocks 216-1A through 216-1C, is performed in external force estimation unit 216-3. Furthermore, the processing block configuration of control unit 210-3 differs from that of the first embodiment in that processing block 218-3D in the external torque adaptive control unit 218-3 is different. Therefore, in this section, only engagement angle command value calculation unit 214-3, processing block 216-3D, and processing block 218-3D will be described, and detailed descriptions of the other processing blocks will be omitted.
[0194] (1) Engagement Angle Command Value Calculation Unit 214-3
[0195] The engagement angle command value calculation unit 214-3 calculates the engagement angle command value q a First, the engagement angle instruction value calculation unit 214-3 performs integration processing. For example, the engagement angle instruction value calculation unit 214-3 calculates the first-order differential value of the current position posture x by integrating the instruction acceleration value (the second-order differential value of the current position posture x) input from the processing block 212-1A in the Cartesian space. Subsequently, the engagement angle instruction value calculation unit 214-3 calculates the current position posture x by integrating the first-order differential value of the current position posture x. Subsequently, the engagement angle instruction value calculation unit 214-3 calculates the engagement angle instruction value q based on the current position posture x by performing inverse kinematics (IK), for example. a The engagement angle command value calculation unit 214-3 calculates the engagement angle command value q a Output to correction unit 219-1.
[0196] (3) Processing Block 216-3D
[0197] Processing block 216-3D performs calculation of the engagement angle q ex For example, processing block 216-3D uses the following equation (9) to calculate the estimated engagement angle q ex Processing block 216-3D converts the calculated estimated engagement angle q ex Output to processing block 218-3D. In equation (9), I a is the imaginary inertia of the joint 102, and v a is the imaginary viscosity coefficient inside the joint 102 .
[0198] [Formula 9]
[0199]
[0200] (4) Processing Block 218-3D
[0201] Processing block 218-3D performs the operation of applying a gain α to the estimated engagement angle q ex For example, processing block 218-3D is performed by converting the estimated engagement angle q input from processing block 216-3D into ex Multiplying by the gain α adjusted by processing block 218-1B calculates αq ex Processing block 218-3D converts the calculated αq ex Output to correction unit 219-1.
[0202] In the above, reference has been made to Figure 11 The configuration example according to the third embodiment is described. As described above, the control unit 210-3 according to the third embodiment is different from the control unit 210-3 according to the other embodiments and performs control of the control target based on angle rather than torque. Next, an operation example according to the third embodiment will be described.
[0203] <4.2. Operation Example>
[0204] The operation of the control device 200 according to the third embodiment is the same as the operation of the control device 200 described in the first embodiment. Therefore, in this section, a detailed description of the operation example of the control device 200 will be omitted.
[0205] In the above, reference has been made to Figure 11 The third embodiment has been described. Next, the fourth embodiment will be described.
[0206] <<5. Fourth embodiment>>
[0207] In the following, reference will be made to Figure 12 The fourth embodiment will be described. In the first embodiment, the embodiment has been described in which the external force F detected by the force sensor 112 is detected. s and the external torque τ detected by the torque sensor 114 e The estimated external force F ex In the fourth embodiment, an example in which the external force F is input to the external torque adaptive control unit 218-1 will be described. s An example of inputting peripheral information to the external torque adaptive control unit 218-4 before acting on the arm device 100. In the fourth embodiment, the processing blocks of the external torque adaptive control unit 218-4 of the control unit 210-4 perform processing different from that of the first embodiment. The following will mainly describe the different processing.
[0208] <5.1. Configuration Example>
[0209] <5.1.1. Configuration Example of Control System 10>
[0210] The configuration of the control system 10 according to the fourth embodiment is the same as the configuration of the control system 10 described in the first embodiment. Therefore, in this section, a detailed description of the configuration of the control system 10 will be omitted.
[0211] <5.1.2. Functional Configuration Example of Control Unit 210-4>
[0212] The functional configuration of the control unit 210-4 according to the fourth embodiment is the same as the functional configuration of the control unit 210-1 described in the first embodiment. Therefore, in this section, a detailed description of the functional configuration of the control unit 210-4 will be omitted.
[0213] <5.1.3. Configuration Example of Processing Block of Control Unit 210 - 4 >
[0214] Figure 12 2 is a block diagram showing a configuration example of a processing block of the control unit 210-4 according to the fourth embodiment. Figure 12 As shown, the processing block configuration of the control unit 210-4 according to the fourth embodiment differs from that of the first embodiment in the processing of the processing block 218-4E of the external torque adaptive control unit 218-4. Therefore, in this section, only the processing block 218-4E will be described, and detailed descriptions of the other processing blocks will be omitted.
[0215] Processing block 218-4E adjusts the gain α. For example, processing block 218-4E adjusts the gain α based on distance information d input from the outside in addition to the difference ε input from processing block 218-1A. Processing block 218-4E outputs the adjusted gain α to processing block 218-1C.
[0216] For example, the external force F sThe distance information d is detected by the sensor unit 110 before acting on the arm device 100 and is input to the processing block 218-4E. For example, the sensor unit 110 that detects the distance information d is a visual sensor such as a stereo camera device and a monocular camera device, a light reflector, and a distance sensor such as a time-of-flight (ToF) sensor. In addition, the sensor unit 110 can be a distance measuring device such as 3D LiDAR (Laser Imaging Detection and Ranging) and a laser rangefinder. Specifically, the distance information d is information indicating the distance from the arm device 100 to the surrounding people or objects. The processing block 218-4E can adjust the gain α so that the avoidance of people or objects is taken into account by knowing the distance to the people or objects in advance. Thus, the arm device 100 can avoid unnecessary contact by performing operations that take into account the distance to the people or objects, and the stability of the operation can be further improved.
[0217] In the above, refer to Figure 12 Description of a Configuration Example According to the Fourth Embodiment Next, an operation example according to the fourth embodiment will be described.
[0218] <5.2. Operation Example>
[0219] The operation of the control device 200 according to the fourth embodiment is the same as the operation of the control device 200 described in the first embodiment. Therefore, in this section, a detailed description of the operation example of the control device 200 will be omitted.
[0220] In the above, reference has been made to Figure 12 The fourth embodiment is described. Next, the hardware configurations of the control device 200 and the arm device 100 according to the embodiment of the present invention will be described.
[0221] <<6. Hardware Configuration Example>>
[0222] In the following, reference will be made to Figure 12 A hardware configuration example of the control device 200 and the arm device 100 according to an embodiment of the present disclosure is described. Figure 12 1 is a block diagram showing a hardware configuration example of the control device 200 and the arm device 100 according to the embodiment of the present disclosure. The control process of the control system 10 according to the present embodiment is realized by a combination of software and hardware described later.
[0223] like Figure 12As shown, the control device 900 includes a central processing unit (CPU) 901, a read-only memory (ROM) 903, and a random access memory (RAM) 905. In addition, the control device 900 includes a host bus 907, a bridge 909, an external bus 911, an interface 913, an input device 915, an output device 917, a storage device 919, a driver 921, a connection port 923, and a communication device 925. The hardware configuration shown herein is an example, and some of the components may be omitted. In addition, the hardware configuration may also include components other than the components shown herein.
[0224] (CPU 901, ROM 903, RAM 905)
[0225] The CPU 901 functions as an arithmetic processing unit or a control device, for example, and controls the entire operation or part of the operation of the constituent elements based on various programs recorded in the ROM 903, the RAM 905, or the storage device 919. The ROM 903 is a unit that stores programs read into the CPU 901 and data used for calculations, etc. The RAM 905 temporarily or permanently stores programs read into the CPU 901 and various parameters that change appropriately during the execution of the programs, etc. The CPU 901, the ROM 903, and the RAM 905 are connected to each other by a host bus 907 configured as a CPU bus or the like. For example, the CPU 901, the ROM 903, and the RAM 905 can realize reference by cooperating with software. Figure 3 The functions of the control unit 210-1 are described.
[0226] (Host bus 907, bridge 909, external bus 911, interface 913)
[0227] For example, the CPU 901, the ROM 903, and the RAM 905 are connected to each other via a host bus 907 capable of high-speed data transmission. On the other hand, the host bus 907 is connected to an external bus 911 whose data transmission speed is relatively slow via, for example, a bridge 909. Furthermore, the external bus 911 is connected to various components via an interface 913.
[0228] (Input device 915)
[0229] The input device 915 is implemented as a device into which a user inputs information, such as a mouse, keyboard, touchpad, button, microphone, switch, and joystick. Furthermore, the input device 915 may be a remote control device using, for example, infrared light or other radio waves, or may be an external connection device compatible with the operation of the control device 900, such as a mobile phone or PDA. The input device 915 may include an input control circuit that generates an input signal based on information input by the user using an input unit, for example, and outputs the input signal to the CPU 901. The user of the control device 900 inputs various data to the control device 900 and instructs the control device 900 to perform processing operations by operating the input device 915.
[0230] In addition, the input device 915 can be configured as a device that detects information related to the user. For example, the input device 915 may include various sensors, such as an image sensor (e.g., a camera), a depth sensor (e.g., a stereo camera), an accelerometer, a gyroscope, a geomagnetic sensor, an optical sensor, a sound sensor, a distance sensor, and a force sensor. Furthermore, the input device 915 can obtain information about the state of the control device 900, such as the posture or movement speed of the control device 900, and can obtain information about the surrounding environment of the control device 900, such as the surrounding brightness or noise of the control device 900. Furthermore, the input device 915 may include a GNSS module that receives GNSS signals from global navigation satellite system (GNSS) satellites (e.g., GPS signals from global positioning system (GPS) satellites) and measures location information including the latitude, longitude, and altitude of the device. Furthermore, regarding location information, the input device 915 may detect location through the following: Wi-Fi (registered trademark), transmission to and reception from mobile phones, PHS, smartphones, etc., near field communication, etc. The input device 915 can be used to implement, for example, Figure 3 The functions of the sensor unit 110 are described.
[0231] (Output device 917)
[0232] The output device 917 is formed by a device capable of visually or audibly notifying the user of acquired information. Examples of such devices include display devices such as a CRT display device, a liquid crystal display device, a plasma display device, an EL display device, a laser projector, an LED projector, or a lamp, sound output devices such as speakers and headphones, and a printer. For example, the output device 917 outputs the results acquired through the various processes performed by the control device 900. Specifically, the display device visually displays the results acquired through the various processes performed by the control device 900 in various formats such as text, images, tables, and graphs. On the other hand, the sound output device converts audio signals, including reproduced sound data, audio data, and the like, into analog signals and audibly outputs the analog signals.
[0233] (Storage device 919)
[0234] The storage device 919 is a device for storing data, which is formed as an example of a storage unit of the control device 900. For example, the storage device 919 is implemented by a magnetic storage device such as an HDD, a semiconductor storage device, an optical storage device, a magneto-optical storage device, etc. The storage device 919 may include a storage medium, a recording device for recording data on the storage medium, a reading device for reading data from the storage medium, a deletion device for deleting data recorded on the storage medium, etc. The storage device 919 stores programs executed by the CPU 901 and various types of data, various types of data acquired from the outside, etc. For example, the storage device 919 may implement reference Figure 3 The function of the storage unit 230 is described.
[0235] (Driver 921)
[0236] The drive 921 is a reader / writer for a storage medium, and is provided in the control device 900 or is externally attached to the control device 900. The drive 921 reads information recorded on a removable storage medium such as a magnetic disk, an optical disk, a magneto-optical disk, or a semiconductor memory mounted thereon, and outputs the information to the RAM 905. In addition, the drive 921 can write information on the removable storage medium.
[0237] (Connection port 923)
[0238] The connection port 923 is a port for connecting an external connection device, such as a universal serial bus (USB) port, an IEEE1394 port, a small computer system interface (SCSI) port, an RS-232C port, or an optical audio terminal, for example.
[0239] (communication device 925)
[0240] The communication device 925 is a communication interface configured as a communication device for connecting to the network 930, for example. The communication device 925 is, for example, a wired or wireless local area network (LAN), Long Term Evolution (LTE), Bluetooth (registered trademark), a communication card for Wireless USB (WUSB), or the like. Furthermore, the communication device 925 may be a router for optical communication, a router for Asymmetric Digital Subscriber Line (ADSL), a modem for various communications, or the like. For example, the communication device 925 can transmit and receive signals and the like on the Internet and with other communication devices using a predetermined protocol such as TCP / IP.
[0241] The network 930 is a wired or wireless transmission path for information transmitted from a device connected to the network 930. For example, the network 930 may include a public circuit network such as the Internet, a telephone circuit network, or a satellite communication network, various local area networks (LANs) including Ethernet (registered trademark) and a wide area network (WAN), etc. In addition, the network 930 may include a dedicated circuit network such as an Internet Protocol-Virtual Private Network (IP-VPN).
[0242] In the above, reference has been made to Figure 13 The hardware configuration examples of the control device 200 and the arm device 100 according to the present embodiment have been described. Each component can be implemented using a general-purpose member or can be implemented using hardware dedicated to the function of each component. Therefore, when implementing the embodiment, the hardware configuration to be used can be appropriately changed according to the level of technology.
[0243] 7. Conclusion
[0244] As described above, the control device 200 according to an embodiment of the present disclosure obtains an external force detected by a force sensor provided in the control target. Furthermore, the control device 200 obtains torque detected by a torque sensor provided in the movable portion of the control target's operating force sensor. Based on the obtained torque, the control device 200 then calculates an estimated external force acting on the control target. The control device 200 compares the external force with the estimated external force and, based on the comparison result, corrects the torque command value calculated based on the external force to control the operation of the control target.
[0245] As described above, control device 200 can calculate an estimated external force acting on the control target based on the external force detected by the force sensor and the torque detected by the torque sensor. Furthermore, control device 200 can correct the torque command value by comparing the estimated external force with the external force detected by the force sensor to control the operation of the control target. In other words, control device 200 can correct the torque command value based on the torque detected by the torque sensor and control the operation of the control target based on the corrected torque command value.
[0246] Therefore, it is possible to provide a new and improved control device, control method, and control system capable of controlling the operation of a control target according to a detected external force.
[0247] Although the preferred embodiments of the present disclosure have been described above with reference to the accompanying drawings, the technical scope of the present disclosure is not limited to the above examples. Those skilled in the art may find various changes and modifications within the scope of the technical concept described in the claims, and it should be understood that these changes and modifications will naturally fall within the technical scope of the present disclosure.
[0248] For example, the devices described in this specification may be implemented as a single device, and some or all of the devices may be implemented as separate devices. Figure 3 The arm device 100 and the control device 200 shown may also be implemented as a single device. Figure 3 The illustrated control device 200 may be realized as a server device connected to the arm device 100 via a network or the like.
[0249] Note that the processes described in the flowcharts in this specification do not necessarily need to be performed in the order shown. Some process steps can be performed in parallel. Furthermore, some additional steps can be employed, and some process steps can be omitted.
[0250] In addition, the effects described in this specification are merely illustrative or exemplary effects, and are not restrictive. That is, together with or in place of the above effects, based on the description of this specification, the technology according to the present disclosure can achieve other effects that are clear to those skilled in the art.
[0251] Note that the following configurations also fall within the technical scope of the present disclosure.
[0252] (1) A control device comprising: a control unit that compares a first external force detected by a force sensor provided in a control target and a second external force estimated based on a torque detected by a torque sensor provided in a movable part of the control target, the movable part enabling the force sensor to move, and the control unit corrects a torque command value based on a result of the comparison to control the operation of the control target.
[0253] (2) A control device according to (1), wherein the control unit adjusts a gain based on a difference between the first external force and the second external force extracted by comparison, and applies the gain to the torque command value to control switching between a first mode in which the control target operates with safety as a priority and a second mode in which the control target operates with operation accuracy as a priority.
[0254] (3) The control device according to (2), wherein the control unit switches between the first mode and the second mode according to an acting state of a third external force acting on the control target based on the difference.
[0255] (4) The control device according to (3), wherein the control unit sets the first mode when the action state is in a state where the expected third external force acts on the control target.
[0256] (5) The control device according to (4), wherein the control unit sets the first mode by adjusting the gain to approach a first value.
[0257] (6) The control device according to any one of (3) to (5), wherein the control unit sets the second mode when the action state is a state in which an unexpected third external force acts on the control target.
[0258] (7) The control device according to (6), wherein the control unit sets the second mode by adjusting the gain to approach a second value.
[0259] (8) The control device according to any one of (2) to (7), wherein the control unit continuously switches between the first mode and the second mode by continuously changing the gain.
[0260] (9) The control device according to (8), wherein the control unit continuously changes the gain when the difference is a value within a predetermined range.
[0261] (10) The control device according to any one of (2) to (7), wherein the control unit discontinuously switches between the first mode and the second mode by discontinuously changing the gain.
[0262] (11) The control device according to (10), wherein the control unit changes the gain in a step shape according to whether the difference is equal to or greater than a predetermined threshold value.
[0263] (12) A control device according to any one of (2) to (11), wherein the control unit corrects the torque instruction value based on a value obtained by multiplying an estimated torque estimated based on the torque and the posture of the control target by the gain.
[0264] (13) The control device according to (12), wherein the control unit estimates the estimated torque by subtracting an external torque that is a torque generated only due to the operation of the control target from the torque.
[0265] (14) The control device according to (13), wherein the control unit calculates the external torque by performing inverse dynamics calculation based on the engagement angle of the control target.
[0266] (15) A control method executed by a processor, comprising: comparing a first external force detected by a force sensor provided in a control target with a second external force estimated based on a torque detected by a torque sensor provided in a movable part of the control target, and correcting a torque command value based on the comparison result to control the operation of the control target, the movable part operating the force sensor.
[0267] (16) A control system comprising: an arm device comprising a movable part having an actuator, an arm part connected to a plurality of links through the movable part, a torque sensor for detecting a torque acting on the movable part, and a force sensor for detecting a first external force acting on an end of the arm part; and a control device comprising a control unit for comparing the first external force with a second external force estimated based on the torque and correcting a torque command value based on the comparison result to control the operation of the arm device.
[0268] Reference Signs List
[0269] 10 Control System
[0270] 100 arm device
[0271] 102 joint
[0272] 104 connecting rod
[0273] 106 terminal part
[0274] 110 sensor unit
[0275] 112 force sensor
[0276] 114 Torque Sensor
[0277] 120 Joint operating unit
[0278] 200 Control Device
[0279] 210 control unit
[0280] 211 All-axis coordinate control unit
[0281] 212 Cartesian space control unit
[0282] 214 Torque command value calculation unit
[0283] 216 External Force Estimation Unit
[0284] 218 External torque adaptive control unit
[0285] 219 calibration unit
[0286] 220 Engagement control unit
[0287] 230 storage units
Claims
1. A control device, comprising: A control unit that compares a first external force detected by a force sensor provided in a first portion of a control target with a second external force estimated based on a torque detected by a torque sensor provided in a movable portion of the control target, the movable portion of the control target enabling the force sensor to move and being different from the first portion of the control target, and corrects a torque command value based on a result of the comparison to control the operation of the control target.
2. The control device according to claim 1, wherein: The control unit adjusts a gain based on a difference between the first external force and the second external force extracted by comparison, and applies the gain to the torque command value to control switching between a first mode in which the control target operates with safety as a priority and a second mode in which the control target operates with operation accuracy as a priority.
3. The control device according to claim 2, wherein: The control unit switches between the first mode and the second mode according to an acting state of a third external force acting on the control target based on the difference.
4. The control device according to claim 3, wherein: The control unit sets the first mode when the action state is in a state where an expected third external force acts on the control target.
5. The control device according to claim 4, wherein: The control unit sets the first mode by adjusting the gain to approach a first value.
6. The control device according to claim 3, wherein: When the action state is a state in which an unexpected third external force acts on the control target, the control unit sets the second mode.
7. The control device according to claim 6, wherein: The control unit sets the second mode by adjusting the gain to approach a second value.
8. The control device according to claim 2, wherein: The control unit continuously switches between the first mode and the second mode by continuously changing the gain.
9. The control device according to claim 8, wherein: When the difference is a value within a predetermined range, the control unit continuously changes the gain.
10. The control device according to claim 2, wherein: The control unit discontinuously switches between the first mode and the second mode by discontinuously changing the gain.
11. The control device according to claim 10, wherein: The control unit changes the gain in steps according to whether the difference is equal to or greater than a predetermined threshold value.
12. The control device according to claim 2, wherein: The control unit corrects the torque instruction value based on a value obtained by multiplying an estimated torque estimated from the torque and the posture of the control target by the gain.
13. The control device according to claim 12, wherein: The control unit estimates the estimated torque by subtracting an external torque, which is a torque generated only due to the operation of the control target, from the torque.
14. The control device according to claim 13, wherein: The control unit calculates the external torque by performing inverse dynamics calculation based on an engagement angle of the control target.
15. A control method executed by a processor, comprising: A first external force detected by a force sensor provided in a first portion of a control target is compared with a second external force estimated based on a torque detected by a torque sensor provided in a movable portion of the control target, wherein the movable portion of the control target enables the force sensor to move and is different from the first portion of the control target, and a torque command value is corrected based on the comparison result to control the operation of the control target.
16. A control system comprising: an arm device including a movable portion having an actuator, an arm portion connected to a plurality of links through the movable portion, a torque sensor provided in the movable portion and configured to detect a torque acting on the movable portion, and a force sensor provided at an end of the arm portion and configured to detect a first external force acting on the end of the arm portion, the end of the arm portion being different from the movable portion; as well as A control device includes a control unit that compares the first external force and a second external force estimated based on the torque and corrects a torque command value based on a comparison result to control an operation of the arm device.
