§
    ÃÂÓj.  ã                   óÊ   — d dl Zd dlmc mZ d dlZd dlmZ d dl	Z
d dlZd dlZd dlmZmZmZmZ d dlmZmZmZ d dlmZmZmZmZmZ d„ Zd„ Zd„ Zd	„ Zd
„ Z d„ Z!d„ Z"d„ Z#d„ Z$dS )é    N)ÚPath)Úbox_iouÚmake_bundleÚoracle_summaryÚselected_detection)ÚPalletPosePredictorÚbundle_pathÚpartial_document)Ú
GLOBAL_DIMÚTASKSÚPointNetResidualÚRidgeResidualÚbase_predictionc                  ó   — ddddddœS )Né@   é   é    g{®Gázt?Ú*assume_native_numeric_metres_research_only)ÚpointsÚgeometry_pointsÚransac_iterationsÚplane_thresholdÚunverified_unit_policy© r   ó    úF/root/private/project/pallet_detection_v2/tests/test_pose_inference.pyÚcfgr      s!   € Ø¨#À"ÐW[Ø!MðOð Oð Or   c                  ój  — t           j        d d…d d…f         \  } }t          j        |dz  dz   |dz
  dz  | dz
  dz  |dz  dz   fd¬	¦  «                             dd
¦  «                             t           j        ¦  «        }|t          j        dt           j        ¬¦  «                             dd¦  «        fS )Né   r   é   g      @é   é(   é   éÿÿÿÿ)Úaxisé   r   ©Údtype)ÚnpÚmgridÚstackÚreshapeÚastypeÚfloat32ÚarangeÚint32)ÚyyÚxxr   s      r   Úarraysr3      sª   € Ý
Œ(�3�B�3�s˜�s�7Ô
�E€B€rÝŒ8�R˜‘T˜!‘V˜R ™V R™K¨¨C©°©°B°q±D¸±FÐ;ÀÐDÑDÔD×LÒLÈRÐPQÑRÔR×YÒYÕZ\ÔZdÑeÔe€FØ•"”)˜C¥b¤hÐ/Ñ/Ô/×7Ò7¸¸2Ñ>Ô>Ð>Ð>r   c                  ó´   — t          j        t           ¦  «        } t          ¦   «         ddœ| _        d| _        t          j        d¦  «        | _        d„ | _        | S )NÚgeometry)Úpose_featuresÚselected_planar_familyFÚcpuc                 ó   — g d¢ddœgS )N©r   r   r   r   gÍÌÌÌÌÌì?©Úbox_xywhÚ
confidencer   )Úimages    r   ú<lambda>z fake_predictor.<locals>.<lambda>   s   € ¨{¨{¨{ÈÐ#KÐ#KÐ"L€ r   )r   Ú__new__r   ÚspecÚallow_unverified_unitsÚtorchÚdeviceÚdetect)Ú	predictors    r   Úfake_predictorrG      sQ   € Ý!Ô)Õ*=Ñ>Ô>€IÝ$'¡E¤EÀ:ÐNÐN€I„NØ%*€IÔ$Ý”\ %Ñ(Ô(€IÔØLÐL€IÔØÐr   c                  óV  — t          g d¢t          d         ¦  «        } g }| d         }d }||u }|}|r"| d         }d }||u }|}|r| d         }	d }
|	|
u }|}|�sdt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }d	d
|iz  }|                     |¦  «         |rÂt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }|                     |¦  «         |r`t          j        d|fd|	|
f¦  «        t          j        |	¦  «        t          j        |
¦  «        dœz  }dd|iz  }|                     |¦  «         t          j        |d¦  «        i z  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}x}x}x}x}x}	x}}
g }| d         }d}||k    }|}|r| d         }| }|}|sÐt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }d	d
|iz  }|                     |¦  «         |r.ddt          j        |¦  «        iz  }|                     |¦  «         t          j        |d¦  «        i z  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}x}x}}t          g d¢t          d         ¦  «        }g }|d         }d }||u }|}|r"|d         }d }||u }|}|r|d          }	d }
|	|
u }|}|�sdt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }d	d
|iz  }|                     |¦  «         |rÂt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }|                     |¦  «         |r`t          j        d|fd|	|
f¦  «        t          j        |	¦  «        t          j        |
¦  «        dœz  }dd|iz  }|                     |¦  «         t          j        |d¦  «        i z  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}x}x}x}x}x}	x}}
g }|d         }g d!¢}||k    }|}|r|d"         }| }|}|sÐt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }d	d
|iz  }|                     |¦  «         |r.ddt          j        |¦  «        iz  }|                     |¦  «         t          j        |d¦  «        i z  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}x}x}}d S )#N)r    çš™™™™™¹?r#   r   r   ÚzÚ
quaternionÚnormal©Úis©z%(py3)s is %(py6)s©Úpy3Úpy6ú%(py8)sÚpy8)z%(py11)s is %(py14)s©Úpy11Úpy14ú%(py16)sÚpy16)z%(py19)s is %(py22)s)Úpy19Úpy22z%(py24)sÚpy24zassert %(py27)sÚpy27Útheta_degreesÚrobot_command_eligible©ú==©z%(py3)s == %(py6)sznot %(py11)srV   zassert %(py15)sÚpy15)r    rI   gš™™™™™É?r#   r   r   r#   ÚyawÚroll)r#   r   r   Úfull_six_dof)	r
   r   Ú
