§
    �­¸j  ã                   óŠ   — 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mZmZmZmZ ddededdfd	„Zd
„ Zd„ Zd„ Zd„ Zd„ ZdS )é    )ÚPathN)ÚImage)Úscan_datasetÚread_pcdÚ
load_frameÚfit_normalizationÚapply_normalizationÚsplit_groupsÚleave_one_domainÚcanonical_recordsÚasciiÚpathÚmodeÚreturnc                 óè  — d|z   dz                         ¦   «         }|dk    rd}n¶|dk    r‚t          j        g d¢d¬¦  «                             ¦   «         }t	          j        d	t          |¦  «        d
z   t          |¦  «        ¦  «        t          t          |¦  «        d
z
  g¦  «        z   |z   }n.t          j        g d¢g d¢gd¬¦  «                             ¦   «         }|                      ||z   ¦  «         d S )Nzu# .PCD v0.7
VERSION .7
FIELDS x y z intensity
SIZE 4 4 4 4
TYPE F F F F
COUNT 1 1 1 1
WIDTH 2
HEIGHT 1
POINTS 2
DATA ú
r   s   1 2 3 4
5 6 7 8
Úbinary_compressed)é   é   é   é   é   é   é   é   ú<f4©Údtypez<IIr   ©r   r   r   r   ©r   r   r   r   )	ÚencodeÚnpÚarrayÚtobytesÚstructÚpackÚlenÚbytesÚwrite_bytes)r   r   ÚheaderÚpayloadÚraws        útests/test_data.pyÚ_pcdr.      sÿ   € ðPØRVñWØY]ñ^ß_eÒ_eÑ_gÔ_gð àˆw‚€Ø'ˆˆØ	Ð$Ò	$Ð	$åŒhÐ/Ð/Ð/°uÐ=Ñ=Ô=×EÒEÑGÔGˆÝ”+˜e¥S¨¡X¤X°¡\µ3°s±8´8Ñ<Ô<½uÅcÈ#ÁhÄhÐQRÁlÀ^Ñ?TÔ?TÑTÐWZÑZˆˆå”(˜L˜L˜L¨,¨,¨,Ð7¸uÐEÑEÔE×MÒMÑOÔOˆØ×Ò�V˜gÑ%Ñ&Ô&Ð&Ð&Ð&ó    c                 óÎ   — dD ]a}| |› d�z  }t          ||¦  «         t          |¦  «        \  }}|d         dgk    sJ ‚t          j                             |g d¢g d¢g¦  «         Œbd S )N)r   Úbinaryr   ú.pcdÚWIDTHÚ2r   r    )r.   r   r"   ÚtestingÚassert_allclose)Útmp_pathr   r   r*   Úpointss        r-   Útest_pcd_ascii_and_binaryr9      s�   € Ø8ð Ið IˆØ˜T˜-˜-˜-Ñ'ˆÝˆT�4ÑÔÐÝ! $™œ‰ˆ�Ø�gŒ 3 %Ò'Ð'Ð'Ð'Ý
Œ
×"Ò" 6¨L¨L¨L¸,¸,¸,Ð+GÑHÔHÐHÐHðIð Ir/   c                 ó"  — d}| dz  }dD ]3}||z  }|                      d¬¦  «         t          |d|› d�z  ¦  «         Œ4t          j        t	          j        dd	ggt          j        ¬
¦  «        ¦  «                             |dz  d|› d�z  ¦  «         |dz  d|› d�z                       ¦   «          t          | ¦  «        }t          |¦  «        dk    sJ ‚t          d„ |D ¦   «         ¦  «        dk    sJ ‚d„ |D ¦   «         ddhk    sJ ‚t          d„ |D ¦   «         ¦  «        sJ ‚|d                              ¦   «         d         |d                              ¦   «         d         k    sJ ‚|d         j        dk    sJ ‚|d         j        |d         j        k    sJ ‚t          |d¬¦  «        }d„ |                     ¦   «         D ¦   «         }t#          |d„ ¬¦  «        |k    sJ ‚t          d„ |                     ¦   «         D ¦   «         ¦  «        dk    sJ ‚t%          ||d         j        ¦  «        }t          |d         ¦  «        dk    r|d          rJ ‚t'          |¦  «        }	t          |	¦  «        dk    sJ ‚d!|	d         j        v rd"|	d         j        v sJ ‚d S )#Nú29-11-2024_07-17-08Ú
2024_11_29)ÚallÚnone_rectifiedT©ÚparentsÚpoint_cloud_xyzi_r2   é   é   r   r>   Údepth_image_ú.pngr=   Ú
rgb_image_z.jpgr   c                 ó   — h | ]	}|j         ’Œ
S © )Úgroup_id©Ú.0Úrows     r-   ú	<setcomp>zQtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<setcomp>/   s   € Ð-Ð-Ð- �”Ð-Ð-Ð-r/   r   c                 ó   — h | ]	}|j         ’Œ
S rH   )ÚvariantrJ   s     r-   rM   zQtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<setcomp>0   s   € Ð(Ð(Ð(˜CˆCŒKÐ(Ð(Ð(r/   c              3   ó(   K  — | ]}d |j         vV — ŒdS )ÚrgbN)ÚpathsrJ   s     r-   ú	<genexpr>zQtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<genexpr>1   s)   è è € Ð6Ð6¨#ˆu˜CœIÐ%Ð6Ð6Ð6Ð6Ð6Ð6r/   r   rI   z2x1; FOV uncertainr   )Úseedc                 ó   — g | ]	}|D ]}|‘ŒŒ
S rH   rH   )rK   ÚvaluesÚrs      r-   ú
<listcomp>zRtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<listcomp>6   s%   € Ð@Ð@Ð@�v¸Ð@Ð@°A�Ð@Ð@Ð@Ð@r/   c                 ó   — | j         | j        fS ©N)rI   rO   )rW   s    r-   ú<lambda>zPtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<lambda>7   s   € ¨A¬J¸¼	Ð+B€ r/   )Úkeyc                 ó   — g | ]}|¯|‘ŒS rH   rH   )rK   rV   s     r-   rX   zRtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<listcomp>8   s   € Ð>Ð>Ð>˜6°vÐ>�Ð>Ð>Ð>r/   ÚtestÚtrainÚpcdÚdepth)Úmkdirr.   r   Ú	fromarrayr"   r#   Úuint16ÚsaveÚtouchr   r'   r=   Úto_dictÚdomainÚframe_idr
   rV   Úsortedr   r   rR   )
r7   ÚstampÚbaseÚversionÚfolderÚrowsÚpartsÚ	flattenedÚheld_outÚ	canonicals
             r-   Ú>test_manifest_groups_processing_versions_and_omits_empty_filesrt   #   sæ  € Ø!€EØ�lÑ"€DØ,ð 7ð 7ˆØ˜‘ˆØ�Š˜TˆÑ"Ô"Ð"ÝˆVÐ5¨%Ð5Ð5Ð5Ñ5Ñ6Ô6Ð6Ð6Ý	„O•B”H˜r 2˜h˜Z­r¬yÐ9Ñ9Ô9Ñ:Ô:×?Ò?ØÐÑÐ"<°Ð"<Ð"<Ð"<Ñ<ñ>ô >ð >à	ˆE�\Ð, Ð,Ð,Ð,Ñ,×3Ò3Ñ5Ô5Ð5Ý˜Ñ!Ô!€DÝˆt‰9Œ9˜Š>ˆ>ˆ>ˆ>ÝÐ-Ð-¨Ð-Ñ-Ô-Ñ.Ô.°!Ò3Ð3Ð3Ð3Ø(Ð( 4Ð(Ñ(Ô(¨UÐ4DÐ,EÒEÐEÐEÐEÝÐ6Ð6°Ð6Ñ6Ô6Ñ6Ô6Ð6Ð6Ð6Ø�Œ7�?Š?ÑÔ˜ZÔ(¨D°¬G¯OªOÑ,=Ô,=¸jÔ,IÒIÐIÐIÐIØ�Œ7Œ>Ð1Ò1Ð1Ð1Ð1Ø�Œ7Ô˜t AœwÔ/Ò/Ð/Ð/Ð/Ý˜ AÐ&Ñ&Ô&€EØ@Ð@ §¢¡¤Ð@Ñ@Ô@€IÝ�)Ð!BÐ!BÐCÑCÔCÀtÒKÐKÐKÐKÝÐ>Ð> U§\¢\¡^¤^Ð>Ñ>Ô>Ñ?Ô?À1ÒDÐDÐDÐDÝ  d¨1¤g¤nÑ5Ô5€HÝˆx˜ÔÑ Ô  AÒ%Ð%¨h°wÔ.?Ð%Ð%Ð?Ý! $Ñ'Ô'€IÝˆy‰>Œ>˜QÒÐÐÐØ�I˜a”LÔ&Ð&Ð&¨7°iÀ´lÔ6HÐ+HÐ+HÐ+HÐHÐ+HÐ+Hr/   c                 ó  — | dz  dz  }|                      d¬¦  «         d}t          |d|› d�z  ¦  «         t          j        t	          j        dd	ggt          j        ¬
