Files
a7l20-hug-sim/tests/test_left_index_pointing_pose.py

31 lines
1.1 KiB
Python

import sys
import unittest
from pathlib import Path
sys.path.insert(0, str(Path(__file__).resolve().parents[1]/'scripts'))
from g20_left_lookup import LeftLookup
from left_index_pointing_pose import pointing_target
class PointingPoseTest(unittest.TestCase):
def test_index_only_extended_and_lateral_preserved(self):
raw = [[244,82,250,0,0,251],[55,0,254,0,0,254],
[12,0,254,0,0,254],[37,0,254,0,0,254],[93,0,254,0,0,254]]
original = [r.copy() for r in raw]
lookup = LeftLookup()
target = pointing_target(raw, lookup)
self.assertEqual(raw, original)
self.assertEqual(target[1][2],255)
self.assertEqual(target[1][5],255)
for i in range(5):
for slot in (0,1,3,4):
self.assertEqual(target[i][slot],raw[i][slot])
for i in (0,2,3,4):
self.assertLess(target[i][2],raw[i][2])
self.assertLess(target[i][5],raw[i][5])
self.assertEqual(lookup.angle('index_mcp_pitch',target[1][2]),0)
self.assertEqual(lookup.angle('index_pip',target[1][5]),0)
if __name__ == '__main__':unittest.main()