§
    ’ˆØjå  ã                  óœ   — d Z ddlmZ ddlZddlZddl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ZddlmZ ddlmZmZmZ  G d„ d	¦  «        ZdS )
zNVersioned metre interpretation without rewriting raw sources or human history.é    )ÚannotationsN)ÚPathé   )Údigest)Ú	canonicalÚ
pose_valueÚsensor_valuec                  óL   — e Zd Zd	d„Zed„ ¦   «         Zd„ Zd„ Zd	d„Zd„ Z	d„ Z
dS )
ÚMetrePolicyNc                óŠ  — t          j        |¦  «        | _        |p2t          j        t          |¦  «        ¦  «                             ¦   «         | _        |d         dz   | j        d d…         z   | _        |d         g|d                              ¦   «         ¢D ]+}t          j
        |¦  «        r|dk    rt          d¦  «        ‚Œ,d S )NÚ	policy_idú:é   Úunknown_default_scale_to_mÚunknown_size_overridesr   zInvalid metre conversion policy)ÚcopyÚdeepcopyÚconfigÚhashlibÚsha256r   Ú	hexdigestÚidÚvaluesÚmathÚisfiniteÚ
ValueError)Úselfr   r   Úscales       úE/root/private/project/pallet_detection_v2/pallet/pose_review_units.pyÚ__init__zMetrePolicy.__init__   sÃ   € Ý”M &Ñ)Ô)ˆŒØÐK�gœn­Y°vÑ->Ô->Ñ?Ô?×IÒIÑKÔKˆŒØ�{Ô# CÑ'¨¬°C°R°CÔ(8Ñ8ˆŒØÐ9Ô:Ðf¸FÐC[Ô<\×<cÒ<cÑ<eÔ<eÐfð 	hð 	hˆEÝ”= Ñ'Ô'Ðg¨5°!ª8¨8½*ÐEfÑ:gÔ:gÐ4g¨8ð	hð 	hó    c                ó   — t          |¦  «        }|                     ¦   «         sd S t          j        |                     ¦   «         ¦  «        }|d         t          t          |¦  «        dz  ¦  «        k    rd S  | |t          |¦  «        ¦  «        S )NÚformal_manifest_sha256zmanifest.json)r   ÚexistsÚjsonÚloadsÚ	read_textr   )ÚclsÚpathÚdatasetÚvalues       r   ÚloadzMetrePolicy.load   s|   € å�$‰ZŒZˆØ�{Š{‰}Œ}Ð( D DÝŒj˜ŸšÑ)Ô)Ñ*Ô*ˆð Ð)Ô*­Fµ4¸±=´=ÀÑ3PÑ,QÔ,QÒQÐQÐY]ÐY]Øˆs�5� ™œÑ&Ô&Ð&r!   c                óú   — |d                               d¦  «        }|�|dz  S d                     t          t          |d         ¦  «        ¦  «        }| j        d                               || j        d         ¦  «        S )NÚsensor_policyÚscale_to_mmg     @�@ÚxÚsizer   r   )ÚgetÚjoinÚmapÚstrr   )r   ÚsourceÚ
registeredr1   s       r   Únative_scalezMetrePolicy.native_scale%   so   € Ø˜/Ô*×.Ò.¨}Ñ=Ô=ˆ
ØÐ!¨°EÑ)9Ð"9Ø�XŠX•c�#˜f VœnÑ-Ô-Ñ.Ô.ˆØŒ{Ð3Ô4×8Ò8¸¸d¼kÐJfÔ>gÑhÔhÐhr!   c                ó®   — t          ||¦  «        }|d         €<|                      |¦  «        }|                     |d¬¦  «         t          ||¦  «        }|S )NÚ
scale_to_muË   ç±³åˆ¶å�•ä½�ç­–ç•¥v1ï¼šç”¨æˆ·æ˜Žç¡®ç¡®è®¤240Ã—96åŽŸå�•ä½�æ¯«ç±³ï¼Œä¹˜0.001è½¬ç±³ï¼›å…¶ä»–åŽŸæœªçŸ¥å�•ä½�æŒ‰ç”¨æˆ·ç¡®è®¤ä»¥ç±³è§£é‡Šã€‚ä»…å�•ä½�è§£é‡Šï¼Œä¸�ç­‰äºŽå·¥åŽ‚æ ‡å®šã€�è½´å�‘æˆ–ä½�å§¿å·²ç¡®è®¤ã€‚)r:   Úevidence)r	   r8   Úupdate)r   Úsensorr6   r+   r   s        r   r=   zMetrePolicy.sensor+   sk   € Ý˜6 &Ñ)Ô)ˆØ�ÔÐ&Ø×#Ò# FÑ+Ô+ˆEØ�LŠL EðXð ñ Zô Zð Zõ ˜u VÑ,Ô,ˆEØˆr!   c                óv   — t          | j        | j        ddd¬¦  «        }|�|                      |¦  «        |d<   |S )NÚmgü©ñÒMbP?Ú2explicit_user_confirmation_not_factory_calibration)r   r   Úposition_unitÚtranslation_step_mÚevidence_kindÚnative_scale_to_m)Údictr   r   r8   )r   r6   r+   s      r   ÚinfozMetrePolicy.info5   sL   € Ý�d”g T¤[¸sÐVZØ!UðWñ Wô WˆàÐ¸×9JÒ9JÈ6Ñ9RÔ9R˜eÐ$7Ñ8Øˆr!   c                ó¸  ‡‡‡— |d         |k    r|S dD ])}|d         |         ||         k    rt          d¦  «        ‚Œ*|d         d         }|d         |�|ndz  }t          d| j        |d         ||d	         ¬
¦  «        }t          j        t          |¦  «        ¦  «                             ¦   «         Š|j        Š|j        5  ‰‰dz   z   	                    d¦  «        5 }	t          j        |	t          j        ¦  «         t          ˆˆfd„dD ¦   «         ¦  «        r4|                     ‰|d         ¦  «        cddd¦  «         cddd¦  «         S ‰|d         dz   z  }
t          |
¦  «        |d	         k    rt          d¦  «        ‚t!          j        |
d¬¦  «        5 Šˆfd„‰j        D ¦   «         }ddd¦  «         n# 1 swxY w Y   |dxx         |z  cc<   t%          j        ¦   «         }t!          j        |fi |¤Ž t!          j        ‰|d         dz   z                       ¦   «         d¬¦  «                             ¦   «                              dd¦  «        }|dd…dd…fxx         |z  cc<   t/          j        |¦  «        }|                     ‰|t          d(i |¤|ddœ¤Ž¬¦  «         g |d         ¢|d          ‘D ]X}t!          j        |d!         ¦  «        |z                       ¦   «         |d!<   |d"xx         |z  cc<   d#|v r|d#xx         |z  cc<   ŒYd|                     ¦   «         fd|                     d¦  «                             ¦   «         ffD ]W\  }}‰‰|z   z  }‰‰d$z   tA          j!        d%¦  «        z   d&z   z  }| "                    |¦  «         | #                    |¦  «         ŒXt          ‰‰dz   z  ¦  «        |d	<   ‰‰d'z   z  }‰‰d$z   tA          j!        d%¦  «        z   d&z   z  }| "                    t          |¦  «        ¦  «         | #                    |¦  «         |cddd¦  «         cddd¦  «         S # 1 swxY w Y   ddd¦  «         dS # 1 swxY w Y   dS ))zåScale an immutable geometry revision, preserving measured face IDs.

        This is not a new automatic segmentation. Old and new tokens remain
        distinct, and every selected source-point index survives unchanged.
        r=   )Úforward_axisÚup_axisÚforward_signÚup_signÚaxes_confirmedu*   å�•ä½�è½¬æ�¢ä¸�èƒ½ä»£æ›¿å��æ ‡è½´é‡�æ��å�–r:   Nç      ð?Ú metre_geometry_preserve_faces_v1ÚtokenÚfull_resolution_artifact_sha256)ÚadapterÚpolicyÚparentr=   Úparent_points_sha256z
