SOFT JOINT GRIPPER BASED ON 4D PRINTING AND CONSISTENCY CONTROL METHOD THEREOF
20220305668 · 2022-09-29
Inventors
- Yuyan Zhang (Qinhuangdao City, CN)
- Shiying KOU (Qinhuangdao City, CN)
- Xiaoyuan LUO (Qinhuangdao City, CN)
- Yintang WEN (Qinhuangdao City, CN)
- Bo LIANG (Qinhuangdao City, CN)
Cpc classification
B25J15/0009
PERFORMING OPERATIONS; TRANSPORTING
B33Y80/00
PERFORMING OPERATIONS; TRANSPORTING
B25J9/1605
PERFORMING OPERATIONS; TRANSPORTING
B25J19/007
PERFORMING OPERATIONS; TRANSPORTING
International classification
B25J15/00
PERFORMING OPERATIONS; TRANSPORTING
B25J15/10
PERFORMING OPERATIONS; TRANSPORTING
Abstract
A soft joint gripper based on 4D printing comprises a palm body and five soft finger units connected with the palm body; each soft finger unit is provided with two soft finger joints and two finger bones; the finger bones are made of 3D printing resin; the soft finger joints are two symmetrical double-layer thin-film soft finger joint actuators; the double-layer thin-film soft finger joint actuator is made of a 4D printing liquid crystal elastomer and a polyimide electrothermal film, and the bending angle of each double-layer thin-film soft finger joint actuator is changed by energization or heating stimulation; and the double-layer film soft finger joint actuator is used to control the soft finger unit to perform reversible bending motion. Accurate control of the soft joint gripper can be realized.
Claims
1. A soft joint gripper based on 4D printing, comprising: a palm body and five soft finger units connected to the palm body, wherein: each soft finger unit is provided with two soft finger joints and two finger bones; the finger bones are made of 3D printing resin; the soft finger joints are two symmetrical double-layer thin-film soft finger joint actuators; the double-layer thin-film soft finger joint actuator is made of a 4D printing liquid crystal elastomer and a polyimide electrothermal film, and the bending angle of each double-layer thin-film soft finger joint actuator is changed by energization or heating stimulation; and the double-layer film soft finger joint actuator is used to control the soft finger unit to perform reversible bending motion.
2. The soft joint gripper based on 4D printing according to claim 1, wherein a bending sensor is attached to the surface of the double-layer film soft joint actuator.
3. The soft joint gripper based on 4D printing according to claim 1, wherein the polyimide electrothermal film is used to adjust the temperature of the double-layer thin-film soft joint actuator; the polyimide electrothermal film generates Joule heat, the temperature rises, the liquid crystal elastomer shrinks, the polyimide electrothermal film expands, the contraction and expansion of different layers result in the bending of the soft finger joint; the double-layer thin-film soft finger joint actuator bends to the contraction side, and when the temperature drops and recovers to its original state, the reversible bending motion of the soft finger unit is controlled.
4. The soft joint gripper based on 4D printing according to claim 1, wherein the bending angles of the double-layer film soft joint actuators are the same; and the bending directions of the two double-layer thin-film soft finger joint actuators with symmetrical soft finger joints are opposite.
5. A consistency control method of a soft joint gripper based on 4D printing, wherein the consistency control method of a soft joint gripper based on 4D printing is applied to the soft joint gripper based on 4D printing according to claim 1, and the consistency control method of a soft joint gripper based on 4D printing comprises: acquiring the bending angle of the soft finger joint and the rotation angle of the finger bone; establishing a soft finger joint dynamic model and a finger bone dynamic model according to the bending angle of the soft finger joint and the rotation angle of the finger bone, respectively; under a local coordinate system, determining the soft finger joint centroid positions and the soft finger joint centroid velocities of any two soft finger joints according to the soft finger joint dynamic model; under a global coordinate system, determining the finger bone centroid positions and the finger bone centroid velocities of any two finger bones according to the finger bone dynamic model; determining the soft finger joint kinetic energy and the soft finger joint potential energy according to the soft finger joint centroid position and the soft finger joint centroid velocity; determining the finger bone kinetic energy and the finger bone potential energy according to the finger bone centroid position and the finger bone centroid velocity; determining the dynamic model of bending angles of five soft finger units with respect to the soft finger joints according to the soft finger joint kinetic energy and the soft finger joint potential energy; taking the dynamic model of bending angles of five soft finger units with respect to the soft finger joints as a control target to determine a consistency control protocol of a soft finger unit; and controlling the soft finger unit to perform reversible bending motion according to the consistency control protocol of the soft finger unit.
6. The consistency control method of a soft joint gripper based on 4D printing according to claim 5, wherein determining the soft finger joint centroid positions and the soft finger joint centroid velocities of any two soft finger joints according to the soft finger joint dynamic model under a local coordinate system specifically comprises: determining the soft finger joint centroid positions of any two soft finger joints according to the formula
V.sub.hi(s)=R.sub.(i−1)γ.sub.i(s)+V.sub.h(i−1)(s); where: V.sub.hi(s) is the soft finger joint centroid position;
7. The consistency control method of a soft joint gripper based on 4D printing according to claim 6, wherein determining the finger bone centroid positions and the finger bone centroid velocities of any two finger bones according to the finger bone dynamic model under a global coordinate system specifically comprises: determining the finger bone centroid positions of any two finger bones according to the formula
8. The consistency control method of a soft joint gripper based on 4D printing according to claim 7, wherein determining the dynamic model of bending angles of five soft finger units with respect to the soft finger joints according to the soft finger joint kinetic energy and the soft finger joint potential energy specifically comprises: determining the dynamic model of bending angles of five soft finger units with respect to the soft firmer joints according to the formula
M(θ.sub.i){umlaut over (θ)}.sub.i+C(θ.sub.i, {dot over (θ)}.sub.l){dot over (θ)}.sub.l+g(θ.sub.i)=τ.sub.i; where C(θ.sub.i, {dot over (θ)}.sub.i){dot over (θ)}.sub.i is a symmetric inertia matrix; M(θ.sub.i){umlaut over (θ)}.sub.i is Coriolis moment; g(θ.sub.i) is a generalized powerful moment; τ.sub.i is the dynamic model of bending angles of five soft finger units with respect to the soft finger joints, τ.sub.i represents the input amount or control torque generated by each soft finger unit; {dot over (θ)}.sub.i is the angular velocity of the bending angle of the soft finger joint; {umlaut over (θ)}.sub.i is the acceleration of the bending angle of the soft finger joint.
9. The consistency control method of a soft joint gripper based on 4D printing according to claim 8, wherein taking the dynamic model of bending angles of five soft finger units with respect to the soft finger joints as a control target to determine a consistency control protocol of a soft finger unit specifically comprises: determining the consistency control protocol of the soft finger unit according to the formula
10. The consistency control method of a soft joint gripper based on 4D printing according to claim 5, wherein a bending sensor is attached to the surface of the double-layer film soft joint actuator.
11. The consistency control method of a soft joint gripper based on 4D printing according to claim 10, wherein determining the soft finger joint centroid positions and the soft finger joint centroid velocities of any two soft finger joints according to the soft finger joint dynamic model under a local coordinate system specifically comprises: determining the soft finger joint centroid positions of any two soft finger joints according to the formula
V.sub.hi(s)=R.sub.(i−1)γ.sub.i(s)+V.sub.h(i−1)(s); where V.sub.hi(s) is the soft finger joint centroid position;
12. The consistency control method of a soft joint gripper based on 4D printing according to claim 11, wherein determining the finger bone centroid positions and the finger bone centroid velocities of any two finger bones according to the finger bone dynamic model under a global coordinate system specifically comprises: determining the finger bone centroid positions of any two finger bones according to the formula
13. The consistency control method of a soft joint gripper based on 4D printing according to claim 12, wherein determining the dynamic model of bending angles of five soft finger units with respect to the soft finger joints according to the soft finger joint kinetic energy and the soft finger joint potential energy specifically comprises: determining the dynamic model of bending angles of five soft finger units with respect to the soft firmer joints according to the formula
M(θ.sub.i){umlaut over (θ)}.sub.i+C(θ.sub.i, {dot over (θ)}.sub.l){dot over (θ)}.sub.l+g(θ.sub.i)=τ.sub.i; where C(θ.sub.i, {dot over (θ)}.sub.i){dot over (θ)}.sub.i is a symmetric inertia matrix; M(θ.sub.i){umlaut over (θ)}.sub.i is Coriolis moment; g(θ.sub.i) is a generalized powerful moment; τ.sub.i is the dynamic model of bending angles of five soft finger units with respect to the soft finger joints, τ.sub.i represents the input amount or control torque generated by each soft finger unit; {dot over (θ)}.sub.i is the angular velocity of the bending angle of the soft finger joint; {umlaut over (θ)}.sub.i is the acceleration of the bending angle of the soft finger joint.
14. The consistency control method of a soft joint gripper based on 4D printing according to claim 5, wherein the polyimide electrothermal film is used to adjust the temperature of the double-layer thin-film soft joint actuator; the polyimide electrothermal film generates Joule heat, the temperature rises, the liquid crystal elastomer shrinks, the polyimide electrothermal film expands, the contraction and expansion of different layers result in the bending of the soft finger joint; the double-layer thin-film soft finger joint actuator bends to the contraction side, and when the temperature drops and recovers to its original state, the reversible bending motion of the soft finger unit is controlled.
15. The consistency control method of a soft joint gripper based on 4D printing according to claim 14, wherein determining the soft finger joint centroid positions and the soft finger joint centroid velocities of any two soft finger joints according to the soft finger joint dynamic model under a local coordinate system specifically comprises: determining the soft finger joint centroid positions of any two soft finger joints according to the formula
V.sub.hi(s)=R.sub.(i−1)γ.sub.i(s)+V.sub.h(i−1)(s); where V.sub.hi(s) is the soft finger joint centroid position;
16. The consistency control method of a soft joint gripper based on 4D printing according to claim 15, wherein determining the finger bone centroid positions and the finger bone centroid velocities of any two finger bones according to the finger bone dynamic model under a global coordinate system specifically comprises: determining the finger bone centroid positions of any two finger bones according to the formula
17. The consistency control method of a soft joint gripper based on 4D printing according to claim 16, wherein determining the dynamic model of bending angles of five soft finger units with respect to the soft finger joints according to the soft finger joint kinetic energy and the soft finger joint potential energy specifically comprises: determining the dynamic model of bending angles of five soft finger units with respect to the soft firmer joints according to the formula
M(θ.sub.i){umlaut over (θ)}.sub.i+C(θ.sub.i, {dot over (θ)}.sub.l){dot over (θ)}.sub.l+g(θ.sub.i)=τ.sub.i; where C(θ.sub.i, {dot over (θ)}.sub.i){dot over (θ)}.sub.i is a symmetric inertia matrix; M(θ.sub.i){umlaut over (θ)}.sub.i is Coriolis moment; g(θ.sub.i) is a generalized powerful moment; τ.sub.i is the dynamic model of bending angles of five soft finger units with respect to the soft finger joints, τ.sub.i represents the input amount or control torque generated by each soft finger unit; {dot over (θ)}.sub.i is the angular velocity of the bending angle of the soft finger joint; {umlaut over (θ)}.sub.i is the acceleration of the bending angle of the soft finger joint.
18. The consistency control method of a soft joint gripper based on 4D printing according to claim 5, wherein the bending angles of the double-layer film soft joint actuators are the same; and wherein the bending directions of the two double-layer thin-film soft finger joint actuators with symmetrical soft finger joints are opposite.
19. The consistency control method of a soft joint gripper based on 4D printing according to claim 18, wherein determining the soft finger joint centroid positions and the soft finger joint centroid velocities of any two soft finger joints according to the soft finger joint dynamic model under a local coordinate system specifically comprises: determining the soft finger joint centroid positions of any two soft finger joints according to the formula
V.sub.hi(s)=R.sub.(i−1)γ.sub.i(s)+V.sub.h(i−1)(s); where V.sub.hi(s) is the soft finger joint centroid position;
20. The consistency control method of a soft joint gripper based on 4D printing according to claim 19, wherein determining the finger bone centroid positions and the finger bone centroid velocities of any two finger bones according to the finger bone dynamic model under a global coordinate system specifically comprises: determining the finger bone centroid positions of any two finger bones according to the formula
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0036] The present disclosure will be further explained with reference to the accompanying drawings.
[0037]
[0038]
[0039]
[0040]
[0041]
[0042]
[0043]
[0044]
[0045]
DETAILED DESCRIPTION
[0046] The technical scheme in the embodiments of the present disclosure will be described clearly and completely hereinafter with reference to the drawings in the embodiments of the present disclosure. Obviously, the described embodiments are only some embodiments of the present disclosure, rather than all of the embodiments. Based on the embodiments of the present disclosure, all other embodiments obtained by those skilled in the art without paying creative labor belong to the scope of protection of the present disclosure.
[0047] The purpose of the present disclosure is to provide a soft joint gripper based on 4D printing and a consistency control method thereof, which can realize accurate control of the soft joint gripper.
[0048] In order to make the above objects, features and advantages of the present disclosure more obvious and understandable, the present disclosure will be further explained in detail with reference to the drawings and specific embodiments.
[0049]
[0050] As shown in
[0051] According to the present disclosure, a double-layer thin-film soft finger joint actuator is manufactured by using a double-layer thin-film structure of a 4D printing liquid crystal elastomer and a polyimide electrothermal film. The thermally responsive liquid crystal elastomer is a polymer which can shrink and deform under the stimulation of temperature, and the expansion and contraction of different layers after being heated result in a larger bending angle. A bending angle detection sensor is attached to the double-layer thin-film soft finger joint actuator. Joule heat generated by a polyimide electrothermal film changes the temperature of the double-layer thin-film soft finger joint actuator and then controls the bending amount. The nonlinear function is used to fit the response characteristics of the double-layer thin-film soft finger joint actuator.
[0052] According to the present disclosure, the soft finger joint in the soft finger joint hand consists of two symmetrical double-layer thin-film soft finger joint actuators, which are similar to artificial muscles and can realize reverse bending. In order to verify the motion ability of the soft joint hand, each soft finger joint is regarded as a degree of freedom. The soft finger joint and the finger bone are modeled in different coordinate systems, respectively, and the dynamic model is established by Euler-Lagrange equation. According to the dynamic model, the consistency control protocol is determined, so that the final position of each soft finger unit is consistent.
[0053] Each soft finger unit can be regarded as an independent agent, which is mainly aimed at the static position consistency problem of the soft joint hand system with independent models under the undirected topology. The final position of a group of soft finger units with different initial states is controlled to converge to a constant value. The simulation proves that the soft hand reaches the position consistency state. Finally, the consistency evaluation is carried out, and the soft joint hand is controlled to achieve the position consistency through the control input signal given by the simulation.
[0054] The orientation of a liquid crystal matrix is programmed in the printing process of liquid crystal elastomer, and then is crosslinked by ultraviolet irradiation. After heating, the expansion and contraction of different layers cause the actuator to bend. A bending curvature detection sensor is attached to the surface of the double-layer thin-film soft finger joint actuator, and the bending angle of each soft finger joint can be changed by energization or heating stimulation. Two symmetrical double-layer film soft finger joint actuators of the soft finger joint have opposite bending directions, so that the reversible bending motion of the finger unit is realized. Finger bones are made of lightweight and fixed materials with high hardness. With the bending of a soft finger joint, the bending of each soft finger joint can be regarded as having one degree of freedom, and each finger unit has two degrees of freedom. When the soft finger joint is energized from the outside, the liquid crystal elastomer shrinks and the polyimide polymer expands due to the increase of temperature. The bending unit will bend to the contracted side. When the energization is stopped, the bending unit will slowly recover to its original state.
[0055]
[0056] Step 501: the bending angle of the soft finger joint and the rotation angle of the finger bone are acquired.
[0057] Prior to step 501, the method further comprises: changing the bending angle of each soft finger joint by energizing the polyimide electrothermal film, measuring the bending angle and the value of the bending normal stress corresponding to the temperature at each moment according to the bending angle detection device, and applying the nonlinear least square fitting function to obtain the relationship equation between the bending normal stress and the bending angle corresponding to the temperature, and further controlling the position and velocity of each finger bone.
[0058] The first soft finger unit is taken as an example. According to the measured bending angle of the soft finger joint, the dynamic models of a finger bone and a bent soft finger joint are established, respectively; θ.sub.i, {dot over (θ)}.sub.i(i+1, 2) is the bending angle and the angular velocity of the ith soft finger joint, q.sub.i, {dot over (q)}.sub.i(i+1, 2) is the rotation angle and the angular velocity of the ith finger bone, and the bending angle relationship therebetween is
[0059] Step 502: a soft finger joint dynamic model and a finger bone dynamic model are established according to the bending angle of the soft finger joint and the rotation angle of the finger bone, respectively.
[0060] Step 503: under a local coordinate system, the soft finger joint centroid positions and the soft finger joint centroid velocities of any two soft finger joints are determined according to the soft finger joint dynamic model.
[0061] Because the soft finger joint bends, it is necessary to obtain the bending radius r.sub.i by virtue of the bending angle, and then determine the position coordinates of the two finger bones by using the length I.sub.h of the soft finger joint and the length I.sub.l of the finger bone under a global coordinate xoy. Then, the position coordinate of the soft finger joint is determined under a local coordinate x.sub.hi(s)oy.sub.hi(s), where the horizontal axis under a local coordinate is the tangent line at a certain point s∈(0˜I.sub.h) on the soft finger joint. Finally, the position coordinate of the soft finger joint is transformed into a global coordinate by virtue of a coordinate transformation matrix.
[0062] The centroid position of two soft finger joints can be expressed as:
is the bending radius,
[0063] T is the thickness of the soft finger joint,
is the coordinate transformation matrix,
[0064] is obtained according to the position geometric relationship, and I.sub.l is the length of the finger bone. The centroid velocity can be obtained by deriving θ.sub.i.
[0065] Step 504: under a global coordinate system, the finger bone centroid positions and the finger bone centroid velocities of any two finger bones are determined according to the finger bone dynamic model.
[0066] The centroid position of two finger bones can be expressed as:
[0067] Step 505: the soft finger joint kinetic energy and the soft finger joint potential energy are determined according to the soft finger joint centroid position and the soft finger joint centroid velocity.
[0068] The kinetic energy k.sub.hi and potential energy u.sub.hi of a soft finger joint are:
[0069] where J is the moment of inertia of each finger bone, g is the acceleration constant of gravity, and m.sub.l and m.sub.h are the mass of a finger bone and a soft finger joint, respectively.
[0070] Step 506: the finger bone kinetic energy and the finger bone potential energy are determined according to the finger bone centroid position and the finger bone centroid velocity.
[0071] The kinetic energy k.sub.li and potential energy u.sub.li of a finger bone are:
k.sub.hi=1/2 ml∥{dot over (V)}∥.sup.2+1/2j{dot over (q)}.sup.2.sub.i
u.sub.li=−m.sub.lgV.sub.li
[0072] Step 507: the dynamic model of bending angles of five soft finger units with respect to the soft finger joints is determined according to the soft finger joint kinetic energy and the soft finger joint potential energy.
[0073] s∈(0˜I.sub.h) is a certain point bent on the soft finger joint. According to the centroid position and centroid velocity obtained in step 2, the kinetic energy k.sub.li and potential energy u.sub.li of the soft finger joint can be obtained. Lagrange function is the difference between all kinetic energy and all potential energy of two finger bones and two soft finger joints, which is expressed as:
[0074] Euler-Lagrange dynamic equation is then established, and the Euler-Lagrange dynamic equation of each soft finger in the system is expressed as:
[0075] Furthermore, according to the angle relationship between the finger bone and the soft finger joint and Euler-Lagrange dynamic equation, the dynamic model of the angle θ of five soft finger units with respect to the soft finger joint is obtained:
M(θ.sub.i){umlaut over (θ)}.sub.i+C(θ.sub.i, {dot over (θ)}.sub.l){dot over (θ)}.sub.l+g(θ.sub.i)=τ.sub.ii=1,2,3,4,5
[0076] where C(θ.sub.i, {dot over (θ)}.sub.l)){dot over (θ)}.sub.i represents a symmetric inertia matrix, M(θ.sub.i){umlaut over (θ)}.sub.i represents Coriolis moment, g(θ.sub.i) represents a generalized force moment, and τ.sub.i represents the input amount or control torque generated by each soft finger unit.
[0077] Step 508: the dynamic model of bending angles of five soft finger units with respect to the soft finger joints is taken as a control target to determine a consistency control protocol of a soft finger unit.
[0078] As shown in
[0079] where, τ.sub.i refers to the bending moment of the ith soft finger unit, and a.sub.ij is the number of edges connecting nodes i and j in the position communication topological graph. According to the control protocol, the input size of each soft finger joint in the process of finally reaching the same position can be obtained. Then, according to the fitting function equation of the bending normal stress and the bending angle corresponding to the temperature, a further control is carried out so that the final position is consistent.
[0080] Step 509: the soft finger unit is controlled to perform reversible bending motion according to the consistency control protocol of the soft finger unit.
[0081] As shown in
[0082] As shown in
[0083] The present disclosure has a reasonable structure, and models soft finger joints and finger bones, respectively. The idea of consistency control is added. By collecting and transmitting sensing information, a group of soft joint hands with different initial states are cooperatively controlled to achieve their expected self-assembly and self-deformation, that is, the same position. Compared with the previous soft hand, the present disclosure overcomes the problems of modeling and control difficulties, realizes the self-sensing and self-driving cooperative consistent action of the 4D printing soft joint hand, and innovatively applies the consistent control theory to the self-driving of the 4D printing intelligent material structure.
[0084] In this specification, each embodiment is described in a progressive manner, and each embodiment focuses on the differences from other embodiments. It is sufficient to refer to the same and similar parts between various embodiments.
[0085] The above embodiments are provided only for the purpose of describing the present disclosure, rather than limit the scope of the present disclosure. The scope of the present disclosure is defined by the appended claims. All equivalent substitutions and modifications made without departing from the spirit and principle of the present disclosure shall be covered within the scope of the present disclosure.