Module: prescribedLinearTranslation

Executive Summary

This module profiles linear translational motion for a rigid body connected to a rigid spacecraft hub. The body frame of the translating body is designated by the frame \(\mathcal{F}\). The states of the translating body are profiled relative to a hub-fixed frame \(\mathcal{M}\). The PrescribedTranslationMsgPayload message is used to output the prescribed translational states from the module. The prescribed states profiled in this module are: r_FM_M, rPrime_FM_M, and rPrimePrime_FM_M. This module has four options to profile the linear translation. The first option is a bang-bang acceleration profile that minimizes the time required to complete the translation. The second option is a bang-coast-bang acceleration profile that adds a coast period of zero acceleration between the acceleration ramp segments. The third option is a smoothed bang-bang acceleration profile that uses cubic splines to construct a continuous acceleration profile across the entire translation. The fourth option is a smoothed bang-coast-bang acceleration profile.

The module defaults to the non-smoothed bang-bang option with no coast period. If the coast option is desired, the user must set the module variable coastOptionBangDuration to a nonzero value. If smoothing is desired, the module variable smoothingDuration must be set to a nonzero value.

Important

Note that this module assumes the initial and final hub-relative translational rates of the translating body are zero.

The general inputs to this module that must be set by the user are the translational axis expressed as a unit vector in mount frame components transHat_M, the initial translational body position relative to the hub-fixed mount frame transPosInit, the reference position relative to the mount frame transPosRef, and the maximum scalar linear acceleration for the translation transAccelMax. The optional inputs coastOptionBangDuration and smoothingDuration can be set by the user to select the specific type of profiler that is desired. If these variables are not set by the user, the module defaults to the non-smoothed bang-bang profiler. If only the variable coastOptionBangDuration is set to a nonzero value, the bang-coast-bang profiler is selected. If only the variable smoothingDuration is set to a nonzero value, the smoothed bang-bang profiler is selected. If both variables are set to nonzero values, the smoothed bang-coast-bang profiler is selected.

Important

To use this module for prescribed motion, it must be connected to the Module: prescribedMotionStateEffector dynamics module. This ensures the translational body’s states are correctly incorporated into the spacecraft dynamics.

Message Connection Descriptions

The following table lists all the module input and output messages. The module msg connection is set by the user from python. The msg type contains a link to the message structure definition, while the description provides information on what this message is used for.

Module I/O Messages

Msg Variable Name

Msg Type

Description

linearTranslationRigidBodyInMsg

LinearTranslationRigidBodyMsgPayload

input msg with the prescribed body reference translational states

prescribedTranslationOutMsg

PrescribedTranslationMsgPayload

output message with the prescribed body translational states

prescribedTranslationOutMsgC

PrescribedTranslationMsgPayload

C-wrapped output message with the prescribed body translational states

Detailed Module Description

Non-Smoothed Bang-Bang Profiler

The first option to profile the linear translation is a pure bang-bang acceleration profile. If the given reference position is greater than the given initial position, the user-specified maximum acceleration value is applied positively to the first half of the translation and negatively to the second half of the translation. However, if the reference position is less than the initial position, the acceleration is instead applied negatively during the first half of the translation and positively during the second half of the translation. As a result of this acceleration profile, the translational body’s hub-relative velocity changes linearly with time and reaches a maximum in magnitude halfway through the translation. Note that the velocity is assumed to both start and end at zero in this module. The resulting translational position profile is parabolic in time.

To profile this motion, the translational body’s hub-relative scalar states \(\rho\), \(\dot{\rho}\), and \(\ddot{\rho}\) are prescribed as a function of time. During the first half of the translation the states are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \ddot{\rho} (t - t_0) + \dot{\rho}_0\]
\[\rho(t) = a (t - t_0)^2 + \rho_0\]

where

\[a = \frac{ \rho_{\text{ref}} - \rho_0}{2 (t_{b1} - t_0)^2}\]

During the second half of the translation the states are:

\[\ddot{\rho}(t) = \mp \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \ddot{\rho} (t - t_f) + \dot{\rho}_0\]
\[\rho(t) = b (t - t_f)^2 + \rho_{\text{ref}}\]

where