.unit.lockÚac              3  óL   •K  — | ]}‰‰|z   z                        ¦   «         V — Œd S ©N)r$   )Ú.0ÚextÚfolderrO   s     €€r   ú	<genexpr>z'MetrePolicy.geometry.<locals>.<genexpr>K   s8   øè è € ÐTÐT°S�F˜E #™IÑ&×.Ò.Ñ0Ô0ÐTÐTÐTÐTÐTÐTr!   )ú.jsonú.npzú.binÚ
target_keyr]   u0   æ—§ç‚¹äº‘è¯�æ�®å“ˆå¸Œå�˜åŒ–ï¼Œæ‹’ç»�å�•ä½�è½¬æ�¢F)Úallow_picklec                óF   •— i | ]}|‰|                               ¦   «         “ŒS © )r   )rX   ÚkÚzs     €r   ú
<dictcomp>z(MetrePolicy.geometry.<locals>.<dictcomp>O   s(   ø€ Ð=]Ð=]Ð=]ÐPQ¸aÀÀ!ÄÇ	Â	ÁÄÐ=]Ð=]Ð=]r!   Úxyzr^   z<f4)Údtypeéÿÿÿÿé   é   T)Úlength_multiplierÚ%face_ids_and_source_indices_preserved)rO   r=   Úunit_conversionÚ
candidatesÚmanualÚcenterÚ
half_widthÚresidual_medianú.é   z.tmpr\   rb   )$r   rE   r   r   r   r   r   ÚcacheÚ	semaphoreÚopenÚfcntlÚflockÚLOCK_EXÚallr,   r   ÚnpÚfilesÚioÚBytesIOÚsavez_compressedÚ
frombufferÚ
read_bytesr   Úreshaper   r<   ÚasarrayÚtolistÚgetvalueÚastypeÚtobytesÚsecretsÚ	token_hexÚwrite_bytesÚreplace)r   ÚengineÚmetar6   r=   ÚfieldÚ	old_scaleÚratioÚbindingÚlockÚoldÚarraysÚstreamÚpreviewÚ	convertedÚ	candidaterY   Úrawr)   ÚtmprZ   rO   rd   s                       @@@r   ÚgeometryzMetrePolicy.geometry;   sË  øøø€ ð �Œ>˜6Ò!Ð!¨ +ØYð 	sð 	sˆEØ�HŒ~˜eÔ$ f¨U¤mÒ3Ð3½*ÐEqÑ:rÔ:rÐ4rÐ3Ø�x”. Ô.ˆ	Ø�\Ô"°Ð1F I IÈBÑOˆÝÐ?ÀtÄwÐVZÐ[bÔVcÐkqØ*.Ð/PÔ*QðSñ Sô SˆåŒn�Y wÑ/Ô/Ñ0Ô0×:Ò:Ñ<Ô<ˆÀFÄL¸VØÔð 	ð 	˜v u¨\Ñ'9Ñ:×@Ò@ÀÑEÔEð 	ÈÝŒK˜�Uœ]Ñ+Ô+Ð+ÝÐTÐTÐTÐTÐTÐ<SÐTÑTÔTÑTÔTð =Ø—{’{ 5¨¨lÔ);Ñ<Ô<ð	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð ˜˜Wœ fÑ,Ñ-ˆCÝ�c‰{Œ{˜DÐ!BÔCÒCÐCÍ*ð  VHñ  KIô  KIð  EIÝ”˜¨%Ð0Ñ0Ô0Ð]°AÐ=]Ð=]Ð=]Ð=]ÐUVÔU\Ð=]Ñ=]Ô=]°fÐ]Ð]Ð]Ñ]Ô]Ð]Ð]Ð]Ð]Ð]Ð]øøøÐ]Ð]Ð]Ð]Ø�5ˆMˆMŒM˜5Ñ ˆMˆM‰MÝ”:‘<”<ˆF¥Ô 3°FÐ DÐ D¸VÐ DÐ DÐ DÝ”M 6¨4°¬=¸Ñ+?Ñ#@×"LÒ"LÑ"NÔ"NÐUZÐ[Ñ[Ô[×`Ò`ÑbÔb×jÒjÐkmÐnoÑpÔpˆGØ�A�A�A�b�q�b�DˆMˆMŒM˜5Ñ ˆMˆM‰MÝ”m DÑ)Ô)ˆI¨)×*:Ò*:ÀÈfÝ $Ð rÐ r wÐ rÀÐmqÐ rÐ rÐ rÐ rð +;ñ +tô +tð +tàK˜y¨Ô6ÐK°yÀÔ7JÐKð Vð V�	Ý%'¤Z°	¸(Ô0CÑ%DÔ%DÀUÑ%J×$RÒ$RÑ$TÔ$T�	˜(Ñ#Ø˜,Ð'Ð'Ô'¨Ñ.Ð'Ð'Ñ'Ø$¨	Ð1Ð1°)Ð<MÐ2NÐ2NÔ2NÐPUÑ2UÐ2NÐ2NÑ2NøØ# F§O¢OÑ$5Ô$5Ð6¸¸w¿~º~ÈeÑ?TÔ?T×?\Ò?\Ñ?^Ô?^Ð7_Ð`ð 7ð 7‘��CØ˜U 3™YÑ'�¨F°E¸#±I½gÔ>OÐPQÑ>RÔ>RÑ4RÐSYÑ4YÑ,Z¨Ø—’ Ñ$Ô$Ð$ S§[¢[°Ñ%6Ô%6Ð%6Ð%6Ý9?ÀÈÈfÉÑ@UÑ9VÔ9VˆIÐ7Ñ8Ø˜˜w™Ñ'ˆD¨F°E¸#±I½gÔ>OÐPQÑ>RÔ>RÑ4RÐSYÑ4YÑ,Z¨Ø�OŠO�I iÑ0Ô0Ñ1Ô1Ð1°#·+²+¸dÑ2CÔ2CÐ2CØð/	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ð 	øøøð 	ð 	ð 	ð 	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ð 	ð 	øøøð 	ð 	ð 	ð 	ð 	ð 	si   ÃQÃAP7Ä4QÅAP7ÆF9Æ-P7Æ9F=Æ=P7Ç F=ÇIP7ÐQÐ7P;	Ð;QÐ>P;	Ð?QÑQÑQc                óR  — |€d S |d         }|                       ||¦  «        }||k    rt          j        |¦  «        S t          j        |¦  «        }|d         }|d         |�|ndz  }||d<   |                     d¦  «        }	|	rGt	          j        |	d         ¦  «        |z                       ¦   «         |	d<   dD ]}
|	|
xx         |z  cc<   Œ|                     dg ¦  «        D ]f}t	          j        |d         ¦  «        |z                       ¦   «         |d<   t	          j        |d         ¦  «        |z                       ¦   «         |d<   Œg|                     d	¦  «        r%d
D ]"}
|
|d	         v r|d	         |
xx         |z  cc<   Œ#|                     d¦  «        rC|                     |d         |d         ¦  «        }|                      ||||¦  «        d         |d<   |                     d¦  «        �|	rt          |	|¦  «        |d<   | 
                    dddddt          | j        |                     d¦  «        |                     d¦  «        t          j        t          |¦  «        ¦  «                             ¦   «         ||d         |d¬¦  «        ¬¦  «         |d         dk    rd|d<   |S )Nr=   r:   rM   ÚrulerÚorigin)ÚwÚdrq   Ú
