If the motor is not reaching the desired velocity, please make sure the space vector PWM is enabled and ensure the full voltage range is used by setting the following register to maximum: UQ_UD_LIMITS = 32767.
To enable the space vector PWM, go to register PWM_SV_CHOP and set bit8 to high.