+ All Categories
Home > Documents > PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT...

PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT...

Date post: 02-Nov-2019
Category:
Upload: others
View: 2 times
Download: 0 times
Share this document with a friend
8
PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect Thorax Metin Sitti Dept. of EECS, University of California at Berkeley, CA 94720 [email protected] Abstract In this paper, a four-bar mechanism with two flexible links is proposed to be used in a micromechanical flying insect robot wing thorax design for stroke amplification. PZT- 5H and PZN-PT based unimorph actuators are utilized at the input link of the four-bar. The kinematics and dy- namics of the proposed wing strcuture with two parallel four-bar mechanisms are analyzed, and DC forces gener- ated at the wing are computed for checking the feasibility of the design. Using laser micromachining and folding techniques, prototype four-bars are constructed, and it is shown that the single four-bar structure can have 90-100 o stroke motion at 29 Hz with a rigid polyester wing on it. 1 Introduction Being inspired from the biological mechanisms and struc- tures in nature, human could innovate many novel tech- nologies and devices from the early times. As a re- cent example of this, biomimetic robotics has been en- abling novel devices and approaches to robotic problems. This kind of field would enable multifunctional, smart, suboptimal, nature friendly, complex and adaptive ma- chines and devices. Flying insect robots are one of the important inspiration areas for the robotic researchers [1], [2], [3], [4] where high maneuverability and novel distributed intelligent device applications would become possible with mechanical flies. On the other hand, espe- cially considering the design issue of a wing structure for a micromechanical flying insect (MFI) robot with sizes and performances comparable to a real fly, many new challenging design constraints are introduced in the re- spects of size, weight, motion speed, power consumption, biomimetic kinematics, space efficiency, etc. Therefore, light structures with high resonant frequencies, low power consuming and compact actuators, and high stroke and rotation motion mechanisms issues are the main chal- lenges of this field. This paper considers mainly the stroke amplification and compact actuator design issues using a four-bar mechanism with two flexible links and integrated PZT unimorph actuator at the input link. The detailed de- sign and characterization of the unimorph actuators are given in [5]. For stroke amplification, different compliant mechanisms are proposed such that Pokines [6] proposed a microamplifier fabricated using LIGA process, Precht [7] developed a large stroke bender actuating a trailing edge flap, Kota et al. [8], [9] designed micro compli- ant mechanisms including a four-bar based mechanism, and Cox et al. constructed PZT bimorph [2] and uni- morph [10] based flapping mechanisms with compliant flexures. However, these works do not have a detailed kinematic, dynamic and quasi-static blocking force anal- ysis of the compliant mechanism for a specific task, and none of them could have a large stroke flapping mech- anism for a micromechanical flying device (Cox et al. achieved 30 - 50 o flapping stroke). In this paper, detailed analysis is realized for a micromechanical flapping wing mechanism based on a compliant four-bar structure, and a high stroke flapping mechanism is developed. Further- more, many design constraints are considered such that the proposed design enables a compact and light weight thorax, high torques at the wing, and high resonant fre- quency (> 25 Hz ). 2 Four-Bar Thorax Structure The complete view of the wing structure to be con- structed is shown in Figure 1. Two four-bar mechanisms constitute the parallel thorax structures that could en- able targeted biomimetic 70 - 160 o stroke and 90 o wing rotation motions [11] with proper stroke amplification at resonant frequency of 100 - 150 Hz . This compact de- sign assumes a flexible wing, and a fan-fold structure is proposed for this problem. The structure of the proposed four-bar mechanism with a wing spar on it is shown in Figure 2. Two elastic beams at the input and output links deflect with Δθ and Δψ angles so that the cou- pler link and spar rotate with angle φ. Then the stroke amplification N of the structure can be defined as: N = φ pp θ pp (1) where θ pp = θ max - θ min and φ pp = φ max - φ min are the peak-to-peak input and output link motions. For the simplicity of the analysis, the input and out- put deflections are assumed to be linear, i.e. small, which is the case for PZT unimorph actuators with moderate input electric fields. Thus, the mechanism can be approx- imated by a four rigid link four-bar mechanism with four rotational (4R) pin joints. Therefore, the kinematics is
Transcript
Page 1: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

PZT Actuated Four-Bar Mechanism with Two Flexible Links for

Micromechanical Flying Insect Thorax

Metin Sitti

Dept. of EECS, University of California at Berkeley, CA 94720

