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