§
    êÀÓj+7  ã                  óò   — d Z ddlm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 dZdZd	Zd
„ Zd„ Zdd„Zdddœd„Zd„ Zd„ Zd„ Zd„ Z G d„ d¦  «        Z G d„ de	j        ¦  «        Zd„ Zd„ Zd„ Zdd„ZdS )a  Small-data partial-pose models and label-free ROI geometry.

PointNet-inspired shared point MLP + symmetric pooling, not a reproduction of
the original PointNet/T-Net. No CAD model, 6D rotation or robot transform is
invented. Preprocessing consumes pixels/XYZI only, never pose targets.
é    )ÚannotationsN)ÚPath)Únn)Ú
functionalé   é   )Úplanar_xy_thetaÚreference_xyz_normalc                óŠ   — t          j        t          j        | ¦  «        t          j        |¦  «        z
  dz   dz  dz
  ¦  «        S )Ng     €f@g     €v@)ÚnpÚabsÚasarray)ÚpredÚtargets     úpallet/pose_model.pyÚangular_error_degreesr      s:   € ÝŒ6•2”:˜dÑ#Ô#¥B¤J¨vÑ$6Ô$6Ñ6°tÑ;¸TÑAÀ$ÑFÑGÔGÐGó    c                ó"  — t          j        | t           j        ¬¦  «        } t           j                             | ¦  «        }t          j        | ¦  «                             ¦   «         r|dk     rt          d¦  «        ‚| |z  } | d         dk     r|  n| S )N©Údtypeç:Œ0âŽyE>zInvalid plane normalr   )r   r   Úfloat64ÚlinalgÚnormÚisfiniteÚallÚ
ValueError)Únormalr   s     r   Úcanonical_normalr      s�   € ÝŒ:�f¥2¤:Ð.Ñ.Ô.€FÝ	Œ�Š˜Ñ	Ô	€DÝŒ;�vÑÔ×"Ò"Ñ$Ô$ð 1¨¨Tª	¨	ÝÐ/Ñ0Ô0Ð0Ø�$‰;€FØ˜Q”i ’k�kˆFˆ7ˆ7 vÐ-r   é*   c                ó¨  ‡‡— t          j        | t           j        ¬¦  «        } t          | ¦  «        dk     s&t          j        | ¦  «                             ¦   «         st          d¦  «        ‚t           j                             |¦  «        }t          t          | ¦  «        |d         ¦  «        }| | 
                    t          | ¦  «        |d¬¦  «                 Š|                     d||d         d	f¬
¦  «        Šˆˆfd„t          d	¦  «        D ¦   «         \  }}}t          j        ||z
  ||z
  ¦  «        }t           j                             |d¬¦  «        }	|	dk    t          j        |dd…df         ¦  «        d|	z  k    z  }
||
         |	|
df         z  }||
         }d}t          j        g d¢¦  «        }t          j        t          ‰¦  «        t&          ¬¦  «        }t          |¦  «        �rŒt          j        ‰|j        z  t          j        ||z  d¬¦  «        z
  ¦  «        }||d         k                          d¬¦  «        }t-          |                     ¦   «         ¦  «        }t1          ||         ¦  «        }|dd…|f         |d         k     }t-          |                     ¦   «         ¦  «        dk    }|rÃt          d¦  «        D ]³}t          j        ‰|         d¬¦  «        }‰|         |z
  }t           j                             |d¬¦  «        \  }}}t1          |d         ¦  «        }|d         dk     r nCt          j        ‰|z
  |z  ¦  «        |d         k     }|                     ¦   «         dk     r n||}}Œ´|rt          j        ‰|         d¬¦  «        nt          j        ‰d¬¦  «        }|||r!t7          |                     ¦   «         ¦  «        nd|fS )zCRANSAC followed by SVD; x-facing is a declared sensor-domain prior.r   r   zToo few finite XYZ pointsÚgeometry_pointsF©Úreplacer   Úransac_iterationsé   )Úsizec              3  ó<   •K  — | ]}‰‰d d …|f                  V — Œd S ©N© )Ú.0ÚiÚdataÚtripless     €€r   ú	<genexpr>z"fit_front_plane.<locals>.<genexpr>,   s4   øè è € Ð
