diff --git a/python/gtsam/tests/test_Pose3SLAMExample.py b/python/gtsam/tests/test_Pose3SLAMExample.py index fce171b55..cb5e3b226 100644 --- a/python/gtsam/tests/test_Pose3SLAMExample.py +++ b/python/gtsam/tests/test_Pose3SLAMExample.py @@ -15,14 +15,14 @@ import numpy as np import gtsam from gtsam.utils.test_case import GtsamTestCase -from gtsam.utils.circlePose3 import * +from gtsam.utils.circlePose3 import circlePose3 class TestPose3SLAMExample(GtsamTestCase): - def test_Pose3SLAMExample(self): + def test_Pose3SLAMExample(self) -> None: # Create a hexagon of poses - hexagon = circlePose3(6, 1.0) + hexagon = circlePose3(numPoses=6, radius=1.0) p0 = hexagon.atPose3(0) p1 = hexagon.atPose3(1) @@ -31,7 +31,7 @@ class TestPose3SLAMExample(GtsamTestCase): fg.add(gtsam.NonlinearEqualityPose3(0, p0)) delta = p0.between(p1) covariance = gtsam.noiseModel.Diagonal.Sigmas( - np.array([0.05, 0.05, 0.05, 5. * pi / 180, 5. * pi / 180, 5. * pi / 180])) + np.array([0.05, 0.05, 0.05, np.deg2rad(5.), np.deg2rad(5.), np.deg2rad(5.)])) fg.add(gtsam.BetweenFactorPose3(0, 1, delta, covariance)) fg.add(gtsam.BetweenFactorPose3(1, 2, delta, covariance)) fg.add(gtsam.BetweenFactorPose3(2, 3, delta, covariance))