You are on page 1of 35

B.

TECH
PROJECT
Design and Development of 3-DOF
PPR Platform for Micro Fabrication
and
Positioning
Under
the Guidance
Dr. M. Santhakumar
Presented
by

Ramavatar
Meena
Roll No. - 1000316
B.Tech 4th year (ME)
IIT Indore
2/16/16

Sandip Patidar
Roll No. - 1000322
B.Tech 4th year (ME)
IIT Indore
Mechanical Engineering

Jayant Kr.
Mohanta
Roll No. - 1000326
B.Tech 4th year (ME)
IIT Indore
1

Acknowledgement
Wewould like to express our special thanks of gratitude to
our guide Dr. M. Santhakumar who gave us the golden
opportunity to do this wonderful project on the topic
Design and Development of 3-DOF PPR Platform for
Micro Fabrication and Positioning Applicationwhich
also helped us in doing a lot of Research and we came to
know about so many new things. We are really thankful to
them. Secondly we would also like to thank my parents and
friends who helped us a lot in finalizing this project within
the limited time frame.
2/16/16

Mechanical Engineering

PROJECT OVERVIEW
Performance analysis
PID
EW
I
V
R
E
V
O

Fabrication
SMC

Control system design


T
C
JE
O
R
P
Mathematical modeling
& Simulation

Kinematic
Analysis
Workspace
Analysis

Selection of
actuators and
sensors

Simulation
Dynamic
Analysis

Concept design
2/16/16
2/16/16
2/16/16

Mechanical Engineering

3
3 3

INTRODUCTION
SKF Linear Actuator Specifications

SKF Linear Actuator

Voltage

12V

Maximum Load

500N

Current at maximum pay load

4 Amp

Stroke length

250mm

MICROSOFT CAMSTUDIO

2/16/16

Mechanical Engineering

PHYSICAL
MODEL

2/16/16

Mechanical Engineering

PHYSICAL PROPERTIES OF
PROPOSED SYSTEM

2/16/16

Mass of Slider 1

410g

Mass of Slider 2

420g

Mass of Slider 3

420g

Links Masses (1; 2 &3)

285g

Platform

100g

Width of Platform

120mm

Mass moment of Inertia

245000g*mm^2

Mechanical Engineering

CONCEPTUAL AND FRAME


DIAGRAM
endeffecto
r frame

Active
prismatic
joint 3

Passive
joint

Guide ways for


prismatic
joints
Inerti
al
frame
2/16/16

Passive
joint

Work
table

Passive
joint

Active
prismatic
joint 2

Rotary
joints

Number of links
=8
Number of joints
=9
Degrees of freedom = 3 (81) 2 (9) = 3

Active
prismatic
joint 1

Mechanical Engineering

FORWARD AND INVERSE KINEMATICS


SOLUTION
Forward kinematic model
h
x r1
* ( r2 r3 )
a
r2 r3
y
2
( r2 r3 )
sin( z )
a

Inverse kinematic
r1 x h * sin( z )
model
r2
r3
2/16/16

where,

r1 , r2 and r3 are prismatic


joint displacements (joint
parameters)
a is the width of
triangular Platform (end
effector)
x and y are the
endeffector (work table /
tool) positions

(sin z)
y a*
2
(sin z )
y a*
2

z is the yaw angle of the


endeffector from the
inertial frame
Mechanical Engineering

WORKSPACE
AREA

Fig: 3 Workspace area of proposed mechanism


2/16/16

Mechanical Engineering

Velocity Analysis (Jacobian


Matrix)
x

Joint space velocities to task space velocities


r1
r and
Where y
are task space velocities
2

joint space
r3
z velocities.

are

h
h

x
1

a
a
y 0

1
/
2
1
/
2

z
0 1 /(a * cos( z )) 1 /( a * cos( z ))

r1
r
2

r3

Use this relation for deriving kinetic energy of the


robotic platform. Therefore, total kinetic energy is in
terms of joint space variables.
2/16/16

Mechanical Engineering

10

Velocity Analysis continued...


If J0, The matrix is non-singular, then we can invert it to calculate
joint rates from given Cartesian velocities.

r1
r
2
r3

x
1

y

z

Singular Condition J=0,

z 90
Maximum allowable yaw angle is
-60 to 60

60 z 60

Square
Trajector
y
2/16/16

Circular
Trajector
y
Mechanical Engineering

11

DYNAMIC
ANALYSIS
It is an energy based
approach.

Since, it is planar platform potential energy of the robotic


platform considered to be zero.
Total kinetic energy (KE) of the robotic platform is sum of
individual prismatic (slider) joint kinematic energies, Link
kinematic energies and workT table kinetic energy
T

1
1
1
* ms 2 r2 2 * ms 3 r3 2
2
2
2
Sliders Kinetic
T
.
Energies

T
.
.
x. m p

0 x3
1
x3 ml 3

* y 0
0
.
.
.
m
2
l3 y
y3
0
3

KE

1
*
2

.
* ms1 r12

1 x1
* .
2
y1
0
mp
0

Kinetic energy of Platform


2/16/16

ml1
0

.
.
0 x1
1 x2

* .

ml1
2
y
y
1
2

ml 2
0

.
0 x2

ml 2
y2

0 x
.
0 y
.

I zzp

Links Kinetic Energies


Platform Kinetic
Energy

Mechanical Engineering

12

DYNAMIC ANALYSIS
Joint forces CONTINUED
can be derived from the following relation as given
below:
d KE KE


fi

dt ri
ri

