3
Õ©¸j	  ã               @   st   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 deeddœdd„Zd	d
„ Zdd„ Zdd„ ZdS )é    )ÚPathN)ÚImage)Úscan_datasetÚread_pcdÚ
load_frameÚfit_normalizationÚapply_normalizationÚascii)ÚpathÚmodeÚreturnc             C   sV   d| d j ƒ }|dkrd}n&tjddddgd	d
ddggdd�jƒ }| j|| ƒ 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
é   é   é   é   é   é   é   é   z<f4)Údtype)ÚencodeÚnpÚarrayÚtobytesZwrite_bytes)r
   r   ÚheaderZpayload© r   útests/test_data.pyÚ_pcd
   s
    &r   c             C   sj   xddD ]\}| |› d� }t ||ƒ t|ƒ\}}|d dgks@t‚tjj|dddd	gd
dddggƒ qW d S )Nr	   Úbinaryz.pcdZWIDTHÚ2r   r   r   r   r   r   r   r   )r	   r   )r   r   ÚAssertionErrorr   ÚtestingÚassert_allclose)Útmp_pathr   r
   r   Zpointsr   r   r   Útest_pcd_ascii_and_binary   s    

r%   c             C   sÀ   d}| d }x4dD ],}|| }|j dd� t|d|› d� ƒ qW |d d	|› d
� jƒ  t| ƒ}t|ƒdksrt‚tdd„ |D ƒƒdksŒt‚dd„ |D ƒddhks¦t‚tdd„ |D ƒƒs¼t‚d S )Nz29-11-2024_07-17-08Ú
2024_11_29ÚallÚnone_rectifiedT)ÚparentsÚpoint_cloud_xyzi_z.pcdZ
rgb_image_z.jpgr   c             S   s   h | ]
}|j ’qS r   )Zgroup_id)Ú.0Úrowr   r   r   ú	<setcomp>'   s    zQtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<setcomp>r   c             S   s   h | ]
}|j ’qS r   )Zvariant)r+   r,   r   r   r   r-   (   s    c             s   s   | ]}d |j kV  qdS )ZrgbN)Úpaths)r+   r,   r   r   r   ú	<genexpr>)   s    zQtest_manifest_groups_processing_versions_and_omits_empty_files.<locals>.<genexpr>)r'   r(   )Úmkdirr   Ztouchr   Úlenr!   r'   )r$   ÚstampÚbaseÚversionÚfolderZrowsr   r   r   Ú>test_manifest_groups_processing_versions_and_omits_empty_files   s    
r6   c             C   s  | d d }|j dd� d}t|d|› d� ƒ tjtjdd	ggtjd
�ƒj|d|› d� ƒ tjtjddggtjd
�ƒj|d|› d� ƒ t| ƒd	 }t	|ƒ}|j
dks®t‚tjj|d	 ddddgd	dd	dggƒ t|gƒ}t||ƒ}|jtjksøt‚|dd d…f jƒ dk�st‚d S )Nr&   r'   T)r)   z29-11-2024_07-17-08r*   z.pcdéd   r   )r   Zdepth_image_z.pngé
   é   Zamplitude_image_r   r   r   .)r   r   r   )r0   r   r   Z	fromarrayr   r   Zuint16Zsaver   r   Úshaper!   r"   r#   r   r   r   Zfloat32Úmax)r$   r5   r2   ÚrecordÚframeZstatsZ
normalizedr   r   r   Ú3test_four_channel_loader_and_training_normalization,   s    ..&

r>   )r	   )Zpathlibr   ÚstructZnumpyr   ZPILr   Zpallet.datar   r   r   r   r   Ústrr   r%   r6   r>   r   r   r   r   Ú<module>   s   
	