§
    7íÙjq  ã                  ó”   — 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mZ ddl	Z	ddl
ZddlmZ ddlmZmZmZmZ dZ G d	„ d
¦  «        ZdS )zKSource-scoped viewing axes without rotating XYZ or rewriting human history.é    )ÚannotationsN)ÚPathé   )Údigest)Ú	basis_forÚ	canonicalÚ
pose_valueÚsensor_value)Úforward_axisÚforward_signÚup_axisÚup_signc                  óL   — e Zd Zd	d„Zed„ ¦   «         Zd„ Zd	d„Zd„ Zd„ Z	d„ Z
dS )
Ú
AxesPolicyNc                ó¬  — t          j        |¦  «        | _        |p2t          j        t          |¦  «        ¦  «                             ¦   «         | _        |d         dz   | j        d d…         z   | _        |d         }|d         dvs|d         dvs|d         |d         k    rt          d¦  «        ‚|d	         d
vs
|d         d
vrt          d¦  «        ‚d S )NÚ	policy_idú:é   Úaxesr   )r   r   é   r   zInvalid scoped viewing axesr   )éÿÿÿÿr   r   zInvalid axis signs)	ÚcopyÚdeepcopyÚconfigÚhashlibÚsha256r   Ú	hexdigestÚidÚ
ValueError)Úselfr   r   Úas       úD/root/private/project/pallet_detection_v2/pallet/pose_review_axes.pyÚ__init__zAxesPolicy.__init__   sÝ   € Ý”M &Ñ)Ô)ˆŒØÐK�gœn­Y°vÑ->Ô->Ñ?Ô?×IÒIÑKÔKˆŒØ�{Ô# CÑ'¨¬°C°R°CÔ(8Ñ8ˆŒØ
�Œ.ˆØˆ^Ô GÐ+Ð+¨q°¬|À7Ð/JÐ/JÈaÐP^ÔN_ÐabÐclÔamÒNmÐNmÝÐ:Ñ;Ô;Ð;Øˆ^Ô FÐ*Ð*¨a°	¬lÀ&Ð.HÐ.HÍzÐZnÑOoÔOoÐIoÐ.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Údatasetr   s       r"   ÚloadzAxesPolicy.load   sz   € å�$‰ZŒZˆØ�{Š{‰}Œ}Ð( D DÝŒz˜$Ÿ.š.Ñ*Ô*Ñ+Ô+ˆØÐ*Ô+­VµD¸±M´MÀ/Ñ4QÑ-RÔ-RÒRÐRÐZ^ÐZ^Øˆs�6�& ™,œ,Ñ'Ô'Ð'r$   c                ój   — |d         d         | j         d         k    o|d         | j         d         k    S )NÚsensor_policyr   Úsource_policy_idÚsizeÚsource_size©r   ©r    Úsources     r"   ÚapplieszAxesPolicy.applies%   sL   € Ø�oÔ& {Ô3°T´[ÐASÔ5TÒTð  DÐY_Ð`fÔYgÐimÔitð  vCô  jDò  ZDð  	Dr$   c           
     ó¸   — |�|                       |¦  «        sd S t          | j        | j        | j        d         | j        d         | j        d         ddd¬¦  «        S )Nr1   r   ÚevidenceFT)r   r   r1   r   r9   ÚXYZ_rotatedÚ"old_width_and_angle_require_reviewÚrobot_command_eligible)r7   Údictr   r   r   r5   s     r"   ÚinfozAxesPolicy.info(   se   € ØÐ d§l¢l°6Ñ&:Ô&:ÐÀ$À$Ý�t”w d¤kÀ4Ä;ÐOaÔCbØ”˜VÔ$¨d¬k¸*Ô.EÐRWØ/3È5ðRñ Rô Rð 	Rr$   c                ól  ‡ ‡— t          ||¦  «        Š‰                      |¦  «        s‰S t          ˆ ˆfd„t          D ¦   «         ¦  «        r"‰                     ‰ j        d         d¬¦  «         ‰ j        d         ‰d         vr$‰d         d d…         dz   ‰ j        d         z   ‰d<   t          ‰|¦  «        S )Nc              3  óR   •K  — | ]!}‰|         ‰j         d          |         k    V — Œ"dS )r   Nr4   )Ú.0Úkr    Úsensors     €€r"   ú	<genexpr>z$AxesPolicy.sensor.<locals>.<genexpr>1   s8   øè è € ÐFÐF°Qˆv�aŒy˜$œ+ fÔ-¨aÔ0Ò0ÐFÐFÐFÐFÐFÐFr$   r   F)Úaxes_confirmedr9   iX  Ú )r
   r7   ÚanyÚAXIS_FIELDSÚupdater   )r    Úvaluer6   rC   s   `  @r"   rC   zAxesPolicy.sensor.   s¿   øø€ Ý˜E &Ñ)Ô)ˆØ�|Š|˜FÑ#Ô#Ð1¨6 MÝÐFÐFÐFÐFÐF½+ÐFÑFÔFÑFÔFð 	DØ�MŠM˜$œ+ fÔ-¸UˆMÑCÔCÐCØŒ;�zÔ"¨&°Ô*<Ð<Ð<Ø% jÔ1°$°3°$Ô7¸Ñ;¸D¼KÈ
Ô<SÑSˆF�:ÑÝ˜F 6Ñ*Ô*Ð*r$   c                ól
  ‡‡— |                       |¦  «        st          d¦  «        ‚|d         |k    r|S |d         d         |d         k    rt          d¦  «        ‚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 t!          ‰|d         dz   z  ¦  «        |d         k    rt          d¦  «        ‚t#          j        |¦  «        }|                     ‰||¬¦  «         t)          j        ‰|d         dz   z  d¬¦  «        5 }|d         }	|d         }
g |d         ¢|d         ‘D �] }|d         r|d         n:t)          j        d¦  «        |d                  |d         z                       ¦   «         }t/          ||¦  «        }|d         r|	|
|d         k             n|	}|                     ¦   «         |d<   |d         s||d<   t1          |¦  «        rÌ||z  }t)          j        |ddgd ¬!¦  «        \  }}|t)          j        |d          |d          z   d"z  t)          j        |dd…d#f         ¦  «        t)          j        |dd…d"f         ¦  «        g¦  «        z                       ¦   «         |d$<   t9          t;          |d          |d          z
  d"z  ¦  «        d%¦  «        |d&<   d'„ |                     d(g ¦  «        D ¦   «         |d(<   t?          t)          j         |t)          j        d¦  «        |d)                  ¦  «        ¦  «        d*k    r|d(          !                    d+¦  «         d,|d-<   �Œ	 ddd¦  «         n# 1 swxY w Y   d.D ]r}‰|d         |z   z   "                    ¦   «         }‰‰d/z   tG          j$        d0¦  «        z   d1z   z  }| %                    |¦  «         | &                    ‰‰|z   z  ¦  «         Œst!          ‰‰dz   z  ¦  «        |d<   ‰‰d/z   tG          j$        d0¦  «        z   d1z   z  }| %                    t          |¦  «        ¦  «         | &                    ‰‰d2z   z  ¦  «         |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 )3zFRebase candidate metadata; copy measurement and preview bytes exactly.z&Axis policy does not cover this sourcerC   Ú