0Ð
0 !ˆ4�˜˜˜˜!˜”ÔÐ
0Ð
0Ð
0Ð
0Ð
0Ð
0r   é   ©Úaxisr   Ng      Ð?)ç      ð?ç        r4   Úplane_thresholdé   )Úfull_matriceséÿÿÿÿr4   )r   r   r   Úlenr   r   r   ÚrandomÚdefault_rngÚminÚchoiceÚintegersÚrangeÚcrossr   r   r   ÚarrayÚonesÚboolÚTÚsumÚintÚargmaxr   ÚmedianÚsvdÚfloatÚmean)ÚxyzÚconfigÚseedÚrngÚcountÚaÚbÚcÚnormalsÚlengthsÚvalidÚcentersÚsuccessr   ÚmaskÚresidualÚscoresÚbestÚ_ÚcenterÚcenteredÚvtÚ	candidateÚrefinedr-   r.   s                           @@r   Úfit_front_planerc   #   sw  øø€ å
Œ
�3�RœZÐ(Ñ(Ô(€CÝ
ˆ3�x„x�‚{€{�"œ+ cÑ*Ô*×.Ò.Ñ0Ô0€{ÝÐ4Ñ5Ô5Ð5Ý
Œ	×Ò˜dÑ#Ô#€CÝ
�c�#‰hŒh�vÐ/Ô0Ñ
1Ô
1€EØ	ˆS�ZŠZ�˜C™œ ¨uˆZÑ5Ô5Ô	6€DØ�LŠL˜˜5 vÐ.AÔ'BÀ1Ð&EˆLÑFÔF€GØ
0Ð
0Ð
0Ð
0Ð
0¥u¨Q¡x¤xÐ
0Ñ
0Ô
0�E€A€aˆÝŒH�Q�q‘S˜˜1™ÑÔ€GÝŒI�NŠN˜7¨ˆNÑ*Ô*€GØ�4Š<�"œ& ¨¨¨¨1¨¤Ñ.Ô.°°G±Ò;Ñ
<€EØ�EŒN˜7 5¨ :Ô.Ñ.€GØˆeŒH€GØ€GÝŒ8�J�J�JÑÔ€FÝ	Œ•�T‘”¥Ð	&Ñ	&Ô	&€DÝ
ˆ7�|„|ñ .Ý”˜˜WœY™¥r¤v¨g°g©oÀ1Ð'EÑ'EÔ'EÑEÑFÔFˆØ˜Ð 1Ô2Ò2×7Ò7¸QÐ7Ñ?Ô?ˆÝ�—’‘”Ñ!Ô!ˆÝ ¨¤Ñ.Ô.ˆØ�a�a�a˜�fÔ˜fÐ%6Ô7Ò7ˆÝ�D—H’H‘J”J‘” Ò#ˆØð 		.Ý˜1‘X”Xð .ð .�Ý”y  d¤°Ð3Ñ3Ô3�Ø˜dœ FÑ*�Ý”y—}’} X¸E�}ÑBÔB‘��!�BÝ*¨2¨b¬6Ñ2Ô2�	Ø˜Q”< Ò#Ð# E EÝœ  V¡¨YÑ6Ñ7Ô7¸Ð?PÔ8QÒQ�Ø—;’;‘=”= Ò#Ð# E EØ% g�t��Ø+2ÐN�2Œ9�T˜$”Z QÐ'Ñ'Ô'Ð'½¼	À$ÈAÐ8NÑ8NÔ8N€FØ�&¨wÐ>�˜tŸyšy™{œ{Ñ+Ô+Ð+¸B¸wÐFÐFr   )Ú
scale_to_mrN   c               óÜ  — |d         dk    rt          d¦  «        ‚t          j        |t          ¬¦  «        }|j        dk    sAt          j        |¦  «                             ¦   «         rt          |dd…         ¦  «        dk    rt          d	¦  «        ‚|j        ||fk    s| j        dk    s| j        d
         dk    rt          d¦  «        ‚|                     ¦   «         dk     s%| 	                    ¦   «         t          | ¦  «        k    rt          d¦  «        ‚|\  }}	}
}t          dt          t          j        |¦  «        ¦  «        ¦  «        t          dt          t          j        |	¦  «        ¦  «        ¦  «        }}t          |t          t          j        ||
z   ¦  «        ¦  «        ¦  «        t          |t          t          j        |	|z   ¦  «        ¦  «        ¦  «        }}||k    s||k    rt          d¦  «        ‚t          j        ||…||…f         \  }}| |||…||…f                              ¦   «                                       t          j        ¦  «        }t          j        |                     ¦   «         |z
  |
z  |                     ¦   «         |	z
  |z  fd
¬¦  «        }t          j        |dd…dd…f         ¦  «                             d
¬¦  «        t          j                             t          j        |dd…dd…f         ¦  «        d
¬¦  «        dk    z  }||         ||         }}t          |¦  «        dk     rt          d¦  «        ‚|�t          |¦  «        nd}t-          j        |¦  «        r|dk    rt          d¦  «        ‚|dd…dd…f         |z  }|€Ft          j        t          j                             |d
¬¦  «        ¦  «        dk    rt          d¦  «        ‚t          j        |d
dgd¬¦  «        \  }}||k    ||k    z                       d
¬¦  «        }|                     ¦   «         dk    r||         ||         ||         }}}t5          |||¦  «        \  }}}}t          j        |ddgd¬¦  «        \  }}||z
  } t          t          t          j                             | ¦  «        ¦  «        d¦  «        }!t          j        ||z
  |!z  dd¦  «        }"|dd…df         }#t          j        |#¦  «        }$t          j        t          |#¦  «        ¦  «        }%|$                     ¦   «         rct          j        |#|$         ddg¦  «        \  }&}'t          j        |#|$         |&z
  t          t          |'|&z
  ¦  «        d¦  «        z  dd