[email protected]

Abstract

In this paper, a four-bar mechanism with two flexible links

is proposed to be used in a micromechanical flying insect

robot wing thorax design for stroke amplification. PZT-

5H and PZN-PT based unimorph actuators are utilized

at the input link of the four-bar. The kinematics and dy-

namics of the proposed wing strcuture with two parallel

four-bar mechanisms are analyzed, and DC forces gener-

ated at the wing are computed for checking the feasibility

of the design. Using laser micromachining and folding

techniques, prototype four-bars are constructed, and it is

shown that the single four-bar structure can have 90−100o

stroke motion at 29 Hz with a rigid polyester wing on it.

1 IntroductionBeing inspired from the biological mechanisms and struc-tures in nature, human could innovate many novel tech-nologies and devices from the early times. As a re-cent example of this, biomimetic robotics has been en-abling novel devices and approaches to robotic problems.This kind of field would enable multifunctional, smart,suboptimal, nature friendly, complex and adaptive ma-chines and devices. Flying insect robots are one of theimportant inspiration areas for the robotic researchers[1], [2], [3], [4] where high maneuverability and noveldistributed intelligent device applications would becomepossible with mechanical flies. On the other hand, espe-cially considering the design issue of a wing structure fora micromechanical flying insect (MFI) robot with sizesand performances comparable to a real fly, many newchallenging design constraints are introduced in the re-spects of size, weight, motion speed, power consumption,biomimetic kinematics, space efficiency, etc. Therefore,light structures with high resonant frequencies, low powerconsuming and compact actuators, and high stroke androtation motion mechanisms issues are the main chal-lenges of this field.

This paper considers mainly the stroke amplificationand compact actuator design issues using a four-barmechanism with two flexible links and integrated PZTunimorph actuator at the input link. The detailed de-sign and characterization of the unimorph actuators aregiven in [5]. For stroke amplification, different compliantmechanisms are proposed such that Pokines [6] proposed

a microamplifier fabricated using LIGA process, Precht[7] developed a large stroke bender actuating a trailingedge flap, Kota et al. [8], [9] designed micro compli-ant mechanisms including a four-bar based mechanism,and Cox et al. constructed PZT bimorph [2] and uni-morph [10] based flapping mechanisms with compliantflexures. However, these works do not have a detailedkinematic, dynamic and quasi-static blocking force anal-ysis of the compliant mechanism for a specific task, andnone of them could have a large stroke flapping mech-anism for a micromechanical flying device (Cox et al.

achieved 30−50o flapping stroke). In this paper, detailedanalysis is realized for a micromechanical flapping wingmechanism based on a compliant four-bar structure, anda high stroke flapping mechanism is developed. Further-more, many design constraints are considered such thatthe proposed design enables a compact and light weightthorax, high torques at the wing, and high resonant fre-quency (> 25 Hz).

2 Four-Bar Thorax Structure

The complete view of the wing structure to be con-structed is shown in Figure 1. Two four-bar mechanismsconstitute the parallel thorax structures that could en-able targeted biomimetic 70− 160o stroke and 90o wingrotation motions [11] with proper stroke amplification atresonant frequency of 100 − 150 Hz. This compact de-sign assumes a flexible wing, and a fan-fold structure isproposed for this problem. The structure of the proposedfour-bar mechanism with a wing spar on it is shown inFigure 2. Two elastic beams at the input and outputlinks deflect with ∆θ and ∆ψ angles so that the cou-pler link and spar rotate with angle φ. Then the strokeamplification N of the structure can be defined as:

N =φpp

θpp

(1)

where θpp = θmax− θmin and φpp = φmax−φmin are thepeak-to-peak input and output link motions.

For the simplicity of the analysis, the input and out-put deflections are assumed to be linear, i.e. small, whichis the case for PZT unimorph actuators with moderateinput electric fields. Thus, the mechanism can be approx-imated by a four rigid link four-bar mechanism with fourrotational (4R) pin joints. Therefore, the kinematics is

Page 2: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

approximated with the rigid 4R kinematics [12] while thedynamics is characterized by utilizing the lumped model-ing of the flexible beams as can be seen in Figure 3. Forlarge motions of the unimorph flexible link, finite elementmethods can be utilized for more accurate dynamic mod-eling [13], [14].

In this proposed four-bar thorax design, if the gener-ated stroke is under the target 70−160o range due to thelimitations in the unimorph actuator motion range andoutput torques, then the multiple four-bar structure asillustrated in Figure 4 can be constructed.

