§
    ƒ,×j½  ã                   ó>  — d Z ddlZddlZddlZddlmZ ddlZddlm	Z	 ddl
mZmZmZmZ ddlmZmZ ddlmZmZmZ dd	lmZ dd„Zd„ Zedk    rM ej        ¦   «         Ze                     dg d¢d
¬¦  «          ee                     ¦   «         j        ¦  «         dS dS )zOOriginal-box full point cloud input; automatic face is only an optional anchor.é    N)ÚPathé   )Úload_dataset)ÚROOTÚSOURCEÚshaÚ	read_rows)Úatomic_jsonÚfeature_values)ÚGeometryEngineÚ	canonicalÚraster_mask)Ú	valid_xyzÚtrainc                 ó  — t          j        d¬¦  «         t           d| z   dz   z                       d¦  «        5 }t          j        |t          j        ¦  «         t          | ¦  «        cd d d ¦  «         S # 1 swxY w Y   d S )NT)Úexist_okÚroi_z.lockÚa)r   ÚmkdirÚopenÚfcntlÚflockÚLOCK_EXÚ_prepare)ÚsplitÚlocks     úpallet/pose_benchmark_roi.pyÚpreparer      sµ   € Ý„J˜ÐÑÔÐÝ
�&˜5‘. 7Ñ*Ñ
+×	1Ò	1°#Ñ	6Ô	6ð ¸$ÝŒ�D�%œ-Ñ(Ô(Ð(Ý˜‰Œðð ð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð ð ð s   ¹.A4Á4A8Á;A8c                 óâ  ‡ ‡+— t          t          j        t          d¦  «                             ¦   «         ¦  «        d         ¦  «        }t	          |¦  «        \  }}t          |t          dz  ¦  «        }ˆ fd„t          t          dz  ¦  «        D ¦   «         }g }t          |¦  «        D �](\  }}|d         }	t          dz  |	dz   z  }
|
 
                    ¦   «         rM|                     t          j        |
                     d	¦  «                             ¦   «         ¦  «        ¦  «         Œ||d
                  }	 |                     t          |¦  «                             ¦   «         ¦  «        \  }}|d         Š+ˆ+fd„dD ¦   «         \  }}}}t!          ||g||z   |g||z   ||z   g|||z   ggg|d         ¢R Ž }t#          j        |¦  «        \  }}|||f         }t'          ||d d…f         ¦  «        }||         t#          j        ||f¦  «        |         }}t+          |¦  «        dk     rt-          d¦  «        ‚||                              t0          ¦  «        }|d                              d¦  «        }|�|dz  nd }||d         d         k    rt-          d¦  «        ‚|�|d d …d d…fxx         |z  cc<   t          dz  |	dz   z  }| 
                    ¦   «         rnt#          j        |¦  «        5 }|d         t1          |d         ¦  «        |d         }}}|d                              ¦   «         } d d d ¦  «         n# 1 swxY w Y   d}!n–t#          j        |d d …d d…f         d¬¦  «        }t;          t1          t#          j        |d d …d f         d!¦  «        t#          j        |d d …d f         d"¦  «        z
  ¦  «        d#¦  «        }t#          j        d$d%g¦  «        }d } d&}!t#          j        |d           |d         dgg |¢d‘g d'¢f¦  «        }"tA          ||d(z  |"¬)¦  «        }#g g }%}$tC          d¦  «        D ]P}&tE          |||d         ‰+|#d*|&z   d+¦  «        \  }'}(}}}|$                     |'¦  «         |%                     |(¦  «         ŒQ|
j#         $                    d,d,¬-¦  «         t#          j%        |
t#          j&        |$¦  «        | €t#          j&        |%¦  «        n| |||¬.¦  «         tA          |	d/‰ tO          |
¦  «        d0|!t+          |¦  «        |d1         ¬2¦  «        })tQ          |
                     d	¦  «        |)¦  «         n7# t,          $ r*}*tA          |	d3tS          |*¦  «        ‰ ¬4¦  «        })Y d }*~*nd }*~*ww xY w|                     |)¦  «         |d5z  dk    rDtU          t          j+        tA          d6‰ |d z   t+          |¦  «        ¬7¦  «        ¦  «        d,¬8¦  «         �Œ*tQ          t          d9‰ z   d	z   z  |¦  «         |S ):Nz"configs/active_formal_dataset.jsonÚdatasetÚroi_registrationc                 ó,   •— g | ]}|d          ‰k    ¯|‘ŒS )r   © )Ú.0Úrr   s     €r   ú