\[b = - \frac{ \rho_{\text{ref}} - \rho_0}{2 (t_{b1} - t_f)^2}\]

The switch time \(t_{b1}\) is the simulation time at the end of the first bang segment:

\[t_{b1} = t_0 + \frac{\Delta t_{\text{tot}}}{2}\]

The total time required to complete the translation \(\Delta t_{\text{tot}}\) is:

\[\Delta t_{\text{tot}} = 2 \sqrt{ \frac{| \rho_{\text{ref}} - \rho_0 | }{\ddot{\rho}_{\text{max}}}} = t_f - t_0\]

Non-Smoothed Bang-Coast-Bang Profiler

The second option to profile the linear translation is a bang-coast-bang acceleration profile with an added coast period between the acceleration segments where the acceleration is zero. Similar to the previous profiler, if the reference position is greater than the given initial position, the maximum acceleration value is applied positively for the specified ramp time coastOptionBangDuration to the first segment of the translation and negatively to the third segment of the translation. The second segment of the translation is the coast period. However, if the reference position is less than the initial position, the acceleration is instead applied negatively during the first segment of the translation and positively during the third segment of the translation. As a result of this acceleration profile, the translational body’s hub-relative velocity changes linearly with time and reaches a maximum in magnitude at the end of the first segment and is constant during the coast segment. The velocity returns to zero during the third segment. The resulting position profiled is parabolic during the first and third segments and linear during the coast segment.

To profile this linear motion, the scalar translating body’s hub-relative states \(\rho\), \(\dot{\rho}\), and \(\ddot{\rho}\) are prescribed as a function of time. During the first segment of the translation the states are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \ddot{\rho} (t - t_0) + \dot{\rho}_0\]
\[\rho(t) = a (t - t_0)^2 + \rho_0\]

where

\[a = \frac{ \rho(t_{b1}) - \rho_0}{2 (t_{b1} - t_0)^2}\]

and \(\rho(t_{b1})\) is the hub-relative position at the end of the first bang segment:

\[\rho(t_{b1}) = \pm \frac{1}{2} \ddot{\rho}_{\text{max}} t_{\text{bang}}^2 + \dot{\rho}_0 t_{\text{bang}} + \rho_0\]

Important

Note the distinction between \(t_{b1}\) and \(t_{\text{bang}}\). \(t_{\text{bang}}\) is the time duration of the acceleration segment and \(t_{b1}\) is the simulation time at the end of the first acceleration segment. \(t_{b1} = t_0 + t_{\text{bang}}\)

During the coast segment, the translational states are:

\[\ddot{\rho}(t) = 0\]
\[\dot{\rho}(t) = \dot{\rho}(t_{b1}) = \ddot{\rho}_{\text{max}} t_{\text{bang}} + \dot{\rho}_0\]
\[\rho(t) = \dot{\rho}(t_{b1}) (t - t_{b1}) + \rho(t_{b1})\]

During the third segment, the translational states are

\[\ddot{\rho}(t) = \mp \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \ddot{\rho} (t - t_f) + \dot{\rho}_0\]
\[\rho(t) = b (t - t_f)^2 + \rho_{\text{ref}}\]

where

\[b = - \frac{ \rho_{\text{ref}} - \rho(t_c) }{(t_c - t_f)^2}\]

Here \(\rho(t_c)\) is the hub-relative position at the end of the coast segment:

\[\rho(t_c) = \rho(t_{b1}) + \Delta \rho_{\text{coast}}\]

and \(\Delta \rho_{\text{coast}}\) is the distance traveled during the coast segment:

\[\Delta \rho_{\text{coast}} = (\rho_{\text{ref}} - \rho_0) - 2 (\rho(t_{b1}) - \rho_0)\]

\(t_c\) is the simulation time at the end of the coast segment:

\[t_c = t_{b1} + \frac{\Delta \rho_{\text{coast}}}{\dot{\rho}(t_{b1})}\]

Using the given translation axis transHat_M, the scalar states are then transformed to the prescribed translational states r_FM_M, rPrime_FM_M, and rPrimePrime_FM_M. The states are then written to the PrescribedTranslationMsgPayload module output message.

Smoothed Bang-Bang Profiler

