A system for generating a ground truth dataset for motion planning of a vehicle is disclosed. The system includes an internet server that further includes an I/O port, configured to transmit and receive electrical signals to and from a client device; a memory; one or more processing units; and one or more programs stored in the memory and configured for execution by the one or more processing units, the one or more programs including instructions for: a corresponding module configured to correspond, for each pair of images, a first image of the pair to a LiDAR static-scene point cloud; and a computing module configured to compute a camera pose associated with the pair of images in the coordinate of the point cloud.