Controlling Speed

Whats the best way to on the fly control speed or velocity? I’ve been in guided mode and using the simple_goto to follow a leader but it simply isn’t updating it fast enough or correctly. If I am constantly receiving the leader’s location and velocity, how can I use that to constantly update my velocity?
Thanks