Drift during shaking

[mohith-sakthivel]

The PD controlller outputs a twist. We add a sinusoidal shaking motion to generate a shaking profile. Because the net integral of velocity that the robot executes will not necessarily sum to zero, a drift from the profile is introduced. This effect is more profound if the control loop is specifically not able to maintain its refresh rate.