diff --git a/.github/workflows/ci.yaml b/.github/workflows/ci.yaml index 0317fcab..0665a20b 100644 --- a/.github/workflows/ci.yaml +++ b/.github/workflows/ci.yaml @@ -9,7 +9,7 @@ jobs: build: runs-on: ubuntu-latest container: - image: osrf/ros:foxy-desktop + image: osrf/ros:galactic-desktop steps: - uses: actions/checkout@v2 - name: Setup colcon workspace @@ -26,18 +26,18 @@ jobs: python3-colcon-ros cd /home/ros2_ws/src/ rosdep update - rosdep install --from-paths ./ -i -y --rosdistro foxy \ + rosdep install --from-paths ./ -i -y --rosdistro galactic \ --ignore-src - name: Build project id: build run: | cd /home/ros2_ws/ - . /opt/ros/foxy/local_setup.sh + . /opt/ros/galactic/local_setup.sh colcon build --packages-up-to gazebo_ros2_control_demos - name: Run tests id: test run: | cd /home/ros2_ws/ - . /opt/ros/foxy/local_setup.sh + . /opt/ros/galactic/local_setup.sh colcon test --event-handlers console_direct+ --packages-select gazebo_ros2_control gazebo_ros2_control_demos colcon test-result diff --git a/gazebo_ros2_control/src/gazebo_ros2_control_plugin.cpp b/gazebo_ros2_control/src/gazebo_ros2_control_plugin.cpp index 376c64f4..53aaa4d9 100644 --- a/gazebo_ros2_control/src/gazebo_ros2_control_plugin.cpp +++ b/gazebo_ros2_control/src/gazebo_ros2_control_plugin.cpp @@ -369,9 +369,9 @@ void GazeboRosControlPrivate::Update() rclcpp::Duration sim_period = sim_time_ros - last_update_sim_time_ros_; if (sim_period >= control_period_) { - last_update_sim_time_ros_ = sim_time_ros; controller_manager_->read(); - controller_manager_->update(); + controller_manager_->update(sim_time_ros, sim_period); + last_update_sim_time_ros_ = sim_time_ros; } // Always set commands on joints, otherwise at low control frequencies the joints tremble diff --git a/gazebo_ros2_control_demos/package.xml b/gazebo_ros2_control_demos/package.xml index 365c86dd..715f4af3 100644 --- a/gazebo_ros2_control_demos/package.xml +++ b/gazebo_ros2_control_demos/package.xml @@ -28,7 +28,7 @@ gazebo_ros hardware_interface joint_trajectory_controller - joint_state_controller + joint_state_broadcaster launch launch_ros robot_state_publisher