The third option to profile the linear translation is a smoothed bang-bang acceleration profile. This option is selected by setting the module variable smoothingDuration to a nonzero value. This profiler uses cubic splines to construct a continuous acceleration profiler across the entire translation. Similar to the non-smoothed bang-bang profiler, this option smooths the acceleration between the given maximum acceleration values. To profile this motion, the translational body’s hub-relative scalar states \(\rho\), \(\dot{\rho}\), and \(\ddot{\rho}\) are prescribed as a function of time and the translational motion is split into five different segments.

The first segment smooths the acceleration from zero to the user-specified maximum acceleration value in the given time smoothingDuration. If the given reference position is greater than the given initial position, the acceleration is smoothed positively to the given maximum acceleration value. If the given reference position is less than the given initial position, the acceleration is smoothed from zero to the negative maximum acceleration value. During this phase, the scalar hub-relative states are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{3 (t - t_0)^2}{t_{\text{smooth}}^2} - \frac{2 (t - t_0)^3}{t_{\text{smooth}}^3} \right)\]
\[\dot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{(t - t_0)^3}{t_{\text{smooth}}^2} - \frac{(t - t_0)^4}{2 t_{\text{smooth}}^3} \right)\]
\[\rho(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{(t - t_0)^4}{4 t_{\text{smooth}}^2} - \frac{(t - t_0)^5}{10 t_{\text{smooth}}^3} \right)\]

The second segment is the first bang segment where the maximum acceleration value is applied either positively or negatively as discussed previously. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} (t - t_{s1}) + \dot{\rho}(t_{s1})\]
\[\rho(t) = \pm \frac{\ddot{\rho}_{\text{max}} (t - t_{s1})^2}{2} + \dot{\rho}(t_{s1})(t - t_{s1}) + \rho(t_{s1})\]

where \(t_{s1}\) is the time at the end of the first smoothing segment:

\[t_{s1} = t_0 + t_{\text{smooth}}\]

The third segment smooths the acceleration from the current maximum acceleration value to the opposite magnitude maximum acceleration value. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( 1 - \frac{3 (t - t_{b1})^2}{2 t_{\text{smooth}}^2} + \frac{(t - t_{b1})^3}{2 t_{\text{smooth}}^3} \right)\]
\[\dot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( (t - t_{b1}) - \frac{(t - t_{b1})^3}{2 t_{\text{smooth}}^2} + \frac{(t - t_{b1})^4}{8 t_{\text{smooth}}^3} \right) + \dot{\rho}(t_{b1})\]
\[\rho(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{(t - t_{b1})^2}{2} - \frac{(t - t_{b1})^4}{8 t_{\text{smooth}}^2} + \frac{(t - t_{b1})^5}{40 t_{\text{smooth}}^3} \right) + \dot{\rho}(t_{b1})(t - t_{b1}) + \rho(t_{b1})\]

where \(t_{b1}\) is the time at the end of the first bang segment:

\[t_{b1} = t_{s1} + t_{\text{bang}}\]

The fourth segment is the second bang segment where the maximum acceleration value is applied either positively or negatively as discussed previously. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \mp \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \mp \ddot{\rho}_{\text{max}} (t - t_{s2}) + \dot{\rho}(t_{s2})\]
\[\rho(t) = \mp \frac{\ddot{\rho}_{\text{max}} (t - t_{s2})^2}{2} + \dot{\rho}(t_{s2})(t - t_{s2}) + \rho(t_{s2})\]

where \(t_{s2}\) is the time at the end of the second smoothing segment:

\[t_{s2} = t_{b1} + t_{\text{smooth}}\]

The fifth segment is the third and final smoothing segment where the acceleration returns to zero. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \mp \ddot{\rho}_{\text{max}} \left ( -1 + \frac{3(t - t_{b2})^2}{t_{\text{smooth}}^2} - \frac{2 (t - t_{b2})^3}{t_{\text{smooth}}^3} \right )\]
\[\dot{\rho}(t) = \mp \ddot{\rho}_{\text{max}} \left ( -(t - t_{b2}) + \frac{(t - t_{b2})^3}{t_{\text{smooth}}^2} - \frac{(t - t_{b2})^4}{2 t_{\text{smooth}}^3} \right ) + \dot{\rho}(t_{b2})\]
\[\rho(t) = \mp \ddot{\rho}_{\text{max}} \left ( \frac{(t - t_{b2})^2}{2} + \frac{(t - t_{b2})^4}{4 t_{\text{smooth}}^2} - \frac{(t - t_{b2})^5}{10 t_{\text{smooth}}^3} \right ) + \dot{\rho}(t_{b2})(t - t_{b2}) + \rho(t_{b2})\]

where \(t_{b2}\) is the time at the end of the second bang segment:

\[t_{b2} = t_{s2} + t_{\text{bang}}\]

Smoothed Bang-Coast-Bang Profiler

The fourth option to profile the linear translation is a smoothed bang-coast-bang acceleration profile. This option is selected by setting the module variables coastOptionBangDuration and smoothingDuration to nonzero values. This profiler uses cubic splines to construct a continuous acceleration profiler across the entire translation. To profile this motion, the translational body’s hub-relative scalar states \(\rho\), \(\dot{\rho}\), and \(\ddot{\rho}\) are prescribed as a function of time and the translational motion is split into seven different segments.

The first segment smooths the acceleration from zero to the user-specified maximum acceleration value in the given time smoothingDuration. If the given reference position is greater than the given initial position, the acceleration is smoothed positively to the given maximum acceleration value. If the given reference position is less than the given initial position, the acceleration is smoothed from zero to the negative maximum acceleration value. During this phase, the scalar hub-relative states are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{3 (t - t_0)^2}{t_{\text{smooth}}^2} - \frac{2 (t - t_0)^3}{t_{\text{smooth}}^3} \right)\]
\[\dot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{(t - t_0)^3}{t_{\text{smooth}}^2} - \frac{(t - t_0)^4}{2 t_{\text{smooth}}^3} \right)\]
\[\rho(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{(t - t_0)^4}{4 t_{\text{smooth}}^2} - \frac{(t - t_0)^5}{10 t_{\text{smooth}}^3} \right)\]

The second segment is the first bang segment where the maximum acceleration value is applied either positively or negatively as discussed previously. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} (t - t_{s1}) + \dot{\rho}(t_{s1})\]
\[\rho(t) = \pm \frac{\ddot{\rho}_{\text{max}} (t - t_{s1})^2}{2} + \dot{\rho}(t_{s1})(t - t_{s1}) + \rho(t_{s1})\]

where \(t_{s1}\) is the time at the end of the first smoothing segment.

The third segment prior to the coast phase smooths the acceleration from the current maximum acceleration value to zero. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( 1 - \frac{3 (t - t_{b1})^2}{t_{\text{smooth}}^2} - \frac{2 (t - t_{b1})^3}{t_{\text{smooth}}^3} \right)\]
\[\dot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left( (t - t_{b1}) - \frac{(t - t_{b1})^3}{t_{\text{smooth}}^2} - \frac{(t - t_{b1})^4}{2 t_{\text{smooth}}^3} \right) + \dot{\rho}(t_{b1})\]
\[\rho(t) = \pm \ddot{\rho}_{\text{max}} \left( \frac{(t - t_{b1})^2}{2} - \frac{(t - t_{b1})^4}{4 t_{\text{smooth}}^2} - \frac{(t - t_{b1})^5}{10 t_{\text{smooth}}^3} \right) + \dot{\rho}(t_{b1})(t - t_{b1}) + \rho(t_{b1})\]

where \(t_{b1}\) is the time at the end of the first bang segment.

The fourth segment is the coast segment where the translational states are:

\[\ddot{\rho}(t) = 0\]
\[\dot{\rho}(t) = \dot{\rho}(t_{s2})\]
\[\rho(t) = \dot{\rho}(t_{s2}) (t - t_{s2}) + \rho(t_{s2})\]

where \(t_{s2}\) is the time at the end of the second smoothing segment.

The fifth segment smooths the acceleration from zero to the maximum acceleration value prior to the second bang segment. The translational states during this phase are:

