Added vheicle_bodyframe_meas and XDR-C parser