<listcomp>z_prepare.<locals>.<listcomp>   s(   ø€ Ð\Ð\Ð\�!ÈÈ'Ì
ÐV[ÒH[ÐH[ˆAÐH[ÐH[ÐH[ó    zsnapshot/eligible.jsonlÚ
target_keyÚroi_featuresz.npzz.jsonÚframe_idÚbboxc              3   ó(   •K  — | ]}‰|         V — Œd S )Nr#   )r$   ÚkÚbs     €r   ú	<genexpr>z_prepare.<locals>.<genexpr>&   s'   øè è € Ð*WÐ*W°A¨1¨Q¬4Ð*WÐ*WÐ*WÐ*WÐ*WÐ*Wr'   )ÚxÚyÚwidthÚheightÚsizeé   é   Úfewer_than_16_valid_ROI_pointsÚsensor_policyÚscale_to_mmiè  ÚsensorÚ
scale_to_mÚsource_unit_policy_mismatchzcache/featuresÚbaser2   Ú	directionÚglobalsÚautomatic_face_optionalr   )Úaxisr   g®Gáz®ï?g{®Gáz„?g:Œ0âŽyE>g      ð?g        Ú"roi_median_source_forward_fallback)r   r   r   é   )ÚcenterÚ
half_widthÚbasisé*   i   T)Úparentsr   )Úfeaturesr?   r=   r2   r>   ÚcompleteÚ5all_valid_original_bbox_points_with_1pct_outlier_trimÚsource_anchor_hash)r(   Ústater   Úsha256ÚinputÚanchorÚ
roi_pointsÚsource_pcd_sha256Úfailed)r(   rM   Úreasonr   éd   Úroi)Ústager   Ú	completedÚtotal)Úflushr   ),r   ÚjsonÚloadsÚ	read_textr   r   r   r	   r   Ú	enumerateÚexistsÚappendÚwith_suffixÚ
registeredr   Údecoder   ÚnpÚnonzeror   Úcolumn_stackÚlenÚ
ValueErrorÚastypeÚfloatÚgetÚloadÚcopyÚmedianÚmaxÚquantileÚarrayÚdictÚranger   Úparentr   Úsavez_compressedÚstackr   r
   ÚstrÚprintÚdumps),r   ÚformalÚ_ÚsourcesÚengineÚrowsÚresultsÚiÚrowÚkeyÚdestÚsourceÚpointsÚmappingr0   r1   ÚwÚhÚmaskÚyyÚxxÚidsÚgoodÚuvÚxyziÚscale_mmÚscaleÚoldÚzr=   r2   r>   Úglobals_rP   rF   Ú	candidateÚfsÚgsÚvariantÚfÚgÚresultÚexcr.   s,   `                                          @r   r   r      s[  øø€ Ý•$”*�TÐ"FÑGÔG×QÒQÑSÔSÑTÔTÐU^Ô_Ñ`Ô`€FÝ˜fÑ%Ô%�J€A€wÝ˜F¥DÐ+=Ñ$=Ñ>Ô>€FØ\Ð\Ð\Ð\•y¥Ð*CÑ!CÑDÔDÐ\Ñ\Ô\€DØ€GÝ˜D‘/”/ð 7lñ 7l‰ˆˆ3Ø�,ÔˆÝ�nÑ$¨¨f©Ñ5ˆØ�;Š;‰=Œ=ð 	Ø�NŠN�4œ: d×&6Ò&6°wÑ&?Ô&?×&IÒ&IÑ&KÔ&KÑLÔLÑMÔMÐMØØ˜˜ZœÔ)ˆð-	XØ$×/Ò/µ	¸&Ñ0AÔ0A×0HÒ0HÑ0JÔ0JÑKÔK‰OˆF�GØ�F”ˆAÐ*WÐ*WÐ*WÐ*WÐ9VÐ*WÑ*WÔ*W™Z˜Q  1 aÝ  A ¨¨Q©°¨
°Q¸±U¸AÀ¹E°NÀQÈÈAÉÀJÐOÐaÐRXÐY_ÔR`ÐaÐaÐaˆDÝ”Z Ñ%Ô%‰FˆB�Ø˜"˜b˜&”/ˆCÝ˜V C¨¨!¨ Gœ_Ñ-Ô-ˆDØ˜$”i¥¤°"°b°Ñ!:Ô!:¸4Ô!@�ˆCÝ�3‰xŒx˜"Š}ˆ}Ý Ð!AÑBÔBÐBØ˜#”;×%Ò%¥eÑ,Ô,ˆDØ˜oÔ.×2Ò2°=ÑAÔAˆHØ'/Ð';�H˜t‘O�OÀˆEà˜˜Hœ lÔ3Ò3Ð3Ý Ð!>Ñ?Ô?Ð?ØÐ Ø�Q�Q�Q˜˜˜�U��”˜uÑ$��‘ÝÐ+Ñ+¨s°V©|Ñ<ˆCØ�zŠz‰|Œ|ð 
>Ý”W˜S‘\”\ð 3 QØ-.¨v¬Y½¸aÀ¼jÑ8IÔ8IÈ1È[Ì> ˜%�DØ  œ|×0Ò0Ñ2Ô2�Hð3ð 3ð 3ñ 3ô 3ð 3ð 3ð 3ð 3ð 3ð 3øøøð 3ð 3ð 3ð 3ð 3��å”y  a a a¨¨!¨ e¤°1Ð5Ñ5Ô5�Ý�E¥"¤+¨d°1°1°1°a°4¬j¸#Ñ">Ô">ÅÄÈTÐRSÐRSÐRSÐUVÐRVÌZÐY\ÑA]ÔA]Ñ"]Ñ^Ô^Ð`dÑeÔe�ÝœH b¨" XÑ.Ô.�	Ø�Ø=�Ý”O y°¤| m°Y¸q´\À1Ð%EÀÈÀÐTUÀÐXaÐXaÐXaÐ$bÑcÔcˆEÝ D°U¸Q±YÀeÐLÑLÔLˆIØ˜�ˆBÝ  ™8œ8ð +ð +�Ý .¨t°R¸À¼ÈÈIÐWYÐ\cÑWcÐehÑ iÔ i‘��1�a˜˜AØ—	’	˜!‘”�˜bŸiši¨™lœl˜l˜làŒK×Ò d°TÐÑ:Ô:Ð:ÝÔ ­r¬x¸©|¬|ÐU]ÐUeÅRÄXÈbÁ\Ä\À\ÐksØ%)°À)ðMñ Mô Mð Må S°
À%ÕPSÐTXÑPYÔPYØ WÐ`fÝ%(¨¡X¤XÀÐH\ÔA]ð_ñ _ô _ˆFõ ˜×(Ò(¨Ñ1Ô1°6Ñ:Ô:Ð:Ð:øÝð 	Xð 	Xð 	XÝ S°ÅÀSÁÄÐQVÐWÑWÔWˆFˆFˆFˆFˆFˆFøøøøð	Xøøøà�Š�vÑÔÐØˆs‰7�aŠ<ˆ<Ý•$”*�T¨°UÀaÈ!ÁeÕSVÐW[ÑS\ÔS\Ð]Ñ]Ô]Ñ^Ô^ÐfjÐkÑkÔkÐkùÝ•˜ ™¨Ñ0Ñ1°7Ñ;Ô;Ð;Ø€Ns?   Ä5F2T6Ë'A L3Ì'T6Ì3L7	Ì7T6Ì:L7	Ì;G:T6Ô6
U*Õ  U%Õ%U*Ú__main__z--split)r   ÚvalÚtest)ÚchoicesÚdefault)r   ) Ú__doc__Úargparser   r[   Úpathlibr   Únumpyrd   Úcluster_targetsr   Úpose_benchmarkr   r   r   r	   Úpose_refinementr
   r   Úpose_review_geometryr   r   r   Úfork_geometryr   r   r   Ú__name__ÚArgumentParserÚparserÚadd_argumentÚ
parse_argsr   r#   r'   r   ú<module>r°      sR  ðØ UÐ UØ €€€Ø €€€Ø €€€Ø Ð Ð Ð Ð Ð à Ð Ð Ð à )Ð )Ð )Ð )Ð )Ð )Ø 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ø 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ð 8Ø HÐ HÐ HÐ HÐ HÐ HÐ HÐ HÐ HÐ HØ $Ð $Ð $Ð $Ð $Ð $ðð ð ð ð?ð ?ð ?ðD ˆzÒÐØ$ˆXÔ$Ñ&Ô&€FØ
×Ò˜	Ð+CÐ+CÐ+CÈWÐÑUÔUÐUØ€GˆF×ÒÑÔÔ%Ñ&Ô&Ð&Ð&Ð&ð Ðr'   