100 likes | 291 Views
FAST PROTOTYPING OF REAL-TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP. Michele Bongiovanni * michele.bongiovanni@polito.it Basilio Bona * basilio.bona@polito.it Dipartimento di Automatica e Informatica POLITECNICO DI TORINO H www.polito.it. Experimental Setup. LAN. D&A I/O.
E N D
FAST PROTOTYPING OF REAL-TIME ROBOT CONTROL USING MATLAB REAL-TIME WORKSHOP Michele Bongiovanni * michele.bongiovanni@polito.it Basilio Bona * basilio.bona@polito.it Dipartimento di Automatica e Informatica POLITECNICO DI TORINO H www.polito.it
Experimental Setup LAN D&A I/O FIELD UNIT
HOST PC • x86 • MATLAB/Simulink • RealTime Workshop • Stateflow • Wind River TORNADO • RTI Stethoscope
TARGET PC • x86 • VxWorks kernel • BSP Intel • driver ethernet NE2000 • driver Sensoray • RTI tools daemons
DAQ & ROBOT • Sensoray 626 • 40 dig I/O • 4 DAC • 6 encoder/counter • Robot • 2 DOF • brushless motors (NSK Megatorque®)
SIMULINK MODEL - Controller - • Controller array • Independent joint control approach • PID controllers on each motor • Scalability • Run time reconfigurable controller
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
Code architecture • Layered and modular • Customizable at low level GENERIC LAYER APPLICATION SPECIFIC LAYER + RTI Scope Daemons COMMON LAYER VXWORKS LAYER
Sequenza dei task READ SYSTEM INPUTS • Common layer coded • Synchronism @ 1 kHz (max 8 kHz) • DAC max delay: 200 ms per channel • powerful H/W, fast control loops. CALCULATE & WRITE SYSTEM OUTPUTS UPDATE DISCRETE STATES INTEGRATION ALGORITHM INCREMENT TIME