Here's a quick example demonstrating how to change the setpoint of the position control loop:

This motion was implemented as shown below. "r" is our global setpoint variable. Since the control loop is implemented using interrupts, you don't really have to worry about it in your main loop once it is enabled!