FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni...

10
FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni [email protected] Basilio Bona [email protected] Dipartimento di Automatica e Informatica POLITECNICO DI TORINO www.polito.it

Transcript of FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni...

Page 1: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

FAST PROTOTYPING OF REAL-TIME ROBOT CONTROL USING

MATLAB REAL-TIME WORKSHOP

Michele [email protected]

Basilio [email protected]

Dipartimento di Automatica e InformaticaPOLITECNICO DI TORINO

www.polito.it

Page 2: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 2

Experimental Setup

FIELD UNIT

D&A I/O

LAN

Page 3: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 3

HOST PC

x86MATLAB/Simulink

RealTime Workshop Stateflow

Wind River TORNADORTI Stethoscope

Page 4: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 4

TARGET PC

x86VxWorks kernel

BSP Intel driver ethernet NE2000 driver Sensoray

RTI tools daemons

Page 5: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 5

DAQ & ROBOT

Sensoray 626 40 dig I/O 4 DAC 6 encoder/counter

Robot 2 DOF brushless motors

(NSK Megatorque®)

Page 6: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 6

SIMULINK MODEL - Events -

Page 7: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 7

SIMULINK MODEL - Controller -

Controller array Independent joint control

approach PID controllers on each

motor Scalability Run time reconfigurable

controller

Page 8: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 8

SIMULINK MODEL - Impianto -

Simulation Robot model

Independent joints Dynamic equations Friction

I/O ports to and from DAQ Custom code block to interface DAQ

Identification & hardware in the loop Parameter based robot model Robot Parameter computation

Page 9: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 9

Code architecture Layered and modular Customizable at low level

GENERIC LAYER

APPLICATION SPECIFIC

LAYER

COMMON LAYER

VXWORKS LAYER

+RTI

Scope Daemons

Page 10: FAST PROTOTYPING OF REAL- TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni michele.bongiovanni@polito.it Basilio Bona basilio.bona@polito.it.

Politecnico di Torino - LabRobMichele Bongiovanni

ANIPLA, 21-22 Novembre 2003, Brescia 10

Sequenza dei task

Common layer coded Synchronism @ 1 kHz (max 8

kHz) DAC max delay: 200 s per

channel powerful H/W, fast control loops.

READ SYSTEM INPUTS

CALCULATE & WRITE

SYSTEM OUTPUTS

UPDATE DISCRETE STATES

INCREMENT TIME

INTEGRATION ALGORITHM