49 lines
1.8 KiB
Python
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()
|