modelPathPlanning1
Generate reference angles for fastest kinematic movement
Extends from Blocks.Icons.Block (Basic graphical layout of input/output block).
Information
Given
- start and end angle of an axis
- maximum speed of the axis
- maximum acceleration of the axis
this component computes the fastest movement under the given constraints. This means, that:
- The axis accelerates with the maximum acceleration until the maximum speed is reached.
- Drives with the maximum speed as long as possible.
- Decelerates with the negative of the maximum acceleration until rest.
The acceleration, constant velocity and deceleration phase are determined in such a way that the movement starts form the start angles and ends at the end angles. The output of this block are the computed angles, angular velocities and angular acceleration and this information is stored as reference motion on the controlBus of the r3 robot.
Parameters
| Type | Name | Default | Description |
|---|---|---|---|
| Modelica.Units.NonSI.Angle_deg | angleBegDeg | 0 | Start angle |
| Modelica.Units.NonSI.Angle_deg | angleEndDeg | 1 | End angle |
| SI.AngularVelocity | speedMax | 3 | Maximum axis speed |
| SI.AngularAcceleration | accMax | 2.5 | Maximum axis acceleration |
| SI.Time | startTime | 0 | Start time of movement |
| SI.Time | swingTime | 0.5 | Additional time after reference motion is in rest before simulation is stopped |
| SI.Angle | angleBeg | Cv.from_deg(angleBegDeg) | Start angles |
| SI.Angle | angleEnd | Cv.from_deg(angleEndDeg) | End angles |
Connectors
| Type | Name | Default | Description |
|---|---|---|---|
| ControlBus | controlBus |
Components
| Type | Name | Default | Description |
|---|---|---|---|
| Modelica.Blocks.Sources.KinematicPTP2 | path | ||
| PathToAxisControlBus | pathToAxis1 | ||
| Blocks.Logical.TerminateSimulation | terminateSimulation |