¦  «        |%|$<   t          j        |"|%|$                     t          ¦  «        |d z
  f¦  «        }(t          j                              |¦  «        })|) !                    t          |(¦  «        |d!         t          |(¦  «        |d!         k     ¬"¦  «        }*|(|*                              t          j"        ¦  «        }(t          j#        || |||z  |	|z  |
|z  ||z  g|t          j$        t          |¦  «        ¦  «        d#z  t          |du¦  «        f                              t          j"        ¦  «        }+|+j        tJ          fk    s|(j        |d!         tL          fk    rtO          d$¦  «        ‚t          j        |(¦  «                             ¦   «         r&t          j        |+¦  «                             ¦   «         st          d%¦  «        ‚|(|+t          |¦  «        ||||du d&œfS )'zÞExtract network inputs with no dependency on GT pose or target identity.

    Unverified units use raw numeric coordinates in the explicitly declared
    research-only mode. This is not a new metric calibration claim.
    Úunverified_unit_policyÚ*assume_native_numeric_metres_research_onlyzUnknown research unit policyr   )é   r6   Nr   zInvalid ROI boxr0   rh   zCloud/grid shape mismatchzPixel map escapes source pointsz#ROI does not intersect native imager1   r&   r   r   z)ROI has fewer than 16 measured XYZ pointsr3   zInvalid point scaleé   zRUnverified raw coordinate scale is outside the research domain; supply calibrationéc   é   éK   g{®Gáz”?éûÿÿÿé   é_   ç�íµ ÷Æ°>g      à?Úpointsr#   g      $@zFeature schema mismatchzNonfinite extracted features)Úroi_valid_pointsÚplane_successÚplane_inlier_fractionÚpoint_scale_to_mÚ$unverified_units_research_assumption)(r   r   r   rJ   Úshaper   r   r<   ÚndimÚmaxr9   rF   ÚfloorÚceilÚmgridÚravelÚastyper   Ústackr   r   Ú
nan_to_numÚmathrH   Ú
percentilerE   rc   ÚclipÚzerosÚanyÚcolumn_stackr:   r;   r=   Úfloat32Úr_Úlog1pÚ
GLOBAL_DIMÚ	POINT_DIMÚAssertionError),rq   Ú	pixel_mapÚboxÚwidthÚheightrM   rd   rN   ÚxÚyÚwÚhÚx0Úy0Úx1Úy1ÚyyÚxxÚselectedÚuvÚgoodÚscalerL   ÚlowÚhighÚkeepÚanchorr   Úinlier_fractionrs   Úq25Úq75ÚspreadÚlocal_scaler_   Ú	intensityÚvalid_iÚ	encoded_iÚloÚhiÚfeaturesrO   ÚpickedÚglobal_featuress,                                               r   Úroi_featuresr°   J   s¢  € ð Ð&Ô'Ð)UÒUÐUÝÐ7Ñ8Ô8Ð8Ý
Œ
�3�UÐ#Ñ#Ô#€CØ
„y�$‚€�bœk¨#Ñ.Ô.×2Ò2Ñ4Ô4€½¸CÀÀÀ¼G¹¼Àaº¸ÝÐ*Ñ+Ô+Ð+Ø„˜ ˜Ò&Ð&¨&¬+°qª.¨.¸F¼LÈ¼OÈQÒ<NÐ<NÝÐ4Ñ5Ô5Ð5Ø‡}‚}�„�qÒÐ˜IŸMšM™OœO­S°©[¬[Ò8Ð8ÝÐ:Ñ;Ô;Ð;Ø�G€A€aˆˆ!Ý
ˆa••B”H˜Q‘K”KÑ Ô Ñ
!Ô
!¥# a­­B¬H°Q©K¬KÑ(8Ô(8Ñ"9Ô"9€r€BÝ
ˆe•C�œ  !¡™œÑ%Ô%Ñ
&Ô
&¥s¨6µ#µb´g¸aÀ¹c±l´lÑ2CÔ2CÑ'DÔ'D€r€BØ	ˆ2‚v€v��R’��jÐ)NÑOÔOÐOÝ
Œ(�2�b�5˜˜B˜�;Ô
�E€B€rØ�I˜b ˜e B r E˜kÔ*×0Ò0Ñ2Ô2Ô3×:Ò:½2¼:ÑFÔF€HÝ	„x�"—(’(‘*”*˜Q‘, Ñ! 2§8¢8¡:¤:¨a¡<°Ñ"2Ð3¸Ð;Ñ;Ô;€BÝ	Œ�X˜a˜a˜a   ˜d”^Ñ	$Ô	$×	(Ò	(¨aÐ	(Ñ	0Ô	0µ"´)·.².ÅÄÈxÐXYÐXYÐXYÐZ\Ð[\ÐZ\ÐX\Ì~ÑA^ÔA^Ðde°.Ñ2fÔ2fÐgkÒ2kÑ	l€DØ˜”˜r $œxˆR€HÝ
ˆ8�}„}�RÒÐ�jÐ)TÑUÔUÐUØ)Ð5�%�
Ñ
Ô
Ð
¸2€EÝŒ=˜ÑÔÐS 5¨!¢8 8µ*Ð=RÑ2SÔ2SÐ,SØ����2�A�2�Œ�uÑ€CØÐ�bœi­¬	¯ª°sÀ¨Ñ(BÔ(BÑCÔCÀBÒFÐFÝÐmÑnÔnÐnÝŒ]˜3  "˜v¨1Ð-Ñ-Ô-�H€CˆØ�Š8�c˜4’iÑ
 ×	%Ò	%¨1Ð	%Ñ	-Ô	-€DØ‡x‚x�z„z�2‚~€~Ø  œ r¨$¤x°°D´	�C�ˆÝ0?ÀÀFÈ4Ñ0PÔ0PÑ/€Fˆ6�/ -ÝŒM˜#˜r "˜g¨1Ð-Ñ-Ô-�G€CˆØˆs‰7€FÝ•E�"œ)Ÿ.š.¨Ñ0Ô0Ñ1Ô1°#Ñ6Ô6€KÝŒW�c˜&‘j +Ñ-¨b°Ñ3Ô3€HØ�q�q�q˜�sŒm€IÝŒK˜	Ñ"Ô"€GÝŒh•s˜9‘~”~Ñ&Ô&€IØ‡{‚{�}„}ð WÝŒm˜I gÔ.°°"¨vÑ6Ô6‰ˆˆ2Ýœ7 I¨gÔ$6°rÑ$9½3½uÀRÈÁU¹|¼|ÈDÑ;QÔ;QÑ#QÐRSÐTUÑVÔVˆ	�'ÑÝŒ_˜h y°·²ÅÑ1FÔ1FÀrÈ"ÁuÐMÑNÔN€HÝ
Œ	×Ò˜dÑ#Ô#€CØ�:Š:•c˜(‘m”m F¨8Ô$4½SÀ¹]¼]È6ÐRZÔK[Ò=[ˆ:Ñ\Ô\€FØ�fÔ×$Ò$¥R¤ZÑ0Ô0€HÝ”E˜& ¨°°%±¸¸&¹ÀÀ5ÁÈÈ6ÉÐ/RØ�œ¥ S¡¤Ñ*Ô*¨3Ñ.­u°ZÀtÐ5KÑ/LÔ/LðMô NßNTÊfÕUWÔU_ÑN`ÔN`ð àÔ�z˜mÒ+Ð+¨x¬~ÀÀxÔ@PÕQZÐ?[Ò/[Ð/[ÝÐ6Ñ7Ô7Ð7ÝŒ;�xÑ Ô ×$Ò$Ñ&Ô&ð 9­b¬k¸/Ñ.JÔ.J×.NÒ.NÑ.PÔ.Pð 9ÝÐ7Ñ8Ô8Ð8Ø�O½¸C¹¼ÐQ^Ø /À:Ø/9¸TÐ/Að%Cð %Cð Cð Cr   c                óR   ‡ — t          j        ˆ fd„dD ¦   «         t          ¬¦  «        S )Nc                ó    •— g | ]
}‰|         ‘ŒS r*   r*   )r+   ÚkrŽ   s     €r   ú
<listcomp>zbox_array.<locals>.<listcomp>‡   s   ø€ Ð@Ð@Ð@ �S˜”VÐ@Ð@Ð@r   )r‘   r’   r�   r�   r   )r   rA   rJ   )rŽ   s   `r   Ú	box_arrayrµ   †   s.   ø€ ÝŒ8Ð@Ð@Ð@Ð@Ð%?Ð@Ñ@Ô@ÅuÐMÑMÔMÐMr   c                óL  ‡ ‡— ‰ d         dk    s ‰ d         d         |k    s‰ d         d         rt          d¦  «        ‚‰ d         d         Š|dk    r}d	}t          ˆ fd
„|D ¦   «         ¦  «        st          d¦  «        ‚t          j        ‰d         ¦  «        }‰d         ‰d         t          j        |¦  «        t          j        |¦  «        g}n€|dk    rkd}t          ˆ fd„|D ¦   «         ¦  «        r‰ d         d         d         st          d¦  «        ‚ˆfd„|D ¦   «         t          ‰ d         d         ¦  «        z   }nt          d¦  «        ‚t          j        |t          j        ¬¦  «        }t          j	        |¦  «                             ¦   «         st          d¦  «        ‚|S )NÚsubsetÚoverlapÚposeÚkindÚissuesz!Ineligible supervised pose recordÚvaluesr	   )Úx_gtÚy_gtÚ
theta_d_gtc              3  ó@   •K  — | ]}‰d          d         |         V — ŒdS ©r¹   Úsupervision_maskNr*   ©r+   r³   Úrows     €r   r/   ztarget_array.<locals>.<genexpr>�   ó2   øè è € ÐFÐF¸!�3�v”;Ð1Ô2°1Ô5ÐFÐFÐFÐFÐFÐFr   zMissing planar supervisionr¿   r½   r¾   r
   )r½   r¾   Úz_gtc              3  ó@   •K  — | ]}‰d          d         |         V — ŒdS rÁ   r*   rÃ   s     €r   r/   ztarget_array.<locals>.<genexpr>–   rÅ   r   rÂ   Ú	normal_gtz$Missing reference/normal supervisionc                ó    •— g | ]
}‰|         ‘ŒS r*   r*   )r+   r³   r¼   s     €r   r´   z target_array.<locals>.<listcomp>˜   s   ø€ Ð*Ð*Ð*˜a��q”	Ð*Ð*Ð*r   zUnknown partial-pose taskr   zInvalid target)
r   r   r   Údeg2radÚcosÚsinÚlistr   r‡   r   )rÄ   ÚtaskÚfieldsÚangleÚresultrA   r¼   s   `     @r   Útarget_arrayrÒ   Š   s¶  øø€ Ø
ˆ8„}�iÒÐ 3 v¤;¨vÔ#6¸Ò#<Ð#<ÀÀFÄÈHÔ@UÐ#<ÝÐ<Ñ=Ô=Ð=ØˆvŒ;�xÔ €FØÐÒÐØ+ˆÝÐFÐFÐFÐF¸vÐFÑFÔFÑFÔFð 	;ÝÐ9Ñ:Ô:Ð:ÝŒj˜ Ô-Ñ.Ô.ˆØ�v”˜v fœ~­b¬f°U©m¬m½B¼FÀ5¹M¼MÐJˆˆØ	Ð%Ò	%Ð	%Ø%ˆÝÐFÐFÐFÐF¸vÐFÑFÔFÑFÔFð 	EÈcÐRXÌkÐZlÔNmÐnyÔNzð 	EÝÐCÑDÔDÐDØ*Ð*Ð*Ð* 6Ð*Ñ*Ô*­4°°F´¸KÔ0HÑ+IÔ+IÑIˆˆÝÐ5Ñ6Ô6Ð	6Ý
Œ*�V¥"¤*Ð
-Ñ
-Ô
-€EÝŒ;�uÑÔ×!Ò!Ñ#Ô#ÐF­*Ð5EÑ*FÔ*FÐ$FØ€Lr   c                ó„  — t          j        | ¦  «        }|dk    rf|ddd…f         }|t          j        t           j                             |dd¬¦  «        d¦  «        z  }t          j        |dd d	…f         |fd¬
¦  «        S |dk    r,t          j        |dd d…f         |ddd…f         fd¬
¦  «        S t          d¦  «        ‚)Nr	   .é   é   r8   T©r2   Úkeepdimsr   r6   r1   r
   r&   é	   úUnknown task)r   r   Úmaximumr   r   Úconcatenater   )r¯   rÎ   ÚgÚns       r   Úbase_predictionrÞ   Ÿ   sÉ   € Ý„j�Ñ!Ô!€AØÐÒÐØ
ˆC��!�ˆGŒ*ˆØ
�BŒJ•r”y—~’~ a¨R¸�~Ñ>Ô>¸tÑDÔDÑ
DˆÝŒ~˜q  R a R œy¨˜m°Ð4Ñ4Ô4Ð4ØÐ#Ò#Ð#ÝŒ~˜q  R a R œy¨¨3¨q°¨s¨7¬Ð4¸"Ð=Ñ=Ô=Ð=Ý
�^Ñ
$Ô
$Ð$r   c                óp  — t          j        | t          ¬¦  «                             ¦   «         } |dk    rdnd}| d|d …f         }t           j                             |dd¬¦  «        }t          j        |¦  «        }d	|d
<   t          j        |dk    |t          j        |d¦  «        z  |¦  «        | d|d …f<   | S )Nr   r	   r6   r&   .r8   TrÖ   r0   ).r   r   )	r   r   rJ   Úcopyr   r   Ú
zeros_likeÚwhererÚ   )r   rÎ   ÚstartÚ	directionr   Úfallbacks         r   Únormalize_predictionræ   ª   s²   € Ý	Œ�D�uÐ	%Ñ	%Ô	%×	*Ò	*Ñ	,Ô	,€DØÐ&Ò&Ð&ˆ!ˆ!¨A€EØ�3�u�v�v�:Ô€IÝ	Œ�Š˜	 r°4ˆÑ	8Ô	8€DÝŒ]˜9Ñ%Ô%€H°a h¨u¡oÝ”X˜d 4ši¨	µ"´*¸TÀ$Ñ2GÔ2GÑ(GÈÑQÔQ€DˆˆUˆVˆVˆÑØ€Kr   c                  óB   — e Zd ZdZd
d„Zd„ Zd„ Zd„ Zed„ ¦   «         Z	d	S )ÚRidgeResidualzCTrain-only standardized geometric features -> regularized residual.r	   r3   c                ó$   — ||c| _         | _        d S r)   ©rÎ   Úalpha)ÚselfrÎ   rë   s      r   Ú__init__zRidgeResidual.__init__¶   s   € Ø! %ÐˆŒ	�$”*�*�*r   c                óì  — t          j        |t          ¬¦  «        }t          j        |t          ¬¦  «        }|                     d¬¦  «        | _        t          j        |                     d¬¦  «        d¦  «        | _        || j        z
  | j        z  }| j        dk    rt          j        g d¢¦  «        nt          j        dgdz  d	gdz  z   ¦  «        }|| _        |t          || j        ¦  «        z
  |z  }|                     d¬¦  «        | _
        t           j                             |j        |z  | j        t          j        |j        d
         ¦  «        z  z   |j        || j
        z
  z  ¦  «        | _        | S )Nr   r   r1   çü©ñÒMbP?r	   )çš™™™™™©?rð   r3   r3   rð   r&   r3   r0   )r   r   rJ   rK   rÚ   ÚstdrÎ   rA   ÚscalesrÞ   Ú	interceptr   ÚsolverD   rë   Úeyerw   Úcoef)rì   r­   Útargetsr‘   r’   rò   rZ   s          r   ÚfitzRidgeResidual.fit¹   s9  € Ý
