Fixes to compile under CCS; updated UKF and NMPC with latest C66 binaries
Switched to custom assert function to preserve stack traces; serial packet parser improvements; fixed EMIF UART; minor reference trajectory generation bug fixes
Fixed HITL script; added sanity check to path length