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 Content

Name Description
Modelica.Mechanics.MultiBody.Examples.Systems.RobotR3.OneAxis OneAxis Model of one axis of robot (controller, motor, gearbox) with simple load
Modelica.Mechanics.MultiBody.Examples.Systems.RobotR3.FullRobot FullRobot Six degree of freedom robot with path planning, controllers, motors, brakes, gears and mechanics
Modelica.Mechanics.MultiBody.Examples.Systems.RobotR3.Utilities Utilities Utility classes for robot examples

Modelica.Mechanics.MultiBody.Examples.Systems.RobotR3.OneAxis 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

NameDescription
mLoadMass of load [kg]
kpGain of position controller of axis
ksGain of speed controller of axis
TsTime constant of integrator of speed controller of axis [s]
startAngleStart angle of axis [deg]
endAngleEnd angle of axis [deg]
swingTimeAdditional time after reference motion is in rest before simulation is stopped [s]
refSpeedMaxMaximum reference speed [rad/s]
refAccMaxMaximum reference acceleration [rad/s2]

Modelica.Mechanics.MultiBody.Examples.Systems.RobotR3.FullRobot 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.Systems.RobotR3.FullRobot

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

Parameters

NameDescription
mLoadMass of load [kg]
rLoad[3]Distance from last flange to load mass [m]
gGravity acceleration [m/s2]
refStartTimeStart time of reference motion [s]
refSwingTimeAdditional time after reference motion is in rest before simulation is stopped [s]
Reference
Start angles
startAngle1Start angle of axis 1 [deg]
startAngle2Start angle of axis 2 [deg]
startAngle3Start angle of axis 3 [deg]
startAngle4Start angle of axis 4 [deg]
startAngle5Start angle of axis 5 [deg]
startAngle6Start angle of axis 6 [deg]
End angles
endAngle1End angle of axis 1 [deg]
endAngle2End angle of axis 2 [deg]
endAngle3End angle of axis 3 [deg]
endAngle4End angle of axis 4 [deg]
endAngle5End angle of axis 5 [deg]
endAngle6End angle of axis 6 [deg]
Limits
refSpeedMax[6]Maximum reference speeds of all joints [rad/s]
refAccMax[6]Maximum reference accelerations of all joints [rad/s2]
Controller
Axis 1
kp1Gain of position controller
ks1Gain of speed controller
Ts1Time constant of integrator of speed controller [s]
Axis 2
kp2Gain of position controller
ks2Gain of speed controller
Ts2Time constant of integrator of speed controller [s]
Axis 3
kp3Gain of position controller
ks3Gain of speed controller
Ts3Time constant of integrator of speed controller [s]
Axis 4
kp4Gain of position controller
ks4Gain of speed controller
Ts4Time constant of integrator of speed controller [s]
Axis 5
kp5Gain of position controller
ks5Gain of speed controller
Ts5Time constant of integrator of speed controller [s]
Axis 6
kp6Gain of position controller
ks6Gain of speed controller
Ts6Time constant of integrator of speed controller [s]
Automatically generated Thu Oct 1 16:07:53 2020.