sm_dance_bot: Overshooting goal

[DecDury]

Describe the bug
A clear and concise description of what the bug is.

When the robot overshoots a goal it gets stuck and continually outlines a circle.

To Reproduce
Steps to reproduce the behavior:

Changed radial pattern iterations to two for faster testing.
launched sm_dance_bot via ros2 launch sm_dance_bot sm_dance_bot_launch.py

Expected behavior
A clear and concise description of what you expected to happen.

The robot would complete its dance.

Screenshots
If applicable, add screenshots to help explain your problem.

Environment (please complete the following information):

ROS DETAILS:

• OS: Ubuntu 20.04 LTS
• Version Rolling

REPO DETAILS:

• Repository: robosoft-ai/SMACC2
• Commit (First 5 Digits): de618

BUILDSPACE DETAILS (List all packages):

• [e.g. ros2_control - 6bbde]
• [e.g. moveit2 - 6bbde]
• ...

BUILD DETAILS

• Build Command: [e.g. colcon build --symlink-install]
  -colcon build --cmake-args -DCMAKE_BUILD_TYPE=Release

TEST DETAILS

• Launch file: ros2 launch sm_dance_bot sm_dance_bot_launch.py

Additional context

• Anything that may be unusual about your environment

Suspect a possibly dirty system but am uncertain.

Add any other context about the problem here, especially include any modifications to smacc2 that relate to this issue.

The only change made to SMACC2 was the number of iterations for the radial patterns to two for faster testing.

Error Details