Figure 1: Proposed wing structure, and its kinematic andforce parameters.

O C

AB

a

h

b

g

q y

f

y

x

( x 1 , y 1 )

( x 2 , y 2 )

f

D

E

D q D yP Z T u n i m o r p h

s t e e l b e a m

Figure 2: Four-bar mechanism with two elastic beams at theinput (OA) and output (BC) links.

3 Wing and Thorax Kinematics

In order to provide a biomimetic kinematics at the wing,the forward and inverse kinematics of the wing shownin Figure 1 are analyzed. Assuming that two four-bar

b w

b 1

k 1

b 3

k 3

m *1 m *

3

a b

h

g

L a

t q

t f

d 1

d 3

q y

f

I w

Figure 3: Lumped parameter dynamic modeling of the four-bar mechanism with two flexible beams, and a rigid spar loadwith an aerodynamic external force on it.

C

O

B

Aq

q *

a *

b *

h *

g *

a

b

g hf

y

gy *

P Z T u n i m o r p h

Figure 4: Multiple (two here) four-bar design proposal forenabling more stroke amplification if necessary.

mechanisms can be approximated as 4R rigid links, withpin joint mechanisms for simplicity, four-bar output an-gles ψ1 and ψ2 and wing spar rotations φ1 and φ2 can becomputed from the input link rotations of θ1 and θ2 as(Appendix 1):

φi = tan−1

( y2 − y1x2 − x1

)

ψi = tan−1

( y2x2 − g

)

(2)

Thus, the wing flapping and rotation angles φf and φr

as illustrated in Figure 1 can be computed as

φf = tan−1

( Z − Zo

(X −Xo)2 + (Y − Y o)2

)

≈φ1 + φ2

2

φr = tan−1

( z1 − z2√

(x2 − x1)2 + (y2 − y1)2

)

. (3)

As the inverse kinematics, θ1 and θ2 input link motionsare computed from the desired biomimetic φf and φr.At first, given φf and φr , the aim is to compute φ1 andφ2. From Eq. (3), it can be seen that φf and φr arecoupled with θi and φi nonlinearly. Therefore, a closed

Page 3: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

form solution is complex, and following simplificationscan be made: (1) Assume that (xo

1, yo1, z

o1) and (xo

2, yo2 , z

o2)

is not a function of θi, i.e. the base of the spars arenot moving, (2) (y2 − y1)

2 term is negligible in the φr

equation. Then,

tanφr ≈z1 − z2x2 − x1

(4)

Then, assuming α1 = α2 = α, φi stroke angles, θi and ψi

i = 1, 2 are computed in Appendix 2.For testing the approximation error for the inverse

kinematics equations, an insect biomimetic trajectory for±45o wing flapping and 90o rotation is used as the de-sired φf and φr as shown in Figure 5c [11]. The resultinginverse kinematics solutions in the reference four-bar ac-tuator motions of θ1 and θ2, and spar stroke motions ofφ1 and φ2 are shown in Figure 5a and 5b. Parametersof the thorax are a = 5 mm, b = 3 mm, g = 4.5 mm,h = 0.5 mm, Lt = 1 mm, La = 7 mm, α = 30o, and mo-tion bandwidth 100 Hz. By using the forward kinematicequations, computed θi and φi values are used for com-puting the φf and φr at the wing. As given in Figure 5c,it can be seen that the simplification in Eq. (4) results ina small error, and therefore it can be used for generatingthe actuator reference motion.

3.1 Size Optimization

Using kinematics equations, optimal four-bar link sizesand initial angles are drived for optimal stroke amplifi-cation N . Fixing h and PZT input voltage V , the effectof a = b = l and initial input link angle θ0 on N isinvestigated. Here, g = h + 2Lcosα due to the symme-try. Maximum PZT deflection, i.e. maximum ∆θ, canbe derived for a steel and PZT heterogenous unimorphactuator as [15]:

∆θ = 3d31

lAB

KV

K = 4spsshsh3

p + 4spssh3

shp + s2ph4

s +

s2sh4

p + 6spssh2

sh2

p

B =hs(hs + hp)

sphs + sshp

A = sssp(sphs + sshp) . (5)