Œ*�X¥EÐ
*Ñ
*Ô
*ˆ­R¬Z¸ÅeÐ-LÑ-LÔ-L¨1Ø—&’&˜a�&‘.”.ˆŒ	­"¬*°Q·U²UÀ°U±]´]À4Ñ*HÔ*H ¤ØˆTŒY‰;˜œÑ
 ˆØ,0¬IÐ7HÒ,HÐ,H�rŒx˜˜˜Ñ(Ô(Ð(ÍbÌhÐX[ÐW\Ð]^ÑW^Ð`bÐ_cÐdeÑ_eÑWeÑNfÔNfˆØˆŒØ•O H¨T¬YÑ7Ô7Ñ7¸Ñ?ˆØ—}’}¨!�}Ñ,Ô,ˆŒÝ”)—/’/ !¤# a¡%¨¬
µ2´6¸!¼'À!¼*Ñ3EÔ3EÑ(EÑ"EÀaÄcÈ8ÐTXÔTbÑKbÑFcÑdÔdˆŒ	Øˆr   c                óÔ   — t          j        |¦  «        | j        z
  | j        z  }t	          || j        ¦  «        || j        z  | j        z   | j        z  z   }t          || j        ¦  «        S r)   )
r   r   rK   rñ   rÞ   rÎ   rö   ró   rò   ræ   )rì   r­   r‘   r   s       r   ÚpredictzRidgeResidual.predictÄ   s[   € ÝŒ:�hÑÔ ¤	Ñ)¨4¬8Ñ
3ˆÝ˜X d¤iÑ0Ô0°!°D´I±+¸d¼nÑ2LÈdÌkÑ1YÑYˆÝ# D¨¬Ñ3Ô3Ð3r   c                ó>   ‡ — ‰ j         ‰ j        dœˆ fd„dD ¦   «         ¥S )Nrê   c                óV   •— i | ]%}|t          ‰|¦  «                             ¦   «         “Œ&S r*   )ÚgetattrÚtolist)r+   r³   rì   s     €r   ú
<dictcomp>z*RidgeResidual.document.<locals>.<dictcomp>Ê   sB   ø€ ð  7Gð  7Gð  7GÐVW°q½ÀÀa¹¼×9OÒ9OÑ9QÔ9Qð  7Gð  7Gð  7Gr   ©rK   rñ   rò   ró   rö   rê   )rì   s   `r   ÚdocumentzRidgeResidual.documentÉ   sU   ø€ Ø”y¨¬ð  Hð  Hð  7Gð  7Gð  7Gð  7Gð  \Fð  7Gñ  7Gô  7Gð  Hð  	Hr   c           	     ó’   —  | |d         |d         ¦  «        }dD ]+}t          ||t          j        ||         ¦  «        ¦  «         Œ,|S )NrÎ   rë   r   )Úsetattrr   r   )ÚclsÚvalueÚobjr³   s       r   Úfrom_documentzRidgeResidual.from_documentÌ   sP   € àˆC��f”˜e GœnÑ-Ô-ˆØ;Ð_Ð_ˆA½GÀCÈÍ"Ì*ÐUZÐ[\ÔU]ÑJ^ÔJ^Ñ<_Ô<_Ð<_Ð<_Øˆ
r   N)r	   r3   )
Ú__name__Ú
__module__Ú__qualname__Ú__doc__rí   rø   rú   r  Úclassmethodr  r*   r   r   rè   rè   ´   sy   € € € € € ØMÐMð(ð (ð (ð (ð	ð 	ð 	ð4ð 4ð 4ð
Hð Hð Hð ðð ñ „[ðð ð r   rè   c                  ó&   ‡ — e Zd Zdˆ fd„	Zd„ Zˆ xZS )ÚPointNetResidualNc                óÞ  •— t          ¦   «                              ¦   «          |t          vrt          d¦  «        ‚|| _        |                      d|€t          j        t          ¦  «        nt          j	        |t          j
        ¬¦  «        ¦  «         |                      d|€t          j        t          ¦  «        n2t          j	        |t          j
        ¬¦  «                             d¦  «        ¦  «         g }t          dfddfD ]U\  }}|                     t          j        ||d	¦  «        t          j        d
|¦  «        t          j        ¦   «         f¦  «         ŒVt          j        |Ž | _        t          j        t          j        dt          z   d¦  «        t          j        ¦   «         t          j        d¦  «        t          j        dd¦  «        t          j        ¦   «         t          j        d|t          d         k    rdnd¦  «        ¦  «        | _        t          j                             | j        d         j        ¦  «         t          j                             | j        d         j        ¦  «         d S )NrÙ   Úglobal_meanr   Ú
global_stdrï   é    )r  é@   )r  é€   r0   rÕ   é   r  gš™™™™™¹?r  r   rh   rÔ   r8   )Úsuperrí   ÚTASKSr   rÎ   Úregister_bufferÚtorchr„   rŠ   Ú	as_tensorr‡   rB   Ú	clamp_minr‹   Úextendr   ÚConv1dÚ	GroupNormÚSiLUÚ
Sequentialrq   ÚLinearÚDropoutÚheadÚinitÚzeros_ÚweightÚbias)rì   rÎ   r  r  ÚblocksÚincÚoutÚ	__class__s          €r   rí   zPointNetResidual.__init__Ô   s2  ø€ Ý‰Œ×ÒÑÔÐØ•uÐÐ¥:¨nÑ#=Ô#=Ð=ØˆŒ	Ø×Ò˜]ÀkÐFY­5¬;µzÑ+BÔ+BÐ+BÕ_dÔ_nÐozõ  BGô  BOð  `Pñ  `Pô  `Pñ  	Qô  	Qð  	QØ×Ò˜\ÀJÐDV­%¬*µZÑ*@Ô*@Ð*@Õ\aÔ\kÐlvõ  ~Cô  ~Kð  ]Lñ  ]Lô  ]L÷  ]Vò  ]Vð  W[ñ  ]\ô  ]\ñ  	]ô  	]ð  	]ØˆÝ" 2˜ w¨xÐ8ð 	Pð 	P‰GˆC�Ø�MŠM�2œ9 S¨¨QÑ/Ô/µ´¸Q¸sÑ0CÔ0CÅBÄGÁIÄIÐNÑOÔOÐOÐOÝ”M 6Ð*ˆŒÝ”-¥¤	¨#­j©.¸Ñ =Ô =½b¼g¹i¼iÍÌ
ÐSUÉÌÝŒI�c˜"ÑÔ�bœg™iœi­¬	°"¸$ÅÀaÄº.¸.°Q°QÈaÑ(PÔ(PñRô RˆŒ	å
Œ�Š�t”y ”}Ô+Ñ,Ô,Ð,­R¬W¯^ª^¸D¼IÀb¼MÔ<NÑ-OÔ-OÐ-OÐ-OÐ-Or   c           
     ó\  — |                       |                     dd¦  «        ¦  «        }t          j        |                     d¬¦  «        |                     d¬¦  «        fd¬¦  «        }|| j        z
  | j        z  }|                      t          j        || 	                    dd¦  «        fd¬¦  «        ¦  «        }| j
        dk    r~t          j        |d d …dd	…f         d¬¦  «        }|d d …d d…f         d