\[\ddot{\rho}(t) = \mp \ddot{\rho}_{\text{max}} \left( \frac{3 (t - t_c)^2}{t_{\text{smooth}}^2} - \frac{2 (t - t_c)^3}{t_{\text{smooth}}^3} \right)\]
\[\dot{\rho}(t) = \mp \ddot{\rho}_{\text{max}} \left( \frac{(t - t_c)^3}{t_{\text{smooth}}^2} - \frac{(t - t_c)^4}{2 t_{\text{smooth}}^3} \right) + \dot{\rho}(t_c)\]
\[\rho(t) = \mp \ddot{\rho}_{\text{max}} \left( \frac{(t - t_c)^4}{4 t_{\text{smooth}}^2} - \frac{(t - t_c)^5}{10 t_{\text{smooth}}^3} \right) + \dot{\rho}(t_c) (t - t_c) + \rho(t_c)\]

where \(t_c\) is the time at the end of the coast segment.

The sixth segment is the second bang segment where the maximum acceleration value is applied either positively or negatively as discussed previously. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \mp \ddot{\rho}_{\text{max}}\]
\[\dot{\rho}(t) = \mp \ddot{\rho}_{\text{max}} (t - t_{s3}) + \dot{\rho}(t_{s3})\]
\[\rho(t) = \mp \frac{\ddot{\rho}_{\text{max}} (t - t_{s3})^2}{2} + \dot{\rho}(t_{s3})(t - t_{s3}) + \rho(t_{s3})\]

where \(t_{s3}\) is the time at the end of the third smoothing segment.

The seventh segment is the fourth and final smoothing segment where the acceleration returns to zero. The scalar hub-relative states during this phase are:

\[\ddot{\rho}(t) = \mp \ddot{\rho}_{\text{max}} \left (\frac{3(t_f - t)^2}{t_{\text{smooth}}^2} - \frac{2 (t_f - t)^3}{t_{\text{smooth}}^3} \right )\]
\[\dot{\rho}(t) = \pm \ddot{\rho}_{\text{max}} \left (\frac{(t_f - t)^3}{t_{\text{smooth}}^2} - \frac{(t_f - t)^4}{2 t_{\text{smooth}}^3} \right )\]
\[\rho(t) = \mp \ddot{\rho}_{\text{max}} \left (\frac{(t_f - t)^4}{4 t_{\text{smooth}}^2} - \frac{(t_f - t)^5}{10 t_{\text{smooth}}^3} \right ) + \rho_{\text{ref}}\]

where \(t_f\) is the time at the end of the translation:

Module Testing

The unit test for this module ensures that the profiled linear translation for a secondary rigid body relative to the spacecraft hub is properly computed for several different simulation configurations. The unit test profiles two successive translations to ensure the module is correctly configured. The secondary body’s initial scalar translational position relative to the spacecraft hub is varied, along with the two final reference positions and the maximum translational acceleration.

The unit test also tests four different methods of profiling the translation. Two profilers prescribe a pure bang-bang or bang-coast-bang linear acceleration profile for the translation. The bang-bang option results in the fastest possible translation; while the bang-coast-bang option includes a coast period with zero acceleration between the acceleration segments. The other two profilers apply smoothing to the bang-bang and bang-coast-bang acceleration profiles so that the secondary body hub-relative rates start and end at zero.

To verify the module functionality, the final position at the end of each translation segment is checked to match the specified reference positions. Additionally, for the smoothed profiler options, the numerical derivative of the profiled displacements and velocities is determined across the entire simulation. These numerical derivatives are checked with the module’s acceleration and velocity profiles to ensure the profiled acceleration is correctly integrated in the module to obtain the displacements and velocities.

User Guide

The general inputs to this module that must be set by the user are the translational axis expressed as a unit vector in mount frame components transHat_M, the initial translational body position relative to the hub-fixed mount frame transPosInit, the reference position relative to the mount frame transPosRef, and the maximum scalar linear acceleration for the translation transAccelMax. The optional inputs coastOptionBangDuration and smoothingDuration can be set by the user to select the specific type of profiler that is desired. If these variables are not set by the user, the module defaults to the non-smoothed bang-bang profiler. If only the variable coastOptionBangDuration is set to a nonzero value, the bang-coast-bang profiler is selected. If only the variable smoothingDuration is set to a nonzero value, the smoothed bang-bang profiler is selected. If both variables are set to nonzero values, the smoothed bang-coast-bang profiler is selected.

