Merge pull request #540 from borglab/fix/imu-factor-example
ImuFactorExample minor fixesrelease/4.3a0
commit
b5014b1403
|
@ -104,7 +104,7 @@ class ImuFactorExample(PreintegrationExample):
|
||||||
|
|
||||||
if verbose:
|
if verbose:
|
||||||
print(factor)
|
print(factor)
|
||||||
print(pim.predict(actual_state_i, self.actualBias))
|
print(pim.predict(initial_state_i, self.actualBias))
|
||||||
|
|
||||||
pim.resetIntegration()
|
pim.resetIntegration()
|
||||||
|
|
||||||
|
@ -125,7 +125,7 @@ class ImuFactorExample(PreintegrationExample):
|
||||||
i += 1
|
i += 1
|
||||||
|
|
||||||
# add priors on end
|
# add priors on end
|
||||||
# self.addPrior(num_poses - 1, graph)
|
self.addPrior(num_poses - 1, graph)
|
||||||
|
|
||||||
initial.print_("Initial values:")
|
initial.print_("Initial values:")
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue