Add iiwa_controller_v2: Implement hardware interface for KUKA iiwa7 via FRI

- Introduced iiwa_hardware_interface_plugin.xml to define the hardware interface.
- Created command_guard.hpp to enforce joint limits for position and torque commands.
- Developed fri_client.hpp and fri_client.cpp to manage FRI communication and state snapshots.
- Implemented system_interface.hpp and system_interface.cpp for lifecycle management and command handling.
- Added system_interface_type_values.hpp for extended state interface names.
- Defined package.xml for ROS2 integration with necessary dependencies.

src/iiwa_config/config/moveit/iiwa_controller.yaml

@@ -8,6 +8,19 @@ controller_manager:
     iiwa_arm_controller:
       type: "joint_trajectory_controller/JointTrajectoryController"
 
+    forward_position_controller:
+      type: "forward_command_controller/ForwardCommandController"
+
+joint_state_broadcaster:
+  ros__parameters:
+    interfaces:
+      - position
+      - velocity
+      - effort
+      - external_torque
+      - commanded_torque
+      - ipo_joint_position
+
 iiwa_arm_controller:
   ros__parameters:
     joints:
@@ -26,25 +39,16 @@ iiwa_arm_controller:
       - position
       - velocity
 
-    # Интерполяция от реально измеренной позиции, а не от желаемой.
-    # При true JTC стартует от последнего desired state, который может расходиться
-    # с measured_pos (= filtered_pos_ в open-loop режиме) → скачок команды → удар приводов.
     interpolate_from_desired_state: false
-
-    # Разрешить неполные goals
     allow_partial_joints_goal: false
-
-    # Полная остановка в конечной точке.
-    # При true и команде через топик JTC уходит в осцилляцию у цели.
     allow_nonzero_velocity_at_trajectory_end: false
 
-    state_publish_rate: 100.0 # Гц публикации /joint_states
-    action_monitor_rate: 20.0 # Гц мониторинга action goal
+    state_publish_rate: 100.0
+    action_monitor_rate: 20.0
 
-    # Допуски — насколько точно робот должен попасть в цель
     # constraints:
-    #   stopped_velocity_tolerance: 0.01  # рад/с — считаем остановившимся
-    #   goal_time: 1.0 # сек — доп. время на достижение цели
+    #   stopped_velocity_tolerance: 0.01
+    #   goal_time: 1.0
     #   joint1: { trajectory: 0, goal: 0.01 }
     #   joint2: { trajectory: 0, goal: 0.01 }
     #   joint3: { trajectory: 0, goal: 0.01 }
@@ -53,3 +57,14 @@ iiwa_arm_controller:
     #   joint6: { trajectory: 0, goal: 0.01 }
     #   joint7: { trajectory: 0, goal: 0.01 }
 
+forward_position_controller:
+  ros__parameters:
+    joints:
+      - joint1
+      - joint2
+      - joint3
+      - joint4
+      - joint5
+      - joint6
+      - joint7
+    interface_name: position

src/iiwa_config/config/setting.yaml

@@ -5,6 +5,7 @@ robot:
   command_mode: "position" # torque, position
   fri_cycle_ms: 5          # период FRI-цикла: 5 мс (200 Гц) или 10 мс (100 Гц)
   joint_position_tau: 0.04  # постоянная времени фильтра позиций [с]: больше → плавнее, медленнее
+  active_controller: "jtc"  # "jtc" = MoveIt/JointTrajectoryController, "forward" = ForwardCommandController
   description: pkg://iiwa_description/urdf/iiwa7.urdf.xacro