|d d …d d…f         z  z   }t          j        |t          j        ||d d …dd …f         z   dd¬¦  «        fd¬¦  «        S |d d …d d…f         d
|d d …d d…f         z  z   }	t          j        |d d …dd…f         |d d …dd …f         z   dd¬¦  «        }
t          j        |	|
fd¬¦  «        S )Nr0   r6   r8   ©Údimiöÿÿÿé
   r	   rÔ   rÕ   rð   rp   )r.  Úepsr&   rØ   )rq   Ú	transposer  ÚcatÚamaxrK   r  r  r#  ÚclamprÎ   ÚFÚ	normalize)rì   rq   r¯   ÚhiddenÚpooledrÜ   rZ   rä   ÚxyrL   r   s              r   ÚforwardzPointNetResidual.forwardâ   sÇ  € Ø�{Š{˜6×+Ò+¨A¨aÑ0Ô0Ñ1Ô1ˆÝŒy˜&Ÿ+š+¨"˜+Ñ-Ô-¨f¯kªk¸b¨kÑ.AÔ.AÐBÀrÐJÑJÔJˆØ˜4Ô+Ñ+¨T¬_Ñ
<ˆØ—’�5œ9 f¨Q¯WªW°S¸©_¬_Ð%=À"ÐEÑEÔEÑFÔFˆØŒ9Ð'Ò'Ð'Ý”k /°!°!°!°A°a°C°%Ô"8¸RÐ@Ñ@Ô@ˆIØ˜q˜q˜q  ! ˜tÔ$ S¨°!°!°!°B°Q°B°$¬Ñ%7Ñ7ˆBÝ”9˜b¥¤¨Y°xÀÀÀÀ!À"À"À´~Ñ-EÈ"ÐQUÐ!VÑ!VÔ!VÐWÐ\^Ð_Ñ_Ô_Ð_Ø˜A˜A˜A˜b˜q˜b˜DÔ! # h¨q¨q¨q°°!°¨t¤nÑ"4Ñ4ˆÝŒ{˜?¨1¨1¨1¨Q¨q¨S¨5Ô1°(¸1¸1¸1¸Q¸R¸R¸4´.Ñ@ÀRÈDÐQÑQÔQˆÝŒy˜#˜f˜¨"Ð-Ñ-Ô-Ð-r   )NN)r  r	  r
  rí   r:  Ú__classcell__)r+  s   @r   r  r  Ó   sR   ø€ € € € € ðPð Pð Pð Pð Pð Pð.ð .ð .ð .ð .ð .ð .r   r  c           	     ó¨  — |dk    rdnd}t          j        | d d …d |…f         |d d …d |…f         z
  dz  t          j        |d d …d |…f         ¦  «        d¬¦  «        }d| d d …|d …f         t          j        |d d …|d …f         d¬	¦  «        z                       d¬	¦  «                             dd¦  «        z
                       ¦   «         }|d
|z  z   S )Nr	   r6   r&   rð   r3   )Úbetar0   r8   r-  r/  )r5  Úsmooth_l1_lossr  rá   r6  rE   r4  rK   )Ú
predictionr   rÎ   ÚdimsÚpositionrÐ   s         r   Úpartial_lossrB  ð   s÷   € ØÐ%Ò%Ð%ˆˆ¨1€DÝÔ˜z¨!¨!¨!¨E¨T¨E¨'Ô2°6¸!¸!¸!¸E¸T¸E¸'´?ÑBÀCÑGÝÔ˜    % 4 % œÑ)Ô)¨rð3ñ 3ô 3€Hàˆj˜˜˜˜4˜5˜5˜Ô!¥!¤+¨f°Q°Q°Q°t°u°u°W¬oÀ"Ð"EÑ"EÔ"EÑE×JÒJÈrÐJÑRÔR×XÒXÐY[Ð\]Ñ^Ô^Ñ^×
dÒ
dÑ
fÔ
f€EØ�B�u‘HÑÐr   c                óª  — t          j        | t          ¬¦  «        t          j        |t          ¬¦  «        }}t          |¦  «        sddiS |dk    rdnd}t           j                             |d d …d |…f         |d d …d |…f         z
  d¬¦  «        }|dk    rƒt          t          j        t          j        |d d …df         |d d …df         ¦  «        ¦  «        t          j        t          j        |d d …df         |d d …df         ¦  «        ¦  «        ¦  «        }nñ|d d …dd …f         t          j	        t           j                             |d d …dd …f         dd	¬
¦  «        d¦  «        z  }|d d …dd …f         t          j	        t           j                             |d d …dd …f         dd	¬
¦  «        d¦  «        z  }	t          j        t          j
        t          j        ||	z                       d¬¦  «        dd¦  «        ¦  «        ¦  «        }t          |¦  «        t          |                     ¦   «         dz  ¦  «        t          t          j        |¦  «        dz  ¦  «        t          t          j        |dz                       ¦   «         ¦  «        dz  ¦  «        t          t          j        |d¦  «        dz  ¦  «        t          |                     ¦   «         ¦  «        t          t          j        |¦  «        ¦  «        t          |dk    |dk    z                       ¦   «         ¦  «        t          |                     ¦   «         dz  |                     ¦   «         dz  z   ¦  «        dœ	}