scale_to_mz$Normalize units before adapting axesÚ$source_axes_preserve_measurements_v1ÚtokenÚfull_resolution_artifact_sha256)Úadapterr   ÚparentrC   Úparent_points_sha256z
.axes.lockr!   c              3  óL   •K  — | ]}‰‰|z   z                        ¦   «         V — Œd S ©N)r'   )rA   ÚextÚfolderrN   s     €€r"   rD   z&AxesPolicy.geometry.<locals>.<genexpr>A   s8   øè è € ÐTÐT°S�F˜E #™IÑ&×.Ò.Ñ0Ô0ÐTÐTÐTÐTÐTÐTr$   )ú.jsonú.npzú.binÚ
target_keyNrX   u0   æ—§ç‚¹äº‘è¯�æ�®å“ˆå¸Œå�˜åŒ–ï¼Œæ‹’ç»�è½´å�‘è½¬æ�¢)rN   rC   Úaxes_conversionF)Úallow_pickleÚxyzÚface_idsÚ
candidatesÚmanualr   Únormalé   r   r   Úbasisç{®Gáz„?ç®Gáz®ï?r   )Úaxisr   r   Úcenterç:Œ0âŽyE>Ú
half_widthc                ó   — g | ]}|d v¯|‘Œ	S ))Úpossible_top_or_ground_faceÚgrazing_view© )rA   Úvs     r"   ú
<listcomp>z'AxesPolicy.geometry.<locals>.<listcomp>P   s#   € ÐxÐxÐx aÀÐIwÐ@wÐ@w Ð@wÐ@wÐ@wr$   Úflagsr   g      è?rk   TÚaxis_adapter_preserved_face_id)rX   rY   ú.é   z.tmprW   )'r7   r   r=   r   r   r   r   r   ÚcacheÚ	semaphoreÚopenÚfcntlÚflockÚLOCK_EXÚallr.   r   r   r   rI   ÚnpÚeyeÚtolistr   ÚlenÚquantileÚarrayÚmedianÚmaxÚfloatÚgetÚabsÚdotÚappendÚ
read_bytesÚsecretsÚ	token_hexÚwrite_bytesÚreplace)r    ÚengineÚmetar6   rC   ÚbindingÚlockÚ	convertedÚdatar]   ÚlabelsÚcra   ÚbÚpÚlocalÚloÚhirU   ÚrawÚtmprV   rN   s                        @@r"   ÚgeometryzAxesPolicy.geometry7   s}  øø€ à�|Š|˜FÑ#Ô#Ð^­*Ð5]Ñ*^Ô*^Ð$^Ø�Œ>˜6Ò!Ð!¨ +Ø�Œ>˜,Ô'¨°Ô)=Ò=Ð=ÅJÐOuÑDvÔDvÐ>vÝÐCÈdÌgÐ]aÐbiÔ]jØ¨tÐ4UÔ/VðXñ Xô XˆåŒ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ð  BÐ\b×\gÒ\gÐhmÐnrÐsô  oAñ  ]Bô  ]Bð	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	õ �f˜d 7œm¨FÑ2Ñ3Ñ4Ô4°dÐ;\Ô6]Ò]Ð]Ý Ð!SÑTÔTÐTÝ”m DÑ)Ô)ˆI¨)×*:Ò*:ÀÈfÐelÐ*:Ñ*mÔ*mÐ*mÝ”˜  g¤¨vÑ!5Ñ6ÀEÐJÑJÔJð =ÈdØ˜”K� t¨JÔ'7 ØG˜9 \Ô2ÐG°9¸XÔ3FÐGð =ñ =�AØ*+¨D¬'Ðz˜1˜Xœ;˜;½¼¸q¹	¼	À&ÈÔBXÔ8YÐZ`ÐaoÔZpÑ8p×7xÒ7xÑ7zÔ7z�FÝ  vÑ.Ô.�AÈÈ4ÌÐ1Y°°V¸Q¸t¼W²_Ô1EÐ1EÐVY¨qØ Ÿxšx™zœz�A�g‘JØ˜Tœ7Ð5¨v 1 X¡;Ý˜1‘v”vð IØ ™c˜­¬°E¸3¸s¸)ÈÐ(KÑ(KÔ(K¡% " RØ%&¥r¤x°"°Q´%¸¸1¼±+¸q±ÅÄÈ5ÐQRÐQRÐQRÐSTÐQTÌ:ÑAVÔAVÕWYÔW`ÐafÐghÐghÐghÐijÐgjÔakÑWlÔWlÐ0mÑ'nÔ'nÑ%n×$vÒ$vÑ$xÔ$x˜˜(™Ý(+­E°2°a´5¸¸A¼±;À±/Ñ,BÔ,BÀ4Ñ(HÔ(H˜˜,™ØxÐx¨1¯5ª5°¸Ñ+<Ô+<ÐxÑxÔx�A�g‘JÝ�2œ6 &­¬°©¬°6¸)Ô3DÔ)EÑFÔFÑGÔGÈÒKÐKÈAÈgÌJ×L]ÒL]Ð^{ÑL|ÔL|ÐL|Ø8<�AÐ6Ñ7Ñ7ð=ð=ð =ð =ñ =ô =ð =ð =ð =ð =ð =ð =øøøð =ð =ð =ð =ð 'ð Eð E�Ø˜T 'œ]¨3Ñ.Ñ/×;Ò;Ñ=Ô=�À&È%ÐPSÉ)ÕT[ÔTeÐfgÑThÔThÑJhÐioÑJoÑBp¸cØ—’ Ñ$Ô$Ð$ S§[¢[°¸¸s¹Ñ1CÑ%DÔ%DÐ%DÐ%DÝ9?ÀÈÈfÉÑ@UÑ9VÔ9VˆIÐ7Ñ8Ø˜˜c™	¥'Ô"3°AÑ"6Ô"6Ñ6°vÑ=Ñ>ˆC¸s¿ºÍyÐYbÑOcÔOcÑ?dÔ?dÐ?dÐeh×epÒepÐqwÐy~ð  @Gñ  zGñ  rHñ  fIô  fIð  fIØð3	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ð 	øøøð 	ð 	ð 	ð 	ð 	ð 	ð 	ñ 	ô 	ð 	ð 	ð 	ð 	ð 	ð 	ð 	øøøð 	ð 	ð 	ð 	ð 	ð 	sj   ÃT)ÃATÄ5T)ÅBTÇH%PÏ6TÐPÐTÐ	PÐ
C.TÓ8T)ÔT	ÔT)ÔT	ÔT)Ô)T-Ô0T-c                óÞ  ‡‡‡— |�|                       |¦  «        st          j        |¦  «        S |d         Š|                      ‰|¦  «        Št          j        |¦  «        Š|                      |¦  «        ‰d<   ‰‰k    r‰S t          ˆˆfd„t          D ¦   «         ¦  «        }‰‰d<   d }‰                     d¦  «        rC|                      || 	                    ‰d         ‰d         ¦  «        |‰¦  «        }|d         ‰d<   ‰                     d¦  «        }|�r;|�r8t          j        |d         ¦  «        }t          j        |d	         ¦  «        |d
         |d d …df         z  z   |d         |d d …df         z  z   }t          ˆfd„|pi                      dg ¦  «        D ¦   «         d ¦  «        }	|	rt          j        |	d         ¦  «        n6t          t          j        d¦  «        ‰d                  ‰d         z  ‰¦  «        }
