Add motion_primitives_forward_controller for interfacing motion primitive messages with hardware interfaces

[mathias31415]

This PR adds the motion_primitives_forward_controller, a controller for forwarding motion primitive commands to motion-primitive-capable hardware interfaces.
It was developed alongside the motion_primitive_ur_driver and is intended to support future hardware interfaces for additional robot manufacturers.
The corresponding PR for integrating the motion_primitive_ur_driver into the official Universal Robots ROS 2 driver can be found here: UniversalRobots/Universal_Robots_ROS2_Driver#1341.

The controller subscribes to MotionPrimitive.msg from the industrial_robot_motion_interfaces package. The MotionPrimitive.msg has been extended with additional helper types:

• STOP_MOTION: Immediately interrupts execution and clears all queued primitives.
• MOTION_SEQUENCE_START and MOTION_SEQUENCE_END: Define a sequence of primitives to be executed as a blended motion block.

The controller uses the following interfaces:

Command Interfaces

• motion_type: Type of motion primitive (e.g., LINEAR_JOINT, LINEAR_CARTESIAN, CIRCULAR_CARTESIAN, etc.)
• q1 – q6: Target joint positions for joint-based motion
• pos_x, pos_y, pos_z: Target Cartesian position
• pos_qx, pos_qy, pos_qz, pos_qw: Orientation quaternion of the target pose
• pos_via_x, pos_via_y, pos_via_z: Intermediate via-point position for circular motion
• pos_via_qx, pos_via_qy, pos_via_qz, pos_via_qw: Orientation quaternion of via-point
• blend_radius: Blending radius for smooth transitions
• velocity: Desired motion velocity
• acceleration: Desired motion acceleration
• move_time: Optional duration for time-based execution

State Interfaces

• execution_status: Indicates the current execution state of the primitive.
• ready_for_new_primitive: Boolean flag indicating whether the interface is ready to receive a new motion primitive

I'd appreciate any feedback or suggestions – thanks in advance!

[bmagyar]

There is a lot of stuff coming from templates in this PR and you either used some AI tool for coding or you are very good at writing AI-style comments.

Please try removing all commented code or fix them and remove all comments that add nothing to the code itself (which in this code is almost all comments...)

[urfeex]

@mathias31415 I've added a PR to control_msgs with the motion primitives in ros-controls/control_msgs#228. Would you like to use those for your PR?

[codecov]

Codecov Report

Attention: Patch coverage is 58.87324% with 146 lines in your changes missing coverage. Please review.

Project coverage is 85.65%. Comparing base (9e89020) to head (a8bcee3).
Report is 5 commits behind head on master.

Files with missing lines	Patch %	Lines
...oller/src/motion_primitives_forward_controller.cpp	39.73%	120 Missing and 18 partials ⚠️
...test/test_motion_primitives_forward_controller.hpp	89.06%	3 Missing and 4 partials ⚠️
...test/test_motion_primitives_forward_controller.cpp	97.43%	0 Missing and 1 partial ⚠️

Additional details and impacted files

@@            Coverage Diff             @@
##           master    #1636      +/-   ##
==========================================
- Coverage   86.42%   85.65%   -0.78%     
==========================================
  Files         123      129       +6     
  Lines       12231    12591     +360     
  Branches     1021     1067      +46     
==========================================
+ Hits        10571    10785     +214     
- Misses       1344     1467     +123     
- Partials      316      339      +23     

Flag	Coverage Δ
unittests	85.65% <58.87%> (-0.78%)	⬇️

Flags with carried forward coverage won't be shown. Click here to find out more.

Files with missing lines	Coverage Δ
...ontroller/motion_primitives_forward_controller.hpp	100.00% <100.00%> (ø)
...test_load_motion_primitives_forward_controller.cpp	100.00% <100.00%> (ø)
...otion_primitives_forward_controller_preceeding.cpp	100.00% <100.00%> (ø)
...test/test_motion_primitives_forward_controller.cpp	97.43% <97.43%> (ø)
...test/test_motion_primitives_forward_controller.hpp	89.06% <89.06%> (ø)
...oller/src/motion_primitives_forward_controller.cpp	39.73% <39.73%> (ø)

🚀 New features to boost your workflow:

• ❄️ Test Analytics: Detect flaky tests, report on failures, and find test suite problems.