t#          dd |…         ¦  «        D ]X\  }}t          t          j        |d d …|f         |d d …|f         z
  ¦  «                             ¦   «         dz  ¦  «        |
|dz   <   ŒY|
S )Nr   Úsamplesr   r	   r6   r&   r0   r1   TrÖ   r   r8   iè  éZ   rð   g      @)	rD  Úposition_mae_mmÚposition_median_mmÚposition_rmse_mmÚposition_p90_mmÚangle_mae_degreesÚangle_median_degreesÚsuccess_50mm_5degÚselection_scorerL   Ú_mae_mm)r   r   rJ   r9   r   r   r   Úrad2degÚarctan2rÚ   Úarccosrƒ   rE   rK   rH   Úsqrtr‚   Ú	enumerater   )r?  r   rÎ   ÚpÚtr@  Ú	distancesÚanglesÚpnÚtnrÑ   r,   r2   s                r   Úpose_metricsrZ  ø   st  € Ý
Œ
�:¥EÐ*Ñ*Ô*­2¬:°fÅ5Ð+IÑ+IÔ+I€a€AÝˆq‰6Œ6Ð&˜) A˜Ð&ØÐ%Ò%Ð%ˆˆ¨1€DÝŒi�nŠn˜Q˜q˜q˜q  $ ˜wœZ¨¨!¨!¨!¨E¨T¨E¨'¬
Ñ2¸ˆnÑ:Ô:€IØÐÒÐÝ$¥R¤Zµ´
¸1¸Q¸Q¸Q¸q¸S¼6À!ÀAÀAÀAÀaÀCÄ&Ñ0IÔ0IÑ%JÔ%JÍ2Ì:ÕVXÔV`ÐabÐcdÐcdÐcdÐefÐcfÔagÐhiÐjkÐjkÐjkÐlmÐjmÔhnÑVoÔVoÑKpÔKpÑqÔqˆˆàˆQˆQˆQˆqˆrˆrˆTŒ7•2”:�bœiŸnšn¨Q¨q¨q¨q°°°¨t¬W¸!ÀT˜nÑJÔJÈ4ÑPÔPÑPˆØˆQˆQˆQˆqˆrˆrˆTŒ7•2”:�bœiŸnšn¨Q¨q¨q¨q°°°¨t¬W¸!ÀT˜nÑJÔJÈ4ÑPÔPÑPˆÝŒz�"œ)¥B¤G¨R°©U¯KªK¸Q¨KÑ,?Ô,?ÀÀ1Ñ$EÔ$EÑFÔFÑGÔGˆÝ˜!‘f”f­u°Y·^²^Ñ5EÔ5EÀdÑ5JÑ/KÔ/KÝ"¥2¤9¨YÑ#7Ô#7¸Ñ#<Ñ=Ô=ÕQVÕWYÔW^Ð`iÐklÑ`l×_rÒ_rÑ_tÔ_tÑWuÔWuÐvzÑWzÑQ{ÔQ{Ý¥¤¨i¸Ñ ;Ô ;¸DÑ @ÑAÔAÝ! &§+¢+¡-¤-Ñ0Ô0ÍÍbÌiÐX^ÑN_ÔN_ÑH`ÔH`Ý! I¨s¢N°V¸R²ZÑ#@×"FÒ"FÑ"HÔ"HÑIÔIÝ 	§¢Ñ 0Ô 0°Ñ 4°V·[²[±]´]À2Ñ5EÑ EÑFÔFðHð H€Fõ ˜E % 4 %œLÑ)Ô)ÐiÐi‰ˆˆ$ÅÅrÄvÈaÐPQÐPQÐPQÐRSÐPSÌfÐUVÐWXÐWXÐWXÐYZÐWZÔU[ÉmÑG\ÔG\×GaÒGaÑGcÔGcÐdhÑGhÑAiÔAi¨&°°i±Ñ*@Ð*@Ø€Mr   c                óÚ  ‡— t          d„ |D ¦   «         ¦  «        }i }|D ]aŠˆfd„t          |¦  «        D ¦   «         }t          t          j        | ¦  «        |         t          j        |¦  «        |         |¦  «        |‰<   Œbt          | ||¦  «        }t          |¦  «        |d<   |r=t          t          j        d„ |                     ¦   «         D ¦   «         ¦  «        ¦  «        nd |d<   ||dœS )Nc                ó   — h | ]
}|d          ’ŒS ©Úgroup_idr*   ©r+   Úrs     r   ú	<setcomp>z"grouped_metrics.<locals>.<setcomp>  s   € Ð/Ð/Ð/ Q�1�Z”=Ð/Ð/Ð/r   c                ó2   •— g | ]\  }}|d          ‰k    ¯|‘ŒS r]  r*   )r+   r,   r`  Úgroups      €r   r´   z#grouped_metrics.<locals>.<listcomp>  s+   ø€ ÐFÐFÐF‘s�q˜°°:´ÀÒ1EÐ1E�Ð1EÐ1EÐ1Er   Úgroupsc                ó   — g | ]
}|d          ‘ŒS )rM  r*   )r+   Úvs     r   r´   z#grouped_metrics.<locals>.<listcomp>  s   € Ð9jÐ9jÐ9jÐST¸!Ð<MÔ:NÐ9jÐ9jÐ9jr   Úmacro_group_selection_score)ÚoverallÚby_group)	ÚsortedrS  rZ  r   r   r9   rJ   rK   r¼   )	r?  r÷   ÚrowsrÎ   rd  ri  Úindicesrh  rc  s	           @r   Úgrouped_metricsrm    s  ø€ ÝÐ/Ð/¨$Ð/Ñ/Ô/Ñ0Ô0€FØ€HØð hð hˆØFÐFÐFÐF�i¨™oœoÐFÑFÔFˆÝ$¥R¤Z°
Ñ%;Ô%;¸GÔ%DÅRÄZÐPWÑEXÔEXÐY`ÔEaÐbfÑgÔgˆ�‰ˆÝ˜ G¨DÑ1Ô1€GÝ˜&‘k”k€GˆHÑØpvð  ,A­5µ´Ð9jÐ9jÐX`×XgÒXgÑXiÔXiÐ9jÑ9jÔ9jÑ1kÔ1kÑ+lÔ+lÐ+lð  }A€GÐ)Ñ*Ø¨Ð2Ð2Ð2r   r&   c                ó¼  ‡ ‡‡‡‡	— dd l Šˆ fd„d„ ‰ D ¦   «         D ¦   «         Št          ‰¦  «        |k     rt          d¦  «        ‚t          ‰ˆˆˆfd„¬¦  «        }d„ t	          |¦  «        D ¦   «         }dg|z  Š	|D ]T}t          t	          |¦  «        ˆ	fd„¬¦  «        }||                              |¦  «         ‰	|xx         ‰|         z  cc<   ŒUˆ fd	„|D ¦   «         S )
Nr   c                óJ   •‡— i | ]Š‰t          ˆfd „‰D ¦   «         ¦  «        “ŒS )c              3  ó0   •K  — | ]}|d          ‰k    V — ŒdS )r^  Nr*   )r+   r`  rÜ   s     €r   r/   z)group_folds.<locals>.<dictcomp>.<genexpr>  s,   øè è € Ð1Ð1 q�!�J”- Ò"Ð1Ð1Ð1Ð1Ð1Ð1r   )rE   )r+   rÜ   rk  s    @€r   rÿ   zgroup_folds.<locals>.<dictcomp>  s9   øø€ ÐYÐYÐY°aˆA�cÐ1Ð1Ð1Ð1¨DÐ1Ñ1Ô1Ñ1Ô1ÐYÐYÐYr   c                ó   — h | ]
}|d          ’ŒS r]  r*   r_  s     r   ra  zgroup_folds.<locals>.<setcomp>  s   € Ð;XÐ;XÐ;XÈa¸A¸j¼MÐ;XÐ;XÐ;Xr   z$Not enough independent groups for CVc                ó’   •— ‰|           ‰                      ‰› d| › �                     ¦   «         ¦  «                             ¦   «         fS )Nú:)Úsha256ÚencodeÚ	hexdigest)rÜ   ÚcountsÚhashlibrN   s    €€€r   ú<lambda>zgroup_folds.<locals>.<lambda>  s@   ø€ ¨¨q¬	 z°'·.².ÀDÀÀÈ1ÀÀ×AUÒAUÑAWÔAWÑ2XÔ2X×2bÒ2bÑ2dÔ2dÐ&e€ r   )Úkeyc                ó   — g | ]}g ‘ŒS r*   r*   )r+   r]   s     r   r´   zgroup_folds.<locals>.<listcomp>  s   € Ð	#Ð	#Ð	#�ˆ"Ð	#Ð	#Ð	#r   c                ó   •— ‰|          | fS r)   r*   )r,   Úsizess    €r   ry  zgroup_folds.<locals>.<lambda>   s   ø€ ¨¨q¬°!¨€ r   c                ó~   •‡— g | ]8Šˆfd „t          ‰¦  «        D ¦   «         ˆfd„t          ‰¦  «        D ¦   «         f‘Œ9S )c                ó.   •— g | ]\  }}|d          ‰v¯|‘ŒS r]  r*   ©r+   r,   r`  rd  s      €r   r´   z*group_folds.<locals>.<listcomp>.<listcomp>!  s+   ø€ ÐJÐJÐJ‘C�A�a¨a°
¬mÀ6Ð.IÐ.IˆaÐ.IÐ.IÐ.Ir   c                ó.   •— g | ]\  }}|d          ‰v ¯|‘ŒS r]  r*   r€  s      €r   r´   z*group_folds.<locals>.<listcomp>.<listcomp>"  s+   ø€ ÐFÐFÐF‘C�A�a¨a°
¬m¸vÐ.EÐ.EˆaÐ.EÐ.EÐ.Er   )rS  )r+   rd  rk  s    @€r   r´   zgroup_folds.<locals>.<listcomp>!  sn   øø€ ð \ð \ð \ØLRð KÐJÐJÐJ�9 T™?œ?ÐJÑJÔJØFÐFÐFÐF�9 T™?œ?ÐFÑFÔFðHð \ð \ð \r   )rx  r9   r   rj  r?   r<   Úappend)
rk  rP   rN   rd  ÚbinsrÜ   rR   rw  rx  r}  s
   ` `    @@@r   Úgroup_foldsr„    s6  øøøøø€ Ø€N€N€NØYÐYÐYÐYÐ;XÐ;XÐSWÐ;XÑ;XÔ;XÐYÑYÔY€FÝ