where hp and hs are the thicknesses, and sp and ss arethe vertical direction compliances of the piezoelectric andsteel layers respectively, and d31 is the piezoelectric con-stant, V is the PZT actuator input voltage. For a PZT-5H piezoelectric layer, if hp = 70 µm, hs = 50 µm,sp = 2 × 10−11 m2/N , ss = 5.18 × 10−12 m2/N ,d31 = 274 × 10−12 C/N , h = 0.5 mm and V = 150 V ,φpp values could be seen in Figure 6. For large L, smallα angles result in singularity while the optimal φpp, i.e.N , can be held close to the singularity.

4 Thorax DynamicsAssuming the elastic beams are linearly bended withsmall δ1 and δ3 displacements, they are represented as

0 0.002 0.004 0.006 0.008 0.01−80

−60

−40

−20

0

20

40

60

80

time (s)

φ 1 and

φ2 (

degr

ee)

φ1

φ2

(a)

0 0.002 0.004 0.006 0.008 0.0130

32

34

36

38

40

42

44

time (s)

θ 1 and

θ2 (

degr

ee)

θ1

θ2

(b)

0 0.002 0.004 0.006 0.008 0.01−50

−40

−30

−20

−10

0

10

20

30

40

50

time (sec)

φ f and

φr (

degr

ee)

ApproximatedReference

(c)

Figure 5: Inverse kinematics simulation for the wing fortracking a biomimetic kinematic motion: (a) computed strokemotions of φ1 and φ2; (b) computed four-bar input link mo-tions of θ1 and θ2; (c) biomimetic reference (dotted lines),and approximated (solid lines) wing flapping and rotation mo-tions.

Page 4: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

Figure 6: Stroke amplification as a function of the four-barlink sizes of a = b = l, and initial input link angle whenh = 0.5 mm and input voltage V = 150 V are fixed (φpp = 0region corresponds to the singular values).

point effective masses of m∗

1= 0.24m1 and m∗

3= 0.24m3

with spring constants of k1 and k3, and damping coeffi-cients of b1 and b3 as shown in Figure 3. The coupler isa rigid link with a long rectangular bar of mass ms andlength La. bw in the figure represents the aerodynamicdamping on the spar where bw = 0 when there is no wingon the spar, and wing inertia Iw = 0.

The kinetic energy K, potential energy U and dissipa-tion energy D are computed for the equation of motionderivation as [16]

K =1

2m∗

1δ̇21

+1

2m∗

3δ̇23

+1

2I2φ̇

2 +1

2m2[a

2 + r2w2

2+

2aw2r2cos(φ− θ + β2)]θ̇2 =

1

2A(θ)θ̇2

U =1

2k1δ

2

1 +1

2k3δ

2

3 +mtgacosθ +m∗

3ghcosφ+

m2gr2cos(β2 + φ)

D =1

2b1δ̇

2

1 +1

2b3δ̇

2

3 +1

2bwφ̇

2 =1

2F0θ̇

2 . (6)

Using the Lagrange equation of

d

dt

(∂K

∂θ̇

)

−∂K

∂θ+∂U

∂θ̇+∂D

∂θ= τθ (7)

the following equation of motion is derived (Appendix

3):

Aθ̈ +1

2

dA

dθθ̇2 +D0 +D1w3 +D2w2 + F0θ̇ = τθ . (8)

As approximate lumped estimates of the resonant fre-quency ω = 2πfr and mechanical quality factor of thewing and thorax Q, following equlaties are derived:

ω2 =k1a

2 + w2

3k3b2

m∗

1a2 + w2

2I2 + w2

3m∗

3b2≈k1a

2 + w2

3k3b2

w2

2I2

Q =k1a

2 + w2

3k3b2

ω(b1 + w2

2bw + w2

3b3)

. (9)

5 DC Force Analysis

In the thorax design, one important parameter is the gen-erated torques (or lift forces) at the wing spars. If thesetorques are significantly less than the generated up ordown lift forces by the aerodynamic forces, the designswill not give enough performance. Therefore, the compu-tation of these forces for the proposed design is realizedfor performance evaluation.

Assuming the 4-bar input link is rotated by a small δθby applying an input voltage V through the input linkunimorph actuator, and the motion is quasi-static (DCmotion), resulting spar motion δφ and blocking torque τφhave the following relation using the principle of virtual

work:

δWv = τθδθ + τφδφ = δU = k1a2∆θδθ + k3b

2∆ψδψ .(10)

Here, the gravitational terms are neglected. For a con-stant δt, δφ = w2δθ and δψ = w3δθ. Thus,