¦  «        ¦  «                             |d|› d�z  ¦  «         t          j        t	          j        ddggt          j        ¬
¦  «        ¦  «                             |d|› d�z  ¦  «         t          | ¦  «        d	         }t          |¦  «        }|j
        dk    sJ ‚t          j                             |d	         g d¢g d¢g¦  «         t          |g¦  «        }t          ||¦  «        }|j        t          j        k    sJ ‚|dd d…f                              ¦   «         dk    sJ ‚d S )Nr<   r=   Tr?   r;   rA   r2   éd   r   r   rD   rE   é
   é   Úamplitude_image_)r   r   r   )rv   rw   r   r   )r   rx   r   r   .r   r   )rb   r.   r   rc   r"   r#   rd   re   r   r   Úshaper5   r6   r   r	   r   Úfloat32Úmax)r7   rn   rk   ÚrecordÚframeÚstatsÚ
normalizeds          r-   Ú3test_four_channel_loader_and_training_normalizationr�   @   s–  € Ø˜Ñ$ uÑ,€FØ
‡L‚L˜€LÑÔÐØ!€EÝˆÐ1 eÐ1Ð1Ð1Ñ	1Ñ2Ô2Ð2Ý	„O•B”H˜s A˜h˜Z­r¬yÐ9Ñ9Ô9Ñ:Ô:×?Ò?ÀÐIcÐX]ÐIcÐIcÐIcÑ@cÑdÔdÐdÝ	„O•B”H˜r 2˜h˜Z­r¬yÐ9Ñ9Ô9Ñ:Ô:×?Ò?ÀÐIgÐ\aÐIgÐIgÐIgÑ@gÑhÔhÐhÝ˜(Ñ#Ô# AÔ&€FÝ�vÑÔ€EØŒ;˜)Ò#Ð#Ð#Ð#Ý„J×Ò˜u Qœx¨/¨/¨/¸=¸=¸=Ð)IÑJÔJÐJÝ˜v˜hÑ'Ô'€EÝ$ U¨EÑ2Ô2€JØÔ�rœzÒ)Ð)Ð)Ð)Ø�c˜2˜A˜2�gÔ×"Ò"Ñ$Ô$¨Ò)Ð)Ð)Ð)Ð)Ð)r/   c           
      óÒ  ‡
— | dz  dz  }|                      d¬¦  «         d}|d|› d�z  }d                     ¦   «         }|                     |t          j        g d	¢g d
¢g d¢g d¢gd¬¦  «                             ¦   «         z   ¦  «         |d|› d�z                       d¦  «         t          | ¦  «        d         }t          |dd¬¦  «        \  }}t          j	         
                    |d         ddgddgg¦  «         t          j	         
                    |d         ddgddgg¦  «         t          j        |d         dk    ¦  «        sJ ‚|d          d!k    sJ ‚|d"         d#k    sJ ‚|d$z  Š