@pytest_arÚ_call_reprcompareÚ	_safereprÚappendÚ_format_boolopÚAssertionErrorÚ_format_explanation)ÚplaneÚ@py_assert1Ú@py_assert2Ú@py_assert5Ú@py_assert4Ú@py_assert0Ú@py_assert10Ú@py_assert13Ú@py_assert12Ú@py_assert18Ú@py_assert21Ú@py_assert20Ú@py_format7Ú@py_format9Ú@py_format15Ú@py_format17Ú@py_format23Ú@py_format25Ú@py_format26Ú@py_format28Ú@py_format13Ú@py_format14Ú@py_format16rL   s                           r   Ú>test_partial_prediction_never_fabricates_missing_rotation_or_zr…   !   s¼  € Ý
˜:˜:˜:¥e¨A¤hÑ
/Ô
/€EØYÐYˆ5�Œ:ÐY˜ÐYˆ:˜ÐÐYÐYÐYÐYÐY %¨Ô"5ÐY¸ÐYÐ"5¸Ð"=ÐYÐYÐYÐYÐYÀ%ÈÄ/ÐYÐUYÐYÀ/ÐUYÐBYÐYÐYÐYÐYÑYÕYÔYÐYÐYÐYÐYˆ:˜ÐYÑYÔYÕYÔYˆ:ÑYÔYÕYÔY˜ÑYÔYÐYÐYÑYÐYÐYÐYÐYÐYÑYÐYÐY×YÒYÐYÑYÔYÐYÐYÐYÕYÔYÐYÐYÐYÐYÐ"5¸ÐYÑYÔYÕYÔYÐ"5ÑYÔYÕYÔY¸ÑYÔYÐYÐYÑYÐYÐYÐYÐYÐYÑYÐYÐY×YÒYÐYÑYÔYÐYÐYÐYÕYÔYÐYÐYÐYÐYÀ/ÐUYÐYÑYÔYÕYÔYÀ/ÑYÔYÕYÔYÐUYÑYÔYÐYÐYÑYÐYÐYÐYÐYÐYÑYÐYÐY×YÒYÐYÑYÔYÐYÕYÔYÐYÐYÑYÔYÐYÑYÐYÐYÐYÐYÐYÑYÐYÕYÕYÔYÐYÑYÔYÑYÔYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYÐYØLÐLˆ5�Ô!ÐL 1ÐLÐ! 1Ò$ÐLÐLÐLÐLÐL¨UÐ3KÔ-LÐLÐ-LÐ)LÐLÐ)LÐLÐLÐLÕLÔLÐLÐLÐLÐLÐ! 1ÐLÑLÔLÕLÔLÐ!ÑLÔLÕLÔL 1ÑLÔLÐLÐLÑLÐLÐLÐLÐLÐLÑLÐLÐL×LÒLÐLÑLÔLÐLÐLÐLÐLÐLÕLÔLÐ-LÑLÔLÐLÑLÐLÐL×LÒLÐLÑLÔLÐLÕLÔLÐLÐLÑLÔLÐLÑLÐLÐLÐLÐLÐLÑLÐLÕLÕLÔLÐLÑLÔLÑLÔLÐLÐLÐLÐLÐLÐLÐLÐLÐLÐLÐLÐLÐLÐLÐLÝ˜O˜O˜O­E°!¬HÑ5Ô5€FØ_Ð_ˆ6�/Ô"Ð_ dÐ_Ð" dÐ*Ð_Ð_Ð_Ð_Ð_¨v°e¬}Ð_ÀÐ_¨}ÀÐ/DÐ_Ð_Ð_Ð_Ð_ÈÐPVÌÐ_Ð[_Ð_ÈÐ[_ÐI_Ð_Ð_Ð_Ð_Ñ_Õ_Ô_Ð_Ð_Ð_Ð_Ð" dÐ_Ñ_Ô_Õ_Ô_Ð"Ñ_Ô_Õ_Ô_ dÑ_Ô_Ð_Ð_Ñ_Ð_Ð_Ð_Ð_Ð_Ñ_Ð_Ð_×_Ò_Ð_Ñ_Ô_Ð_Ð_Ð_Õ_Ô_Ð_Ð_Ð_Ð_¨}ÀÐ_Ñ_Ô_Õ_Ô_¨}Ñ_Ô_Õ_Ô_ÀÑ_Ô_Ð_Ð_Ñ_Ð_Ð_Ð_Ð_Ð_Ñ_Ð_Ð_×_Ò_Ð_Ñ_Ô_Ð_Ð_Ð_Õ_Ô_Ð_Ð_Ð_Ð_ÈÐ[_Ð_Ñ_Ô_Õ_Ô_ÈÑ_Ô_Õ_Ô_Ð[_Ñ_Ô_Ð_Ð_Ñ_Ð_Ð_Ð_Ð_Ð_Ñ_Ð_Ð_×_Ò_Ð_Ñ_Ô_Ð_Õ_Ô_Ð_Ð_Ñ_Ô_Ð_Ñ_Ð_Ð_Ð_Ð_Ð_Ñ_Ð_Õ_Õ_Ô_Ð_Ñ_Ô_Ñ_Ô_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_Ð_ØCÐCˆ6�(ÔÐC˜W˜W˜WÐCÐ˜WÒ$ÐCÐCÐCÐCÐC¨V°NÔ-CÐCÐ-CÐ)CÐCÐ)CÐCÐCÐCÕCÔCÐCÐCÐCÐCÐ˜WÐCÑCÔCÕCÔCÐÑCÔCÕCÔC˜WÑCÔCÐCÐCÑCÐCÐCÐCÐCÐCÑCÐCÐC×CÒCÐCÑCÔCÐCÐCÐCÐCÐCÕCÔCÐ-CÑCÔCÐCÑCÐCÐC×CÒCÐCÑCÔCÐCÕCÔCÐCÐCÑCÔCÐCÑCÐCÐCÐCÐCÐCÑCÐCÕCÕCÔCÐCÑCÔCÑCÔCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCr   c                  óŽ  — t          ¦   «         } t          ¦   «         \  }}t          j        t          d¬¦  «        5  |                      ||g d¢dd¦  «         d d d ¦  «         n# 1 swxY w Y   |                      t          j        dt          j	        ¬¦  «        ||d¬¦  «        }|d	         d
         d         d         }t          j
        }d} ||¦  «        }||k    }|sÚt          j        d|fd||f¦  «        t          j        |¦  «        dt          j        ¦   «         v st          j        t          ¦  «        rt          j        t          ¦  «        ndt          j        |¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }	dd|	iz  }
