Files
MeltMind/tools/test_g1_blind_pose.py
T

18 lines
1.4 KiB
Python

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()