add msg and srv

control_msgs/CMakeLists.txt

@@ -21,6 +21,7 @@ find_package(trajectory_msgs REQUIRED)
 
 set(msg_files
   msg/AdmittanceControllerState.msg
+  msg/CartesianTrajectoryGeneratorState.msg
   msg/DynamicJointState.msg
   msg/GripperCommand.msg
   msg/InterfaceValue.msg
@@ -50,6 +51,7 @@ set(action_files
 set(srv_files
   srv/QueryCalibrationState.srv
   srv/QueryTrajectoryState.srv
+  srv/ResetDofs.srv
 )
 
 rosidl_generate_interfaces(${PROJECT_NAME}

control_msgs/msg/CartesianTrajectoryGeneratorState.msg

@@ -0,0 +1,15 @@
+std_msgs/Header header
+
+string[] dof_names
+# The set point, that is, the reference.
+trajectory_msgs/MultiDOFJointTrajectoryPoint reference_world
+trajectory_msgs/MultiDOFJointTrajectoryPoint reference_local
+# Current value of the process (ie: latest sensor measurement or estimation on the controlled value).
+trajectory_msgs/MultiDOFJointTrajectoryPoint feedback
+# Adjusted feedback message for the interpolation in the local frame.
+trajectory_msgs/MultiDOFJointTrajectoryPoint feedback_local
+# The error of the controlled value, essentially reference - feedback (for a regular PID implementation).
+trajectory_msgs/MultiDOFJointTrajectoryPoint error
+# Current output of the controller.
+trajectory_msgs/MultiDOFJointTrajectoryPoint output_world
+trajectory_msgs/MultiDOFJointTrajectoryPoint output_local

control_msgs/srv/ResetDofs.srv

@@ -0,0 +1,8 @@
+# This service enables resetting internal value of a controller with multiple degrees of freedom.
+
+string[] names
+float64[] positions # if present, positions should match size of dof names and also size of velocities/accelerations
+float64[] velocities
+float64[] accelerations
+---
+bool ok