The Dance officially begins when the robot begins to stand up, but I included the beginning part too because that is part of the code. I tried, with some order of success, to time the movements of the robot to the music, but that was very shotty as the execution speed varied with each test.
And click here to go to the video on YouTube