is the position vector of p in camera coordinates.
is the position vector of p in vehicle coordinates.
is the homogeneous matrix which takes to
.
Since the camera was rigidly fixed with respect to the vehicle, this
transformation remains the same across all the sequences.
The values of the matrix are provided in the file cam_to_veh_homo.dat .