TWO-STEP APPROACH TO OPTIMAL MOTION AND STRUCTURE ESTIMATION.