t          ‰
¦  «         t          ˆ
fd%„t          | ¦  «        D ¦   «         ¦  «        }	 t          |¦  «         t          d&¦  «        ‚# t          $ r}	d't!          |	¦  «        v sJ ‚Y d }	~	d S d }	~	ww xY w)(NÚ	2023_10_7ÚsceneTr?   z07-10-2023_01-02-03rA   r2   z|# .PCD v0.7
VERSION .7
FIELDS x y z intensity
SIZE 4 4 4 4
TYPE F F F F
COUNT 1 1 1 1
WIDTH 4
HEIGHT 1
POINTS 4
DATA binary
)r   r   r   rw   )r   r   r   rx   )r   r   r   é   )r   r   r   é(   r   r   ry   z.yamlz3%YAML:1.0
rows: 2
cols: 2
dt: u
data: [0, 0, 0, 0]
r   )r   r   )rz   Úreturn_metadata).r   r   r   r   r   ).r   rw   rx   r…   r†   ).r   Údepth_sourcezpositive PCD x coordinateÚintensity_sourcezPCD intensity fallbackz(point_cloud_xyzi_07-10-2023_01-03-03.pcdc              3   ó2   •K  — | ]}|j         ‰k    ¯|V — Œd S rZ   )r`   )rK   rW   Úunknowns     €r-   rS   zKtest_pcd_only_depth_and_bad_zero_yaml_intensity_fallback.<locals>.<genexpr>e   s/   øè è € ÐMÐM˜Q¸A¼EÀWÒ<LÐ<L�qÐ<LÐ<LÐ<LÐ<LÐMÐMr/   z/unknown flat cloud was treated as an image gridzno loadable)rb   r!   r)   r"   r#   r$   Ú
write_textr   r   r5   r6   r=   r.   ÚnextÚAssertionErrorÚ
ValueErrorÚstr)r7   rn   rk   r   r*   r}   r~   ÚmetadataÚunorganizedÚexcr‹   s             @r-   Ú8test_pcd_only_depth_and_bad_zero_yaml_intensity_fallbackr”   Q   sg  ø€ Ø˜Ñ# gÑ-€FØ
‡L‚L˜€LÑÔÐØ!€EØÐ3¨Ð3Ð3Ð3Ñ3€DðXßY_ÒY_ÑYaÔYað à×Ò�V�bœh¨¨¨°}°}°}Ø(5¨¨°}°}°}ð(FØMRðTñ Tô TßT[ÒT[ÑT]ÔT]ñ^ñ _ô _ð _àÐ- Ð-Ð-Ð-Ñ-×9Ò9ØBñDô Dð Då˜(Ñ#Ô# AÔ&€FÝ  ¨vÀtÐLÑLÔL�O€Eˆ8Ý„J×Ò˜u Vœ}°°1¨v¸¸1°vÐ.>Ñ?Ô?Ð?Ý„J×Ò˜u Vœ}°°B¨x¸"¸b¸Ð.BÑCÔCÐCÝŒ6�%˜”- 1Ò$Ñ%Ô%Ð%Ð%Ð%Ø�NÔ#Ð'BÒBÐBÐBÐBØÐ&Ô'Ð+CÒCÐCÐCÐCØÐAÑA€GÝˆ�M„M€MÝÐMÐMÐMÐM¥,¨xÑ"8Ô"8ÐMÑMÔMÑMÔM€KðPÝ�;ÑÔÐõ ÐNÑOÔOÐOøõ ð )ð )ð )Ø¥ C¡¤Ð(Ð(Ð(Ð(Ð(Ð(Ð(Ð(Ð(Ð(øøøøð)øøøs   Æ F> Æ>
G&ÇG!Ç!G&c                 óv  — | dz  dz  }|                      d¬¦  «         dD ]q}|d|› d�z  }d                     ¦   «         }t          j        d	d
¬¦  «        }d|d d …df<   d|d d …df<   |                     ||                     ¦   «         z   ¦  «         Œrt          | ¦  «        }t          |¦  «        dk    sJ ‚|d         j        |d         j        k    sJ ‚|d         j	         
                    d¦  «        sJ ‚t          |d         ¦  «        }|j        dk    sJ ‚t          j        |d         dk    ¦  «        sJ ‚d S )NÚ
2024_11_27r=   Tr?   )z27-11-2024_07-01-10z27-11-2024_07-01-48rA   r2   z„# .PCD v0.7
VERSION .7
FIELDS x y z intensity
SIZE 4 4 4 4
TYPE F F F F
COUNT 1 1 1 1
WIDTH 23040
HEIGHT 1
POINTS 23040
DATA binary
)i Z  r   r   r   éú   r   r   r   r   r   z240x96;)é`   éð   r   ).r   )rb   r!   r"   Úzerosr)   r$   r   r'   rI   rh   Ú
startswithr   rz   r=   )r7   rn   rk   r   r*   r8   ro   r~   s           r-   Ú8test_flattened_pcd_grid_restoration_and_session_groupingrœ   n   se  € Ø˜Ñ$ uÑ,€FØ
‡L‚L˜€LÑÔÐØ?ð 4ð 4ˆØÐ7¨EÐ7Ð7Ð7Ñ7ˆðdßekÒekÑemÔemð 	å”˜*¨EÐ2Ñ2Ô2ˆØˆˆqˆqˆq�!ˆt‰Øˆˆqˆqˆq�!ˆt‰Ø×Ò˜ &§.¢.Ñ"2Ô"2Ñ2Ñ3Ô3Ð3Ð3Ý˜Ñ!Ô!€DÝˆt‰9Œ9˜Š>ˆ>ˆ>ˆ>Ø�Œ7Ô˜t AœwÔ/Ò/Ð/Ð/Ð/Ø�Œ7Œ>×$Ò$ YÑ/Ô/Ð/Ð/Ð/Ý�t˜A”wÑÔ€EØŒ;˜,Ò&Ð&Ð&Ð&ÝŒ6�%˜”- 1Ò$Ñ%Ô%Ð%Ð%Ð%Ð%Ð%r/   )r   )Úpathlibr   r%   Únumpyr"   ÚPILr   Úpallet.datar   r   r   r   r	   r
   r   r   r�   r.   r9   rt   r�   r”   rœ   rH   r/   r-   ú<module>r¡      s.  ðØ Ð Ð Ð Ð Ð Ø €€€à Ð Ð Ð Ø Ð Ð Ð Ð Ð ð,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð ,ð
'ð 'ˆtð '˜3ð '¨Tð 'ð 'ð 'ð 'ðIð Ið IðIð Ið Ið:*ð *ð *ð"Pð Pð Pð:&ð &ð &ð &ð &r/   