Looks good. The acceleration vs velocity seems strange, but maybe that's just a limitation of running at 25kHz.