Added Direct Step, Direct Chirp and Trajectory Command

Changed PID parameters for Trajectory test.
Added bash scripts to record messages in csv format for matlab edit
mend