import align from gtsam directly
parent
5c737c3cc4
commit
3fc7692b4a
|
@ -13,7 +13,7 @@ import unittest
|
||||||
import numpy as np
|
import numpy as np
|
||||||
|
|
||||||
import gtsam
|
import gtsam
|
||||||
from gtsam import Point2, Point2Pairs, Pose2
|
from gtsam import align, Point2, Point2Pairs, Pose2
|
||||||
from gtsam.utils.test_case import GtsamTestCase
|
from gtsam.utils.test_case import GtsamTestCase
|
||||||
|
|
||||||
|
|
||||||
|
@ -58,7 +58,7 @@ class TestPose2(GtsamTestCase):
|
||||||
|
|
||||||
# fmt: on
|
# fmt: on
|
||||||
ab_pairs = Point2Pairs(list(zip(pts_a, pts_b)))
|
ab_pairs = Point2Pairs(list(zip(pts_a, pts_b)))
|
||||||
bTa = Pose2.align(ab_pairs)
|
bTa = align(ab_pairs)
|
||||||
aTb = bTa.inverse()
|
aTb = bTa.inverse()
|
||||||
assert aTb is not None
|
assert aTb is not None
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue