Systems and methods are provided for the elimination/mitigation of vibration arising from a mode transition during robotic operation include a moveable robotic mechanism and a processor configured to control the robotic mechanism. The processor is configured to detect a request for a mode transition, wherein the request for the mode transition designates a new mode that is different than a current mode, determine initial parameters of the robotic mechanism, calculate a smoothing curve, and move the robotic mechanism according to the smoothing curve. The initial parameters include a position and a velocity of the robotic mechanism. The smoothing curve transitions between the current mode and the new mode and is C3 continuous. In some embodiments, to calculate the smoothing curve, the processor is configured to establish a first command position, calculate a step value, and set a second command position based on the first command position and the step value.