This section is to outline the steps needed to setup the prescribed linear translational module in python using Basilisk.

  1. Import the prescribedLinearTranslation class:

    from Basilisk.simulation import prescribedLinearTranslation
    
  2. Create an instantiation of the module:

    prescribedLinearTrans = prescribedLinearTranslation.PrescribedLinearTranslation()
    
  3. Define all of the configuration data associated with the module. For example, to configure the smoothed bang-coast-bang option:

    prescribedLinearTrans.ModelTag = "prescribedLinearTranslation"
    prescribedLinearTrans.setTransHat_M(np.array([0.5, 0.0, 0.5 * np.sqrt(3)]))
    prescribedLinearTrans.setTransAccelMax(0.01)  # [m/s^2]
    prescribedLinearTrans.setTransPosInit(0.5)  # [m]
    prescribedLinearTrans.setCoastRampDuration(1.0)  # [s]
    prescribedLinearTrans.setSmoothingDuration(1.0)  # [s]
    
  4. Connect a LinearTranslationRigidBodyMsgPayload message for the translating body reference position to the module. For example, the user can create a stand-alone message to specify the reference position:

    linearTranslationRigidBodyMessageData = messaging.LinearTranslationRigidBodyMsgPayload()
    linearTranslationRigidBodyMessageData.rho = 1.0  # [m]
    linearTranslationRigidBodyMessageData.rhoDot = 0.0  # [m/s]
    linearTranslationRigidBodyMessage = messaging.LinearTranslationRigidBodyMsg().write(linearTranslationRigidBodyMessageData)
    
  5. Subscribe the reference message to the prescribedTranslation module input message:

    prescribedLinearTrans.linearTranslationRigidBodyInMsg.subscribeTo(linearTranslationRigidBodyMessage)
    
  6. Add the module to the task list:

    unitTestSim.AddModelToTask(unitTaskName, prescribedLinearTrans)
    

class PrescribedLinearTranslation : public SysModel
#include <prescribedLinearTranslation.h>

Prescribed Linear Translation Profiler Class.

Public Functions

PrescribedLinearTranslation() = default

Constructor.

~PrescribedLinearTranslation() = default

Destructor.

void SelfInit() override

Member function to initialize the C-wrapped output message.

This method self initializes the C-wrapped output message.

Returns

void

void Reset(uint64_t CurrentSimNanos) override

Reset member function.

This method resets required module variables and checks the input messages to ensure they are linked.

Parameters

callTime – [ns] Time the method is called

Returns

void

void UpdateState(uint64_t CurrentSimNanos) override

Update member function.

This method profiles the translation and updates the prescribed translational states as a function of time. The prescribed translational states are then written to the output message.

Parameters

callTime – [ns] Time the method is called

Returns

void

void setCoastOptionBangDuration(const double bangDuration)

Setter method for the coast option bang duration.

Setter method for the coast option bang duration.

Parameters

coastOptionBangDuration – [s] Bang segment time duration

Returns

void

void setSmoothingDuration(const double smoothingDuration)

Setter method for the duration the acceleration is smoothed until reaching the given maximum acceleration value.

Setter method for the duration the acceleration is smoothed until reaching the given maximum acceleration value.

Parameters

smoothingDuration – [s] Duration the acceleration is smoothed until reaching the given maximum acceleration value

Returns

void

void setTransAccelMax(const double transAccelMax)

Setter method for the bang segment scalar linear acceleration.

Setter method for the bang segment scalar linear acceleration.

Parameters

transAccelMax – [m/s^2] Bang segment linear angular acceleration

Returns

void

void setTransHat_M(const Eigen::Vector3d &transHat_M)

Setter method for the translating body axis of translation.

Setter method for the translating body axis of translation.

Parameters

transHat_M – Translating body axis of translation (unit vector)

Returns

void

void setTransPosInit(const double transPosInit)

Setter method for the initial translating body hub-relative position.

Setter method for the initial translating body hub-relative position.

Parameters

transPosInit – [m] Initial translating body position relative to the hub

Returns

void

double getCoastOptionBangDuration() const

