1818 )
1919 ).resolve ()
2020)
21- eval_trajectories = np .load (f"{ paper_data_path } /TRI_CLEAN_SPILL_v2.npy" )
21+ eval_clean_up_spill = np .load (
22+ f"{ paper_data_path } /TRI_CLEAN_SPILL_v2.npy"
23+ ) # Must be flipped for standard form
24+ eval_fold_red_towel = np .load (
25+ f"{ paper_data_path } /TRI_FOLD_RED_TOWEL.npy"
26+ ) # ALREADY in standard form
27+ eval_sim_spoon_on_towel = np .load (
28+ f"{ paper_data_path } /TRI_SIM_SPOON_ON_TOWEL.npy"
29+ ) # Must be flipped for standard form
30+ eval_sim_eggplant_in_basket = np .load (
31+ f"{ paper_data_path } /TRI_SIM_EGGPLANT_IN_BASKET.npy"
32+ ) # Must be flipped for standard form
33+ eval_sim_stack_cube = np .load (
34+ f"{ paper_data_path } /TRI_SIM_STACK_CUBE.npy"
35+ ) # Must be flipped for standard form
2236
2337
2438@pytest .fixture (scope = "module" )
@@ -63,10 +77,10 @@ def test_step_input_value_error(step):
6377 (Hypothesis .P0MoreThanP1 , np .zeros (15 ), np .ones (15 ), Decision .FailToDecide ),
6478 (Hypothesis .P0LessThanP1 , np .ones (15 ), np .zeros (15 ), Decision .FailToDecide ),
6579 (Hypothesis .P0MoreThanP1 , np .ones (15 ), np .zeros (15 ), Decision .AcceptAlternative ),
66- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], Decision .AcceptAlternative ),
67- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], Decision .FailToDecide ),
68- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], Decision .FailToDecide ),
69- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], Decision .AcceptAlternative ),
80+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], Decision .AcceptAlternative ),
81+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], Decision .FailToDecide ),
82+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], Decision .FailToDecide ),
83+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], Decision .AcceptAlternative ),
7084 # fmt: on
7185 ],
7286 indirect = ["step" ],
@@ -80,17 +94,21 @@ def test_step(step, sequence_0, sequence_1, expected):
8094 ("step" , "sequence_0" , "sequence_1" , "expected" ),
8195 [
8296 # fmt: off
83- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 22.5 ),
84- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 50 ),
85- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 50 ),
86- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 22.5 ),
97+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 23 ),
98+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 50 ),
99+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 50 ),
100+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 23 ),
101+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 21.5 ),
102+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 50 ),
103+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 50 ),
104+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 21.5 ),
87105 # fmt: on
88106 ],
89107 indirect = ["step" ],
90108)
91109def test_step_time (step , sequence_0 , sequence_1 , expected ):
92110 result = step .run_on_sequence (sequence_0 , sequence_1 )
93- assert np .abs (float (result .info ["Time" ]) - expected ) <= 3.0
111+ assert np .abs (float (result .info ["Time" ]) - expected ) <= 1.2
94112
95113
96114@pytest .fixture (scope = "module" )
@@ -108,17 +126,21 @@ def step500(request):
108126 ("step500" , "sequence_0" , "sequence_1" , "expected" ),
109127 [
110128 # fmt: off
111- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 33 ),
112- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 50 ),
113- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 50 ),
114- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 33 ),
129+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 25.5 ),
130+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 50 ),
131+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 50 ),
132+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 25.5 ),
133+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 23.5 ),
134+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 50 ),
135+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 50 ),
136+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 23.5 ),
115137 # fmt: on
116138 ],
117139 indirect = ["step500" ],
118140)
119141def test_step500_time (step500 , sequence_0 , sequence_1 , expected ):
120142 result = step500 .run_on_sequence (sequence_0 , sequence_1 )
121- assert np .abs (result .info ["Time" ] - expected ) <= 1.5
143+ assert np .abs (result .info ["Time" ] - expected ) <= 0.6
122144
123145
124146##### Mirrored STEP Test #####
@@ -160,17 +182,21 @@ def test_mirrored_step(mirrored_step, sequence_0, sequence_1, expected):
160182 ("mirrored_step" , "sequence_0" , "sequence_1" , "expected" ),
161183 [
162184 # fmt: off
163- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 25 ),
164- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 25 ),
165- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 25 ),
166- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 25 ),
185+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 23.5 ),
186+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 23.5 ),
187+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 23.5 ),
188+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 23.5 ),
189+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 21.5 ),
190+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 21.5 ),
191+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 21.5 ),
192+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 21.5 ),
167193 # fmt: on
168194 ],
169195 indirect = ["mirrored_step" ],
170196)
171197def test_mirrored_step_time (mirrored_step , sequence_0 , sequence_1 , expected ):
172198 result = mirrored_step .run_on_sequence (sequence_0 , sequence_1 )
173- assert np .abs (result .info ["Time" ] - expected ) <= 1.5
199+ assert np .abs (result .info ["Time" ] - expected ) <= 0.6
174200
175201
176202@pytest .fixture (scope = "module" )
@@ -188,14 +214,30 @@ def mirrored_step500(request):
188214 ("mirrored_step500" , "sequence_0" , "sequence_1" , "expected" ),
189215 [
190216 # fmt: off
191- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 33 ),
192- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 1 ], eval_trajectories [:, 0 ], 33 ),
193- (Hypothesis .P0LessThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 33 ),
194- (Hypothesis .P0MoreThanP1 , eval_trajectories [:, 0 ], eval_trajectories [:, 1 ], 33 ),
217+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 25.5 ),
218+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 1 ], eval_clean_up_spill [:, 0 ], 25.5 ),
219+ (Hypothesis .P0LessThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 25.5 ),
220+ (Hypothesis .P0MoreThanP1 , eval_clean_up_spill [:, 0 ], eval_clean_up_spill [:, 1 ], 25.5 ),
221+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 23.5 ),
222+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 0 ], eval_fold_red_towel [:, 1 ], 23.5 ),
223+ (Hypothesis .P0LessThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 23.5 ),
224+ (Hypothesis .P0MoreThanP1 , eval_fold_red_towel [:, 1 ], eval_fold_red_towel [:, 0 ], 23.5 ),
225+ (Hypothesis .P0LessThanP1 , eval_sim_spoon_on_towel [:, 1 ], eval_sim_spoon_on_towel [:, 0 ], 32.5 ),
226+ (Hypothesis .P0MoreThanP1 , eval_sim_spoon_on_towel [:, 1 ], eval_sim_spoon_on_towel [:, 0 ], 32.5 ),
227+ (Hypothesis .P0LessThanP1 , eval_sim_spoon_on_towel [:, 0 ], eval_sim_spoon_on_towel [:, 1 ], 32.5 ),
228+ (Hypothesis .P0MoreThanP1 , eval_sim_spoon_on_towel [:, 0 ], eval_sim_spoon_on_towel [:, 1 ], 32.5 ),
229+ (Hypothesis .P0LessThanP1 , eval_sim_eggplant_in_basket [:, 1 ], eval_sim_eggplant_in_basket [:, 0 ], 119.5 ),
230+ (Hypothesis .P0MoreThanP1 , eval_sim_eggplant_in_basket [:, 1 ], eval_sim_eggplant_in_basket [:, 0 ], 119.5 ),
231+ (Hypothesis .P0LessThanP1 , eval_sim_eggplant_in_basket [:, 0 ], eval_sim_eggplant_in_basket [:, 1 ], 119.5 ),
232+ (Hypothesis .P0MoreThanP1 , eval_sim_eggplant_in_basket [:, 0 ], eval_sim_eggplant_in_basket [:, 1 ], 119.5 ),
233+ (Hypothesis .P0LessThanP1 , eval_sim_stack_cube [:, 1 ], eval_sim_stack_cube [:, 0 ], 172.5 ),
234+ (Hypothesis .P0MoreThanP1 , eval_sim_stack_cube [:, 1 ], eval_sim_stack_cube [:, 0 ], 172.5 ),
235+ (Hypothesis .P0LessThanP1 , eval_sim_stack_cube [:, 0 ], eval_sim_stack_cube [:, 1 ], 172.5 ),
236+ (Hypothesis .P0MoreThanP1 , eval_sim_stack_cube [:, 0 ], eval_sim_stack_cube [:, 1 ], 172.5 ),
195237 # fmt: on
196238 ],
197239 indirect = ["mirrored_step500" ],
198240)
199241def test_mirrored_step500_time (mirrored_step500 , sequence_0 , sequence_1 , expected ):
200242 result = mirrored_step500 .run_on_sequence (sequence_0 , sequence_1 )
201- assert np .abs (result .info ["Time" ] - expected ) <= 1.5
243+ assert np .abs (result .info ["Time" ] - expected ) <= 0.6
0 commit comments