[#1379] update jointThrAllocation to write desired joint accelerations

Author: Will-Schwend

src/fswAlgorithms/effectorInterfaces/jointThrAllocation/jointThrAllocation.py

@@ -367,7 +367,9 @@ def UpdateState(self, CurrentSimNanos):
 
         self.jointAnglePayload.states.clear()
         self.jointAnglePayload.stateDots.clear()
+        self.jointAnglePayload.stateDDots.clear()
         for angleCmd in bestDecision[: self.nJoint]:
             self.jointAnglePayload.states.push_back(float(angleCmd))
             self.jointAnglePayload.stateDots.push_back(0.0)  # [rad/s]
+            self.jointAnglePayload.stateDDots.push_back(0.0)  # [rad/s^2]
         self.desJointAnglesOutMsg.write(self.jointAnglePayload, CurrentSimNanos, self.moduleID)