Add a took that parses regul log and apply all that forces to gazebo model. Then it should check navig message and compare paths in regul log and gazebo model's one.