set_pos() function waits until the servo reaches the target pos (based on stimated time)