Code Update

Separated the Cur off frequency for trajectory LPF and  velocity LPF.