Getter method for the coast option bang duration.

Getter method for the coast option bang duration.

Returns

double

double getSmoothingDuration() const

Getter method for the duration the acceleration is smoothed until reaching the given maximum acceleration value.

Getter method for the duration the acceleration is smoothed until reaching the given maximum acceleration value.

Returns

double

double getTransAccelMax() const

Getter method for the bang segment scalar linear acceleration.

Getter method for the bang segment scalar linear acceleration.

Returns

double

const Eigen::Vector3d &getTransHat_M() const

Getter method for the translating body axis of translation.

Getter method for the translating body axis of translation.

Returns

const Eigen::Vector3d

double getTransPosInit() const

Getter method for the initial translating body position.

Getter method for the initial translating body position.

Returns

double

Public Members

ReadFunctor<LinearTranslationRigidBodyMsgPayload> linearTranslationRigidBodyInMsg

Input msg for the translational reference position and velocity.

Message<PrescribedTranslationMsgPayload> prescribedTranslationOutMsg

Output msg for the translational body prescribed states.

PrescribedTranslationMsg_C prescribedTranslationOutMsgC = {}

C-wrapped Output msg for the translational body prescribed states.

BSKLogger *bskLogger

BSK Logging.

Private Functions

void computeTranslationParameters()

Intermediate method to group the calculation of translation parameters into a single method.

This intermediate method groups the calculation of translation parameters into a single method.

Returns

void

void computeBangBangParametersNoSmoothing()

Method for computing the required parameters for the non-smoothed bang-bang profiler option.

This method computes the required parameters for the translation with a non-smoothed bang-bang acceleration profile.

Returns

void

void computeBangCoastBangParametersNoSmoothing()

Method for computing the required parameters for the non-smoothed bang-coast-bang profiler option.

This method computes the required parameters for the translation with a non-smoothed bang-coast-bang acceleration profile.

Returns

void

void computeSmoothedBangBangParameters()

Method for computing the required parameters for the translation with a smoothed bang-bang acceleration profile.

This method computes the required parameters for the translation with a smoothed bang-bang acceleration profile.

Returns

void

void computeSmoothedBangCoastBangParameters()

Method for computing the required parameters for the smoothed bang-coast-bang option.

This method computes the required parameters for the translation with a smoothed bang-coast-bang acceleration profile.

Returns

void

void computeCurrentState(double time)

Intermediate method used to group the calculation of the current translational states into a single method.

This intermediate method groups the calculation of the current translational states into a single method.

Returns

void

bool isInFirstBangSegment(double time) const

Method for determining if the current time is within the first bang segment.

This method determines if the current time is within the first bang segment.

Parameters

t – [s] Current simulation time

Returns

bool

bool isInSecondBangSegment(double time) const

Method for determining if the current time is within the second bang segment.

This method determines if the current time is within the second bang segment.

Parameters

t – [s] Current simulation time

Returns

bool

bool isInFirstSmoothedSegment(double time) const

Method for determining if the current time is within the first smoothing segment for the smoothed profiler options.

This method determines if the current time is within the first smoothing segment for the smoothed profiler options.

Parameters

t – [s] Current simulation time

Returns

bool

bool isInSecondSmoothedSegment(double time) const

Method for determining if the current time is within the second smoothing segment for the smoothed profiler options.

This method determines if the current time is within the second smoothing segment for the smoothed profiler options..

Parameters

t – [s] Current simulation time

Returns

bool

bool isInThirdSmoothedSegment(double time) const

Method for determining if the current time is within the third smoothing segment for the smoothed profiler options.

This method determines if the current time is within the third smoothing segment for the smoothed profiler options.

Parameters

t – [s] Current simulation time

Returns

bool

bool isInFourthSmoothedSegment(double time) const

Method for determining if the current time is within the fourth smoothing segment for the smoothed bang-coast-bang option.

This method determines if the current time is within the fourth smoothing segment for the smoothed bang-coast-bang option.

Parameters

t – [s] Current simulation time

Returns

bool

bool isInCoastSegment(double time) const

Method for determining if the current time is within the coast segment.

This method determines if the current time is within the coast segment.

Parameters

t – [s] Current simulation time

Returns

