Trajectory Optimization for 3D Scene Reconstruction