merge with cleaned up comments

release/4.3a0
John Lambert 2020-10-19 09:12:59 -04:00
commit f8d534e8e5
1 changed files with 5 additions and 7 deletions

View File

@ -36,14 +36,14 @@ def run(args):
""" Run LM optimization with BAL input data and report resulting error """
input_file = gtsam.findExampleDataFile(args.input_file)
# # Load the SfM data from file
# Load the SfM data from file
scene_data = readBal(input_file)
logging.info(f"read {scene_data.number_tracks()} tracks on {scene_data.number_cameras()} cameras\n")
# # Create a factor graph
# Create a factor graph
graph = gtsam.NonlinearFactorGraph()
# # We share *one* noiseModel between all projection factors
# We share *one* noiseModel between all projection factors
noise = gtsam.noiseModel.Isotropic.Sigma(2, 1.0) # one pixel in u and v
# Add measurements to the factor graph
@ -71,7 +71,7 @@ def run(args):
)
)
# # Create initial estimate
# Create initial estimate
initial = gtsam.Values()
i = 0
@ -97,7 +97,7 @@ def run(args):
except Exception as e:
logging.exception("LM Optimization failed")
return
# Error drops from 2764.22 to 0.046
# Error drops from ~2764.22 to ~0.046
logging.info(f"final error: {graph.error(result)}")
@ -116,5 +116,3 @@ if __name__ == "__main__":
)
run(parser.parse_args())