bool

void computeFirstBangSegment(double time)

Method for computing the first bang segment scalar translational states.

This method computes the first bang segment scalar translational states.

Parameters

t – [s] Current simulation time

Returns

void

void computeSecondBangSegment(double time)

Method for computing the second bang segment scalar translational states.

This method computes the second bang segment scalar translational states.

Parameters

t – [s] Current simulation time

Returns

void

void computeFirstSmoothedSegment(double time)

Method for computing the first smoothing segment scalar translational states for the smoothed profiler options.

This method computes the first smoothing segment scalar translational states for the smoothed profiler options.

Parameters

t – [s] Current simulation time

Returns

void

void computeSecondSmoothedSegment(double time)

Method for computing the second smoothing segment scalar translational states for the smoothed profiler options.

This method computes the second smoothing segment scalar translational states for the smoothed profiler options.

Parameters

t – [s] Current simulation time

Returns

void

void computeThirdSmoothedSegment(double time)

Method for computing the third smoothing segment scalar translational states for the smoothed profiler options.

This method computes the third smoothing segment scalar translational states for the smoothed profiler options.

Parameters

t – [s] Current simulation time

Returns

void

void computeFourthSmoothedSegment(double time)

Method for computing the fourth smoothing segment scalar translational states for the smoothed bang-coast-bang option.

This method computes the fourth smoothing segment scalar translational states for the smoothed bang-coast-bang option.

Parameters

t – [s] Current simulation time

Returns

void

void computeCoastSegment(double time)

Method for computing the coast segment scalar translational states.

This method computes the coast segment scalar translational states

Parameters

t – [s] Current simulation time

Returns

void

void computeTranslationComplete()

Method for computing the scalar translational states when the translation is complete.

This method computes the scalar translational states when the translation is complete.

Returns

void

void writeOutputMessages(uint64_t CurrentSimNanos)

Method for writing the module output messages and computing the output message data.

This method writes the module output messages and computes the output message data.

Returns

void

Private Members

double coastOptionBangDuration

[s] Time used for the coast option bang segment

double smoothingDuration

[s] Time the acceleration is smoothed to the given maximum acceleration value

double transAccelMax

[m/s^2] Maximum acceleration magnitude

Eigen::Vector3d transHat_M

Axis along the direction of translation expressed in M frame components.

double transPosInit

[m] Initial translational body position from M to F frame origin along transHat_M

double transPosRef

[m] Reference translational body position from M to F frame origin along transHat_M

double transPos

[m] Current translational body position along transHat_M

double transVel

[m] Current translational body velocity along transHat_M

double transAccel

[m] Current translational body acceleration along transHat_M

double transPos_tb1

[m] Position at the end of the first bang segment

double transVel_tb1

[m/s] Velocity at the end of the first bang segment

double transPos_tb2

[m] Position at the end of the second bang segment

double transVel_tb2

[m/s] Velocity at the end of the second bang segment

double transPos_ts1

[m] Position at the end of the first smoothed segment

double transVel_ts1

[m/s] Velocity at the end of the first smoothed segment

double transPos_ts2

[m] Position at the end of the second smoothed segment

double transVel_ts2

[m/s] Velocity at the end of the second smoothed segment

double transPos_ts3

[m] Position at the end of the third smoothed segment

double transVel_ts3

[m/s] Velocity at the end of the third smoothed segment

double transPos_tc

[m] Position at the end of the coast segment

double transVel_tc

[m/s] Velocity at the end of the coast segment

double tInit

[s] Simulation time at the beginning of the translation

double t_b1

[s] Simulation time at the end of the first bang segment

double t_b2

[s] Simulation time at the end of the second bang segment

double t_s1

[s] Simulation time at the end of the first smoothed segment

double t_s2

[s] Simulation time at the end of the second smoothed segment

double t_s3

[s] Simulation time at the end of the third smoothed segment

double t_c

[s] Simulation time at the end of the coast segment

double t_f

[s] Simulation time when the translation is complete

bool convergence

Boolean variable is true when the translation is complete.

double a

Parabolic constant for the first half of the bang-bang non-smoothed translation.

double b

Parabolic constant for the second half of the bang-bang non-smoothed translation.