t#          t          j        |
¦  «        ¦  «        ‚d x}x}x}x}}|d         }d}||u }|slt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }t#          t          j        |¦  «        ¦  «        ‚d x}x}}|d         }| }|s:ddt          j        |¦  «        iz  }t#          t          j        |¦  «        ¦  «        ‚d x}}|                      t          j        dt          j	        ¬¦  «        ||¦  «        }g }|d	         d
         d         }d }||u }|}|r|d	         d
         d         }|}|sÐt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        d œz  }d!d"|iz  }|                     |¦  «         |r.d#dt          j        |¦  «        iz  }
|                     |
¦  «         t          j        |d
¦  «        i z  }d$d%|iz  }t#          t          j        |¦  «        ¦  «        ‚d x}x}x}x}x}}t          j        t          d&¬¦  «        5  |                      t          j        d't          j	        ¬¦  «        ||d¬¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )(Nzunits unverified)Úmatchr:   r   )r   r   r'   ç      ð?)Ú
scale_to_mÚ
detectionsr   ÚposeÚxr    r`   )zL%(py1)s == %(py9)s
{%(py9)s = %(py5)s
{%(py5)s = %(py3)s.approx
}(%(py7)s)
}Úpytest)Úpy1rQ   Úpy5Úpy7Úpy9úassert %(py11)srV   Úground_truth_used_for_inferenceFrM   )z%(py1)s is %(py4)s©rŽ   Úpy4úassert %(py6)srR   r_   zassert not %(py1)srŽ   ÚerrorrO   rP   rS   rT   ú%(py11)szassert %(py14)srW   Úregistration)r   r   )rG   r3   r�   ÚraisesÚ
ValueErrorr‹   Úpredictr)   ÚzerosÚuint8Úapproxrg   rh   ri   Ú@py_builtinsÚlocalsÚ_should_repr_global_namerl   rm   rj   rk   )rF   r   ÚmappingÚresultrs   rr   Ú@py_assert6Ú@py_assert8rp   Ú@py_format10Ú@py_format12Ú@py_assert3Ú@py_format5rz   Ú@py_format3Úbadro   rq   rt   r{   r‚   r|   s                         r   ÚItest_real_roi_prediction_needs_no_ground_truth_and_rejects_implicit_unitsr­   *   s\  € ÝÑÔ€I­f©h¬h™~˜v gÝ	Œ•zÐ(:Ð	;Ñ	;Ô	;ð 9ð 9Ø�Š�v˜g k k k°"°RÑ8Ô8Ð8ð9ð 9ð 9ñ 9ô 9ð 9ð 9ð 9ð 9ð 9ð 9øøøð 9ð 9ð 9ð 9à×Ò�RœX gµB´HÐ=Ñ=Ô=¸fÀWÐXZÐÑ[Ô[€FØ�,Ô Ô" 6Ô*¨3Ô/ÐAµ´ÐA¸qÐA°°¸qÑ1AÔ1AÐAÐ/Ð1AÒAÐAÐAÐAÕAÔAÐAÐAÐAÐAÐ/Ð1AÐAÑAÔAÕAÔAÐ/ÑAÔAÐAÕAÔAÑAÔAÐAÐAÕAÔAµÑAÔAÐAÕAÔAµÑAÔAÐAÐAÕAÔA°ÑAÔAÕAÔA¸qÑAÔAÕAÔAÐ1AÑAÔAÐAÐAÑAÐAÐAÐAÐAÐAÑAÐAÕAÕAÔAÐAÑAÔAÑAÔAÐAÐAÐAÐAÐAÐAÐAÐAÐAÐAÐAØÐ3Ô4Ð=¸Ð=Ð4¸Ð=Ð=Ð=Ð=Õ=Ô=Ð=Ð=Ð=Ð=Ð4¸Ð=Ñ=Ô=Õ=Ô=Ð4Ñ=Ô=Õ=Ô=¸Ñ=Ô=Ð=Ð=Ñ=Ð=Ð=Ð=Ð=Ð=Ñ=Ð=Õ=Õ=Ô=Ð=Ñ=Ô=Ñ=Ô=Ð=Ð=Ð=Ð=Ð=Ð=Ð=ØÐ.Ô/Ð/Ð/Ð/Ð/Ð/Ð/Ð/Ð/Õ/Ô/Ð/Ñ/Ô/Ð/Ñ/Ð/Õ/Õ/Ô/Ð/Ñ/Ô/Ñ/Ô/Ð/Ð/Ð/Ð/Ð/Ø×Ò�"œ( 7µ´Ð:Ñ:Ô:¸6À'ÑJÔJ€CØQÐQˆ3ˆ|Ô˜QÔ Ô'ÐQ¨4ÐQÐ'¨4Ð/ÐQÐQÐQÐQÐQ°C¸Ô4EÀaÔ4HÈÔ4QÐQÐ4QÐQÐQÐQÕQÔQÐQÐQÐQÐQÐ'¨4ÐQÑQÔQÕQÔQÐ'ÑQÔQÕQÔQ¨4ÑQÔQÐQÐQÑQÐQÐQÐQÐQÐQÑQÐQÐQ×QÒQÐQÑQÔQÐQÐQÐQÐQÐQÕQÔQÐ4QÑQÔQÐQÑQÐQÐQ×QÒQÐQÑQÔQÐQÕQÔQÐQÐQÑQÔQÐQÑQÐQÐQÐQÐQÐQÑQÐQÕQÕQÔQÐQÑQÔQÑQÔQÐQÐQÐQÐQÐQÐQÐQÐQÐQÐQÐQÐQÐQÝ	Œ•z¨Ð	7Ñ	7Ô	7ð Yð YØ×Ò�"œ( 7µ´Ð:Ñ:Ô:¸6À'ÐUWÐÑXÔXÐXðYð Yð Yñ Yô Yð Yð Yð Yð Yð Yð Yð Yøøøð Yð Yð Yð Yð Yð Ys#   »A#Á#A'Á*A'Ï58P:Ð:P>ÑP>c            	      ó  — g d¢} g d¢ddœ| ddœ| ddœg}d}t          || |¦  «        }d}||k    }|�sCt          j        d	|fd
||f¦  «        dt          j        ¦   «         v st          j        t           ¦  «        rt          j        t           ¦  «        nddt          j        ¦   «         v st          j        |¦  «        rt          j        |¦  «        nddt          j        ¦   «         v st          j        | ¦  «        rt          j        | ¦  «        ndt          j        |¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}}|d d…         }d}	t          || |	¦  «        }
d }|
|u }|�st          j        d|fd|
|f¦  «        dt          j        ¦   «         v st          j        t           ¦  «        rt          j        t           ¦  «        ndt          j        |¦  «        dt          j        ¦   «         v st          j        | ¦  «        rt          j        | ¦  «        ndt          j        |	¦  «        t          j        |
¦  «        t          j        |¦  «        dœz  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}	x}
x}}g }t          | | ¦  «        }d}||k    }|}|r(|d         d         }t          | |¦  «        }d}||k    }|}|�s_t          j        d	|fd||f¦  «        dt          j        ¦   «         v st          j        t          ¦  «        rt          j        t          ¦  «        nddt          j        ¦   «         v st          j        | ¦  «        rt          j        | ¦  «        nddt          j        ¦   «         v st          j        | ¦  «        rt          j        | ¦  «        ndt          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }| 
                    |¦  «         |rùt          j        d	|fd||f¦  «        dt          j        ¦   «         v st          j        t          ¦  «        rt          j        t          ¦  «        nddt          j        ¦   «         v st          j        | ¦  «        rt          j        | ¦  «        ndt          j        |¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd |iz  }| 
                    |¦  «         t          j        |d¦  «        i z  }d!d"|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}x}x}x}x}}d S )#N)r   r   é
   r¯   )é2   r°   r¯   r¯   g®Gáz®ï?r;   g333333ã?gš™™™™™é?ç      à?r    r`   )zB%(py6)s
{%(py6)s = %(py0)s(%(py1)s, %(py2)s, %(py4)s)
} == %(py9)sr   rŠ   Útruth)Úpy0rŽ   Úpy2r•   rR   r‘   r’   rV   r#   rM   )zC%(py7)s
{%(py7)s = %(py0)s(%(py2)s, %(py3)s, %(py5)s)
} is %(py10)s)r³   r´   rQ   r�   r�   Úpy10úassert %(py12)sÚpy12r   r<   )z9%(py6)s
{%(py6)s = %(py2)s(%(py3)s, %(py4)s)
} == %(py9)sr   )r´   rQ   r•   rR   r‘   r˜   )z?%(py18)s
{%(py18)s = %(py13)s(%(py14)s, %(py16)s)
} == %(py21)s)Úpy13rW   rY   Úpy18Úpy21z%(py23)sÚpy23zassert %(py26)sÚpy26)r   rg   rh   r    r¡   r¢   ri   rl   rm   r   rj   rk   )r²   rŠ   r©   rq   r¦   Ú@py_assert7r§   r¨   ro   rr   r¥   Ú@py_assert9Ú@py_format11r‚   rs   Ú@py_assert15Ú@py_assert17ry   Ú@py_assert19Ú@py_format22Ú@py_format24r   Ú@py_format27s                          r   Ú?test_detector_matching_is_scoring_only_and_orders_by_confidencerÆ   8   s  € Ø
ˆ+ˆ+€EØ)˜M˜M°sÐ;Ð;Ø rÐ*Ð*°uÈ"Ð+MÐ+MðO€Jà/1Ð5Õ˜j¨¨rÑ2Ô2Ð5°AÐ5Ð2°AÒ5Ð5Ð5Ñ5Õ5Ô5Ð5Ð5Ð5Ð5Ð2°AÐ5Ñ5Ô5Ð5Õ5Ô5Ñ5Ô5Ð5Ð5Õ5Ô5ÕÑ5Ô5Ð5Õ5Ô5ÕÑ5Ô5Ð5Ð5Ð5Õ5Ô5Ñ5Ô5Ð5Ð5Õ5Ô5˜jÑ5Ô5Ð5Õ5Ô5˜jÑ5Ô5Ð5Ð5Ð5Õ5Ô5Ñ5Ô5Ð5Ð5Õ5Ô5¨Ñ5Ô5Ð5Õ5Ô5¨Ñ5Ô5Ð5Ð5Õ5Ô5¨rÑ5Ô5Õ5Ô5Ð2Ñ5Ô5Õ5Ô5°AÑ5Ô5Ð5Ð5Ñ5Ð5Ð5Ð5Ð5Ð5Ñ5Ð5Õ5Õ5Ô5Ð5Ñ5Ô5Ñ5Ô5Ð5Ð5Ð5Ð5Ð5Ð5Ð5Ð5Ð5Ø(¨¨!¨œnÐ>°2Ð>Õ˜n¨U°2Ñ6Ô6Ð>¸$Ð>Ð6¸$Ð>Ð>Ð>Ñ>Õ>Ô>Ð>Ð>Ð>Ð>Ð6¸$Ð>Ñ>Ô>Ð>Õ>Ô>Ñ>Ô>Ð>Ð>Õ>Ô>ÕÑ>Ô>Ð>Õ>Ô>ÕÑ>Ô>Ð>Ð>Õ>Ô>˜nÑ>Ô>Ð>Õ>Ô>Ñ>Ô>Ð>Ð>Õ>Ô>¨UÑ>Ô>Ð>Õ>Ô>¨UÑ>Ô>Ð>Ð>Õ>Ô>°2Ñ>Ô>Õ>Ô>Ð6Ñ>Ô>Õ>Ô>¸$Ñ>Ô>Ð>Ð>Ñ>Ð>Ð>Ð>Ð>Ð>Ñ>Ð>Õ>Õ>Ô>Ð>Ñ>Ô>Ñ>Ô>Ð>Ð>Ð>Ð>Ð>Ð>Ð>Ð>Ð>Ð>Ð>ØRÐR�7�5˜ÑÔÐR ÐRÐ Ò"ÐRÐRÐRÐRÐR°ZÀ´]À:Ô5NÐR¥w¨uÐ5NÑ'OÔ'OÐRÐQRÐRÐ'OÐQRÒ'RÐRÐRÐRÐRÑRÕRÔRÐRÐRÐRÐRÐ ÐRÑRÔRÐRÕRÔRÑRÔRÐRÐRÕRÔR�7ÑRÔRÐRÕRÔR�7ÑRÔRÐRÐRÐRÕRÔRÑRÔRÐRÐRÕRÔR�5ÑRÔRÐRÕRÔR�5ÑRÔRÐRÐRÐRÕRÔRÑRÔRÐRÐRÕRÔR˜ÑRÔRÐRÕRÔR˜ÑRÔRÐRÐRÕRÔRÐÑRÔRÕRÔR ÑRÔRÐRÐRÑRÐRÐRÐRÐRÐRÑRÐRÐR×RÒRÐRÑRÔRÐRÐRÐRÕRÔRÐRÐRÐRÐRÐ'OÐQRÐRÑRÔRÐRÕRÔRÑRÔRÐRÐRÕRÔR¥wÑRÔRÐRÕRÔR¥wÑRÔRÐRÐRÐRÕRÔRÑRÔRÐRÐRÕRÔR¨uÑRÔRÐRÕRÔR¨uÑRÔRÐRÐRÕRÔRÐ5NÑRÔRÕRÔRÐ'OÑRÔRÕRÔRÐQRÑRÔRÐRÐRÑRÐRÐRÐRÐRÐRÑRÐRÐR×RÒRÐRÑRÔRÐRÕRÔRÐRÐRÑRÔRÐRÑRÐRÐRÐRÐRÐRÑRÐRÕRÕRÔRÐRÑRÔRÑRÔRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRÐRr   c                  óD  — t          j        g d¢g d¢g¦  «        } |                      ¦   «         }t           j        |d<   t	          || ddiddig¦  «        }g }|d         }d}||k    }|}|r|d         }d}	||	k    }
|
}|�st          j        d	|fd
||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }|                     |¦  «         |r`t          j        d	|
fd||	f¦  «        t          j        |¦  «        t          j        |	¦  «        dœz  }dd|iz  }|                     |¦  «         t          j	        |d¦  «        i z  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}x}x}x}
}	|d         d         }d}||k    }|slt          j        d	|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}}|d         }d}||k    }|slt          j        d	|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}}d S )N)rˆ   r   rˆ   r   r#   Úgroup_idÚaÚbÚattempted_samplesr    Úinput_failuresr`   rb   rP   rS   rT   )z%(py11)s == %(py14)srU   rX   rY   r   zassert %(py19)srZ   ÚoverallÚsuccess_50mm_5degrˆ   )z%(py1)s == %(py4)sr”   r–   rR   Ú"success_rate_all_samples_50mm_5degr±   )r)   ÚarrayÚcopyÚnanr   rg   rh   ri   rj   rk   rl   rm   )ÚyÚ
predictionr¤   ro   rp   rq   rr   rs   rt   ru   rv   rz   r{   r|   r}   Ú@py_format18Ú@py_format20r©   rª   s                      r   Ú;test_failed_oracle_inputs_remain_in_the_success_denominatorr×   A   sf  € Ý„h���˜K˜K˜KÐ(Ñ)Ô)€AØ�vŠv‰xŒx€J¥b¤f˜
 1™Ý˜* Q¨°CÐ(8¸*ÀSÐ9IÐ'JÑKÔK€FØIÐIˆ6Ð%Ô&ÐI¨ÐIÐ&¨Ò)ÐIÐIÐIÐIÐI¨fÐ5EÔ.FÐIÈÐIÐ.FÈÒ.IÐIÐIÐIÐIÑIÕIÔIÐIÐIÐIÐIÐ&¨ÐIÑIÔIÕIÔIÐ&ÑIÔIÕIÔI¨ÑIÔIÐIÐIÑIÐIÐIÐIÐIÐIÑIÐIÐI×IÒIÐIÑIÔIÐIÐIÐIÕIÔIÐIÐIÐIÐIÐ.FÈÐIÑIÔIÕIÔIÐ.FÑIÔIÕIÔIÈÑIÔIÐIÐIÑIÐIÐIÐIÐIÐIÑIÐIÐI×IÒIÐIÑIÔIÐIÕIÔIÐIÐIÑIÔIÐIÑIÐIÐIÐIÐIÐIÑIÐIÕIÕIÔIÐIÑIÔIÑIÔIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIÐIØ�)ÔÐ0Ô1Ð5°2Ð5Ð1°2Ò5Ð5Ð5Ð5Õ5Ô5Ð5Ð5Ð5Ð5Ð1°2Ð5Ñ5Ô5Õ5Ô5Ð1Ñ5Ô5Õ5Ô5°2Ñ5Ô5Ð5Ð5Ñ5Ð5Ð5Ð5Ð5Ð5Ñ5Ð5Õ5Õ5Ô5Ð5Ñ5Ô5Ñ5Ô5Ð5Ð5Ð5Ð5Ð5Ð5Ð5ØÐ6Ô7Ð;¸Ð;Ð7¸Ò;Ð;Ð;Ð;Õ;Ô;Ð;Ð;Ð;Ð;Ð7¸Ð;Ñ;Ô;Õ;Ô;Ð7Ñ;Ô;Õ;Ô;¸Ñ;Ô;Ð;Ð;Ñ;Ð;Ð;Ð;Ð;Ð;Ñ;Ð;Õ;Õ;Ô;Ð;Ñ;Ô;Ñ;Ô;Ð;Ð;Ð;Ð;Ð;Ð;Ð;Ð;Ð;r   c           	      óê  — d}t          | |¦  «        }d}| |z  }||k    }|�sCt          j        d|fd||f¦  «        dt          j        ¦   «         v st          j        t           ¦  «        rt          j        t           ¦  «        nddt          j        ¦   «         v st          j        | ¦  «        rt          j        | ¦  «        ndt          j        |¦  «        t          j        |¦  «        dt          j        ¦   «         v st          j        | ¦  «        rt          j        | ¦  «        ndt          j        |¦  «        dœz  }dd|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}}t          j
        t          ¦  «        5  t          | d	¦  «         d d d ¦  «         n# 1 swxY w Y   t          j
        t          ¦  «        5  t          | d
¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )Nzmodel.ptr`   )zE%(py5)s
{%(py5)s = %(py0)s(%(py1)s, %(py3)s)
} == (%(py7)s / %(py9)s)r	   Útmp_path)r³   rŽ   rQ   r�   r�   r‘   r¶   r·   z../escape.ptz/absolute.pt)r	   rg   rh   r    r¡   r¢   ri   rl   rm   r�   rš   r›   )rÙ   rp   rr   r¦   rt   r¥   r¿   r‚   s           r   Útest_bundle_paths_cannot_escaperÚ   J   s6  € Ø *Ð@�;�x 
Ñ+Ô+Ð@°jÐ@¨X°jÑ-@Ð@Ð+Ð-@Ò@Ð@Ð@Ñ@Õ@Ô@Ð@Ð@Ð@Ð@Ð+Ð-@Ð@Ñ@Ô@Ð@Õ@Ô@Ñ@Ô@Ð@Ð@Õ@Ô@�;Ñ@Ô@Ð@Õ@Ô@�;Ñ@Ô@Ð@Ð@Ð@Õ@Ô@Ñ@Ô@Ð@Ð@Õ@Ô@�xÑ@Ô@Ð@Õ@Ô@�xÑ@Ô@Ð@Ð@Õ@Ô@ 
Ñ@Ô@Õ@Ô@Ð+Ñ@Ô@Ð@Õ@Ô@Ñ@Ô@Ð@Ð@Õ@Ô@¨XÑ@Ô@Ð@Õ@Ô@¨XÑ@Ô@Ð@Ð@Õ@Ô@°jÑ@Ô@Ð@Ð@Ñ@Ð@Ð@Ð@Ð@Ð@Ñ@Ð@Õ@Õ@Ô@Ð@Ñ@Ô@Ñ@Ô@Ð@Ð@Ð@Ð@Ð@Ð@Ð@Ð@Ð@Ð@Ð@Ý	Œ•zÑ	"Ô	"ÐGÐG¥;¨x¸Ñ#GÔ#GÐ#GÐGÐGÐGÑGÔGÐGÐGÐGÐGÐGÐGøøøÐGÐGÐGÐGÝ	Œ•zÑ	"Ô	"ÐGÐG¥;¨x¸Ñ#GÔ#GÐ#GÐGÐGÐGÑGÔGÐGÐGÐGÐGÐGÐGÐGøøøÐGÐGÐGÐGÐGÐGs$   Æ	F&Æ&F*Æ-F*Ç
G(Ç(G,Ç/G,c           	      ó   — ddl m} | dz  }|                     ¦   «          |dz  }|                     d¦  «         i }dt          d         fdt          d         ffD ]e\  }}||d	z   z  }t          |¦  «        }t          j        ||                     ¦   «         d d
œ|¦  «         t          |¦  «         ||¦  «        dœ||<   Œft          j        dt          f¦  «        }	g d¢|	d d …df<   d|	d d …df<   t          ¦   «                              |	t          |	t          d         ¦  «        ¦  «        }
|dz  }|                     t#          j        |
                     ¦   «         ¦  «        ¦  «         t          |¦  «         ||¦  «        dœ|d<   |ddœ}t)          ¦   «         ddddœdœ}t+          |||t          |¦  «         ||¦  «        dœ¦  «        }t#          j        |dz                       ¦   «         ¦  «        }|d                              ¦   «         D �]\  }}t          j        ||z  dd¬¦  «        }g }t5          |¦  «        }ddh}||k    }|}|r|d         }||k    }|}|�s³t7          j        d|fd ||f¦  «        d!t;          j        ¦   «         v st7          j        t4          ¦  «        rt7          j         t4          ¦  «        nd!d"t;          j        ¦   «         v st7          j        |¦  «        rt7          j         |¦  «        nd"t7          j         |¦  «        t7          j         |¦  «        d#œz  }d$d%|iz  }| !                    |¦  «         |r‹t7          j        d|fd&||f¦  «        t7          j         |¦  «        dt;          j        ¦   «         v st7          j        |¦  «        rt7          j         |¦  «        ndd'œz  }d(d)|iz  }| !                    |¦  «         t7          j"        |d¦  «        i z  }d*d+|iz  }tG          t7          j$        |¦  «        ¦  «        ‚d x}x}x}x}x}x}}�Œt+          |||t          |¦  «         ||¦  «        dœ¦  «         d S ),Nr   )Údigest_fileÚrunzdetector.pts   isolated dummy detectorÚpointnetÚnormal_pointnetr#   z.pt)ÚtaskÚmodelÚ	optimizer)ÚpathÚsha256é   )r#   r    rå   é   z
ridge.jsonÚridge)Úweightsr7   i€  g      Ð?é   )ÚimgszÚconfÚmax_det)r‹   Údetector)ÚbestÚbest_sha256zinference_config.jsonÚpointnet_weightsr8   T)Úmap_locationÚweights_onlyrà   rá   r`   )z0%(py5)s
{%(py5)s = %(py2)s(%(py3)s)
} == %(py8)sÚsetÚstate)r´   rQ   r�   rT   z%(py10)srµ   )z%(py13)s == %(py15)s)r¸   rc   z%(py17)sÚpy17zassert %(py20)sÚpy20)%Úpallet.pose_inferencerÜ   ÚmkdirÚwrite_bytesr   r   rC   ÚsaveÚ
state_dictÚstrr)   r�   r   r   Úfitr   Ú
write_textÚjsonÚdumpsÚdocumentr   r   ÚloadsÚ	read_textÚitemsÚloadró   rg   rh   r    r¡   r¢   ri   rj   rk   rl   rm   )rÙ   rÜ   Úoutrí   rè   Úkeyrà   Úprá   Úgrç   ÚplanÚconfigÚbundlerA   rã   rô   ro   rr   r½   r¥   rs   rv   Ú@py_assert14r{   r¿   r„   rÕ   Ú@py_format19Ú@py_format21s                                 r   ÚFtest_portable_pointnet_weights_are_tensor_only_and_match_frozen_sourcer  P   s¾  € Ø1Ð1Ð1Ð1Ð1Ð1Ø�‰€C�s—y’y‘{”{�{Ø�Ñ€H˜x×3Ò3Ð4NÑOÔOÐOØ€GØ ¥ q¤Ð*Ð,=½eÀA¼hÐ+GÐHð =ð =‰ˆˆDØ
ˆs�5‰y‰/ˆÕ 0°Ñ 6Ô 6˜%ÝŒ
˜4¨×(8Ò(8Ñ(:Ô(:ÀtÐLÐLÈQÑOÔOÐOÝ  ™VœV¨[¨[¸©^¬^Ð<Ð<ˆ�‰ˆÝ„h�•*ˆ~ÑÔ€A g g g˜q    1 ™v°Q¨a°°°°!°©fÝ
‰/Œ/×
Ò
˜a¥°µ%¸´(Ñ ;Ô ;Ñ
<Ô
<€E¸sÀ<Ñ?O¸QØ‡L‚L•”˜EŸNšNÑ,Ô,Ñ-Ô-Ñ.Ô.Ð.ÍÈAÉÌÐXcÐXcÐdeÑXfÔXfÐ@gÐ@g¨w°wÑ/?Ø°ZÐ	@Ð	@€DÝ‘5”5¨S¸ÀbÐ$IÐ$IÐJÐJ€FÝ�s˜6 $­s°8©}¬}È;È;ÐW_ÑK`ÔK`Ð'aÐ'aÑbÔb€FÝ	Œ�VÐ3Ñ3×>Ò>Ñ@Ô@Ñ	AÔ	A€DØÐ,Ô-×3Ò3Ñ5Ô5ð Dñ D‰	ˆˆTÝŒj˜ ™°%ÀTÐJÑJÔJˆØCÐC�s�5‰zŒzÐC˜F 7Ð+ÐCˆzÐ+Ò+ÐCÐCÐCÐCÐC°°f´ÐC°¸tÒ0CÐCÐCÐCÐCÑCÕCÔCÐCÐCÐCÐCˆzÐ+ÐCÑCÔCÐCÕCÔCÑCÔCÐCÐCÕCÔC�sÑCÔCÐCÕCÔC�sÑCÔCÐCÐCÐCÕCÔCÑCÔCÐCÐCÕCÔC�5ÑCÔCÐCÕCÔC�5ÑCÔCÐCÐCÕCÔCˆzÑCÔCÕCÔCÐ+ÑCÔCÐCÐCÑCÐCÐCÐCÐCÐCÑCÐCÐC×CÒCÐCÑCÔCÐCÐCÐCÕCÔCÐCÐCÐCÐC°¸tÐCÑCÔCÕCÔC°ÑCÔCÐCÕCÔCÑCÔCÐCÐCÕCÔC¸tÑCÔCÐCÕCÔC¸tÑCÔCÐCÐCÐCÐCÑCÐCÐCÐCÐCÐCÑCÐCÐC×CÒCÐCÑCÔCÐCÕCÔCÐCÐCÑCÔCÐCÑCÐCÐCÐCÐCÐCÑCÐCÕCÕCÔCÐCÑCÔCÑCÔCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÐCÑCÝ��F˜4­¨H©¬ÀKÀKÐPXÑDYÔDYÐ ZÐ ZÑ[Ô[Ð[Ð[Ð[r   )%Úbuiltinsr    Ú_pytest.assertion.rewriteÚ	assertionÚrewriterg   rÿ   Úpathlibr   Únumpyr)   r�   rC   Úpallet.pose_evaluationr   r   r   r   r÷   r   r	   r
   Úpallet.pose_modelr   r   r   r   r   r   r3   rG   r…   r­   rÆ   r×   rÚ   r  r   r   r   ú<module>r     si  ðØ  € € € € € € € € € € € € €€€€Ø Ð Ð Ð Ð Ð à Ð Ð Ð Ø €€€Ø €€€à XÐ XÐ XÐ XÐ XÐ XÐ XÐ XÐ XÐ XÐ XÐ XØ RÐ RÐ RÐ RÐ RÐ RÐ RÐ RÐ RÐ RØ ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]Ð ]ðOð Oð Oð
?ð ?ð ?ðð ð ðDð Dð DðYð Yð YðSð Sð Sð<ð <ð <ðHð Hð Hð\ð \ð \ð \ð \r   