By combining all input variables and formulating the


equations of motion of the platform in state space form as
follows:
T

M C , dis

Where
M

is inertia matrix

C , Is the Coriolis and centripetal

r1 r2

2/16/16

m12
m 22
m32

m13
m 23
m33

r3 T , r1 r2

f1 f 2 f 3 T
Disturbance vector dis idis edis

matrix

m11
M m 21
m31

r3 , r1 r2

n1
C , n 2
n3
Mechanical Engineering

idis
edis

r3 T

Internal Disturbance
(Process and
measurement noise)
External
Disturbance
(payload variation,
vibration..)
13

DYNAMIC ANALYSIS
m11 M

M s1 3 * M l

m12

h
a

m13

(M

h
a

m21
m22

m23

(M

h
a

(M

CONTINUED

2*Ml )

2*Ml )
p

2* Ml )

1
h

4
a

1
h

4
a

m31

h
a

(M

n2

n 3

*M

*M

h
m l *
3

3 I zz
a 3

2/16/16

I zz
* sec z
a2

I zz
* sec z
a2

I zz
* sec z
a2

I zz
* sec z
a2

5
h

a
4


1
h

a
4

M s2

M s2

m l *
3


h
1
M s 2

a
4

5
h

a
4

M s3

1
ml
sec
tan z m l
2a
2a 2

I zz

tan z
tan z

h * tan 2 * h
z

a
a

2 * h

m
l

m
l

2*Ml )

*M

1
h

4
a

n1 0

*M

1
h
m32

4
a

m33

m l 1

2a

tan m
z
l

h
2a 2


sec

tan z 2

tan z

m
l

2*

h * tan 2 * h
z

a
a

.
.

h
3
2
2
m l 2 sec z r2 r3
a

..
.

3
2
2
m l 2 sec z r2 r3
a

Mechanical Engineering

m
l

* r r
3
2

* r r
3
2

14

DYNAMIC
SIMULATION

Dynamic Simulation with 1 N


2/16/16

Mechanical Engineering

15

CONTROLLER
DESIGN

Simulation
Cases
PID Controller

Proposed Controller (Sliding Mode


Controller)

Desired
Trajectory
Task 1t<=15;
Task-2

Y=0.1;

t<=15+31.4

X 0.4 0.2 * sin(0.1* )


Y 0.3 0.2 * cos(0.1* )
Task-3
t<=15+31.4+15

Y
2/16/16

(4 * X 0.1)
3
Mechanical Engineering

16

PID
CONTROLLER

The robotic control of PID controller


is given by
~
~
~

M d K D K P K I C , dis

2/16/16

Mechanical Engineering

17

RESULT AND DISCUSSION OF PID


CONTROLLER

Desired Trajectory Vs Actual Trajectory


(SMC) Tracking

PID controller Error

2/16/16

Mechanical Engineering

18

RESULT AND DISCUSSION OF PID


CONTROLLER

Joint Position Vs time

Joint Velocity Vs
time

2/16/16

Mechanical Engineering

19

RESULT AND DISCUSSION OF PID


CONTROLLER
ask Position Vs time

2/16/16

Mechanical Engineering

20

PROPOSED CONTROLLER (SMC WITH


DISTURBANCE OBSERVER)
Why Disturbance Observer
Un-modelled Dynamics
Unknown Disturbance
Lack of Sensors

2/16/16

Mechanical Engineering

21

MODE CONTROL WITH DISTURBANCE OBSERVER CONTI

2/16/16

Mechanical Engineering

22

RESULT AND DISCUSSION OF SMC CONTROLLER


Desired Trajectory Vs Actual Trajectory (SMC)
Tracking

SMC controller Error

2/16/16

Mechanical Engineering

23

RESULT AND DISCUSSION OF SMC CONTROLLER


Joint Position Vs time

Joint velocity Vs time

2/16/16
2/16/16

Mechanical Engineering

24

RESULT AND DISCUSSION OF SMC CONTROLLER


Joint velocity Vs
time

2/16/16
2/16/16

Mechanical Engineering

25

TRACKING RESULT B/W DESIRED, PID AND SM

2/16/16
2/16/16

Mechanical Engineering

26

ERROR COMPARISION PID


AND SMC

2/16/16
2/16/16

Mechanical Engineering

27

DESIGN
VALIDATION
Tracking
Using
Camera

PC with
MATLAB
Simulink

Feedback

2/16/16
2/16/16

Mechanical Engineering

Ardunio
and Motor
Drivers

Actuators

28

DESIGN VALIDATION
t to point openCONT.....
and closed loop Control

2/16/16
2/16/16

Mechanical Engineering

29

TRACKING USING CAMERA

2/16/16
2/16/16

Mechanical Engineering

30

RESULT SUMMARY
Kinematic Design of mechanism Verified
Dynamic Model of 3PPR verified
Controller Used PID and SMC- Better result are obtained on using
efficient control scheme
Closed controller established using sensor feedback
Final position of end effector tracked using camera

2/16/16
2/16/16

Mechanical Engineering

31

LIVE DEMO
Video 1 Point to Point trajectory with
Feedback

2/16/16
2/16/16

Mechanical Engineering

32

LIVE DEMO

Video 2 Square, Inclined Base trajectory

2/16/16
2/16/16

Mechanical Engineering

33

LIVE DEMO
Video 3: Square (Parallel Base)

2/16/16
2/16/16

Mechanical Engineering

34

k
n
a
h
T
u
o
Y
2/16/16
2/16/16

Mechanical Engineering

35