import unittest import numpy as np from scipy.spatial.transform import Rotation from g1_blind_pose import pose class PoseTests(unittest.TestCase): def setUp(self):self.x=np.array([[2.,3,4],[3.,3,4],[2.,5,4],[2.,3,7]]);self.f=np.array([[0,1,2],[0,1,3],[0,2,3],[1,2,3]]) def test_scale_distances_and_inverse(self): r=Rotation.from_rotvec([.3,.5,.1]).as_matrix();y,m=pose(self.x,self.f,r,[.2,-.1,.7]);back=(y-np.array(m['random_translation']))@r+np.array(m['source_center']);np.testing.assert_allclose(back,self.x,rtol=0,atol=1e-12);self.assertLess(m['edge_error_over_bbox_diagonal'],1e-12) def test_reflection_rejected(self): with self.assertRaises(ValueError):pose(self.x,self.f,np.diag([-1,1,1]),[0,0,0]) def test_scale_change_rejected(self): with self.assertRaises(ValueError):pose(self.x,self.f,2*np.eye(3),[0,0,0]) def test_seed_children_stable_and_mirror_parity(self): two=np.random.SeedSequence([2026111413]).spawn(2);three=np.random.SeedSequence([2026111413]).spawn(3) for a,b in zip(two,three):np.testing.assert_array_equal(a.generate_state(8),b.generate_state(8)) rng=np.random.Generator(np.random.PCG64(three[2]));a=Rotation.random(random_state=rng).as_matrix();b=Rotation.random(random_state=rng).as_matrix();self.assertFalse(np.allclose(a,b));self.assertAlmostEqual(np.linalg.det(b@np.diag([-1,1,1])@a.T),-1) if __name__=='__main__':unittest.main()