Convert vehicle motion to a class.

1. Add Vehicle class.
2. Minor refactoring of camera intrinsics solving.