Added velocity to ground truth odometry and changed default GUI window size to 600x400.

Changed default GUI window size to 600x400 (fixes a bug on small screens, which results in segfault or absence of font-rendered content).
Added velocity to ground truth odometry.