Add warmup for robot movement