Files
a7l20-hug-sim/scripts/test_offline_table_guard.py

49 lines
1.8 KiB
Python

"""Hardware-free tests; no RealArm construction or service requests."""
import unittest
from unittest.mock import patch
import numpy as np
from offline_table_guard import TableGuard
from real_arm import RealArm
class OfflineTests(unittest.TestCase):
@classmethod
def setUpClass(cls):cls.guard=TableGuard([0,0,1],[0,0,-2])
def setUp(self):self.guard.p=np.array([0.,0.,-2.])
def test_clear_path(self):
result=self.guard.check_segment(np.zeros(7),np.ones(7)*.01)
self.assertGreater(result['minimum_gap_m'],.02)
def test_table_reject(self):
self.guard.p[2]=2
with self.assertRaises(RuntimeError):self.guard.check_segment(np.zeros(7),np.zeros(7))
def test_invalid(self):
for q in ([0]*6,[float('nan')]*7,[100]*7):
with self.assertRaises(ValueError):self.guard.check_segment(np.zeros(7),q)
def test_midpath_reject(self):
def gap(q):return (.0 if .04<q[0]<.06 else 1.,'synthetic_link')
with patch.object(self.guard,'clearance',side_effect=gap):
with self.assertRaises(RuntimeError):self.guard.check_segment(np.zeros(7),[.1,0,0,0,0,0,0])
def test_send_gate(self):
arm=RealArm.__new__(RealArm);arm.side='left'
with patch('real_arm.roslibpy.Service',side_effect=AssertionError('No service allowed')) as service:
for name in ('movej','movel'):
with self.assertRaises(RuntimeError):arm._call(name,'unused',{'joints':[0]*7})
service.assert_not_called()
def test_stale(self):
arm=RealArm.__new__(RealArm);arm._st={'n':1,'m':{}}
with self.assertRaises(RuntimeError):arm.read(timeout=0)
def test_fk_failure(self):
arm=RealArm.__new__(RealArm);arm.fk=lambda q:None
self.assertFalse(arm.path_safe([0]*7,[0]*7)[0])
if __name__=='__main__':unittest.main()