20
1 م ي ح ر ل ا ن م ح ر ل له ا ل م ا س بAN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Embed Size (px)

Citation preview

Page 1: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

1

الرحيم الرحمن الله بسمAN-NAJAH NATIONAL UNIVERSITY

DEPARTMENT OF MECHANICAL ENGINEERING

MANIPULATOR

( DESIGN AND CONTROL )

Page 2: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

2

Introduction to Robotics

Manipulator Kinematics

Trajectory Generation

Motor Selection

Design of Prototype

Control of Manipulator

Page 3: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

The word "Robot" comes from the Czech word "Robota" which means "labor doing compulsory manual works without receiving any remuneration

Robotic device that can automatically control these are programmable

Robotic device that can automatically control these are programmable

Characteristics:

1. Unchanging.

2. Unthinking.

3. Untiring.

3

Introduction to RoboticsIntroduction to Robotics

Page 4: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Today robots perform many tasks:Today robots perform many tasks:

Make life easier on the people.To help people.The ability to work in hazardous conditions.Work on things that may be boring to us.

4

Introduction to RoboticsIntroduction to Robotics

Page 5: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Welding applications

Applications in Our LifeApplications in Our Life

Spray painting applications

5

Introduction to RoboticsIntroduction to Robotics

Page 6: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Medical Robotics

Space robotics

6

Introduction to RoboticsIntroduction to Robotics

Page 7: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Kinds of robot :Kinds of robot :

Parallel robot Serial robots

7

Introduction to RoboticsIntroduction to Robotics

Page 8: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

8

Introduction to RoboticsIntroduction to Robotics

Page 9: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

9

Page 10: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Inverse Kinematics

Given a desired position

(X,Y,Z)

(1 … n )

Find the joint variables

which can bring the robot

to the desired configuration.

x

y

z

10

Inverse KinematicsInverse Kinematics

Page 11: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Forward K

Inverse K

Joint variables

(1 … n)

Position of the end-effector

(X,Y,Z)Workspace: volume of space which can be reached by the end effector.

Factor that effect the workspace of a robot:

1.Limitation on joint angles.

2. Limitation on the number of degree of freedom of the robot.

11

Inverse KinematicsInverse Kinematics

Page 12: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Method of solutionMethod of solution

Solutions

numerical solutionsnumerical solutions closed form solutionsclosed form solutions

Only returns a single solution

Too many iterations

Unknown number of operations to solve.

many solution

No need for iteration

(direct solution)

12

Inverse KinematicsInverse Kinematics

Page 13: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Closed-form SolutionsClosed-form Solutions

We are interested in closed-form solutions:

1. Algebraic methods

2. Geometric methods

TTTTTBE23

12

01

03

13

Inverse KinematicsInverse Kinematics

Page 14: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Z

X

Y

OO

ө3

180

-ө3

X,Y,Z

L2

L3

d

Z

Distance from origin at this point

ө2

α

β

14

Inverse KinematicsInverse Kinematics

Page 15: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

Jacobians : Velocities and Static Force

15

Jacobian can also be used to compute the set of {Joint Torques} required to generate them.

Jacobians : Velocities and Static ForceJacobians : Velocities and Static Force

)(44 JV

gularitynonJ

ingularityJ

sin:0]det[

s:0]det[

Workspace boundary singularities:

Occur when the manipulator is fully starched

F44 TJ

Page 16: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

16

Trajectory Generation

move a manipulator from its initial position to some desired goal position in a smooth manner

Trajectory GenerationTrajectory Generation

Page 17: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

17

Cubic PolynomialsCubic Polynomials

33

2210)( tatataat

.0)(,0)0(

,)(,)0( 0

f

ff

t

t

: initial and final values

).(2

),(3

,0

,

033

022

1

00

ff

ff

ta

ta

a

a

Trajectory GenerationTrajectory Generation

Page 18: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

18

Motor Selection

AC MotorAC Motor

•Speed

•Cooling

•Controls

•Speed

•Cooling

•Controls

Motor SelectionMotor Selection

Page 19: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

19

DC MotorDC Motor

•Electrical noise

•Reliability

•Speed

•Cooling

•Electrical noise

•Reliability

•Speed

•Cooling

Motor SelectionMotor Selection

Page 20: 1 بسم الله الرحمن الرحيم AN-NAJAH NATIONAL UNIVERSITY DEPARTMENT OF MECHANICAL ENGINEERING MANIPULATOR ( DESIGN AND CONTROL )

20

Stepper MotorStepper Motor

•Stepping speed

•Cooling

•Open loop operation

•Stepping speed

•Cooling

•Open loop operation

Motor SelectionMotor Selection