τθ + w2τφ = k1a2∆θ + k3b

2w3∆ψ . (11)

Here, unimorph actuator tip torque τθ can be given as:

τθ = −aFb = −3

4d31wBV (12)

where w is the unimorph width. For stiffnesses:

k1 =Kw

4Aa3

k3 =wh3

s

4b3ss

(13)

Using above equations, the blocking torque at the sparend is computed as:

τφ =1

w2

(3

4d31wBV + k1a

2∆θ + k3b2w3∆ψ) . (14)

The lift force on the ith (i = 1, 2) wing spar generatedby the above torque can be computed as F i

φ = τ iφ/La.

Then the average lift force and drag force at the wingrotation axis edge are:

Flift = −(F 1

φcosα1cosφ1 + F 2

φcosα2cosφ2)/2

Fdrag = F 1

φsinα1sinφ1 − F2

φsinα2sinφ2 . (15)

Denoting the measured aerodynamic lift and dragforces as Fl and Fd, Flift ≥ −Fl and Fdrag ≥ −Fd equal-ities should be held at each instant for enabling sufficientforces for flight with any thorax and wing design.

6 Thorax Fabrication

Assembly process of the four-bar with spar is shown inFigure 7. Super glue is used for attaching a steel baseto the unimorph for fixing it to the base frame, conduc-tive epoxy is used for the cable connection to the uni-morph actuator, and the unimorph ground cable is sol-dered to the steel beam. The top link joint is designedby a polyester flexible sheet of 12.5 µm thickness, and

Page 5: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

is cut by a laser micromachining device. Fabrication re-sult for PZT-5H and PZN-PT based unimorph actuatorsare displayed in Figure 8. In Figure 8b, a polyester wingwith 100 µm thickness is also attached for flapping ex-periments.

( a )

( b )

s p a r

p o l y e s t e r

P Z T / P Z N - P T

s t e e l

t o p l i n k

c a b l e s

Figure 7: Assembly process of the unimorph and steel beamwith polyester flexible joints: (a) horizontal assembly of input,output and top links and steel spar, (b) assembly with thehollow rectangular steel base.

7 Simulation and Experiments

For the simulations of a four-bar mechanism with thebonded PZN-PT actuator and steel at the input link,the parameters are: a = l = 5 mm, w = 1 mm, b =3 mm, g = 4.5 mm, h = 0.5 mm, La = 7 mm, α1 =α2 = 30o, Lt = 1 mm, hp = hs = 50µm, sp = 65 ×10−12 m2/N , ss = 5.18× 10−12 m2/N , and d31 = 950×10−12 C/N . Thus, k1 = 94.85 N/m, k3 = 48.26 N/m,m1 = 2.05 mg and m3 = 1.9 mg. For these values inputlink DC motions are θ1 = θ0

1±6o and θ2 = θ0

2±5.78o with

θ01

= 36.54o and θ02

= 36.89o as shown in Figure 9a. ThenDC kinematic spar motions are given in Figure 9b. Fordifferent electric fields of E1,2 ∈ [−5, 5] V/µm, the rangeof actuator and spar torques, and lifting and drag forcesare given in Figures 10 and 11 respectively. Since theaerodynamic lift force would be equal or twice the weightof the overall flying robot which is designed for overallweight of 1 mN [1], the aerodynamic loading would bein the range of 0.7− 1.4× 10−5 Nm where the resultanttorques in Figure 10 with the range of [−5, 4]×10−5 Nmcan handle this range of forces.

Next, the fabricated four-bar in Figure 8b without awing at the beginning was tested. Motion of the sparfor θpp = 4o unimorph deflection is shown in Figure 12.Here a = b = 10 mm, h = 0.5 mm and V = ±150 V .

(a)

(b)

Figure 8: Fabrication results of unimorph and steel beaminput and output links with polyester flexible joints assembly:(a) 5 × 1× 0.25 mm3 PZN-PT unimorph based four-bar andspar, (b) 10 × 1 × 0.12 mm3 PZT unimorph based four-barwith a rigid polyester wing.

