Fixed scale drift issue in self-calibration by using odometry data in full bundle adjustment.