Holding control unit, control device, and program
By using correction filters to process force sensor signals in the robot control system, the problem of unstable force of the robot is solved, and higher stability and control accuracy are achieved.
Patent Information
- Application Number
- CN202380029522.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Applications(China)
- Current Assignee / Owner
- Priority Date
- 2022-03-28
- Filing Date
- 2023-03-22
- Publication Date
- 2024-11-12
- Estimated Expiration
- Not applicable · inactive patent
AI Technical Summary
The existing robot control technology is difficult to effectively and stably control the retaining force of the robot, especially when considering the viscoelastic characteristics of the protective member, resulting in unstable maintenance movement.
By adopting a control device including a correction filter, the force sensor detection signal is filtered to reduce the influence of the viscoelastic characteristics of the protection member, and the filter characteristics are adjusted to match the viscoelastic characteristics to achieve stable control of the retaining force.
It improves the stability of the robot when maintaining an object, ensures that the holding force is close to the actual force, reduces the influence of noise, and enhances control accuracy.
Smart Images

Figure CN118946440A_ABST
Abstract
Description
Technical Field
[0001] The present disclosure relates to control technology. Background Art
[0002] Patent Document 1 describes a robot control technology.
[0003] Prior art literature
[0004] Patent Literature
[0005] Patent Document 1: Japanese Patent Application Publication No. 2013-113661 Summary of the invention
[0006] A holding control unit, a control device, and a program are disclosed. In one embodiment, the holding control unit is a holding control unit that controls a holding unit capable of holding an object via a protective member. The holding control unit controls the holding force of the holding unit in consideration of the viscoelastic properties of the protective member.
[0007] In one embodiment, the control device controls a holding portion that holds an object. The holding portion includes: a sensor that detects a holding force of an object in the holding portion; and a protective member on a detection portion of the sensor. The sensor detects the holding force through the protective member. The control device includes a holding control portion that controls the holding force based on a detection signal output by the sensor. The holding control portion includes a correction filter. The correction filter performs a first filtering process on the detection signal to reduce the influence of the viscoelastic properties of the protective member in the detection signal.
[0008] Furthermore, in one embodiment, the program is a program for causing a computer device to function as the above-mentioned retention control unit.
[0009] Furthermore, in one embodiment, the program is a program for causing a computer device to function as the above-mentioned control device. BRIEF DESCRIPTION OF THE DRAWINGS
[0010] Figure 1 It is a schematic diagram showing an example of a control device.
[0011] Figure 2 A schematic diagram showing an example of a robot system.
[0012] Figure 3 This is a schematic diagram showing an example of a partial configuration of a robot system.
[0013] Figure 4 This is a schematic diagram showing an example of a robot.
[0014] Figure 5 This is a graph showing an example of the temporal change of the gripping force.
[0015] Figure 6 This is a graph showing an example of the temporal change of the gripping force.
[0016] Figure 7 This is a schematic diagram showing an example of a Bode plot.
[0017] Figure 8 This is a schematic diagram showing an example of a Bode plot.
[0018] Fig. 9 This is a schematic diagram showing an example of a Bode plot.
[0019] Fig.10 This is a schematic diagram showing an example of a Bode plot.
[0020] Fig.11 This is a schematic diagram showing an example of a Bode plot.
[0021] Fig.12 This is a schematic diagram showing an example of a partial configuration of a robot system.
[0022] Fig.13 This is a schematic diagram showing an example of a partial configuration of a robot system.
[0023] Fig.14 This is a schematic diagram showing an example of a partial configuration of a robot system.
[0024] Fig.15 This is a schematic diagram showing an example of a partial configuration of a robot system.
[0025] Fig.16 This is a schematic diagram showing an example of a partial configuration of a robot system. DETAILED DESCRIPTION
[0026] Figure 1 The schematic diagram is a diagram showing an example of the structure of a control device 1 that controls a holding portion that holds an object. The control device 1 can control a holding portion that a robot has, for example. Hereinafter, the control device 1 is described by taking the case where the control device 1 controls the holding portion of the robot as an example, but the holding portion controlled by the control device 1 is not limited to the holding portion of the robot.
[0027] Figure 2Schematic diagram showing an example of a robot system 9 having a control device 1. The robot system 9 involved in the present embodiment includes, for example, a robot 3, a control device 1, and a control device 2. The control device 2 is, for example, a device that manages the overall movement of the robot 3, and is also called a robot controller. The robot 3 includes, for example, an arm 4 and a manipulator 5 connected to the arm 4. The manipulator 5 includes a holding portion 50 that holds an object 8. The holding portion 50 holds the object 8 by, for example, gripping the object 8. The robot 3 can move the object 8 by, for example, moving the arm 4 while the object 8 is held by the holding portion 50. Hereinafter, the holding portion 50 that holds the object 8 is sometimes referred to as the gripping portion 50. The holding portion 50 may also hold the object 8 by a method other than the method of gripping the object 8. For example, the holding portion 50 may also hold the object 8 by adsorbing the object 8. In this case, the holding portion 50 is also referred to as an adsorption portion.
[0028] The control device 2 can control the arm 4, for example. The control device 1 can control the manipulator 5, for example. Specifically, the control device 1 can control the gripping portion 50 of the manipulator 5. The control device 1 is also called a manual controller, for example. The control device 1 can control the gripping force of the object 8 in the gripping portion 50. The gripping force of the gripping portion 50 is also called a holding force. The "gripping force" in the following description can be read as "holding force". The control device 1 can be set inside the manipulator 5 or outside the manipulator 5.
[0029] like Figure 1 As shown, the control device 1 includes, for example, a control unit 10, a storage unit 11, and an interface 12. The control device 1 is also called a control circuit, for example. The control device 1 is, for example, a type of computer device.
[0030] The interface 12 can exchange signals with the control device 2. The control unit 10 can exchange signals with the control device 1 via the interface 12. The interface 12 may also be called an interface circuit, for example.
[0031] The control unit 10 can manage the operation of the control device 1 by controlling other components of the control device 1. The control unit 10 is also called a control circuit. As described in further detail below, the control unit 10 includes at least one processor to provide control and processing capabilities for performing various functions.
[0032] According to various embodiments, at least one processor may also be implemented as a single integrated circuit (IC), or as multiple communicatively connected integrated circuits (ICs) and / or discrete circuits. At least one processor may be implemented according to various known techniques.
[0033] In one embodiment, the processor includes, for example, one or more circuits or units configured to perform one or more data calculation procedures or processes by executing instructions stored in an associated memory. In other embodiments, the processor may also be firmware (e.g., discrete logic components) configured to perform one or more data calculation procedures or processes.
[0034] According to various embodiments, the processor may also include one or more processors, controllers, microprocessors, microcontrollers, application-specific integrated circuits (ASICs), digital signal processing devices, programmable logic devices, field programmable gate arrays, or any combination of these devices or structures, or a combination of other devices and structures, to perform the functions described below.
[0035] The control unit 10 may also include, for example, a CPU (Central Processing Unit) as a processor. The storage unit 11 may also include a non-temporary recording medium such as a ROM (Read Only Memory) and a RAM (Random Access Memory) that can be read by the CPU of the control unit 10. The storage unit 11 may also include, for example, NVRAM (Non Volatile Random Access Memory) as a non-volatile memory. The storage unit 11 stores, for example, a program 11a for controlling the control device 1. Various functions of the control unit 10 are realized by, for example, the CPU of the control unit 10 executing the program 11a in the storage unit 11.
[0036] It should be noted that the structure of the control unit 10 is not limited to the above-mentioned example. For example, the control unit 10 may also include multiple CPUs. In addition, the control unit 10 may also include at least one DSP (Digital Signal Processor). In addition, all functions of the control unit 10 or part of the functions of the control unit 10 may also be implemented by a hardware circuit that does not require software in the implementation of the function. In addition, the storage unit 11 may also include a non-temporary recording medium that can be read by a computer other than ROM and RAM. The storage unit 11 may also include, for example, a small hard disk drive and an SSD (Solid State Drive).
[0037] The CPU of the control unit 10 executes the program 11a in the storage unit 11, so that the holding control unit 100 that controls the holding unit 50 of the manipulator 5 is formed as a functional block in the control unit 10. The holding unit 50 that holds the object 8, in other words, the holding control unit 100 that controls the holding unit 50 is also called the holding control unit 100.
[0038] Figure 3 It is a schematic diagram showing an example of a partial configuration of the robot system 9 . Figure 4 Schematic diagram showing an example of the structure of the robot 5. Figure 3 As shown in FIG. 4 , the gripping unit 50 includes, for example, a plurality of fingers 51, a force sensor 52, a plurality of protection members 53, and a driving unit 54 for driving the plurality of fingers 51. Hereinafter, the robot system 9 will be described by taking the case where the gripping unit 50 includes two fingers 51 as an example, but the number of fingers 51 may be three or more.
[0039] The two fingers 51 can move so as to approach or move away from each other. It can also be said that the two fingers 51 can be opened and closed. The driving unit 54 drives the two fingers 51 so as to approach or move away from each other. The gripping unit 50 can grip the object 8 by the two fingers 51, or open the grip of the object 8 by the two fingers 51.
[0040] The force sensor 52 is arranged at a position where it can detect the holding force of the object 8 when the holding portion 50 holds the object 8. For example, in the present embodiment, the holding portion 50 can hold the object 8 by the front end portion of the finger 51. The force sensor 52 is provided at, for example, the front end portion of the finger 51d. The force sensor 52 can detect the holding force of the holding portion 50 on the object 8. In the present embodiment, the force sensor 52 can detect the holding force of the holding portion 50 on the object 8. The force sensor 52 has two detection portions 52a respectively provided on the two fingers 51. Each detection portion 52a can detect the force applied to itself. For example, the detection portion 52a can detect the contact pressure applied to the force sensor 52. The force sensor 52 detects the holding force of the object 8 generated by the two fingers 51 by detecting the force applied to the two detection portions 52a. The holding force of the object 8 becomes, for example, a value obtained by adding the forces detected by the two detection portions 52a. It can also be said that the force sensor 52 detects the force applied to the object 8 when the object 8 is grasped by the grasping unit 50. The force sensor 52 outputs a detection signal 152 indicating the detected grasping force (detected grasping force) to the grasping control unit 100. The detected grasping force indicated by the detection signal 152 is expressed, for example, as torque. The detection signal 152 indicates the timing of the detected grasping force. The force sensor 52 may also be, for example, a tactile sensor. The force sensor 52 may be a resistive type, an electrostatic capacitive type, a piezoelectric type, or an optical type. It should be noted that the grasping force of the object 8 may also be evaluated by, for example, the average value of the forces detected by the two detection units 52a.
[0041] The protective member 53 is located on each detection part 52a. The detection part 52a detects the force applied to the object 8 through the protective member 53 thereon. The protective member 53 is provided, for example, at the belly of the finger 51. When the two fingers 51 hold the object 8, the two protective members 53 come into contact with the object 8. The object 8 is clamped by the two protective members 53. The protective member 53 can protect the detection part 52a. In addition, the protective member 53 can mitigate the collision of the holding part 50 with the object 8. In addition, the protective member 53 is made to be difficult to damage the object 8 when the holding part 50 holds the object 8. The protective member 53 is composed of an elastic member such as synthetic rubber, for example. The two fingers 51 hold the object 8 through the two protective members 53. The force sensor 52 detects the holding force (in other words, the holding force) of the object 8 through the protective member 53. Hereinafter, if it is simply referred to as the holding force, it means the holding force of the object 8 in the holding part 50. It should be noted that, in the present embodiment, the protective member 53 is directly disposed on the detection portion 52a, but if the force applied to the object 8 via the protective member 53 can be detected, it may be indirectly disposed on the detection portion 52a via, for example, other members.
[0042] The driving unit 54 includes, for example, a motor 56, a gear 57, an encoder 58, and a motor driver 55 for driving the motor 56. The driving unit 54 drives the two fingers 51 based on the control signal 111 output by the grip control unit 100. The two fingers 51 are driven based on the control signal 111, so that the interval between the two fingers 51 is controlled. It can also be said that the positional relationship between the two fingers 51 is controlled by driving the two fingers 51 based on the control signal 111. In addition, it can also be said that the positions of the two fingers 51 are controlled by driving the two fingers 51 based on the control signal 111.
[0043] The motor 56 drives the two fingers 51 via the gear 57. The two fingers 51 are driven by the motor 56 so that they can approach each other or separate from each other. As the two fingers 51 are driven by the motor 56, the interval between the two fingers 51 changes. The encoder 58 is a rotary encoder that detects the rotational position of the motor 56 (also referred to as the motor rotational position). The encoder 58 outputs a detection signal 158 indicating the detection result of the rotational position of the motor 56 to the grip control unit 100. The motor driver 55 drives the motor 56 based on the control signal 111 output by the grip control unit 100. The motor driver 55 controls the rotation of the motor 56 based on the control signal 111. As the motor 56 is driven based on the control signal 111, the position of each finger 51 is controlled.
[0044] When the robot 3 moves the object 8, the position of the arm 4 is controlled by the control device 2 so that the object 8 is located between the two fingers 51 in a separated state. Then, the grip control unit 100 controls the driving unit 54 by the control signal 111, so that the two fingers 51 approach each other and grip the object 8. At this time, the gripping force of the object 8 in the two fingers 51 is appropriately controlled by the grip control unit 100. Then, the position of the arm 4 is controlled by the control device 2 in a state where the object 8 is gripped by the two fingers 51, so that the object 8 gripped by the two fingers 51 moves.
[0045] After the position of the arm 4 is controlled by the control device 2 so that the object 8 is located between the two fingers 51, the grip control unit 100 controls the grip unit 50. The grip control unit 100 generates a control signal 111 for controlling the rotational position of the motor 56 based on the detection signal 152 output by the force sensor 52 and the detection signal 158 output by the encoder 58. Then, the grip control unit 100 controls the rotational position of the motor 56 by outputting the control signal 111 to the motor driver 55. By controlling the rotational position of the motor 56, the interval between the two fingers 51 (in other words, the position of each finger 51) is controlled. The grip control unit 100 controls the gripping force of the object 8 in the grip unit 50 based on the detection signal 152 and the detection signal 158. In the robot system 9, a force position control loop is formed in which the grip control unit 100 and the grip unit 50 control the gripping force of the object 8 in the grip unit 50 and the positions of the two fingers 51. It can also be said that the grip control unit 100 and the grip unit 50 constitute a feedback control system that controls the grip force and the position of the finger 51 .
[0046] The grip control unit 100 controls the gripping force by controlling the interval between the two fingers 51. For example, when the two fingers 51 grip the object 8, if the interval between the two fingers 51 decreases, the gripping force increases, and if the interval between the two fingers 51 increases, the gripping force decreases.
[0047] like Figure 3 As shown in FIG. 1 , the grip control unit 100 includes, as functional blocks, for example, a position control unit 101, an adder 102, a position acquisition unit 103, a subtractor 104, a conversion unit 105, a filter 106, and a correction filter 107. It should be noted that all functions of the position control unit 101 or a part of the functions of the position control unit 101 may be realized by a hardware circuit that does not require software in the realization of the functions. This is also true for the adder 102, the position acquisition unit 103, the subtractor 104, the conversion unit 105, the filter 106, and the correction filter 107.
[0048] The correction filter 107 is, for example, a digital filter. The correction filter 107 performs filtering processing on the detection signal 152 output from the force sensor 52 and corrects the detection signal 152. Then, the correction filter 107 outputs the filtered detection signal 152, in other words, the corrected detection signal 152 as the filter signal 117. The operation of the correction filter 107 will be described in detail later.
[0049] The subtractor 104 subtracts the detected holding force indicated by the filter signal 117 from the target holding force. Then, the subtractor 104 outputs a holding force deviation signal 114 which represents the timing of the holding force deviation obtained by subtracting the detected holding force indicated by the filter signal 117 from the target holding force. The target holding force is a target value of the holding force of the object 8 in the holding portion 50. The target value is also referred to as an instruction value or a reference value. When the holding force deviation is positive, the detected holding force is smaller than the target holding force, and when the holding force deviation is negative, the detected holding force is larger than the target holding force. It can also be said that the target holding force is a target value of the force applied to the object 8 when the object 8 is held. The target holding force and the holding force deviation are represented by, for example, torque.
[0050] The conversion unit 105 converts the gripping force deviation indicated by the gripping force deviation signal 114 into a rotational position change amount. The rotational position change amount means the change amount of the motor rotational position required to change the gripping force according to the gripping force deviation serving as the basis thereof. The conversion unit 105 outputs a rotational position change amount signal 115 indicating the time series of the rotational position change amount. The gripping force of the object 8 in the gripping unit 50 is controlled according to the rotational position change amount.
[0051] The filter 106 performs filtering processing on the rotation position variation signal 115. The filter 106 performs low-pass filtering processing on the rotation position variation signal 115, for example. Thus, the rotation position variation signal 115 is subjected to noise removal processing. Then, the filter 106 outputs the rotation position variation signal 115 after filtering processing as a filter signal 116. The filter 106 may also be constituted by, for example, an integrator.
[0052] The adder 102 adds the rotation position change amount indicated by the filter signal 116 to the target rotation position, and uses the obtained value as the corrected target rotation position. The target rotation position is the target value of the motor rotation position when the two fingers 51 grasp the object 8. The adder 102 outputs a corrected target rotation position signal 112 indicating the timing of the corrected target rotation position.
[0053] The position acquisition unit 103 obtains the motor rotation position based on the detection signal 158 output by the encoder 58. Then, the position acquisition unit 103 outputs a rotation position signal 113 indicating the timing of the obtained motor rotation position (also referred to as a detected motor rotation position).
[0054] The position control unit 101 subtracts the detected motor rotation position indicated by the rotation position signal 113 from the corrected target rotation position indicated by the corrected target rotation position signal 112. Then, the position control unit 101 generates a control signal 111 for changing the motor rotation position according to the rotation position deviation obtained by subtracting the detected motor rotation position from the corrected target rotation position, and outputs the control signal to the motor driver 55. The motor driver 55 drives the motor 56 based on the control signal 111, thereby controlling the motor rotation position to approach the corrected target rotation position. Thus, the gripping force is controlled to approach the target gripping force.
[0055] As described above, the protective member 53 is located on the detection portion 52a of the force sensor 52. Therefore, the responsiveness of the detection portion 52a is reduced due to the viscoelastic properties of the protective member 53 as an elastic member, and the detected holding force indicated by the detection signal 152 of the force sensor 52 may be different from the actual holding force. It should be noted that, strictly speaking, the viscoelastic properties of the detection portion 52a also affect the responsiveness of the detection portion 52a, but since the viscoelastic properties of the protective member 53 have a dominant effect on the responsiveness of the detection portion 52a, the hysteresis of the responsiveness of the detection portion 52a is almost determined by the viscoelastic properties of the protective member 53.
[0056] Figure 5 1 is a graph showing an example of time variation of the detected gripping force and the actual gripping force (in other words, the force actually applied to the object 8 during gripping). The dotted line 120 shows an example of time variation of the actual gripping force, and the solid line 121 shows an example of time variation of the detected gripping force. Figure 5 and the following Figure 6 As can be understood by comparing the dotted line 120 with the solid line 121, the viscoelastic properties of the protection member 53 cause a hysteresis in the detection of the holding force by the force sensor 52, and while the object 8 is held for a period of time, the detected holding force differs from the actual holding force.
[0057] Therefore, the holding control unit 100 controls the holding force of the holding unit 50 in consideration of the viscoelastic properties of the protective member 53. In other words, the holding control unit 100 controls the holding force of the holding unit 50 in consideration of the viscoelastic properties of the protective member 53. As a result, the stability of the holding action of the object 8 can be improved when the holding unit 50 holds the object 8. For example, in the holding control unit 100, the correction filter 107 performs filtering processing on the detection signal 152 of the force sensor 52 so that the detected holding force shown by the force sensor 52 is close to the actual holding force, and corrects the detection signal 152. As a result, based on the filtered detection signal 152 (in other words, the filter signal 117), the holding force of the object 8 in the holding unit 50 can be appropriately controlled.
[0058] Figure 6 1 is a graph showing an example of the time variation of the detected holding force and the actual holding force shown in the filter signal 117. The dotted line 120 shows an example of the time variation of the actual holding force, and the solid line 125 shows an example of the time variation of the detected holding force shown in the filter signal 117. As can be understood by comparing the dotted line 120 with the solid line 125, the detected holding force shown in the filter signal 117 is close to the actual holding force due to the operation of the correction filter 107. The operation example of the correction filter 107 is described in detail below. Hereinafter, if only the viscoelastic property is mentioned, it means the viscoelastic property of the protective member 53.
[0059] The correction filter 107 performs a first filtering process on the detection signal 152 to reduce the influence of the viscoelastic properties of the protection member 53 in the detection signal 152. In addition, the correction filter 107 performs a second filtering process on the detection signal 152 to reduce the influence of the first filtering process in a frequency band above the control band of the grip control unit 100. Then, the correction filter 107 performs a noise removal process on the detection signal 152 in a frequency band above the control band of the grip control unit 100. The correction filter 107 outputs the detection signal 152 that has been subjected to the first filtering process, the second filtering process, and the noise removal process to the subtractor 104 as a filter signal 117. Hereinafter, the noise removal process performed by the correction filter 107 is sometimes referred to as the first noise removal process, and the noise removal process performed by the filter 106 is sometimes referred to as the second noise removal process.
[0060] <Example of the First Filter Processing>
[0061] The viscoelastic properties of the protective member 53 are represented by, for example, a Voigt model in which a spring and a dashboard are connected in parallel. The Voigt model is a first-order hysteresis system model, and the viscoelastic properties are, for example, first-order hysteresis properties. In this case, the transfer function G0(s) of the viscoelastic properties becomes, for example, a transfer function of a first-order hysteresis system having one pole. The transfer function G0(s) is represented, for example, by the following formula (1).
[0062] [Formula 1]
[0063]
[0064] T0 and K in formula (1) represent the time constant and gain, respectively. The frequency of the pole of the viscoelastic characteristic, in other words, the frequency of the pole of the transfer function G0(s) is represented by 1 / T0. Hereinafter, the frequency of the pole is referred to as the pole frequency. The frequency may also be an angular frequency or may be represented by Hz.
[0065] When the viscoelastic characteristic is a first-order lag characteristic, in order to reduce the influence of the viscoelastic characteristic of the protection member 53 in the detection signal 152, as the characteristic of the first filtering process (also referred to as the first filter characteristic), for example, a first-order lead filter characteristic is adopted. The transfer function G1(s) of the first filter characteristic of the first-order lead characteristic is represented by, for example, the following equation (2).
[0066] [Formula 2]
[0067]
[0068] T1 and K in formula (2) represent the time constant and gain, respectively. The pole frequency of the first filter characteristic, in other words, the pole frequency of the transfer function G1(s) is represented by 1 / T1. The pole frequency of the first filter characteristic is set to a value that is the same as or close to the pole frequency of, for example, the viscoelastic characteristic. Thus, the first filter characteristic roughly represents the opposite characteristic of the viscoelastic characteristic, and the influence of the viscoelastic characteristics of the protective component 53 is unlikely to appear in the detection signal 152 after the first filtering process. Therefore, the detected holding force shown in the detection signal 152 can be made close to the actual holding force. The pole frequency of the first filter characteristic can also be set to, for example, more than 0.8 times and less than 1.2 times the pole frequency of the viscoelastic characteristic, or more than 0.9 times and less than 1.1 times the pole frequency of the viscoelastic characteristic.
[0069] In this way, the correction filter 107 performs the first filtering process on the detection signal 152 to reduce the influence of the viscoelastic characteristics in the detection signal 152, so that the detected holding force shown in the detection signal 152 after the first filtering process can be close to the actual holding force. Therefore, the holding force of the object 8 in the holding part 50 can be appropriately controlled based on the detected holding force. As a result, the stability of the holding action of the object 8 when the holding part 50 holds the object 8 can be improved.
[0070] The pole frequency of the first filter characteristic may also be pre-stored in the storage unit 11. In addition, when the transfer function G0(s) of the viscoelastic characteristic is stored in the storage unit 11, the holding control unit 100 may also determine the pole frequency of the first filter characteristic based on the transfer function G0(s) of the viscoelastic characteristic in the storage unit 11. In this case, the holding control unit 100 obtains the pole frequency of the viscoelastic characteristic based on the transfer function G0(s) of the viscoelastic characteristic in the storage unit 11. Then, the holding control unit 100 determines the pole frequency of the first filter characteristic based on the obtained pole frequency of the viscoelastic characteristic.
[0071] <Example of the Second Filter Processing>
[0072] In the detection signal 152 , in a frequency band equal to or higher than the control frequency band of the grip control unit 100 , the first filtering process does not contribute much to the grip force control in the grip control unit 100 .
[0073] On the other hand, the influence of the first filtering process in the frequency band above the control frequency band in the detection signal 152 may have an adverse effect on the gripping force control in the gripping control unit 100. For example, in the gain diagram of the first-order lead system, when the frequency is larger than the pole frequency, the gain increases as the frequency increases. Therefore, in the first filtering process representing the characteristics of the first-order lead system, noise is easily amplified in a high frequency band. Therefore, with respect to the detection signal 152, due to the influence of the first filtering process in the frequency band above the control frequency band, noise is easily amplified in this frequency band, and there is a possibility that this situation may have an adverse effect on the gripping force control.
[0074] Therefore, in the detection signal 152, in order to reduce the influence of the first filtering process in the frequency band above the control frequency band, as the characteristic of the second filtering process (also referred to as the second filter characteristic), a lag filter characteristic of a first-order lag system is adopted, for example. The second filter characteristic is called a low-pass filter characteristic. The transfer function G2(s) of the second filter characteristic of the first-order lag characteristic is represented by, for example, the following equation (3).
[0075] [Formula 3]
[0076]
[0077] T2 and K in the formula (3) represent a time constant and a gain, respectively. The pole frequency of the second filter characteristic, in other words, the pole frequency of the transfer function G2(s) is represented by 1 / T2. The pole frequency (also referred to as a cutoff frequency) of the second filter characteristic is set to be, for example, larger than the pole frequency of the first filter characteristic and to be greater than the upper limit value of the control band of the control unit 100. As a result, in the detection signal 152, the influence of the first filtering process in the frequency band above the control band of the control unit 100 (in detail, the frequency band above the pole frequency of the second filter characteristic) is reduced.
[0078] The upper limit value of the control band of the grip control unit 100 is greater than the pole frequency of the viscoelastic characteristic. The pole frequency of the first filter characteristic is set to a value smaller than the upper limit value of the control band of the grip control unit 100. The pole frequency of the second filter characteristic may also be set to be greater than 1 times and less than 20 times the upper limit value of the control band of the grip control unit 100, or may be set to be greater than 10 times and less than 20 times the upper limit value.
[0079] The control band of the grip control unit 100 is a band from the gain diagram of the open-loop transfer function of the force position control loop (also referred to as the first force position control loop) when the grip control unit 100 does not include the correction filter 107 to the zero-point frequency (also referred to as the zero-crossing frequency) at which the gain becomes 0 dB. The upper limit value of the control band of the grip control unit 100 becomes the zero-point frequency of the gain diagram of the open-loop transfer function of the first force position control loop. Figure 3 In the example of , the open loop transfer function of the first force position control loop becomes a transfer function from the input of the conversion unit 105 to the output of the force sensor 52.
[0080] Figure 7 is a diagram showing an example of a Bode plot of an open-loop transfer function. Figure 7 In the figure showing the Bode diagram described later, the upper side shows the gain diagram and the lower side shows the phase diagram.
[0081] Figure 7 In FIG. 5 , the Bode plot of the open-loop transfer function of the first force position control loop is represented by a solid line. Figure 7 , represents the zero frequency ω0 of the gain diagram of the open-loop transfer function of the first force position control loop, in other words, the upper limit value ω0 of the control band of the control unit 100. Figure 7 In the example of , the upper limit value ω0 of the control band becomes approximately 20 rad / s.
[0082] also, Figure 7 In FIG. 1 , a dotted line is used to represent a Bode plot of an open-loop transfer function of a force position control loop (also referred to as a second force position control loop) when the grip control unit 100 does not perform the second filtering process and the third filtering process. The open-loop transfer function of the second force position control loop is a transfer function from the input of the conversion unit 105 to the output of the correction filter 107 that performs only the first filtering process. In addition, Figure 7 In FIG. 1 , a Bode plot of an open-loop transfer function of a force position control loop (also referred to as a third force position control loop) when the grip control unit 100 does not perform the third filtering process is represented by a single-dot chain line. The open-loop transfer function of the third force position control loop is a transfer function from the input of the conversion unit 105 to the output of the correction filter 107 that performs only the first filtering process and the second filtering process. Figure 7 And the Bode diagrams shown in the figures described later are Bode diagrams for the case where K=1.
[0083] It should be noted that the first filtering process and the second filtering process can also be regarded as one filtering process. In this case, for example, as described above, when the first filter characteristic is a lead filter characteristic and the second filter characteristic is a lag filter characteristic, the first filtering process and the second filtering process can be regarded as one filtering process representing the lead-lag filter characteristic.
[0084] Hereinafter, the first filtering process and the second filtering process are sometimes collectively referred to as the comprehensive filtering process. The transfer function G12(s) of the characteristics of the comprehensive filtering process (also referred to as the comprehensive filter characteristics) is a function obtained by multiplying the transfer function G1(s) of the first filter characteristics by the transfer function G2(s) of the second filter characteristics. The transfer function G12(s) is represented, for example, by the following equation (4).
[0085] [Formula 4]
[0086]
[0087] Figure 8 It is a schematic diagram showing an example of a Bode diagram of a transfer function G12(s) of comprehensive filter characteristics and a Bode diagram of a transfer function G0(s) of viscoelastic characteristics. Figure 8 In the figure, the solid line represents the Bode plot of the transfer function G12(s), and the dotted line represents the Bode plot of the transfer function G0(s). Figure 8 , an example of the upper limit value ω0 of the control band, an example of the pole frequency a of the first filter characteristic (in other words, 1 / T1), and an example of the pole frequency b of the second filter characteristic (in other words, 1 / T2) are shown. Figure 8 In the example of , the pole frequency b of the second filter characteristic is set to about 30 times the upper limit value ω0 of the control band.
[0088] Fig. 9 This is a diagram showing an example of a Bode diagram of a transfer function obtained by multiplying the transfer function G12(s) and the transfer function G0(s). Fig. 9 The Bode diagram shown is: when the transfer function of the force sensor 52 is set to 1 Figure 3 In the example of FIG. 5 , a Bode plot of the transfer function from the input of the protection component 53 to the output of the correction filter 107 that performs only the integrated filtering process is shown. Fig. 9 The Bode plots shown and Figure 8 By comparing the Bode diagram represented by the dotted line in FIG. 1 , it can be seen that in the detection signal 152 subjected to the comprehensive filtering process, the influence of the viscoelastic characteristics (for example, the influence of the first-order lag characteristics) is reduced in the frequency band below the pole frequency b of the second filter characteristics. Then, in the detection signal 152 subjected to the comprehensive filtering process, the influence of the first filtering process (for example, the influence of the first-order lead characteristics) is reduced in the frequency band above the pole frequency b, and the noise is difficult to be amplified.
[0089] In this way, the correction filter 107 performs the second filtering process on the detection signal 152 to reduce the influence of the first filtering process in the frequency band above the control frequency band of the grip control unit 100. As a result, the possibility that the influence of the first filtering process in the frequency band above the control frequency band in the detection signal 152 will have an adverse effect on the gripping force control in the grip control unit 100 can be reduced. For example, when the first filter characteristic is a first-order lead characteristic, the possibility that the noise generated in the frequency band above the control frequency band is amplified by the first filtering process and this situation has an adverse effect on the gripping force control can be reduced.
[0090] The pole frequency of the second filtering process may also be pre-stored in the storage unit 11. In addition, when the open-loop transfer function of the first force position control loop is stored in the storage unit 11, the grip control unit 100 may also determine the pole frequency of the second filter characteristic based on the open-loop transfer function in the storage unit 11. In this case, the grip control unit 100 calculates the zero-point frequency of the open-loop transfer function in the storage unit 11. Then, the grip control unit 100 determines the pole frequency of the second filter characteristic based on the calculated zero-point frequency, in other words, the upper limit value of the control band.
[0091] <Example of the First Noise Removal Processing>
[0092] As the first noise removal process, for example, a low-pass filter process is used. The characteristic of the first noise removal process (also referred to as the first noise removal characteristic) is, for example, a first-order lag characteristic. The transfer function G3(s) of the first noise removal characteristic is represented by, for example, the following first-order equation (5).
[0093] [Formula 5]
[0094]
[0095] T3 and K in formula (5) represent the time constant and gain, respectively. The pole frequency c of the first noise removal characteristic, in other words, the pole frequency c of the transfer function G3(s) is represented by 1 / T3. The pole frequency c (also called the cutoff frequency) of the first noise removal characteristic is set to a value greater than the pole frequency b of the second filter characteristic, for example. The pole frequency c may be greater than the pole frequency b and less than 20 times the pole frequency b, or may be greater than 2 times and less than 10 times the pole frequency b. The first noise removal process may also be a second-order or higher filtering process.
[0096] Fig.10 1 is a schematic diagram showing an example of a Bode diagram of a transfer function of the correction filter 107 that performs the first filtering process, the second filtering process, and the first noise removal process. Fig.10 In FIG. 1 , an example of the upper limit value ω0 of the control band, the pole frequency a, the pole frequency b, and the pole frequency c are shown. Fig.10 In the example, the pole frequency c is set to about 700 times the pole frequency b.
[0097] In this way, the correction filter 107 performs the first noise removal processing on the detection signal 152 in a frequency band above the control band of the grip control unit 100 , so that the grip control unit 100 can appropriately control the gripping force of the object 8 in the gripping unit 50 based on the detection signal 152 after the first noise removal processing.
[0098] The pole frequency of the first noise removal characteristic may also be pre-stored in the storage unit 11. In addition, when the storage unit 11 stores the open-loop transfer function of the first force position control loop, the grip control unit 100 may determine the pole frequency c of the first noise removal characteristic based on the open-loop transfer function in the storage unit 11. In this case, the grip control unit 100 calculates the zero-point frequency of the open-loop transfer function in the storage unit 11. Then, the grip control unit 100 determines the pole frequency c of the first noise removal characteristic based on the calculated zero-point frequency, in other words, the upper limit value of the control frequency band.
[0099] The order of performing the first filtering process, the second filtering process, and the first noise removal process can be any order. For example, the second filtering process can be performed after the first filtering process is performed on the detection signal 152, or the first filtering process can be performed after the second filtering process is performed. In addition, the first noise removal process can be performed after the second filtering process is performed on the detection signal 152, or the second filtering process can be performed after the first noise removal process is performed. In addition, the first noise removal process can be performed after the first filtering process is performed on the detection signal 152, or the first filtering process can be performed after the first noise removal process is performed. Even in the case where the first filtering process is performed after the second filtering process is performed, the influence of the first filtering process in the frequency band above the control band is reduced in the detection signal 152 that has undergone the second filtering process and the first filtering process by the action of the second filtering process that is performed first.
[0100] In addition, at least two of the first filtering process, the second filtering process, and the first noise removal process may also be performed simultaneously. For example, consider the case where the correction filter 107 has a filter having a transfer function that is the same as the transfer function G12(s) of the above-mentioned integrated filter. In this case, the detection signal 152 is filtered by the one filter, so that the first filtering process and the second filtering process are performed simultaneously. In addition, in the case where the detection signal 152 is filtered by a filter having a transfer function obtained by multiplying the transfer function G1(s) and the transfer function G3(s), the first filtering process and the first noise removal process are performed simultaneously. In addition, in the case where the detection signal 152 is filtered by a filter having a transfer function obtained by multiplying the transfer function G2(s) and the transfer function G3(s), the second filtering process and the first noise removal process are performed simultaneously. Furthermore, when the detection signal 152 is filtered by one filter having a transfer function obtained by multiplying the transfer functions G1(s), G2(s), and G3(s), the first filtering process, the second filtering process, and the first noise removal process are simultaneously executed.
[0101] In the above example, the first filter characteristic is a first-order lead characteristic, but is not limited thereto. In order to reduce the influence of the viscoelastic characteristic of the protective member 53 in the detection signal 152, the first filter characteristic may also be a characteristic corresponding to the viscoelastic characteristic. For example, when the viscoelastic characteristic is a second-order lag characteristic, the first filter characteristic may also be, for example, a second-order lead characteristic.
[0102] In addition, in the above example, the second filter characteristic is a first-order lag characteristic, but it is not limited to this. In order to reduce the influence of the first filtering process in the frequency band above the control frequency band, the second filter characteristic may also be a characteristic corresponding to the first filter characteristic. For example, in the case where the first filter characteristic is a second-order lead characteristic, the second filter characteristic may also be, for example, a second-order lag characteristic.
[0103] Here, as an example, consider a case where the viscoelastic characteristic is a second-order lag characteristic, the first filter characteristic is a second-order lead filter characteristic of a second-order lead system, and the second filter characteristic is a second-order lag filter characteristic of a second-order lag system. Fig.11 1 is a diagram showing an example of a Bode diagram of a transfer function G12(s) of the integrated filter characteristics in this case. The transfer function G12(s) of the integrated filter characteristics can also be called a transfer function of a second-order lead-lag filter characteristic. Fig.11 In the figure, the Bode plot of the transfer function G12(s) is shown by a dotted line. In addition, Fig.11 In the figure, the solid line indicates Figure 8The Bode plot shown by the solid line in (in other words, the Bode plot of the transfer function of the first-order lead-lag filter characteristic). In addition, Fig.11 , an example of two pole frequencies a1 and a2 of the second-order first filter characteristic, an example of two pole frequencies b1 and b2 of the second-order second filter characteristic, and an example of the upper limit value ω0 of the control band of the grip control unit 100 are shown. The two pole frequencies of the second-order viscoelastic characteristic are respectively smaller than the upper limit value ω0 of the control band, for example.
[0104] The pole frequency a1 is set to a value that is the same as or close to the smaller pole frequency of the two pole frequencies of the viscoelastic characteristic, for example. The pole frequency a2 is set to a value that is the same as or close to the larger pole frequency of the two pole frequencies of the viscoelastic characteristic, for example. The two pole frequencies b1 and b2 are set to, for example, the same values as each other. The two pole frequencies b1 and b2 are set to, for example, above the upper limit value ω0 of the control band of the control unit 100, similar to the pole frequency b of the first-order second filter characteristic. It should be noted that even if the viscoelastic characteristic is second-order, the first filter characteristic and the second filter characteristic may be first-order filter characteristics.
[0105] <Regarding Adjustment of First Filter Characteristics>
[0106] <First Adjustment Example>
[0107] The viscoelastic property of the protection member 53 may vary according to the environment. For example, the viscoelastic property of the protection member 53 may vary according to the temperature of the protection member 53. Therefore, the first filter characteristic may also be adjusted based on the detection result of the temperature of the protection member 53. Fig.12 1 is a schematic diagram showing a configuration example of a part of the robot system 9 in this case.
[0108] exist Fig.12 In the example of FIG. 5 , the grip control unit 100 includes an adjustment unit 108 for adjusting the first filter characteristic, and the grip unit 50 includes a temperature sensor 59 for detecting the temperature of the protection member 53. The adjustment unit 108 adjusts the first filter characteristic based on the detection result of the temperature sensor 59. For example, the adjustment unit 108 adjusts the first filter characteristic by adjusting the pole frequency of the first filter characteristic. All functions of the adjustment unit 108 or part of the functions of the adjustment unit 108 may also be realized by a hardware circuit that does not require software in the realization of the function.
[0109] The temperature sensor 59 may be provided in, for example, one of the two detection parts 52a of the force sensor 52, or in one of the two protection members 53. The temperature sensor 59 may be formed of a semiconductor temperature sensor such as a thermistor, or may be formed of other members. The temperature sensor 59 repeatedly detects the temperature of, for example, the protection member 53, and outputs the detection result to the adjustment unit 108.
[0110] exist Fig.12 In the example, for example, relationship information 11b indicating the relationship between the temperature of the protective member 53 and the pole frequency of the viscoelastic characteristic is stored in the nonvolatile memory of the storage unit 11 of the control device 1. The relationship information 11b may be information in a tabular form indicating the relationship between the temperature and the pole frequency of the viscoelastic characteristic, or may be information in the form of a relationship formula indicating the relationship between the temperature and the pole frequency of the viscoelastic characteristic. The relationship information 11b may also be information indicating how the viscoelastic characteristic changes according to the temperature of the protective member 53.
[0111] If the adjustment unit 108 receives the detection result from the temperature sensor 59, the temperature of the protective component 53 is determined based on the detection result. Next, the adjustment unit 108 obtains the pole frequency of the viscoelastic characteristic corresponding to the determined temperature from the relationship information 11b in the storage unit 11. Next, the adjustment unit 108 adjusts the pole frequency of the first filter characteristic according to the pole frequency of the obtained viscoelastic characteristic. For example, the adjustment unit 108 sets the pole frequency a of the first filter characteristic to a value that is the same as or close to the pole frequency of the obtained viscoelastic characteristic. Thus, the first filter characteristic is adjusted based on the detection result of the temperature of the protective component 53. The adjustment unit 108, for example, repeatedly performs adjustment of the first filter characteristic.
[0112] In this way, the holding control unit 100 can further improve the stability of the holding operation of the object 8 in the holding unit 50 while controlling the holding force of the holding unit 50 in consideration of environmental changes in the viscoelastic properties of the protection member 53 .
[0113] Furthermore, by adjusting the first filter characteristic based on the detection result of the temperature of the protection member 53, the influence of the viscoelastic characteristic in the detection signal 152 can be appropriately reduced. Therefore, the gripping force of the object 8 in the gripping portion 50 can be appropriately controlled.
[0114] <Second Adjustment Example>
[0115] The viscoelastic property of the protection member 53 changes with the aging of the protection member 53. In other words, the viscoelastic property changes with the aging. Therefore, the adjustment unit 108 may adjust the first filter characteristic based on the first index information that is an index of the aging change of the viscoelastic property. Fig.13 1 is a schematic diagram showing a partial configuration example of the robot system 9 in this case.
[0116] The first indicator information 11c is stored in the non-volatile memory of the storage unit 11. As the first indicator information 11c, for example, the elapsed time from a reference timing (also referred to as the elapsed time) is used. The reference timing may be the timing when the manipulator 5 having the protective component 53 is shipped from the factory, or the timing when the manipulator 5 is first introduced into the working environment. In addition, the reference timing may be the timing when the manipulator 5 is first operated, or the timing when the protective component 53 is installed on the gripping portion 50. Since the longer the elapsed time is, the more advanced the secular change of the viscoelastic property is, it can be said that the elapsed time is information that serves as an indicator of the secular change of the viscoelastic property. The control unit 10 updates the first indicator information 11c in the storage unit 11 based on an output signal of a type possessed by the control device 1, etc.
[0117] In addition, the non-volatile memory of the storage unit 11 stores relationship information 11d indicating the relationship between the first index information 11c (e.g., elapsed time) and the pole frequency of the viscoelastic property. The relationship information 11d may be information in the form of a table indicating the relationship between the first index information 11c and the pole frequency of the viscoelastic property, or may be information of a relationship formula indicating the relationship between the first index information 11c and the pole frequency of the viscoelastic property. When the first index information 11c is the elapsed time, the relationship information 11d may be referred to as information indicating how the viscoelastic property changes according to the elapsed time.
[0118] When adjusting the first filter characteristic, the adjustment unit 108 first reads out the first index information 11c from the storage unit 11. Next, the adjustment unit 108 obtains the pole frequency of the viscoelastic characteristic corresponding to the read first index information 11c from the relationship information 11d in the storage unit 11. Next, the adjustment unit 108 adjusts the pole frequency of the first filter characteristic according to the obtained pole frequency of the viscoelastic characteristic in the same manner as in the first adjustment example described above. The adjustment unit 108, for example, repeatedly performs the adjustment of the first filter characteristic.
[0119] In this way, when the holding control unit 100 controls the holding force of the holding unit 50 in consideration of the secular change in the viscoelastic properties of the protection member 53 , the stability of the holding operation of the object 8 in the holding unit 50 can be further improved.
[0120] Furthermore, by adjusting the first filter characteristic based on the first index information 11c that is an index of the secular change in the viscoelastic characteristic, the influence of the viscoelastic characteristic in the detection signal 152 can be appropriately reduced. Therefore, the gripping force of the object 8 in the gripping portion 50 can be appropriately controlled.
[0121] <Third Adjustment Example>
[0122] The viscoelastic property of the protection member 53 changes according to the use of the protection member 53. Therefore, the adjustment unit 108 may adjust the first filter characteristic based on the second index information which is an index of the change in the viscoelastic property due to the use of the protection member 53. Fig.14 1 is a schematic diagram showing a partial configuration example of the robot system 9 in this case.
[0123] The second indicator information 11e is stored in the non-volatile memory of the storage unit 11. As the second indicator information 11e, for example, the total operating time of the manipulator 5 is used. The greater the total operating time, the more advanced the change in the viscoelastic properties caused by the use of the protective member 53, and thus the total operating time can be said to be information that is an indicator of the change in the viscoelastic properties caused by the use of the protective member 53. The control unit 10 updates the second indicator information 11e in the storage unit 11 based on the output signal of the timer of the control device 1, etc.
[0124] In addition, relationship information 11f indicating the relationship between the second index information 11e (for example, the total operating time) and the pole frequency of the viscoelastic characteristic is stored in the non-volatile memory of the storage unit 11. The relationship information 11f may be information in the form of a table indicating the relationship between the second index information 11e and the pole frequency of the viscoelastic characteristic, or may be information of a relationship formula indicating the relationship between the second index information 11e and the pole frequency of the viscoelastic characteristic. In the case where the second index information 11e is the total operating time, the relationship information 11f may be referred to as information indicating how the total viscoelastic characteristic changes according to the operating time.
[0125] When adjusting the first filter characteristic, the adjustment unit 108 first reads the second index information 11e from the storage unit 11. Next, the adjustment unit 108 obtains the pole frequency of the viscoelastic characteristic corresponding to the read second index information 11e from the relationship information 11f in the storage unit 11. Next, the adjustment unit 108 adjusts the pole frequency of the first filter characteristic according to the obtained pole frequency of the viscoelastic characteristic in the same manner as in the first adjustment example described above. The adjustment unit 108, for example, repeatedly performs the adjustment of the first filter characteristic.
[0126] In this way, when the holding control unit 100 controls the holding force of the holding unit 50 in consideration of the change in the viscoelastic properties caused by the use of the protection member 53 , the stability of the holding operation of the object 8 in the holding unit 50 can be further improved.
[0127] Furthermore, by adjusting the first filter characteristic based on the second index information 11e which is an index of the change in the viscoelastic characteristic caused by the use of the protection member 53, the influence of the viscoelastic characteristic in the detection signal 152 can be appropriately reduced. Therefore, the gripping force of the object 8 in the gripping portion 50 can be appropriately controlled.
[0128] It should be noted that the second index information 11 e is not limited to the total operation time. For example, the second index information 11 e may be the total number of times the gripping unit 50 grips, or the total gripping time of the gripping unit 50 .
[0129] The holding control unit 100 may also control the holding force of the holding unit 50 by considering at least two of environmental changes in the viscoelastic properties of the protection member 53, changes in the viscoelastic properties of the protection member 53 over time, and changes in the viscoelastic properties caused by the use of the protection member 53. For example, the adjustment unit 108 may also adjust the first filter characteristic based on at least two of the detection result of the temperature of the protection member 53, the first indicator information 11c, and the second indicator information 11e. Fig.15 1 is a schematic diagram showing a configuration example of a part of the robot system 9 when the adjustment unit 108 adjusts the first filter characteristic based on the detection result of the temperature of the protection member 53, the first index information 11c, and the second index information 11e. Fig.15 In the example, relationship information 11g indicating the relationship between the temperature of the protective member 53, the first indicator information 11c, the second indicator information 11e, and the pole frequency of the viscoelastic characteristic is stored in the non-volatile memory of the storage unit 11. The adjustment unit 108 determines the temperature of the protective member 53 based on the detection result of the temperature sensor 59. In addition, the adjustment unit 108 reads the first indicator information 11c and the second indicator information 11e from the storage unit 11. Then, the adjustment unit 108 obtains the pole frequency of the viscoelastic characteristic corresponding to the temperature of the protective member 53, the first indicator information 11c, and the second indicator information 11e from the relationship information 11g in the storage unit 11. Then, the adjustment unit 108 adjusts the pole frequency of the first filter characteristic according to the obtained pole frequency of the viscoelastic characteristic.
[0130] When the adjustment unit 108 adjusts the first filter characteristic based on the detection result of the temperature of the protection member 53 and the first index information 11c, the adjustment unit 108 stores the relationship information indicating the relationship between the temperature of the protection member 53, the first index information 11c, and the pole frequency of the viscoelastic characteristic in the storage unit 11. Thus, the adjustment unit 108 can obtain the pole frequency of the viscoelastic characteristic determined corresponding to the temperature of the protection member 53 and the first index information 11c in the storage unit 11. In addition, when the adjustment unit 108 adjusts the first filter characteristic based on the detection result of the temperature of the protection member 53 and the second index information 11e, the adjustment unit 108 stores the relationship information indicating the relationship between the temperature of the protection member 53, the second index information 11e, and the pole frequency of the viscoelastic characteristic in the storage unit 11. Thus, the adjustment unit 108 can obtain the pole frequency of the viscoelastic characteristic determined corresponding to the temperature of the protection member 53 and the second index information 11e in the storage unit 11. Furthermore, when adjusting the first filter characteristic based on the first index information 11c and the second index information 11e, the adjustment unit 108 stores relationship information indicating the relationship between the first index information 11c, the second index information 11e, and the pole frequency of the viscoelastic characteristic in the storage unit 11. Thus, the adjustment unit 108 can obtain the pole frequency of the viscoelastic characteristic corresponding to the first index information 11c and the second index information 11e in the storage unit 11.
[0131] <Fourth Adjustment Example>
[0132] A reference object 8 for adjusting the first filter characteristic may be prepared. Then, the robot system 9 may include a calibration mode as an operation mode in which the adjustment unit 108 adjusts the first filter characteristic based on the detection signal 152 of the force sensor 52 when the gripping unit 50 grips the reference object 8. The following describes an operation example of the robot system 9 in this case.
[0133] For example, when the robot 5 is shipped, the detection signal 152 of the force sensor 52 when the gripping unit 50 grips the reference object 8 is stored in the storage unit 11 as the reference detection signal 152. After the robot 5 is introduced into the working environment and starts to be used, the reference detection signal 152 in the storage unit 11 is used to adjust the first filter characteristic.
[0134] For example, the user inputs an instruction to the control device 2 as a robot controller, and the instruction input instructs the robot system 9 to operate in the calibration mode. The control device 2 receiving the instruction input controls the position of the arm 4 so that the reference object 8 is located between the two fingers 51 of the gripping portion 50. Then, the gripping portion 50 grasps the reference object 8 by bringing the two fingers 51 close to each other through the control performed by the gripping control unit 100. The adjustment unit 108 receives the detection signal 152 of the force sensor 52 when the gripping portion 50 grasps the reference object 8. The adjustment unit 108 compares the received detection signal 152 with the reference detection signal 152 in the storage unit 11, and infers the pole frequency of the current viscoelastic characteristic of the protective member 53 based on the comparison result. Then, the adjustment unit 108 adjusts the first filter characteristic according to the pole frequency of the inferred viscoelastic characteristic. For example, the adjustment unit 108 sets the pole frequency a of the first filter characteristic to a value that is the same as or close to the pole frequency of the inferred viscoelastic characteristic. After the first filter characteristic is adjusted, the calibration mode ends, and the gripping of the reference object 8 is released by the gripping unit 50. Thereafter, the robot system 9 performs normal operations.
[0135] The manipulator 5 may also be equipped with a force sensor in the arm portion. The force sensor can detect, for example, a force applied to the manipulator 5 further forward than the arm portion. In the case where there is an elastic member such as the protective member 53 that exhibits viscoelastic properties further forward than the force sensor of the manipulator 5, the force sensor detects the force via the elastic member that exhibits viscoelastic properties. In the case described above, the correction filter 107 may also perform the same filtering process on the detection signal output by the force sensor. Thereby, the force indicated by the detection signal output by the force sensor can be made close to the force actually applied to the manipulator 5. For example, in the case where the finger 51 is composed of an elastic member, the force sensor detects the force via the elastic member that exhibits viscoelastic properties. The force sensor may also be a resistive sensor, an electrostatic capacitive sensor, a piezoelectric sensor, or an optical sensor.
[0136] In the above example, the correction filter 107 performs the first filtering process, the second filtering process, and the first noise removal process, but it is not necessary to perform either the second filtering process or the first noise removal process.
[0137] In addition, the second filtering process may be performed not on the detection signal 152 but on the signal based on the detection signal 152. In this case, in the signal based on the detection signal 152, the influence of the first filtering process in the frequency band above the control frequency band is reduced by the second filtering process. For example, the filter 106 may perform the second filtering process on the rotational position variation signal 115 based on the detection signal 152. In this case, a part of the function of the filter 106 also constitutes the correction filter 107. In addition, the second filtering process may be performed on the gripping force deviation signal 114 based on the detection signal 152. In this case, the gripping force deviation signal 114 after the second filtering process is input to the conversion unit 105. In addition, the second filtering process may be performed on the filter signal 116 based on the detection signal 152, or on the correction target rotational position signal 112 based on the detection signal 152.
[0138] In addition, the first noise removal process may be performed not on the detection signal 152 but on the signal based on the detection signal 152. In this case, in the signal based on the detection signal 152, the noise in the frequency band above the control frequency band is removed by the first noise removal process. For example, the filter 106 may also perform the first noise removal process on the rotational position change amount signal 115. In this case, part of the function of the filter 106 also constitutes the correction filter 107. The filter 106 may also perform the first noise removal process instead of the second noise removal process. In addition, the first noise removal process may also be performed on the holding force deviation signal 114, may also be performed on the filter signal 116, and may also be performed on the correction target rotational position signal 112.
[0139] Fig.16 1 is a schematic diagram showing a configuration example of a portion of the robot system 9 when the filter 106 performs the second filtering process and the first noise removal process on the rotational position variation signal 115. Fig.16 In the example of FIG. 1 , the correction filter 107 is composed of the functions of the filter 106 that performs the second filtering process and the first noise removal process, and the filter 109 that performs the first filtering process on the detection signal 152. The detection signal 152 that has been subjected to the first filtering process by the filter 109 is input to the subtractor 104 as the filter signal 117.
[0140] In the above example, the target rotation position is input to the adder 102, but the target value of the position of the two fingers 51 when the two fingers 51 grasp the object 8 (also referred to as the target finger position) may be input to the adder 102. In this case, the conversion unit 105 converts the gripping force deviation represented by the gripping force deviation signal 114 into the finger position change amount. The finger position change amount means the change amount of the position of the finger 51 required to change the gripping force according to the gripping force deviation that is the basis thereof. The conversion unit 105 outputs a finger position change amount signal representing the time series of the finger position change amount.
[0141] The filter 106 performs filtering processing on the finger position variation signal. The finger position variation signal after filtering processing is input to the adder 102 as the filter signal 116. The adder 102 adds the finger position variation indicated by the filter signal 116 to the target finger position, and sets the value obtained thereby as the corrected target finger position. The adder 102 outputs the corrected target finger position signal indicating the timing of the corrected target finger position.
[0142] The position acquisition unit 103 obtains the position of the finger 51 based on the detection signal 158 output by the encoder 58. Then, the position acquisition unit 103 outputs a detection finger position signal representing the timing of the obtained position of the finger 51 (also referred to as the detection finger position). The position control unit 101 subtracts the detection finger position indicated by the detection finger position signal from the correction target finger position indicated by the correction target finger position signal. Then, the position control unit 101 generates a control signal 111 for changing the position of the finger 51 in accordance with the finger position deviation obtained by subtracting the detection finger position from the correction target finger position, and outputs it to the motor driver 55. The motor 56 is driven by the motor driver 55 with the control signal 111, so that the position of the finger 51 is controlled to be close to the correction target finger position. As a result, the gripping force is controlled to be close to the target gripping force.
[0143] In the robot system 9, the control device 1 and the control device 2 may be constituted by one control device. In addition, at least a part of the functions of the control unit 10 of the control device 1 may be implemented by the control device 2. In addition, at least one of the control device 1 and the control device 2 may control the robot 3 via a network including the Internet. In this case, at least one of the control device 1 and the control device 2 may be constituted by, for example, a cloud server. The cloud server may also be implemented by a plurality of computer devices.
[0144] As described above, the robot system and the control device are described in detail, but the above description is illustrative in all aspects, and the disclosure is not limited to this. In addition, the above various examples can be combined and applied as long as they are not contradictory to each other. Then, it is considered that countless examples that are not exemplified can be conceived without departing from the scope of the present disclosure.
[0145] -Description of Reference Numerals-
[0146] 1 Control device
[0147] 11a Procedure
[0148] 11c First indicator information
[0149] 11e Second indicator information
[0150] 50 Holding unit
[0151] 52 Force Sensor
[0152] 53 Protection components
[0153] 100 Maintain Control
[0154] 107 Correction filter
[0155] 108 Adjustment Department
[0156] 152 Detection signal.
Claims
1. A holding control unit for controlling a holding unit capable of holding an object via a protective member, The holding force of the holding portion is controlled in consideration of the viscoelastic properties of the protection member.
2. The holding control unit according to claim 1, wherein: The holding force of the holding portion is controlled in consideration of environmental changes in the viscoelastic properties of the protection member.
3. The holding control unit according to claim 1 or 2, wherein: The holding force of the holding portion is controlled in consideration of the aging change in the viscoelastic properties of the protection member.
4. The holding control unit according to any one of claims 1 to 3, wherein: The holding force of the holding portion is controlled in consideration of a change in viscoelastic properties caused by use of the protection member.
5. The holding control unit according to any one of claims 1 to 4, wherein: The holding control unit includes a correction filter that performs a first filtering process that reduces the influence of the viscoelastic characteristics of the protection member.
6. A control device for controlling a holding portion for holding an object, The holding portion includes: a sensor for detecting a holding force of the holding portion on the object; and a protection member disposed on a detection portion of the sensor. The sensor detects the holding force via the protection member, The control device includes a holding control unit configured to control the holding force based on a detection signal output by the sensor. The holding control unit includes a correction filter configured to perform a first filtering process on the detection signal, the first filtering process reducing the influence of the viscoelastic property of the protection member in the detection signal.
7. The control device according to claim 6, wherein: The correction filter performs a second filtering process on the detection signal or a signal based on the detection signal, the second filtering process reducing the influence of the first filtering process in a frequency band equal to or greater than a control frequency band of the hold control unit.
8. The control device according to claim 7, wherein: The correction filter performs noise removal processing on the detection signal or a signal based on the detection signal in a frequency band higher than the control frequency band.
9. The control device according to any one of claims 6 to 8, wherein: The control device includes an adjustment unit that adjusts the characteristics of the first filtering process based on a detection result of the temperature of the protection member.
10. The control device according to any one of claims 6 to 9, wherein: The control device includes an adjustment unit that adjusts the characteristics of the first filtering process based on first index information that is an index of the secular change of the viscoelastic property.
11. The control device according to any one of claims 6 to 10, wherein: The control device includes an adjustment unit that adjusts the characteristics of the first filtering process based on second index information that is an index of a change in the viscoelastic characteristic due to use of the protection member.
12. The control device according to any one of claims 6 to 11, wherein: The characteristic of the first filtering process is a look-ahead filter characteristic.
13. The control device according to claim 7 or 8, wherein: The characteristic of the second filtering process is a lag filter characteristic. 14 . A program for causing a computer device to function as the retention control unit according to claim 1 . 15 . A program for causing a computer device to function as the control device according to claim 6 .
Citation Information
Patent Citations
External force detection device, robot control system and external force detection method
JP2013113661A