The up and down strokes are also observed with an op-tical microscope as displayed in Figure 13. The spar hasa stroke of 80− 90o at resonance of 32 Hz. This meansN ≈ 22 is achieved which is coinciding with the size op-timization graph in Figure 6. On the other hand, fromEq. (9), fr = ω/2π = 61 Hz is estimated by the valuesof k1 = 43.7 N/m, k3 = 24.1 N/m, Q1 = 22, Q3 = 35,m1 = 9.4 mg, m3 = 3.9 mg, I2 = 1.14 × 10−10 kgm2,w2 = 20, and w3 = 1. Here, the loss in the frequency isdue to the neglected polyester flexure compliance. Then,the wing is attached and the motion of the four-bar istested as displayed in Figure 14. The stroke motion be-comes around 90− 100o with resonance at 29 Hz. Thisshows that the attached wing does not result in signifi-cant damping due to the aerodynamic forces (bw in Figure3). However, if the area and size of the polyester wing isincreased more, at some point the aerodynamic dampingwould become significant.

Finally, dependency of N on θ0 is tested experimen-tally for a = b = L = 10 mm for a small motion case(V = 100 V ). The plot of the N vs. the stroke ampli-tude (φpp) is shown in Figure 15a. Here, there are twooptimal values of θ0 where one is around 35o and theother is around 70o. The latter is expected from Figure6 while the former is not modeled (in the singular re-

Page 6: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

30 32 34 36 38 40 42−70

−50

−30

−10

10

30

50

70

θ1 and θ

2 (degree)

φ 1 and

φ2 (

degr

ee)

φ1 vs. θ

2 vs. θ

2

Figure 9: Simulated spar motion due to the given input mo-tions: first spar (’o’), and second spar (’+’).

gion in Figure 6), and could be due to the flexible jointmechanism. Furthermore, θ0 also changes the resonantfrequency as can be seen in Figure 15b. This is due tothe change in the load on the PZT actuator dependingon θ0.

8 Conclusion

In this paper, a four-bar mechanism with two flexiblelinks is proposed to be used in a micromechanical flyinginsect thorax design for stroke amplification. PZT andPZN-PT unimorph actuators are utilized at the inputlink of the four-bar. The kinematics, dynamics and quasi-static force analsis of the proposed wing strcuture is real-ized. Using laser micromachining and folding techniques,prototype four-bars are constructed, and it is shown thatthe single four-bar structure can have 90 − 100o strokemotion at 29 Hz with a rigid polyester wing on it. Asthe future work, the rotational motion of the wing is tobe realized with a flexible wing, the resonant frequencyof the four-bar mechanism is to be increased by optimiz-ing the wing load, flexure stiffness, output force and Nvalues, and blocking force measurements will be realizedand compared with simulations.

Acknowledgements

This work was funded by ONR MURI N00014-98-1-0671,

ONR DURIP N00014-99-1-0720 and DARPA. The author

would like to thank Ronald S. Fearing for his comments and

discussions, and Joseph Yan for helping in assembly and fold-

ing process.

Appendix 1: Forward Kinematics

x1 = acosθi

y1 = asinθi

x2 = g −CD ±√

(CD − g)2 − (1 +C2)(g2 − b2 +D2)

y2 = Cx2 +D

C =g − acosθi

asinθi

−70 −50 −30 −10 10 30 50 70−5

−4

−3

−2

−1

0

1

2

3

4

5x 10

−5

φ1 (degree)

τ φ1 (N

m)

(a)

−70 −50 −30 −10 10 30 50 70−5

−4

−3

−2

−1

0

1

2

3

4

5x 10

−5

φ2 (degree)

τ φ2 (N

m)

(b)

Figure 10: For electric fields of E1,2 ∈ [−5, 5] V/µm: (a) τ 1

φ

and (b) τ 2

φ blocking torques at the spar ends.

D =b2 − g2 + a2 − h2

2asinθi

(X,Y, Z) = (x1 + x2

2,y1 + y2

2,z1 + z2

2)

(Xo, Y o, Zo) = (xo

1 + xo2

2,yo1 + yo

2

2,zo1 + zo

2

2)

(x1, y1, z1) = (xo1 − Lacosφ1sinα1, y

o1 + Lacosφ1cosα1,

zo1 + Lasinφ1)

(x2, y2, z2) = (xo2 + Lacosφ2sinα2, y

o2 + Lacosφ2cosα2,

zo2 + Lasinφ2)

(xo1, y

o1 , z

o1) = (0,

h

2sinφ1 + asinθ1, g −

h

2cosφ1 − acosθ1)

(xo2, y

o2 , z

o2) = (Lt,

h

2sinφ2 + asinθ2, g −

h

2cosφ2 − acosθ2)

