modelTrapezoidalTrajectory

The outputs are three reference values for the three actuators of a Delta robot to follow a line with a trapezoidal velocity profile

Extends from DeltaRobot.Icons.TrapezoidalTrajectory (Icon for 'TrapezoidalTrajectory' model), PartialTrajectoryModel (This model collects all the common parameters and interfaces of the trajectory models).

Parameters

TypeNameDefaultDescription
Real[3]direction (from PartialTrajectoryModel)normalize(stopPosition - startPosition)Unit vector that indicates the direction of motion
SI.DistancetotalDistance (from PartialTrajectoryModel)norm(stopPosition - startPosition)Distance from initial point to final point
SI.TimestopTime (from PartialTrajectoryModel)startTime + transitionTimeoutput = stopPosition for time>=stopTime
SI.VelocityinitialSpeed0Initial platform speed (direction = stopPosition-startPosition, in base frame)
SI.VelocityfinalSpeed0Final platform speed (direction = stopPosition-startPosition, in base frame)
SI.VelocitymaxSpeed1Max platform speed (direction = stopPosition-startPosition, in base frame)
SI.AccelerationmaxAcceleration1Max platform acceleration (direction = stopPosition-startPosition, in base frame)
Realtempif case == 1 then 1 else sqrt(0.5*initialSpeed*initialSpeed + 0.5*finalSpeed*finalSpeed + ai*totalDistance)
SI.TimeTiif case == 1 then Ti_bar else -initialSpeed/ai + temp/aiInitial acceletation time
SI.TimeTfif case == 1 then Tf_bar else (finalSpeed - initialSpeed - ai*Ti)/afFinal acceleration time
SI.TimeTcif case == 1 then (totalDistance - Ti*initialSpeed - Tf*maxSpeed - 0.5*ai*Ti^2 - 0.5*af*Tf^2)/maxSpeed else 0Constant speed time
Real[3]initialSpeedVectorinitialSpeed*direction
Real[3]finalSpeedVectorfinalSpeed*direction
Real[3]maxSpeedVectorif case == 1 then maxSpeed*direction else initialSpeedVector + ai*direction*Ti
Position
SI.Position[3]startPosition (from PartialTrajectoryModel)gp.initPlatformPosInitial platform position resolved in base frame
SI.Position[3]stopPosition (from PartialTrajectoryModel)startPositionFinal platform position resolved in base frame
Time
SI.TimestartTime (from PartialTrajectoryModel)0output = startPosition for time<=startTime
SI.TimetransitionTime (from PartialTrajectoryModel)1Time required for the motion

Connectors

TypeNameDefaultDescription
Interfaces.Posepose (from PartialTrajectoryModel)

Components

TypeNameDefaultDescription
DeltaRobot.Components.GlobalParametersgp (from PartialTrajectoryModel)Object with all global parameters
SI.Position[3]position (from PartialTrajectoryModel)Current position vector
SI.Positiondistance (from PartialTrajectoryModel)Current distance from 'startPosition' to the current position
Interfaces.PoseMuxmux (from PartialTrajectoryModel)
Modelica.Blocks.Sources.Constantconst_startTime (from PartialTrajectoryModel)
Modelica.Blocks.Sources.Constantconst_stopTime (from PartialTrajectoryModel)
SI.Velocity[3]speedCurrent speed vector
SI.Acceleration[3]accelerationCurrent acceleration vector
SI.VelocityspeedModuleModule of current speed vector
SI.AccelerationaccelerationModuleModule of current acceleration vector