A master-slave controlled soft robot system and control method
By using soft drivers and distance detection units in the flexible robot arm to build the master and slave joint units, forming closed-loop control, the problem of complex structure and slow motion speed of the traditional flexible robot arm in the master-slave control field is solved, and the more Efficient robotic arm application.
Patent Information
- Application Number
- CN202211139799.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-09-19
- Publication Date
- 2024-11-19
- Estimated Expiration
- 2042-09-19
AI Technical Summary
In the field of master-slave control, traditional flexible robot arms have complex structures, slow motion speed and easy damage to the drive motor, which is difficult to meet the needs of industrial robot applications.
The main control joint unit and the driven joint unit are constructed using a software driver, and the joint motion information is obtained through the distance detection unit, forming closed-loop control, simplifying the control difficulty and realizing multi-space degree of freedom movement.
It realizes a flexible robot arm with simple structure and convenient control, which is suitable for the master-slave control field, reduces structural complexity and movement speed limitations, and improves the widespread application of robot arm.
Smart Images

Figure CN115464647B_ABST
Abstract
Description
Technical Field
[0001] The present invention relates to the field of robotics technology, and in particular to a master-slave controlled soft robot system and a control method. Background Art
[0002] The more mature master-slave control technology currently mainly uses computer vision and sensor signal conversion, or directly uses motor signal synchronization to achieve the drive of the slave motor, but this is mostly applied in the field of traditional rigid robotic arms. Different from the application environment of traditional robots, flexible robots have environmental adaptability that traditional robots lack, and are the best choice for master-slave robot control systems with interaction as the main application scenario.
[0003] In the field of flexible robotic arms, screws are mostly used to drive the extension and retraction of muscle joints. This type of flexible robotic arm needs to reserve sufficient extension length at the top of the joint to ensure the range of motion of the robotic arm. The structure is also relatively complex. Therefore, it has certain limitations in terms of joint size, weight, cost, and application scope, and is difficult to use in the master-slave control field. Summary of the invention
[0004] In view of the above problems, the present invention provides a master-slave controlled soft robot system and a control method, which are described in detail below.
[0005] According to the first aspect, an embodiment provides a master-slave controlled soft robot system, including a master control system, a slave system, a power system and a controller;
[0006] The main control system includes at least one main control joint unit, which includes a first software driver, a first calibration piece, and at least three first detection units. The first detection unit and the first calibration piece are respectively arranged at two ends of the first software driver; the first detection unit is used to detect the distance between itself and the first calibration piece and generate a first detection signal;
[0007] The driven system includes at least one driven joint unit, one driven joint unit corresponds to one master joint unit; the driven joint unit includes at least three second software drivers, a second calibration piece and at least three second detection units, all the second detection units are arranged at one end of the at least three second software drivers, the second calibration piece is arranged at the other end of the at least three second software drivers, and the second detection unit is used to detect the distance between itself and the second calibration piece and generate a second detection signal;
[0008] The power system is used to pass fluid into the second soft drive to move the second soft drive, and the second detection unit moves relative to the second calibration member;
[0009] The main control joint unit moves under external action, and the first detection unit generates a corresponding first detection signal;
[0010] The controller is used to determine the first posture information of a master joint unit according to all the first detection signals of a master joint unit, obtain all the second detection signals of the corresponding slave joint unit, and determine the second posture information of the slave joint unit according to all the second detection signals; according to the first posture information and the second posture information, control the power system to drive each second software driver of the slave joint unit to move until the first posture information and the second posture information meet the preset judgment criteria.
[0011] In one embodiment, at least three first detection units are arranged according to a preset arrangement relationship, at least three second software drivers are arranged side by side corresponding to the preset arrangement relationship, and at least three second detection units are arranged corresponding to the preset arrangement relationship.
[0012] In one embodiment, at least three second software drivers are arranged side by side according to a preset arrangement relationship, and at least three second detection units are arranged according to a preset arrangement relationship; one second detection unit is arranged corresponding to one first detection unit, and one second software driver is arranged corresponding to one first detection unit; and / or, at least three first detection units are arranged in the same plane.
[0013] In one embodiment, the first detection unit includes a Hall element, and the first calibration member is a magnetic member; and / or the second detection unit includes a Hall element, and the second calibration member is a magnetic member.
[0014] In one embodiment, the first software driver includes a first end cover, a first software cavity wall and a first base, wherein the first end cover, the first software cavity wall and the first base form a sealed cavity; the first detection unit is disposed on the first end cover, and the first calibration member is disposed on the first base;
[0015] And / or, the second soft drive includes a second end cover, a second soft cavity wall and a second base, the second end cover, the second soft cavity wall and the second base form a sealed cavity; the second end covers of all second soft drives are relatively fixed or share a second end cover, and the second bases of all second soft drives are relatively fixed or share a second base; the second detection unit is arranged on the second end cover, the second calibration part is arranged on the second base, and one second detection unit corresponds to one second soft drive; the sealed cavity of the second soft drive is used to receive the fluid provided by the power system, so that the second end cover moves relative to the second base.
[0016] In one embodiment, the main control system includes a plurality of main control joint units, and the plurality of main control joint units are arranged along a first preset direction, or the plurality of main control joint units are arranged along a second preset direction, and the first preset direction is perpendicular to the second preset direction;
[0017] And / or, the driven system includes a plurality of driven joint units, and the plurality of driven joint units are arranged along a first preset direction, or the plurality of driven joint units are arranged along a second preset direction, and the first preset direction is perpendicular to the second preset direction.
[0018] According to the second aspect, an embodiment provides a control method, which is applied to the soft robot system described in the first aspect, and the control method includes:
[0019] Acquire first detection signals output by all first detection units of a main control joint unit, and determine first position information of the main control joint unit according to all first detection signals;
[0020] Acquire second detection signals output by all second detection units of the slave joint units corresponding to the master joint unit, and determine second posture information of the slave joint units according to all second detection signals;
[0021] According to the first posture information and the second posture information, the power system is controlled to drive each second software driver of the driven joint unit to move until the first posture information and the second posture information meet the preset judgment criteria.
[0022] In one embodiment, determining the first position information of the master control joint unit according to all the first detection signals includes:
[0023] Acquire a first set spacing between at least two first detection units, and determine a first distance between all first detection units and the first calibration component according to the first detection signal;
[0024] Determine the first posture information of the master control joint unit according to the first set spacing and the first distance;
[0025] And / or, determining the second posture information of the driven joint unit according to all the second detection signals, including:
[0026] Acquire a second set spacing between at least two second detection units, and determine a second distance between all second detection units and the second calibration member according to the second detection signal;
[0027] The second position information of the master control joint unit is determined according to the second set spacing and the second distance.
[0028] In one embodiment, controlling the power system to drive each second software driver of the driven joint unit to move includes:
[0029] Determining a correspondence between each first software driver and the second software driver according to a preset arrangement relationship of the first software drivers and an arrangement relationship of the second software drivers;
[0030] Determining a correspondence between the first detection signal and the second detection signal according to a correspondence between the first software driver and the second software driver;
[0031] The movement of the second software driver is controlled according to the corresponding relationship between the first detection signal and the second detection signal.
[0032] In one embodiment, controlling the movement of the second software driver according to the corresponding relationship between the first detection signal and the second detection signal includes:
[0033] According to the first detection signal and the corresponding second detection signal, driving the second software driver in sequence according to a preset order;
[0034] Alternatively, all second software drivers are synchronously driven according to the first detection signal and the corresponding second detection signal.
[0035] According to a master-slave controlled soft robot system and control method of the above-mentioned embodiment, the first detection signal of the master joint unit is obtained by the controller to obtain the first posture information, and the movement of the corresponding slave joint unit is controlled based on the first posture information to drive the second soft driver to perform telescopic movement. The second detection signal of the slave joint unit is obtained in real time, and the second posture signal of the current slave joint unit is calculated to form a closed-loop controlled slave system. The first soft driver and the second soft driver have a simple structure and do not need to reserve a telescopic length. The soft drivers can be stacked and arranged to form a complex joint structure, so that the soft robot can be used in the field of master-slave control. BRIEF DESCRIPTION OF THE DRAWINGS
[0036] Figure 1 is a schematic structural diagram of a soft robot system according to an embodiment;
[0037] Figure 2 A schematic diagram of the structure of a main control joint unit according to an embodiment;
[0038] Figure 3 is a structural schematic diagram of a first detection unit in an embodiment;
[0039] Figure 4 is a schematic structural diagram of a driven joint unit according to an embodiment;
[0040] Figure 5 is a schematic structural diagram of a second detection unit in an embodiment;
[0041] Figure 6 is a structural schematic diagram of a first detection unit in an embodiment;
[0042] Figure 7 For the corresponding Figure 6 A schematic structural diagram of a second detection unit;
[0043] Figure 8 A schematic diagram of the structure of a main control joint unit according to an embodiment;
[0044] Fig. 9 is a schematic structural diagram of a driven joint unit according to an embodiment;
[0045] Fig.10 for Figure 8 Front view of
[0046] Fig.11 for Fig. 9 Front view of
[0047] Fig.12 A schematic flow chart of a control method according to an embodiment;
[0048] Fig.13 A schematic diagram of posture calculation according to an embodiment;
[0049] Fig.14 Schematic diagram of a control method according to an embodiment.
[0050] Figure markings: 10-first soft driver; 11-first end cover; 12-first base; 13-first soft cavity wall; 20-first detection unit; 30-first calibration piece; 40-second soft driver; 41-second end cover; 42-second base; 43-second soft cavity wall; 50-second detection unit; 60-second calibration piece; 100-master joint unit; 200-slave joint unit; 300-power system; 400-controller. DETAILED DESCRIPTION
[0051] The present invention is further described in detail below by specific embodiments in conjunction with the accompanying drawings. Wherein similar elements in different embodiments adopt associated similar element numbers. In the following embodiments, many detailed descriptions are for making the present application better understood. However, those skilled in the art can easily recognize that some features can be omitted in different situations, or can be replaced by other elements, materials, methods. In some cases, some operations related to the present application are not shown or described in the specification, this is to avoid the core part of the present application being overwhelmed by too much description, and for those skilled in the art, it is not necessary to describe these related operations in detail, and they can fully understand the related operations according to the description in the specification and the general technical knowledge in the art.
[0052] In addition, the features, operations or characteristics described in the specification can be combined in any appropriate manner to form various implementations. At the same time, the steps or actions in the method description can also be interchanged or adjusted in a manner that is obvious to those skilled in the art. Therefore, the various sequences in the specification and the drawings are only for the purpose of clearly describing a certain embodiment and are not meant to be a required sequence, unless otherwise specified that a certain sequence must be followed.
[0053] The serial numbers of the components in this document, such as "first", "second", etc., are only used to distinguish the objects described and do not have any order or technical meaning. The "connection" and "coupling" mentioned in this application, unless otherwise specified, include direct and indirect connections (couplings).
[0054] The master-slave control robot is generally formed based on a rigid manipulator, which mainly relies on visual recognition or the spatial position of multiple sensor standard reference points. The motor of the slave system is driven to realize the movement of the slave system to the spatial position of the corresponding master control system. The spatial continuous motion design of this type of multi-motor driven industrial manipulator is complicated kinematics, which is not only complex in structure design, but also difficult to control. Some flexible manipulators mostly use screws to drive the muscle joint telescopic movement, such as the solution shown in the existing patent CN104476533A. This type of flexible manipulator needs to reserve enough telescopic length at the top of the joint to ensure the range of motion of the manipulator. The structure is also relatively complex, and it is essentially still using a transmission part (flexible screw) and a drive motor to realize the telescopic movement. There are problems such as complex structure, slow movement speed and easy damage of the flexible screw. The above problems make it difficult for traditional flexible manipulators to be applied to master-slave control industrial robots.
[0055] The applicant analyzed and found that the joint unit is the smallest unit of the robot. How to set the corresponding relationship between the master joint and the slave joint has a great impact on the control difficulty of the master-slave control robot and the complexity of the structure. As in the technical solution of the above-mentioned public patent, the master joint and the slave joint basically adopt the same structure, and the master joint is relatively complex.
[0056] The applicant has found that in order for the flexible robotic arm to be used in a master-slave control robot, the following characteristics need to be met: such as simple structure, convenient control, and multiple degrees of freedom in space, and the drive system is not set on the robotic arm when necessary. The inventor has found that the soft drive can be used as a drive part of the soft robot, and the soft drive is described below.
[0057] The soft drive may include a base, a soft cavity wall and an end cap, which together form a sealed cavity. By introducing a fluid into the sealed cavity, the end cap and the base can be driven to move relative to each other. In the existing soft drive, a folding structure is provided on the soft cavity wall, so that the end cap can be extended and retracted along the normal direction of the base.
[0058] Unlike traditional push rod assemblies or screw assemblies, which can calculate the distance of telescopic movement through outputs such as the motor's encoder, the telescopic distance of the soft drive is relatively complex to obtain. The existing method is to determine it by detecting internal pressure and constructing a curve between pressure and telescopic amount, or to obtain it through visual recognition, which makes the control more complicated.
[0059] In response to this problem, the applicant further studied and found that a distance detection unit can be used to obtain the distance between the end cover and the base, so as to calculate the telescopic distance of the soft drive.
[0060] In some embodiments of the present application, the master joint unit 100 and the slave joint unit 200 are composed of a software driver, and the first software driver 10 of the master joint unit 100 and the second software driver 40 of the slave joint unit 200 are in a one-to-many relationship in number. The master joint unit 100 has a simple structure, and the slave joint unit 200 relies on multiple second software drivers 40 to achieve multi-degree-of-freedom motion. The master joint unit 100 is provided with at least three first detection units 20 to detect the first detection signal generated by its own motion, so as to calculate the first position information after the motion. Subsequently, the corresponding slave joint unit 200 can be controlled to move according to the first position information, and the second position information of the slave joint unit 200 can be obtained in real time through the second detection unit 50, forming a closed-loop control, which is simple to control. The corresponding slave joint unit 200 is controlled according to the first position information of each master joint unit 100, and finally the slave system is controlled according to the master control system.
[0061] The following is an explanation of the master-slave controlled soft robot system.
[0062] Please refer to Figure 1 In some embodiments, a master-slave controlled soft robot system may include a master control system, a slave system, a power system 300 and a controller 400, which are described in detail below.
[0063] like Figure 2As shown, the main control system may include at least one main control joint unit 100, and the main control joint unit 100 may include a first soft drive 10, a first calibration member 30 and at least three first detection units 20, the first detection unit 20 and the first calibration member 30 are respectively arranged at the two ends of the first soft drive 10, and the at least three first detection units 20 are arranged according to a preset arrangement relationship; the first detection unit 20 is used to detect the distance between itself and the first calibration member 30, and generate a first detection signal. Wherein, when the main control system includes a plurality of main control joint units 100, the plurality of main control joint units 100 can be arranged vertically stacked in the direction of extension and contraction of the first soft drive 10 (the up and down direction shown in the figure), and can also be arranged in parallel. In some embodiments, at least three first detection units 20 are located on the same plane, and at least three first detection units 20 are not on the same straight line. The arrangement according to the preset arrangement relationship can be distributed on the same plane according to a preset polygon, and this preset arrangement relationship definition can be a first preset arrangement relationship.
[0064] In some embodiments, such as Figure 2 As shown, the first soft drive 10 may include a first end cover 11, a first soft cavity wall 13 and a first base 12. The first end cover 11, the first soft cavity wall 13 and the first base 12 form a sealed cavity and have a gas channel, through which gas can be introduced for expansion and contraction; the first detection unit 20 is arranged on the first end cover 11, and the first calibration component 30 is arranged on the first base 12.
[0065] For example, the first soft cavity wall 13 can be made of flexible materials, such as silicone rubber, silica gel, rubber, etc. The first end cover 11 and the first base 12 can be made of rigid materials, such as nylon or ABS and other polymers that are both rigid and lightweight. While ensuring strength, the weight is lighter and customization for specific scenarios can be better achieved. At the same time, these materials are also corrosion-resistant materials that can achieve durability in a variety of harsh working environments; or they can be made of lightweight metals such as aluminum alloys. Polymers such as nylon or ABS can be made through an integrated rapid prototyping process, including injection molding, 3D printing additive manufacturing and other processes, which can directly achieve large-scale batch production. The first calibration part 30 can be a permanent magnet made of alloy permanent magnet materials such as neodymium iron boron, aluminum nickel cobalt, or ferrite permanent magnet materials.
[0066] In some embodiments, such as Figure 3 and Figure 8 As shown, taking the number of the first detection units 20 as an example, the three first detection units 20 can be evenly distributed on the first end cover 11 according to the circumference, and evenly distributed at an angle of 120° between each other. The plane where the three first detection units 20 are located is defined as the first plane. Fig.13As shown, taking the center of the first calibration piece 30 as the origin, a spatial rectangular coordinate system is established. By acquiring the first detection signals (H1, H2, H3) of the three first detection units 20, the distance R (corresponding to R1, R2, R3) between itself and the first calibration piece 30 can be obtained, and the spatial coordinates of each first detection unit 20 can be obtained, so that the distance l of the center O0 of the first plane (the center of the three first detection units 20) relative to the center O of the first calibration piece 30, as well as the spatial angles α and β of the first plane can be obtained. The spatial posture of the first end cover 11 relative to the first base 12 can be expressed as (α, β, l), and the first posture information can be expressed as (H1, H2, H3, α, β, l). For example, Fig.13 As shown, angle α is the angle between the first plane and the XY plane, and angle β is the angle between the first plane and the XZ plane (or YZ plane). By determining the angle between the first plane and the two planes of the coordinate system, the hole angle of the first plane in the coordinate system can be determined, and the spatial posture of the first plane in the coordinate system can be determined by combining the distance l.
[0067] The following details Fig.13 The calculation relationship of each parameter in .
[0068] First, the straight-line distance R of the first detection unit 20 relative to the center O of the first calibration piece 30 can be calculated through the first detection signal of the first detection unit 20, and the corresponding three first detection units 20 are R1, R2, and R3. According to the constant curvature of the joint of the first software driver, l1, l2, and l3 in the figure can be calculated, and then l can be calculated according to formula 1, β can be calculated according to formula 2, and α can be calculated according to formula 3.
[0069] l=(l1+l2+l3) / 3 (1)
[0070] β=atan2(cosθ1-(l-l1) / (l-l2)*cosθ2,(l-l1) / (l-l2)*sinθ2-sinθ1)) (2)
[0071] a=(l-l1) / (r*cos(θ1-β)) (3)
[0072] Where θ represents the angle between the installation direction of the first detection unit 20 and the X-axis, such as Fig.13 As shown, θ1=0, θ2=2π / 3, θ3=-2π / 3.
[0073] The above is an explanation of the master control system. The following is a detailed explanation of the slave system.
[0074] like Figure 4As shown, the driven system may include at least one driven joint unit 200, one driven joint unit 200 corresponds to one master joint unit 100; the driven joint unit 200 may include at least three second soft drives 40, a second calibration member 60 and at least three second detection units 50, all the second detection units 50 are arranged at one end of the at least three second soft drives 40, the second calibration member 60 is arranged at the other end of the at least three second soft drives 40, and the second detection unit 50 is used to detect the distance between itself and the second calibration member 60, and generate a second detection signal. Wherein, when the driven system includes a plurality of driven joint units 200, they are arranged in accordance with the arrangement of the corresponding plurality of master joint units 100. In some embodiments, at least three second detection units 50 are located on the same plane, and at least three second detection units 50 are not on the same straight line, and can be arranged according to the preset arrangement relationship of the first soft drive, or can be arranged according to another preset arrangement relationship, and this preset arrangement relationship can be defined as a second preset arrangement relationship.
[0075] In some embodiments, Figure 4 As shown, the second soft drive 40 may include a second end cover 41, a second soft cavity wall 43 and a second base 42, the second end cover 41, the second soft cavity wall 43 and the second base 42 form a sealed cavity, and have a gas channel, which can drive the cavity wall to expand and contract after the gas is introduced; the second end covers 41 of all second soft drives 40 are relatively fixed or share a second end cover 41, and the second bases 42 of all second soft drives 40 are relatively fixed or share a second base 42; the second detection unit 50 is arranged on the second end cover 41, the second calibration component 60 is arranged on the second base 42, and one second detection unit 50 is arranged corresponding to one second soft drive 40; the sealed cavity of the second soft drive 40 is used to receive the fluid provided by the power system 300, so that the second end cover 41 moves relative to the second base 42.
[0076] For example, the second soft cavity wall 43 can be made of flexible materials, such as silicone rubber, silica gel, rubber, etc. The second end cap 41 and the second base 42 can be made of rigid materials, such as nylon or ABS and other polymers that are both rigid and lightweight. Under the premise of ensuring strength, the weight is lighter and can better realize customization of specific scenes. At the same time, these materials are also corrosion-resistant materials, which can achieve durability in a variety of harsh working environments, or are made of lightweight metals such as aluminum alloys. The first calibration piece 60 can be made of permanent magnets made of alloy permanent magnet materials such as neodymium iron boron, aluminum nickel cobalt, or ferrite permanent magnet materials.
[0077] In some embodiments, Figure 3 and Figure 5 , Figure 6 and Figure 7 as well as Figures 8 to 11 As shown, at least three second software drivers 40 can be arranged side by side in accordance with a preset arrangement relationship, and at least three second detection units 50 can be arranged in accordance with a preset arrangement relationship. Figure 3 and Figure 5 As shown, taking three first detection units 20, three second detection units 50 and three second soft drives 40 as an example, the three first detection units 20 are arranged according to a first preset arrangement relationship and are evenly distributed on a circle with a first radius, the three second detection units 50 are arranged according to a second preset arrangement relationship and are evenly distributed on a circle with a second radius, the second radius can be the same as or different from the first radius, and the three second soft drives 40 are arranged according to a third preset arrangement relationship and are evenly distributed on a circle with a third radius. It should be noted that at least three second soft drives 40 are arranged side by side corresponding to the preset arrangement relationship, which can be understood as being evenly arranged on the circle, such as Figure 3 and Figure 5 As shown, one second software driver 40 corresponds to the direction setting of one first detection unit 30; three second detection units 50 can be arranged corresponding to the preset arrangement relationship, and the second radius can be the same as the first radius, which can be as shown in FIG. Figure 3 and Figure 5 The three second detection units 50 are arranged in the same direction as the three first detection units 20. Figure 8 and Fig. 9 , in the opposite direction.
[0078] For example, Figure 6 and Figure 7 As shown, when there are more than three first detection units 20, the number of second software drivers 40 may also be more than three, and the number of second detection units 50 may also be more than three and may not be the same as the number of second software drivers 40. At this time, the second software drivers 40 may still correspond to the third preset arrangement relationship setting, and the second detection units 50 may still correspond to the second preset arrangement relationship setting.
[0079] In some embodiments, Figure 3 and Figure 5As shown, at least three second software drivers 40 can be arranged side by side according to a preset arrangement relationship, and at least three second detection units 50 are arranged according to a preset arrangement relationship; one second detection unit 50 is arranged corresponding to one first detection unit 20, and one second software driver 40 is arranged corresponding to one first detection unit 20; and / or, at least three first detection units 20 are arranged in the same plane. In these embodiments, in order to simplify the control, reduce the complexity of the control calculation, and improve the control accuracy, a one-to-one corresponding relationship is adopted. Among them, still taking a master joint unit 100 including three first detection units 20 as an example, the slave joint unit 200 includes three second detection units 50, one second detection unit 50 corresponds to the direction setting of one first detection unit 20, and one second software driver 40 corresponds to the direction setting of one first detection unit 20. At this time, the second software driver 40 at the corresponding position can be controlled according to the first detection signal of the first detection unit 20, and the master-slave control can be determined according to the second detection signal of the second detection unit 50 at the corresponding position. Whether it is in place and adjusted.
[0080] The above is an explanation of the slave system. The following is a detailed explanation of how to perform master-slave control between the master control system and the slave system.
[0081] The power system 300 is used to pass fluid into the second soft driver 40 to move the second soft driver 40 and the second detection unit 50 moves relative to the second calibration member 60. In some embodiments, the power system 300 is at least used to provide gas to the second soft driver 40, and the extension and retraction of the second soft driver 40 can be achieved by adjusting the air pressure. In some embodiments, the power system 300 can also pass gas of a fixed pressure into the first soft driver 10 so that the first soft driver 10 can be adaptively ventilated or exhausted when the main control joint unit 100 moves. The power system 300 may include an air source, a gas pipeline, an air valve, and a speed regulating valve, etc. The air pressure output can be controlled by the speed regulating valve, the pressure regulating valve, etc., and the extension and retraction of the second soft driver 40 can be controlled.
[0082] The following describes the expansion and contraction control of the software driver (including the first software driver and the second software driver).
[0083] The relationship between force and displacement in the soft muscle joint (i.e., soft actuator) used in this application can be approximated to the relationship between force and displacement in a spring. According to Hooke's law F=kΔl, the air pressure numerical signal p=k*(l-l0) / s transmitted by the controller 400 to the power system 300 is estimated. l0 refers to the distance between the center of the upper end face and the center of the lower end face of the soft actuator under no load, and s refers to the average cross-sectional area of the soft actuator. The k value changes with the hardness of the cavity wall of the soft actuator.
[0084] The main control joint unit 100 moves under external action, and the first detection unit 20 generates a corresponding first detection signal. For example, when the user operates the main control system, the main control joint unit 100 of the main control system moves under external action, the first detection unit 20 moves relative to the first calibration component 30, and the first detection signal is generated accordingly. In some embodiments, there may be a preset proportional relationship between the main control joint unit 100 and the driven joint unit 200 in terms of the movement length ratio. For example, if the main control joint unit 100 extends 1 cm upward, the driven joint unit 200 needs to extend 2 cm, then the preset proportional relationship between the two is 1:2. In order to simplify the description, unless otherwise specified, the preset proportional relationship between the two is 1:1.
[0085] The controller 400 is used to determine the first posture information of the master joint unit 100 based on all the first detection signals of a master joint unit 100, obtain all the second detection signals of the corresponding slave joint unit 200, and determine the second posture information of the slave joint unit 200 based on all the second detection signals; according to the first posture information and the second posture information, control the power system 300 to drive each second software driver 40 of the slave joint unit 200 to move until the first posture information and the second posture information meet the preset judgment criteria.
[0086] For example, Figure 3 and Figure 5 For example, at least three second software drivers 40 can be arranged side by side according to the first preset arrangement relationship, and at least three second detection units 50 can be arranged according to the second preset arrangement relationship; one second detection unit 50 is arranged corresponding to one first detection unit 20, and one second software driver 40 is arranged corresponding to one first detection unit 20. Under external action, the three first detection units 20 respectively generate three first detection signals, and each first detection signal can calculate the distance between the corresponding first detection unit 20 and the first calibration member 30. Combined with the spatial relationship between the three first detection units 20 and the three first detection signals, the first position information of the current master joint unit 100 can be obtained. Then, according to the preset proportional relationship between the master joint unit 100 and the slave joint unit 200, the target position that the corresponding slave joint unit 200 needs to reach is calculated, and the slave joint unit 200 is driven to move according to the first position information, and the current second position information of the slave joint unit 200 is obtained in real time. The first position information and the second position information meet the preset judgment standard, and the slave joint unit 200 is controlled to stop moving.
[0087] For example, Fig.14As shown, it is assumed that the preset ratio relationship between the master joint unit 100 and the slave joint unit 200 is 1:1. Then the target posture of the slave joint unit 200 is (α, β, l), and the distance r (r1, r2, r3) between the three second detection units 50 and the center of the second calibration piece 60 can be calculated inversely according to the target posture, so as to convert the three second detection signals (h1, h2, h3) corresponding to the target posture and the lengths (l1, l2, l3) of the three second software drivers under the target posture. The current three second detection signals are obtained as (h1 S , h2 S , h3 S ), calculate the current length (l1 S , l2 S , l3 S ), thereby obtaining the required driving air pressure p=k*(l-l0) / s for each soft drive.
[0088] For example, the first position information of the master joint unit 100 under external action can be expressed as (H1, H2, H3, α, β, l). According to the first detection signal and the side length, the spatial position of one end of the current master joint relative to the other end can be determined, that is, the first end cover 11 is equivalent to the spatial position of the first base 12. According to the preset proportional relationship A between the master joint unit 100 and the slave joint unit 200, the target position of the slave joint unit 200 can be obtained as (α, β, l t ), where l t =A×1, the three second detection signals corresponding to the target posture are (h1, h2, h3). The controller 400 obtains the current second posture information (h1 S , h2 S , h3 S , α S , β S , l S ), according to h1 and h1 S The positive and negative difference of , drives the corresponding second software driver 40 to extend and retract. S , h2=h2 S , h3=h3 S , determine whether the first posture information and the second posture information meet the preset judgment criteria.
[0089] It should be noted that the above examples are based on the one-to-one correspondence between the second detection unit 50 and the first detection unit 20, and the one-to-one correspondence between the second software driver 40 and the second detection unit 50. Without limiting such a corresponding relationship, it is necessary to calculate the target posture of the slave joint unit 200 according to the preset proportional relationship, and calculate the current second posture information of the slave joint unit 200 in real time. The specific calculation method depends on the specific settings of the second software driver 40 and the second detection unit 50, and the motion method of controlling the slave joint unit 200 also needs to be set according to the specific situation, but it does not affect the application of soft robots in the field of master-slave control robots.
[0090] It can be seen that when using Figure 3 and Figure 5 The corresponding relationship shown only requires the first detection signal of the first detection unit 20 to control the movement of the corresponding second software driver 40, without the need for complex conversion calculations, making control more convenient and reducing the difficulty of control.
[0091] In some embodiments, the first detection unit 20 may include a Hall element, and the first calibration member 30 is a magnetic member; and / or, the second detection unit 50 may include a Hall element, and the second calibration member 60 is a magnetic member. In some embodiments, the first detection unit 20 may also be a detection unit that converts distance based on detecting changes in capacitance, inductance, or resistance, and may be a calibration member that uses one or more detection methods, and the first calibration member 30 corresponds to the calibration member required by the detection method. The second detection unit 50 and the second calibration member 60 may be implemented in the same manner as the first detection unit 20 and the first calibration member 30.
[0092] In some embodiments, the main control system may include a plurality of main control joint units 100, and the plurality of main control joint units 100 are arranged along a first preset direction (eg Figure 2 Alternatively, the plurality of master control joint units 100 may be arranged along a second preset direction (such as Figure 2The first preset direction is perpendicular to the second preset direction; and / or, the driven system may include multiple driven joint units 200, multiple driven joint units 200 are arranged along the first preset direction, or, multiple driven joint units 200 are arranged along the second preset direction, and the first preset direction is perpendicular to the second preset direction. Wherein, the first preset direction is the same as the telescopic direction of the first software driver 10. The main control system may be one or more main control joint units 100, and multiple main control joint units 100 may be stacked vertically along the first preset direction, or may be arranged horizontally in the second preset direction; one driven joint unit 200 corresponds to one main control joint unit 100. A single main control joint unit 100 can be driven linearly or can be passively bent in all directions. A combination of multiple main control joint units 100 can be driven linearly and can achieve all-directional continuous bending motion, while also having all-directional passive motion performance.
[0093] The above-mentioned soft robot system, the master joint unit 100 and the slave joint unit 200, can be made of silicone rubber material and plastic, can be low-cost mass production through 3D printing or mold opening, has a simple structural design, does not require precise assembly, is waterproof and corrosion-resistant, and has a wide range of applications. Complex and continuous robot movements can be performed using fewer valves without the need for electrical components such as motors and push rods.
[0094] The above is a description of the soft robot system. The following is a specific description of the control method of the soft robot system.
[0095] In some embodiments, the control method of the soft robot system of the above embodiment is as follows: Fig.12 As shown, the control method may include:
[0096] Step 1: Obtain the first detection signals output by all the first detection units 20 of a master control joint unit 100, and determine the first position information of the master control joint unit 100 according to all the first detection signals.
[0097] In some embodiments, in step 1, determining the first pose information of the master control joint unit 100 according to all the first detection signals may include:
[0098] Step 101: Obtain a first set spacing between at least two first detection units 20, and determine a first distance between all first detection units 20 and a first calibration member 30 according to a first detection signal.
[0099] Step 102: Determine the first position information of the master control joint unit 100 according to the first set spacing and the first distance.
[0100] For example, Fig.13As shown, three first detection units 20 are used as an example. By obtaining two first setting intervals and the straight-line distance R from the three first detection units 20 to the first calibration piece 30, the first plane where the first detection unit 20 is located can be determined, and the spatial position and spatial angle of the top end (relative moving end) of the main control joint unit 100 relative to the other end (relative static end) can be determined by combining the first setting intervals and the first distance, that is, the first posture information (H1, H2, H3, α, β, l).
[0101] Step 2: Obtain the second detection signals output by all the second detection units 50 of the slave joint unit 200 corresponding to the master joint unit 100, and determine the second posture information of the slave joint unit 200 according to all the second detection signals.
[0102] In some embodiments, in the above step 2, determining the second posture information of the driven joint unit 200 according to all the second detection signals may include:
[0103] Step 201: Obtain a second set spacing between at least two second detection units 50, and determine a second distance between all second detection units 50 and the second calibration member 60 according to a second detection signal.
[0104] Step 202: Determine second position information of the master control joint unit 100 according to the second set spacing and the second distance.
[0105] For example, taking three second detection units 50 as an example, the spatial position and spatial angle of the top end (relative motion end, second end cover 41) of the driven joint unit 200 relative to the other end (relative static end, second base 42) are determined by combining the second setting interval and the second distance, that is, the second posture information (h1 S , h2 S , h3 S , α S , β S , l S ).
[0106] Step 3: According to the first posture information and the second posture information, the power system 300 is controlled to drive each second software driver 40 of the driven joint unit 200 to move until the first posture information and the second posture information meet the preset judgment criteria.
[0107] In some embodiments, when the soft robotic system uses Figure 3 and Figure 5 As shown in the corresponding relationship, the second detection unit 50 is set in a one-to-one correspondence with the first detection unit 20, and the second software driver 40 is set in a one-to-one correspondence with the second detection unit 50. The above step 3 may include:
[0108] Step 301: According to a preset proportional relationship between the movement distances of the master joint unit 100 and the slave joint unit 200, a target posture corresponding to the slave joint unit 200 is determined according to the first posture information.
[0109] Step 302: Obtain the current second posture information of the driven joint unit 200, and drive all the second software drivers 40 to move according to the target posture and the current second posture information. According to the first detection signal and the corresponding second detection signal, the second software drivers 40 are driven in sequence according to a preset order; or, according to the first detection signal and the corresponding second detection signal, all the second software drivers 40 are driven synchronously.
[0110] Step 303: When the current second posture information is the same as the target posture information, it is determined that the first posture information and the second posture information meet the preset judgment standard, and the second software driver 40 is controlled to stop moving.
[0111] However, the second detection unit 50 is not arranged in a one-to-one correspondence with the first detection unit 20. When the second software driver 40 is arranged in a one-to-one correspondence with the second detection unit 50, it is necessary to determine the correspondence between each of the first software driver and the second software driver according to the preset arrangement relationship of the first software driver and the arrangement relationship of the second software driver. Then, according to the correspondence between the first software driver and the second software driver, the correspondence between the first detection signal and the second detection signal is determined. Finally, according to the correspondence between the first detection signal and the second detection signal, the movement of the second software driver is controlled.
[0112] For example, as described in the above embodiment, the first pose information can be expressed as (H1, H2, H3, α, β, l), where (H1, H2, H3) are three first detection signals, and (α, β, l) is used to represent the pose of the first end cover 11 relative to the first base 12. According to the preset proportional relationship between the master joint unit 100 and the slave joint unit 200, the target pose of the slave joint unit 200 can be obtained as (α, β, l t ), according to the values (h1, h2, h3) that the corresponding three second detection signals need to reach. The controller 400 obtains the current second posture information (h1) of the driven joint unit 200 in real time. S , h2 S , h3 S , α S , β S , l S ), according to h1 and h1 S The positive and negative difference of , drives the corresponding second software driver 40 to extend and retract. S , h2=h2 S , h3=h3S , determine whether the first posture information and the second posture information meet the preset judgment criteria.
[0113] In some embodiments, Figures 2 to 5 As shown, the first detection unit 20 and the second detection unit 50 can be Hall elements. When the main control system is subjected to external force and deformed, the three Hall signals of the first detection unit 20 change. The change generated by Hall element a is Δa, the signal change generated by Hall element b is Δb, and the signal change generated by Hall element c is Δc. The posture change of the main control system can be obtained by solving the three electromagnetic signals. The posture change is input into the controller 400. The controller 400 calibrates the change of the Hall signal with the change of the air pressure in the inner cavity of the driven system to obtain a digital signal of the output air pressure for controlling the movement of the driven system. The signal is input into the three air valves respectively, so that the three inner cavities of the driven system generate positive pressure or negative pressure respectively, thereby controlling the movement of the driven joint. The above is only an example and does not limit the specific implementation method.
[0114] In some embodiments, Fig.14 As shown, the following master-slave control process can also be used:
[0115] According to the change of the end face posture of the main control joint, the relative position of the Hall sensor on the upper end face and the permanent magnet changes. By detecting the Hall potential of the three Hall sensors on the main control joint, the current posture α, β, and l of the upper end face of the main control joint can be calculated.
[0116] α, β, and l are input to the controller 400 to calculate the direction (positive pressure or negative pressure) of the air pressure required for each second soft driver to control the driven joint to reach the target posture, as well as the air pressure levels p1, p2, and p3.
[0117] The air pressure signals p1, p2, and p3 are input to the power system, and the corresponding air pressure electrical signals are output and input to the air valve to control the opening and closing of the air valve, inhalation or exhaust, and thus control the movement of the joint.
[0118] Each of the three air valves has its own independent air pressure feedback system, which is composed of an air pressure sensor. The current air pressure value in the air cavity of the second soft actuator is fed back to the power system, and it is continuously adjusted to make the target air pressure size in the muscle air cavity.
[0119] The posture of the second end cap of the driven joint changes, and the Hall potential of the three Hall sensors on the driven joint can be detected. Similarly, the current posture (α S , β S , l S The posture information is fed back to the controller 400 to calculate the target posture (α, β, l t) to obtain Δp1, Δp2, Δp3.
[0120] Through continuous closed-loop control, a steady state with a difference close to zero is achieved, and the air pressure at this time can be used to control the driven joint to achieve the target spatial posture.
[0121] The above control method is illustrated by taking a structure that the applicant considers to be relatively simple as an example. The main idea is to construct a joint unit with a software driver, obtain the first posture information of the master joint unit 100 and the second posture information of the slave joint unit 200 with a distance sensor, and perform motion control of the slave system according to the first posture information and the second posture information. On this basis, by setting the second detection unit 50 and the first detection unit 20, and the second detection unit 50 and the second software driver 40 in correspondence, the control and motion calculation of the slave joint unit 200 can be simplified.
[0122] This document is described with reference to various exemplary embodiments. However, those skilled in the art will recognize that changes and modifications may be made to the exemplary embodiments without departing from the scope of this document. For example, various operating steps and components for performing the operating steps may be implemented in different ways (e.g., one or more steps may be deleted, modified, or incorporated into other steps) depending on the specific application or considering any number of cost functions associated with the operation of the system.
[0123] Although the principles of this invention have been shown in various embodiments, many modifications of structures, arrangements, proportions, elements, materials and components particularly suitable for specific environments and operational requirements can be used without departing from the principles and scope of this invention. The above modifications and other changes or amendments will be included in the scope of this invention.
[0124] The foregoing specific description has been described with reference to various embodiments. However, those skilled in the art will recognize that various modifications and changes can be made without departing from the scope of the present disclosure. Therefore, the consideration of the present disclosure will be illustrative rather than restrictive, and all these modifications will be included in its scope. Similarly, the advantages, other advantages and solutions to the problems of various embodiments have been described above. However, the benefits, advantages, solutions to the problems and any elements that can produce these, or make them more clear, should not be interpreted as critical, necessary or necessary. The term "include" and any other variants used in this article are all non-exclusive inclusions, so that the process, method, article or device including the list of elements not only includes these elements, but also includes other elements that are not explicitly listed or do not belong to the process, method, system, article or device. In addition, the term "coupled" and any other variants used in this article refer to physical connections, electrical connections, magnetic connections, optical connections, communication connections, functional connections and / or any other connections.
[0125] Those skilled in the art will appreciate that many changes may be made to the details of the above-described embodiments without departing from the basic principles of the invention. Therefore, the scope of the present invention should be determined solely by the claims.
Claims
1. A master-slave controlled soft robot system, characterized in that: Including master control system, slave system, power system and controller; The main control system includes at least one main control joint unit, which includes a first software driver, a first calibration piece, and at least three first detection units, wherein the first detection unit and the first calibration piece are respectively arranged at two ends of the first software driver; the first detection unit is used to detect the distance between itself and the first calibration piece and generate a first detection signal; The driven system comprises at least one driven joint unit, one driven joint unit corresponds to one master joint unit; the driven joint unit comprises at least three second software drivers, a second calibration piece and at least three second detection units, all of the second detection units are arranged at one end of the at least three second software drivers, the second calibration piece is arranged at the other end of the at least three second software drivers, and the second detection unit is used to detect the distance between itself and the second calibration piece and generate a second detection signal; The power system is used to pass fluid into the second soft drive to move the second soft drive, and the second detection unit moves relative to the second calibration member; The main control joint unit moves under external action, and the first detection unit generates the corresponding first detection signal; The controller is used to determine the first posture information of the master joint unit according to all the first detection signals of one of the master joint units, obtain all the second detection signals of the corresponding slave joint unit, and determine the second posture information of the slave joint unit according to all the second detection signals; according to the first posture information and the second posture information, control the power system to drive each of the second software drivers of the slave joint unit to move until the first posture information and the second posture information meet the preset judgment standard; Wherein, at least three of the first detection units are arranged according to a preset arrangement relationship, at least three of the second software drivers are arranged side by side corresponding to the preset arrangement relationship, and at least three of the second detection units are arranged corresponding to the preset arrangement relationship; Wherein, at least three of the second software drivers are arranged side by side according to the preset arrangement relationship, and at least three of the second detection units are arranged according to the preset arrangement relationship; one of the second detection units is arranged corresponding to one of the first detection units, and one of the second software drivers is arranged corresponding to one of the first detection units; and / or at least three of the first detection units are arranged in the same plane; Wherein, the first detection unit includes a Hall element, and the first calibration member is a magnetic member; and / or, the second detection unit includes a Hall element, and the second calibration member is a magnetic member; Wherein, the first soft driver comprises a first end cover, a first soft cavity wall and a first base, wherein the first end cover, the first soft cavity wall and the first base form a sealed cavity; the first detection unit is arranged on the first end cover, and the first calibration member is arranged on the first base; And / or, the second soft drive comprises a second end cover, a second soft cavity wall and a second base, the second end cover, the second soft cavity wall and the second base form a sealed cavity; the second end covers of all the second soft drives are relatively fixed or share a second end cover, and the second bases of all the second soft drives are relatively fixed or share a second base; the second detection unit is arranged on the second end cover, the second calibration member is arranged on the second base, and one second detection unit is arranged corresponding to one second soft drive; the sealed cavity of the second soft drive is used to receive the fluid provided by the power system, so that the second end cover moves relative to the second base; Wherein, the main control system comprises a plurality of the main control joint units, and the plurality of the main control joint units are arranged along a first preset direction, or the plurality of the main control joint units are arranged along a second preset direction, and the first preset direction is perpendicular to the second preset direction; And / or, the driven system includes a plurality of the driven joint units, and the plurality of the driven joint units are arranged along a first preset direction, or, the plurality of the driven joint units are arranged along a second preset direction, and the first preset direction is perpendicular to the second preset direction.
2. A control method, applied to the soft robot system according to claim 1, characterized in that: include: Acquire first detection signals output by all first detection units of a main control joint unit, and determine first position information of the main control joint unit according to all the first detection signals; Acquire second detection signals output by all second detection units of the slave joint units corresponding to the master joint unit, and determine second posture information of the slave joint units according to all the second detection signals; According to the first posture information and the second posture information, controlling the power system to drive each of the second software drivers of the driven joint unit to move until the first posture information and the second posture information meet a preset judgment standard; Wherein, determining the first posture information of the master control joint unit according to all the first detection signals includes: Acquire a first set spacing between at least two of the first detection units, and determine a first distance between all the first detection units and the first calibration component according to the first detection signal; Determining first posture information of the master control joint unit according to the first setting interval and the first distance; And / or, determining the second posture information of the driven joint unit according to all the second detection signals, comprising: Acquire a second set spacing between at least two of the second detection units, and determine a second distance between all the second detection units and the second calibration member according to the second detection signal; The second position information of the main control joint unit is determined according to the second set interval and the second distance.
3. The control method according to claim 2, characterized in that: Controlling the power system to drive each of the second software drivers of the driven joint unit to move includes: Determining a corresponding relationship between each of the first software drivers and the second software drivers according to a preset arrangement relationship of the first software drivers and an arrangement relationship of the second software drivers; Determining a correspondence between the first detection signal and the second detection signal according to a correspondence between the first software driver and the second software driver; The second software driver is controlled to move according to the corresponding relationship between the first detection signal and the second detection signal.
4. The control method according to claim 2, characterized in that: Controlling the movement of the second software driver according to the correspondence between the first detection signal and the second detection signal includes: According to the first detection signal and the corresponding second detection signal, driving the second software driver in sequence according to a preset order; Alternatively, all the second software drivers are synchronously driven according to the first detection signal and the corresponding second detection signal.
