PRADA: Parallel Robot with Adaptive Dynamic ...

64 downloads 0 Views 2MB Size Report
Objective: The PRADA European ECHORD project focuses on complex manipulation and aims at reaching beyond today's performances for high speed parallel ...
PRADA: Parallel Robot with Adaptive Dynamic Accuracy Objective: The PRADA European ECHORD project focuses on complex manipulation and aims at reaching beyond today’s performances for high speed parallel robots in terms of: dynamic accuracy and adaptability to changes in operational conditions. Three partners were involved in this project. An academia partner, Lirmm, an academia to industry foundation which is Tecnalia, and an end-user which is Adept Technology. The developments have been made on the Par4 architecture, and validated on the industrial Quattro robot from Adept.

Task1: Modeling

Task2: Simulation of dynamic control Various implemented controllers Non redundant case

SIMULATIONS

Rigid platform

Redundant case

Articulated platform

1. 2. 3. 4.

Two study cases Non redundant

Redundantly actuated

PID joint controller PID cartesian control Inverse dynamic joint control Inverse dynamics cartesian control

1. 2. 3.

PID control in cartesian space Dual-space feedforward controller Dual-space adaptive controller

x Äd

Efficient Dynamic Model: complexicity/computing time compromise

x_ d

x ~_

+

+ Kd

-

Principle:

x ~

xd +

Total torque:

+

+ -

J ¡1 (q)

y

¿

M(q) +

q_

Robot

q

+

Kp

N(q; q) _ q_ + G(q)

_ q) J(q; _

x_

- arm gravity compensation

x

J(q)

F:K:

- motor axis viscous friction Application: pick and Place task

- equivalent nacelle mass

Dynamic accuracy evaluation with 200g payload uncertainty

- moment of inertia of arms

Task3: Calibration

Adaptive control: better accuracy No error variation vs payload conditions

Task4: control Implementation

• Kinematic Step 1 modeling

Step 2

Application: laser cutting task

• Measurements P31 Platform

METRIS K600 measurement system

• Optimization Step 3 procedure

P34 Platform

Case of Study: Adept Quattro

-750 -800 -850

sgn( q d )

Workspace cartography

mm

• Parameters Step 4 implementation

-900

qd

d dt

-950

Fv

Standard control : joint space PID joint space feedforwards

Fs

viscous friction

-1000 500 500

0 mm

• Precision Step 5 Evaluation

0 -500

-500

2

d dt 2

mm

d q

inner arm, gear and motor inertia Iq

Sensitivity analysis of P34 platform 0.06

Xd 0.05

I.K.

+ qd -

Δq

PID Control in the joint space PID

+

τ

qm

Error [m]

0.04

0.03

d2 dt 2

0.02

X d

Platform inertial effects Mn

+

J(q)T

Cartesian space feedforward control

w

0.01

55% Improvement of error with optimized parameters

weight of the platform 0

x1 y1 z1 x2 y2 z2 x3 y3 z3 l0

l1

l2

l3 L0 L1 L2 L3 alpha01

2

3beta0 1

2

3 offs0 1

2

3

h0 h1 h2 h3 d0 d1 d2 d3 H1 H2 d

Parameter name

Sensitivity Study Norm of the experimental error in each measured pose

46 % Faster than standard control (without feedforward control)

1 0.8 Einitiale = Xmetris- Xmapping

Errors

EXPERIMENTS

dry friction

0.6

E E

0.4

calibrated simu calibrated exp

=X

calibrated simu

=X

mapping

-X

metris

metris calibrated

Acknowledgments PRADA experimenters would like to thank ECHORD project funded by the European Commission (contract number 231143)

0.2 0 0

-X

50

100

150

Point number

200

250

300

Suggest Documents