ˆ6�{„{�5ÒÐ�zÐ*PÑQÔQÐQÝ�&ÐeÐeÐeÐeÐeÐeÐfÑfÔf€FØ	#Ð	#•e˜E‘l”lÐ	#Ñ	#Ô	#€D¨1¨#¨e©) EØð \ð \ˆÝ
�e�E‰lŒlÐ4Ð4Ð4Ð4Ð
5Ñ
5Ô
5ˆ°d¸1´g·n²nÀQÑ6GÔ6GÐ6GÈÈaÈÈÌÐRXÐYZÔR[ÑH[ÈÈÉÈð\ð \ð \ð \ØVZð\ñ \ô \ð \r   )r    )r&   r    )r  Ú
__future__r   r�   Úpathlibr   Únumpyr   r  r   Útorch.nnr   r5  r‹   rŠ   r  r   r   rc   r°   rµ   rÒ   rÞ   ræ   rè   ÚModuler  rB  rZ  rm  r„  r*   r   r   ú<module>rŠ     sÍ  ððð ð #Ð "Ð "Ð "Ð "Ð "à €€€Ø Ð Ð Ð Ð Ð à Ð Ð Ð Ø €€€Ø Ð Ð Ð Ð Ð Ø $Ð $Ð $Ð $Ð $Ð $à€	Ø€
Ø3€ðHð Hð Hð.ð .ð .ð$Gð $Gð $Gð $GðN HLÐQSð 9Cð 9Cð 9Cð 9Cð 9CðxNð Nð Nðð ð ð*%ð %ð %ðð ð ðð ð ð ð ñ ô ð ð>.ð .ð .ð .ð .�r”yñ .ô .ð .ð:ð ð ðð ð ð*	3ð 	3ð 	3ð	\ð 	\ð 	\ð 	\ð 	\ð 	\r   