Package Modelica.​Mechanics.​MultiBody.​Examples.​Systems.​RobotR3
Library to demonstrate robot system models based on the Manutec r3 robot

Information

This package contains models of the robot r3 of the company Manutec. These models are used to demonstrate in which way complex robot models might be built up by testing first the component models individually before composing them together. Furthermore, it is shown how CAD data can be used for animation.

model Examples.Systems.RobotR3

The following models are available:

   oneAxis   Test one axis (controller, motor, gearbox).
   fullRobot Test complete robot model.

The r3 robot is no longer manufactured. In fact the company Manutec does no longer exist. The parameters of this robot have been determined by measurements in the laboratory of DLR. The measurement procedure is described in:

   Tuerk S. (1990): Zur Modellierung der Dynamik von Robotern mit
       rotatorischen Gelenken. Fortschrittberichte VDI, Reihe 8, Nr. 211,
       VDI-Verlag 1990.

The robot model is described in detail in

   Otter M. (1995): Objektorientierte Modellierung mechatronischer
       Systeme am Beispiel geregelter Roboter. Dissertation,
       Fortschrittberichte VDI, Reihe 20, Nr. 147, VDI-Verlag 1995.
       This report can be downloaded as compressed postscript file
       from: http://www.robotic.dlr.de/Martin.Otter.

The path planning is performed in a simple way by using essentially the Modelica.Mechanics.Rotational.KinematicPTP block. A user defines a path by start and end angle of every axis. A path is planned such that all axes are moving as fast as possible under the given restrictions of maximum joint speeds and maximum joint accelerations. The actual r3 robot from Manutec had a different path planning strategy. Today's path planning algorithms from robot companies are much more involved.

In order to get a nice animation, CAD data from a KUKA robot is used, since CAD data of the original r3 robot was not available. The KUKA CAD data was derived from public data of KUKA. Since dimensions of the corresponding KUKA robot are similar but not identical to the r3 robot, the data of the r3 robot (such as arm lengths) have been modified, such that it matches the CAD data.

In this model, a simplified P-PI cascade controller for every axes is used. The parameters have been manually adjusted by simulations. The original r3 controllers are more complicated. The reason to use simplified controllers is to have a simpler demo.

Extends from Modelica.​Icons.​ExamplesPackage (Icon for packages containing runnable examples).

Package Contents

NameDescription
ComponentsLibrary of components of the robot
fullRobotSix degree of freedom robot with path planning, controllers, motors, brakes, gears and mechanics
oneAxisModel of one axis of robot (controller, motor, gearbox) with simple load

Model Modelica.​Mechanics.​MultiBody.​Examples.​Systems.​RobotR3.​oneAxis
Model of one axis of robot (controller, motor, gearbox) with simple load

Information

With this model one axis of the r3 robot is checked. The mechanical structure is replaced by a simple load inertia.

Extends from Modelica.​Icons.​Example (Icon for runnable examples).

Parameters

TypeNameDefaultDescription
MassmLoad15Mass of load
Realkp5Gain of position controller of axis 2
Realks0.5Gain of speed controller of axis 2
TimeTs0.05Time constant of integrator of speed controller of axis 2
RealstartAngle0Start angle of axis 2
RealendAngle120End angle of axis 2
TimeswingTime0.5Additional time after reference motion is in rest before simulation is stopped
AngularVelocityrefSpeedMax3Maximum reference speed
AngularAccelerationrefAccMax10Maximum reference acceleration

Model Modelica.​Mechanics.​MultiBody.​Examples.​Systems.​RobotR3.​fullRobot
Six degree of freedom robot with path planning, controllers, motors, brakes, gears and mechanics

Information

This example animates a motion of a detailed model of the robot with predefined axes' angles over time. For animation, CAD data is used. Translate and simulate with the default settings (default simulation stop time = 2 s).

The path planning block incorporates a simulation termination condition. Thus, the simulation can be terminated before reaching the stop time. The condition depends on the start and end positions of the joints, and on their reference speeds and reference accelerations. For current settings, the termination condition should indeed be fulfilled right before the simulation stops.

model Examples.Loops.Systems.RobotR3.fullRobot

Extends from Modelica.​Icons.​Example (Icon for runnable examples).

Parameters

TypeNameDefaultDescription
MassmLoad15Mass of load
PositionrLoad[3]{0.1, 0.25, 0.1}Distance from last flange to load mass
Accelerationg9.81Gravity acceleration
TimerefStartTime0Start time of reference motion
TimerefSwingTime0.5Additional time after reference motion is in rest before simulation is stopped
RealstartAngle1-60Start angle of axis 1
RealstartAngle220Start angle of axis 2
RealstartAngle390Start angle of axis 3
RealstartAngle40Start angle of axis 4
RealstartAngle5-110Start angle of axis 5
RealstartAngle60Start angle of axis 6
RealendAngle160End angle of axis 1
RealendAngle2-70End angle of axis 2
RealendAngle3-35End angle of axis 3
RealendAngle445End angle of axis 4
RealendAngle5110End angle of axis 5
RealendAngle645End angle of axis 6
AngularVelocityrefSpeedMax[6]{3, 1.5, 5, 3.1, 3.1, 4.1}Maximum reference speeds of all joints
AngularAccelerationrefAccMax[6]{15, 15, 15, 60, 60, 60}Maximum reference accelerations of all joints
Realkp15Gain of position controller
Realks10.5Gain of speed controller
TimeTs10.05Time constant of integrator of speed controller
Realkp25Gain of position controller
Realks20.5Gain of speed controller
TimeTs20.05Time constant of integrator of speed controller
Realkp35Gain of position controller
Realks30.5Gain of speed controller
TimeTs30.05Time constant of integrator of speed controller
Realkp45Gain of position controller
Realks40.5Gain of speed controller
TimeTs40.05Time constant of integrator of speed controller
Realkp55Gain of position controller
Realks50.5Gain of speed controller
TimeTs50.05Time constant of integrator of speed controller
Realkp65Gain of position controller
Realks60.5Gain of speed controller
TimeTs60.05Time constant of integrator of speed controller

Generated 2018-12-12 12:12:41 EST by MapleSim.