Study and implementation of industrial robots dynamic controllers in real time
Download
1 / 31

Study and Implementation of Industrial Robots Dynamic Controllers in Real-Time - PowerPoint PPT Presentation


  • 378 Views
  • Uploaded on

Study and Implementation of Industrial Robots Dynamic Controllers in Real-Time. Name: Núria Rosillo Guerrero Faculty: Computer Science Engineering Department: Mathematics Science and Computation . Universidad Cardenal Herrera CEU Halmstad, 10.03.14. PUMA 560 Architecture. Robot Arm.

loader
I am the owner, or an agent authorized to act on behalf of the owner, of the copyrighted work described.
capcha
Download Presentation

PowerPoint Slideshow about 'Study and Implementation of Industrial Robots Dynamic Controllers in Real-Time' - Sharon_Dale


An Image/Link below is provided (as is) to download presentation

Download Policy: Content on the Website is provided to you AS IS for your information and personal use and may not be sold / licensed / shared on other websites without getting consent from its author.While downloading, if for some reason you are not able to download a presentation, the publisher may have deleted the file from their server.


- - - - - - - - - - - - - - - - - - - - - - - - - - E N D - - - - - - - - - - - - - - - - - - - - - - - - - -
Presentation Transcript
Study and implementation of industrial robots dynamic controllers in real time l.jpg
Study and Implementation of Industrial Robots Dynamic Controllers in Real-Time

Name:

Núria Rosillo Guerrero

Faculty:

Computer Science Engineering

Department:

Mathematics Science and Computation

Universidad Cardenal Herrera CEU

Halmstad, 10.03.14

Núria Rosillo Guerrero


Puma 560 architecture l.jpg
PUMA 560 Architecture Controllers in Real-Time

Robot Arm

Control Wardrobe

Original Architecture

Núria Rosillo Guerrero


Puma 560 architecture3 l.jpg
PUMA 560 Architecture Controllers in Real-Time

Robot Arm

Núria Rosillo Guerrero


Puma 560 architecture4 l.jpg
PUMA 560 Architecture Controllers in Real-Time

Control Wardrobe

  • Power Tray.

  • Control Panel.

  • Control Module.

  • I/O Module.

  • Amplifier Module.

Núria Rosillo Guerrero


Puma 560 architecture5 l.jpg
PUMA 560 Architecture Controllers in Real-Time

Original Architecture

...

Núria Rosillo Guerrero


Puma 560 architecture6 l.jpg
PUMA 560 Architecture Controllers in Real-Time

Original Architecture

  • LSI –11/02 Processor.

  • Digital Servos.

  • Analogical Servos.

  • Amplifiers.

  • Incremental encoders.

  • Potentiometers.

...

Núria Rosillo Guerrero


Puma 560 architecture7 l.jpg
PUMA 560 Architecture Controllers in Real-Time

Original Architecture

Núria Rosillo Guerrero


Opened control architecture l.jpg
Opened Control Architecture Controllers in Real-Time

...

Núria Rosillo Guerrero


Opened control architecture9 l.jpg
Opened Control Architecture Controllers in Real-Time

...

Núria Rosillo Guerrero


Opened control architecture10 l.jpg
Opened Control Architecture Controllers in Real-Time

  • PCL-812.

  • PCL-833.

  • PCL-726.

...

Núria Rosillo Guerrero


Opened control architecture11 l.jpg
Opened Control Architecture Controllers in Real-Time

...

Núria Rosillo Guerrero


Opened control architecture12 l.jpg
Opened Control Architecture Controllers in Real-Time

  • Brake circuit

  • Original braking system.

  • Brake control by computer.

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

...

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation14 l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

Solve the Inverse Dynamic Problem

Gibbs’s Function :

Gibbs’s function for the solid i is given by

...

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation15 l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

Solve the Inverse Dynamic Problem

If we express the tensorial and vectorial magnitudes considering a reference system located in the iesim bar.

For a system consisting of n bodies, Gibbs’s function could be given by:

...

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation16 l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

Solve the Inverse Dynamic Problem

The Gibbs-Appell’s movements equations are obtained leading respect to the generalized accelerations , of that way we obtain the inertial forces that correspond to the generalized external forces j

Operating:

...

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation17 l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

Complexity n algorism

From D-H and off-line:

With a recursive way:

A term:

B term:

...

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation18 l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

Complexity n algorism

...

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation19 l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

Direct Dynamic Problem

Algorism that simulate the dynamic behavior of industrial robot.

General form of the movement equation:

Obtaining BIAS vector:

Obtaining gravity vector:

...

Núria Rosillo Guerrero


Obtaining of robots dynamic model by gibbs appell formulation20 l.jpg
Obtaining of Robots dynamic model by Gibbs-Appell formulation

Direct Dynamic Problem

Obtaining the system inertias matrix.

Núria Rosillo Guerrero


Movement simulation through the dynamic model l.jpg
Movement simulation through the Dynamic Model formulation

qd

q, v, a

Controller

Simulator

Dynamic equation:

DDP: IDP

System to solve:

...

Núria Rosillo Guerrero


Movement simulation through the dynamic model22 l.jpg
Movement simulation through the Dynamic Model formulation

Results

Núria Rosillo Guerrero


Control of manipulators robots l.jpg
Control of manipulators Robots formulation

Development of a general expression to the controllers by passiveness and inverse dynamic

 = Mâ + C + G

...

Núria Rosillo Guerrero


Control of manipulators robots24 l.jpg
Control of manipulators Robots formulation

Control by passiveness

The control based in the passiveness with point to point strategies can be seen as particular cases of this control law.

We obtain the gravitational term a partir de:

doing that and

...

Núria Rosillo Guerrero


Control of manipulators robots25 l.jpg
Control of manipulators Robots formulation

...

Núria Rosillo Guerrero


Control of manipulators robots26 l.jpg
Control of manipulators Robots formulation

Control by passiveness

...

Núria Rosillo Guerrero


Control of manipulators robots27 l.jpg

Type of control over the trajectory formulation

a

Point to point

Follow-up of the trajectory

Follow-up of the trajectory with integral action

Control of manipulators Robots

Control by inverse dynamic

We start from this equation

We will establish a control over the trajectory, calculating a of that way

...

Núria Rosillo Guerrero


Control of manipulators robots28 l.jpg
Control of manipulators Robots formulation

Control by inverse dynamic

Núria Rosillo Guerrero


Reference trajectories l.jpg
Reference Trajectories formulation

Ramp entry Natural cubic spline

...

Núria Rosillo Guerrero


Reference trajectories30 l.jpg
Reference Trajectories formulation

Fourier Series

...

Núria Rosillo Guerrero


Conclusions l.jpg
Conclusions formulation

Núria Rosillo Guerrero


ad