Now uses setpoint to drive undulator