|	r|	d         n+|pi                      di ¦  «                             dd¦  «        }|r·‰                     d¦  «        r¢|                     |‰d         ‰                     dg ¦  «        ¦  «        }|d         |d                  }t!          |¦  «        dk    rJt          j        ||
d d …df         z  ddg¦  «        \  }}t%          t'          ||z
  dz  ¦  «        d¦  «        }t)          |                     ¦   «         |
                     ¦   «         ddd|d¬¦  «        ‰d<   t)          dddt%          d |z  d!¦  «        ¬"¦  «        ‰d#<   ‰                     d$¦  «        �.‰                     d¦  «        rt-          ‰d         ‰¦  «        ‰d$<   |rÔ‰                     d%d&d&d&d&t)          | j        |                     d'¦  «        t3          j        t7          |¦  «        ¦  «                             ¦   «         ‰|                     d¦  «        |                     d#¦  «        |                     d$¦  «        d(d(d(d(d(¬)¦  «        ¬*¦  «         ‰                     d+¦  «        d,k    rd-‰d+<   ‰S ).NrC   Úaxes_policyc              3  ó<   •K  — | ]}‰|         ‰|         k    V — Œd S rT   rm   )rA   rB   Ú
old_sensorrC   s     €€r"   rD   z$AxesPolicy.review.<locals>.<genexpr>_   s0   øè è € ÐGÐG°a˜ œ J¨q¤MÒ1ÐGÐGÐGÐGÐGÐGr$   Úgeometry_tokenrZ   rN   Úrulerrc   ÚoriginÚwr   Údr   c              3  óX   •K  — | ]$}|d          ‰                      dg ¦  «        v ¯ |V — Œ%dS )r   Úselected_facesN)r„   )rA   r”   Úresults     €r"   rD   z$AxesPolicy.review.<locals>.<genexpr>g   sD   øè è € ÐwÐw !ÈAÈdÌGÐW]×WaÒWaÐbrÐsuÑWvÔWvÐLvÐLv˜AÐLvÐLvÐLvÐLvÐwÐwr$   r_   rb   r   r   ri   r`   g      à?r§   Ú
exclusionsr]   Úselectedrd   re   r   rh   g        )r£   rc   r¤   r¥   Úangleri   Údirection_signg333333@gš™™™™™É?)ÚcenterWÚcenterDÚcenterHÚspanÚviewÚposeÚpendingFÚrevisionT)r   Úsource_revisionÚoriginal_record_sha256r    Úlegacy_rulerÚlegacy_viewÚlegacy_poseÚ)center_preserved_for_review_not_confirmedÚ)width_and_angle_reinitialized_as_proposalÚ*exclusions_preserved_in_source_coordinatesÚselected_point_ids_preservedÚhistorical_record_unchanged)Úpose_statusÚhuman_pose_confirmedÚmetric_pose_confirmedÚautomatic_training_eligibler<   Úaxes_interpretationÚstateÚcompleteÚdraft)r7   r   r   rC   r>   rG   rH   r„   rœ   r.   r{   ÚasarrayÚnextr   r|   rª   r~   r   r‚   rƒ   r=   r}   r	   rI   r   r   r   r   r   )r    rJ   r6   r�   Úaxes_changedrŽ   Úrr•   rg   Ú	candidateÚ	new_basisÚhalfrª   r–   r˜   r™   r    r¨   rC   s                   @@@r"   ÚreviewzAxesPolicy.reviewZ   s²  øøø€ Øˆ= §¢¨VÑ 4Ô 4ˆ=½D¼MÈ%Ñ<PÔ<PÐ5PØ˜”?ˆ
¨$¯+ª+°jÀÑ*HÔ*H 6ÕPTÔP]Ð^cÑPdÔPdÈØ"Ÿiši¨Ñ/Ô/ˆˆ}ÑØ�:ÒÐ V˜mÝÐGÐGÐGÐGÐG½;ÐGÑGÔGÑGÔGˆØˆˆxÑ T Ø�:Š:Ð&Ñ'Ô'ð 	3Ø—’˜v f§k¢k°&Ð9IÔ2JÈ6ÐR^ÔK_Ñ&`Ô&`ÐagÐhnÑoÔoˆDØ%)¨'¤]ˆFÐ#Ñ$Ø
�*Š*�WÑ
Ô
ˆØñ 	Y˜Añ 	YÝŒj˜˜7œÑ$Ô$ˆA­B¬J°q¸´{Ñ,CÔ,CÀAÀcÄFÈ1ÈQÈQÈQÈqÈSÌ6ÁMÑ,QÐRSÐTWÔRXÐYZÐ[\Ð[\Ð[\Ð]^Ð[^ÔY_ÑR_Ñ,_ VÝÐwÐwÐwÐw¨¨
°×'7Ò'7¸ÀRÑ'HÔ'HÐwÑwÔwÐx|Ñ}Ô}ˆIØ8Að  R•b”j ¨7Ô!3Ñ4Ô4Ð4ÅyÕQSÔQWÐXYÑQZÔQZÐ[aÐbpÔ[qÔQrÐsyð  {Iô  tJñ  RJð  KQñ  HRô  HRˆIØ,5Ðm�˜<Ô(Ð(¸D¸JÀB×;KÒ;KÈHÐUWÑ;XÔ;X×;\Ò;\Ð]iÐjlÑ;mÔ;mˆDØð b˜Ÿ
š
Ð#3Ñ4Ô4ð bØŸš¨¨fÐ5EÔ.FÀvÇzÂzÐR^Ð_aÑGbÔGbÑcÔc�Ø˜5”/ (¨:Ô"6Ô7�Ý�q‘6”6˜1’9�9Ýœ+ a¨	°!°!°!°A°#¬Ñ&6¸¸C°yÑAÔA‘E�B�rÅsÍ5ÐRTÐUWÑRWÐYZÑQZÑK[ÔK[Ð\`ÑGaÔGaÀ$Ý ¨¯ª©¬¸i×>NÒ>NÑ>PÔ>PÐSUÐXZÐacÐosð  DEð  Fñ  Fô  FˆF�7‰OÝ¨°2¸bÅcÈ$ÈtÉ)ÐTVÑFWÔFWÐXÑXÔXˆF�6‰NØ�:Š:�fÑÔÐ)¨f¯jªj¸Ñ.AÔ.AÐ)ÕQ[Ð\bÐcjÔ\kÐlrÑQsÔQsÀ&ÈÁ.Øð 	GØ�MŠM iÀUÐafØ,1ÈÝ$(°4´7È5Ï9Ê9ÐU_ÑK`ÔK`Ý+2¬>½)ÀEÑ:JÔ:JÑ+KÔ+K×+UÒ+UÑ+WÔ+WÐcmØ!&§¢¨7Ñ!3Ô!3ÀÇ	Â	È&Ñ@QÔ@QÐ^c×^gÒ^gÐhnÑ^oÔ^oØ>BÐmqØ?CÐaeð  CGð	%Hñ %Hô %Hð ñ Iô Ið Ið �zŠz˜'Ñ"Ô" JÒ.Ð.¸w¨v°g©Øˆr$   rT   )Ú__name__Ú
__module__Ú__qualname__r#   Úclassmethodr.   r7   r>   rC   rœ   rÎ   rm   r$   r"   r   r      sŸ   € € € € € ðpð pð pð pð ð(ð (ñ „[ð(ðDð Dð DðRð Rð Rð Rð+ð +ð +ð!ð !ð !ðF!ð !ð !ð !ð !r$   r   )Ú__doc__Ú
__future__r   r   rw   r   r(   Úpathlibr   r‰   Únumpyr{   Úcluster_targetsr   Úpose_review_geometryr   r   r	   r
   rH   r   rm   r$   r"   ú<module>rÙ      sß   ðØ QÐ QØ "Ð "Ð "Ð "Ð "Ð "à €€€Ø €€€Ø €€€Ø €€€Ø Ð Ð Ð Ð Ð Ø €€€à Ð Ð Ð à #Ð #Ð #Ð #Ð #Ð #Ø MÐ MÐ MÐ MÐ MÐ MÐ MÐ MÐ MÐ MÐ MÐ Mà?€ðhð hð hð hð hñ hô hð hð hð hr$   