exclusionsÚboundsÚview)ÚcenterWÚcenterDÚcenterHÚspanÚgeometry_tokenr_   rO   ÚposeÚpendingFÚrevisionÚstateT)r   Úsource_revisionÚsource_stateÚoriginal_record_sha256Úold_scale_to_mÚnew_scale_to_mrk   Úhistorical_record_unchanged)Úpose_statusÚhuman_pose_confirmedÚmetric_pose_confirmedÚautomatic_training_eligibleÚrobot_command_eligibleÚunit_interpretationÚcompleteÚdraft)r=   r   r   r2   r|   r„   r…   r,   rœ   r   r<   rE   r   r   r   r   r   )r   r+   r6   r�   Ú
old_sensorr=   Úresultr�   r‘   rž   r�   Ú	exclusionrŽ   s                r   ÚreviewzMetrePolicy.reviewb   sÕ  € Øˆ=  Ø˜”?ˆ
¨$¯+ª+°jÀÑ*HÔ*H 6Ø�:ÒÐ¥T¤]°5Ñ%9Ô%9Ð9ÝŒ}˜UÑ#Ô#ˆØ˜\Ô*ˆ	°¸Ô1EÐT]ÐTiÀyÀyÐoqÑ1r¨5ØˆˆxÑØ�jŠj˜Ñ!Ô!ˆØð 	DÝœZ¨¨h¬Ñ8Ô8¸Ñ>×FÒFÑHÔHˆE�(‰OØ/ÐCÐC�°°e°°´¸eÑ0C°°±°ØŸš L°Ñ4Ô4ð 	Qð 	QˆIÝ!#¤¨I°hÔ,?Ñ!@Ô!@ÀÑ!F× NÒ NÑ PÔ PˆI�hÑÝ!#¤¨I°hÔ,?Ñ!@Ô!@ÀÑ!F× NÒ NÑ PÔ PˆI�hÑÐØ�:Š:�fÑÔð 	HØ?ð Hð H�Ø˜F 6œNÐ*Ð*¨6°&¬>¸%Ð+@Ð+@Ô+@À%Ñ+GÐ+@Ð+@Ñ+@øØ�:Š:Ð&Ñ'Ô'ð 	WØ—’˜VÐ$4Ô5°f¸\Ô6JÑKÔKˆDØ%)§]¢]°6¸$¸vÀfÑ%MÔ%MÈgÔ%VˆFÐ#Ñ$Ø�:Š:�fÑÔÐ)¨eÐ)Å:ÈeÐTZÑC[ÔC[°F¸6±Nà�Š )ÀÐ]bØ(-ÀUÝ $¨t¬wÀuÇyÂyÐQ[ÑG\ÔG\Ø"ŸYšY wÑ/Ô/Ý'.¤~µiÀÑ6FÔ6FÑ'GÔ'G×'QÒ'QÑ'SÔ'SØ(¸¸|Ô8LÐ_dØ,0ð	!2ñ !2ô !2ð 	ñ 	3ô 	3ð 	3ð �'Œ?˜JÒ&Ð&°w v¨g¡Øˆr!   rW   )Ú__name__Ú
__module__Ú__qualname__r    Úclassmethodr,   r8   r=   rF   rœ   r¿   rb   r!   r   r   r      s›   € € € € € ðhð hð hð hð ð'ð 'ñ „[ð'ðið ið iðð ð ðð ð ð ð%ð %ð %ðNð ð ð ð r!   r   )Ú__doc__Ú
__future__r   r   rx   r   r~   r%   r   Úpathlibr   r‰   Únumpyr|   Úcluster_targetsr   Úpose_review_geometryr   r   r	   r   rb   r!   r   ú<module>rÊ      sæ   ðØ TÐ TØ "Ð "Ð "Ð "Ð "Ð "à €€€Ø €€€Ø €€€Ø 	€	€	€	Ø €€€Ø €€€Ø Ð Ð Ð Ð Ð Ø €€€à Ð Ð Ð à #Ð #Ð #Ð #Ð #Ð #Ø CÐ CÐ CÐ CÐ CÐ CÐ CÐ CÐ CÐ Cðmð mð mð mð mñ mô mð mð mð mr!   