naming of local function
parent
5aa75b5594
commit
2f5a60d039
|
@ -20,14 +20,14 @@ import numpy as np
|
||||||
import gtsam
|
import gtsam
|
||||||
|
|
||||||
|
|
||||||
def Vector3(x, y, z):
|
def vector3(x, y, z):
|
||||||
"""Create 3d double numpy array."""
|
"""Create 3d double numpy array."""
|
||||||
return np.array([x, y, z], dtype=np.float)
|
return np.array([x, y, z], dtype=np.float)
|
||||||
|
|
||||||
|
|
||||||
# Create noise models
|
# Create noise models
|
||||||
PRIOR_NOISE = gtsam.noiseModel_Diagonal.Sigmas(Vector3(0.3, 0.3, 0.1))
|
PRIOR_NOISE = gtsam.noiseModel_Diagonal.Sigmas(vector3(0.3, 0.3, 0.1))
|
||||||
ODOMETRY_NOISE = gtsam.noiseModel_Diagonal.Sigmas(Vector3(0.2, 0.2, 0.1))
|
ODOMETRY_NOISE = gtsam.noiseModel_Diagonal.Sigmas(vector3(0.2, 0.2, 0.1))
|
||||||
|
|
||||||
# 1. Create a factor graph container and add factors to it
|
# 1. Create a factor graph container and add factors to it
|
||||||
graph = gtsam.NonlinearFactorGraph()
|
graph = gtsam.NonlinearFactorGraph()
|
||||||
|
|
Loading…
Reference in New Issue