where a, b, g and h are the four-bar link lengths for bothfour-bars as illustrated in Figure 2, and i = 1, 2 shows theindex number for the four-bars, La is the spar length, Lw

is the wing cord length, Lt is the separation distance of twofour-bars, and α1 and α2 are the pan angles of the spars.

Page 7: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

−50 −30 −10 10 30 50−5

−3

−1

1

3

5

x 10−3

−φf (degree)

Flif

t (N

)DOWN STROKE

UP STROKE

(a)

−50 −40 −30 −20 −10 0 10 20 30 40 50−4

−3

−2

−1

0

1

2

3

4x 10

−3

−φf (degree)

Fdr

ag (

N)

DOWN STROKE

UP STROKE

(b)

Figure 11: Spar end lifting and drag forces: (a) Flift, and(b) Fdrag forces at the wing cord center.

Appendix 2: Inverse Kinematics

φ1 = cos−1

(−BD ±C√−B2 +C2 +D2

C2 +D2

)

φ2 = p− φ1

p = 2φf

A = sinαtanφr

B = tanφrLt/La

C = cosp−Asinp+ 1

D = A(1 + cosp) + sinp

θi = tan−1

(

y1x1

)

ψi = tan−1

(

y2x2 − g

)

x1 =−EF ±

E2F 2 − (F 2 − a2)(1 +E2)

1 +E2

y1 = Ex1 + F

x2 = x1 + hcosφi

f p p = 8 0 - 9 0 o

P Z T u n i m o r p h

s t e e lb e a m

p o l y e s t e r j o i n t s

w i n g s p a r

Figure 12: Four-bar and spar motion at resonance (32 Hz)with ±2o unimorph motion input.

(a) (b)

Figure 13: PZT-5H unimorph actuated spar motion at res-onance (33 Hz) with ±2o unimorph motion input: (a) downstroke, (b) up stroke.

(a) (b)

Figure 14: PZT-5H unimorph actuated wing motion at res-onance (29 Hz): (a) down stroke, (b) up stroke.

10 20 30 40 50 60 7018

20

22

24

26

28

30

32

34

36

θ0 (degree)

Str

oke

Am

plitu

de (

degr

ee)

10 20 30 40 50 60 7023

24

25

26

27

28

29

30

31

32

θ0 (degree)

Res

onan

t Fre

quen

cy (

Hz)

(a) (b)

Figure 15: Effect of θ0 on (a) stroke amplitude, (b) resonantfrequency.

Page 8: PZT Actuated Four-Bar Mechanism with Two Flexible Links ...ronf/PAPERS/icra01_design1.pdf · PZT Actuated Four-Bar Mechanism with Two Flexible Links for Micromechanical Flying Insect

y2 = y1 + hsinφi

E =−hcosφi + g

hsinφi

F =b2 + 2ghcosφi − h2 − g2 − a2

2hsinφi

. (16)

For x1, ’±’ becomes ’+’ for φi ≥ 0, and ’−’ else.

Appendix 3: Dynamics Parameters

δ1 ≈ a∆θ

δ3 ≈ b∆ψ

∆θ = θ − θ0∆ψ = ψ − ψ0

φ̇ = w2θ̇

ψ̇ = w3θ̇

w2 =dφ

dθ=asin(π + ψ − θ)hsin(φ− π − ψ)

w3 =dψ

dθ=

asin(φ− θ)bsin(π + ψ − φ)

mt = m∗

1 +m2 +m∗

3

m2 = mφ +ms +mw ≈ ms +mw

I2 = Iw +msL

2

a

3

x =(ms +mw)La/2

mφ + (ms +mw)≈ La

2

β2 = tan−1

(

2x

h

)

r2 =h

2cosβ2

,

A(θ) = C0 +C1w2

2 +C2w2

3 + C3w2cos(φ− θ + β2)

dA

dθ= 2C1w2

dw2

dθ+ 2C2w3

dw3

dθ+C3

{

dw2

dθcos(φ− θ + δ2)

−w2(w2 − 1)sin(φ− θ + δ2)}

C0 = m∗

1a2 +m2a

2

C1 = I2

C2 = m∗

3b2

C3 = 2ar2m2

dw2

dθ=

a(C4 + C5)

hsin2(φ− ψ)

dw3

dθ=

a(C6 +C7)

bsin2(φ− ψ)

C4 = (w3 − 1)sin(φ− ψ)cos(ψ − θ)C5 = sin(ψ − θ)cos(φ− ψ)(w3 − w2)

C6 = (w2 − 1)sin(φ− ψ)cos(φ− θ)C7 = sin(φ− θ)cos(φ− ψ)(w3 − w2)

F0 = b1a2 + b3b

2w2

3 + bww2

2 ,

D0 = k1a2∆θ −mtgasinθ ,

D1 = k3b2∆ψ ,

D2 = −m∗

3ghsinφ−m2gr2cos(β2 + φ)

where θ0 and ψ0 are the initial link angles, mw is the wing

mass, mφ is the top link mass, and ms is the spar mass.

References

[1] R. Fearing, K. Chiang, M. Dickinson, D. Pick, M. Sitti,and J. Yan, “Transmission mechanism for a microme-chanical flying insect,” in Proc. of the IEEE Int. Conf.on Robotics and Automation, pp. 1509–1516, San Fran-cisco, CA USA, Apr. 2000.

[2] A. Cox, E. Garcia, and M. Goldfarb, “Actuator devel-opment for a flapping microrobotic microaerial vehicle,”in SPIE Microrobotics Symposium, Nov. 1998, Boston,USA.

[3] I. Shimoyama, H. Miura, K. Suzuki, and Y. Ezura,“Insect-like microrobots with external skeletons,” IEEEControl Systems Magazine, vol. 13, no. 1, pp. 37–41,1993.

[4] J. Yan, R. Wood, S. Avandhanula, M. Sitti, and R. Fear-ing, “Towards flapping wing control for a micromechan-ical flying insect,” in Proc. of the IEEE Int. Conf. onRobotics and Automation, Korea, 2001 (to appear).

[5] M. Sitti, D. Campolo, J. Yan, R. Fearing, T. Su, D. Tay-lor, and T. Sands, “Development of PZT and PZN-PT based unimorph actuators for micromechanical flap-ping mechanisms,” in Proc. of the IEEE Int. Conf. onRobotics and Automation, Korea, 2001 (to appear).

[6] B. Pokines and E. Garcia, “A smart material microam-plification mechanism fabricated using LIGA,” SmartMater. Struct., vol. 7, pp. 105–112, 1998.

[7] E. Precht and S. Hall, “Design of a high efficiency,large stroke, electromechanical actuator,” Smart Mater.Struct., vol. 8, pp. 13–30, 1999.

[8] S. Kota, J. Hetrick, Z. Li, and L. Saggere, “Tailoringunconventional actuators using compliant transmissions:Design methods and applications,” IEEE/ASME Trans.on Mechatronics, vol. 4, pp. 396–408, Dec. 1999.

[9] S. Kota, J. Hetrick, Z. Li, S. Rodgers, and T. Krygowski,“Synthesizing high-performance compliant stroke ampli-fication systems for MEMS,” in Proc. of the MEMS,2000.

[10] A. Cox, D. Monopoli, and M. Goldfarb, “Developmentof piezoelectrically actuated elastodynamic flapping mi-croaerial devices,” in ASME Adaptive Structures andMaterial Systems, pp. 257–262, 1999.

[11] M. Dickinson, F.-O. Lehnman, and S. Sane, “Wing rota-tion and the aerodynamic basis of insect flight,” Science,vol. 284, pp. 2085–2104, 18 June 1999.

[12] J. M. McCarthy, Geometric Design of Linkages. SpringerVerlag, New York, 2000.

[13] Y. Wang and Z.Wang, “A temporal finite elementmethod for the dynamic analysis of flexible mechanisms,”Journal of Sound and Vibration, vol. 213, no. 3, pp. 569–576, 1998.

[14] M. Karkoub and A. Yigit, “Vibration control of a four-bar mechanism with a flexible coupler link,” Journal ofSound and Vibration, vol. 222, pp. 171–189, 29 April1999.

[15] J. Smits and W. Choi, “The constituent equations ofpiezoelectric heterogenous bimorphs,” IEEE Tran. onUltrasonics, Ferroelectrics, and Freq. Control, vol. 38,pp. 256–270, May 1991.

[16] W. Zhang, Q. Li, and L. Guo, “Integrated design ofmechanical structure and control algorithm for a pro-grammable four-bar linkage,” IEEE/ASME Trans. onMechatronics, vol. 4, pp. 354–362, Dec 1999.


Recommended