Custom gazebo_ros_control simulation plugin that can add latency to communication between ros_control and gazebo - View it on GitHub