§
    »©¸j¼  ã                  ób   — d dl mZ d dlmZ d dlZd dlZ G d„ de¦  «        Zdd„Z	dd„Z
dd„ZdS )é    )Úannotations)ÚPathNc                  ó   — e Zd ZdS )ÚPCDFormatErrorN)Ú__name__Ú
__module__Ú__qualname__© ó    úpallet/data/pcd.pyr   r   	   s   € € € € € Ø€Dr   r   ÚdataÚbytesÚexpectedÚintÚreturnc                ól  — t          ¦   «         }d}|t          | ¦  «        k     �rM| |         }|dz  }|dk     rP|dz   }||z   t          | ¦  «        k    rt          d¦  «        ‚|                     | |||z   …         ¦  «         ||z  }nÖ|dz	  }t          |¦  «        |dz  dz  z
  dz
  }|dk    r2|t          | ¦  «        k    rt          d	¦  «        ‚|| |         z  }|dz  }|t          | ¦  «        k    rt          d
¦  «        ‚|| |         z  }|dz  }|dz  }|dk     rt          d¦  «        ‚t	          |¦  «        D ]"}|                     ||         ¦  «         |dz  }Œ#|t          | ¦  «        k     �°Mt          |¦  «        |k    r"t          dt          |¦  «        › d|› �¦  «        ‚t          |¦  «        S )Nr   é   é    ztruncated LZF literalé   é   é   é   ztruncated LZF lengthztruncated LZF offseté   zinvalid LZF back referencezLZF decoded z bytes, expected )Ú	bytearrayÚlenr   ÚextendÚrangeÚappendr   )r   r   ÚoutÚiÚctrlÚlengthÚrefÚ_s           r   Ú_lzf_decompressr%      sÖ  € Ý
‰+Œ+€CØ	€AØ
�c�$‰iŒiŠ-‰-Ø�AŒwˆØ	ˆQ‰ˆØ�"Š9ˆ9Ø˜A‘XˆFØ�6‰z�C ™IœIÒ%Ð%Ý$Ð%<Ñ=Ô=Ð=Ø�JŠJ�t˜A˜a &™j˜LÔ)Ñ*Ô*Ð*Ø�‰KˆAˆAà˜Q‘YˆFÝ�c‘(”(˜t d™{¨qÑ0Ñ1°AÑ5ˆCØ˜Š{ˆ{Ø�˜D™	œ	’>�>Ý(Ð)?Ñ@Ô@Ð@Ø˜$˜qœ'Ñ!�Ø�Q‘�Ø•C˜‘I”IŠ~ˆ~Ý$Ð%;Ñ<Ô<Ð<Ø�4˜”7‰NˆCØ�‰FˆAØ�a‰KˆFØ�QŠwˆwÝ$Ð%AÑBÔBÐBÝ˜6‘]”]ð ð �Ø—
’
˜3˜sœ8Ñ$Ô$Ð$Ø�q‘��ð5 �c�$‰iŒiŠ-‰-õ6 ˆ3�x„x�8ÒÐÝÐQ­C°©H¬HÐQÐQÀxÐQÐQÑRÔRÐRÝ�‰:Œ:Ðr   Úpathú
str | Pathú'tuple[dict[str, list[str]], np.ndarray]c                ó
  ‡ — t          | ¦  «        } |                      d¦  «        5 }i }	 |                     ¦   «         }|st          d¦  «        ‚	 |                     d¦  «                             ¦   «         }n"# t          $ r}t          d¦  «        |‚d}~ww xY w|r|                     d¦  «        rŒ‰|                     ¦   «         }|dd…         ||d	          	                    ¦   «         <   |d	          	                    ¦   «         d
k    rnŒá| 
                    d| 
                    dg ¦  «        ¦  «        }t          t          t          | 
                    ddgt          |¦  «        z  ¦  «        ¦  «        ¦  «        }| 
                    ddgt          |¦  «        z  ¦  «        }	t          t          t          | 
                    ddgt          |¦  «        z  ¦  «        ¦  «        ¦  «        }
t          | 
                    ddg¦  «        d	         ¦  «        }t          | 
                    ddg¦  «        d	         ¦  «        }t          | 
                    dt          ||z  ¦  «        g¦  «        d	         ¦  «        }|d	k    sL|rJt          |¦  «        t          |¦  «        cxk    r't          |	¦  «        cxk    rt          |
¦  «        k    sn t          d¦  «        ‚i }d	}t!          |||	|
¦  «        D ]<\  }}}}||| 	                    ¦   «         |f||                     ¦   «         <   |||z  z  }Œ=|                     ¦   «         }ddd¦  «         n# 1 swxY w Y   |d
         d	                              ¦   «         }|dk    rÄd}	 t'          j        |                     d¦  «        dt&          j        ¬¦  «                             |t1          |
¦  «        ¦  «        }n)# t2          t          f$ r}t          d¦  «        |‚d}~ww xY wd	}i Š t!          ||
¦  «        D ]+\  }}|dd…|f         ‰ |                     ¦   «         <   ||z  }Œ,�nž|dv �r‡|dk    rçt          |¦  «        dk     rt          d ¦  «        ‚t5          j        d!|dd…         ¦  «        \  }}t9          |dd|z   …         |¦  «        }i Š d	}t!          |||	|
¦  «        D ]r\  }}}}t;          ||¦  «        }t'          j        ||||z  |¬"¦  «        }|                     ||¦  «        dd…d	f         ‰ |                     ¦   «         <   |||z  |z  z  }Œsn¬t          |¦  «        ||z  k     rt          d#¦  «        ‚i Š d	}t!          |||	|
¦  «        D ]]\  }}}}t;          ||¦  «        }t'          j        ||f|||||f¬$¦  «        }|dd…d	f         ‰ |                     ¦   «         <   |||z  z  }Œ^nt          d%|› �¦  «        ‚tA          ˆ fd&„d'D ¦   «         ¦  «        st          d(¦  «        ‚‰  
                    d)t'          j!        |t&          j"        ¦  «        ¦  «        }|t'          j#        ‰ d*         ‰ d+         ‰ d,         |g¦  «         $                    t&          j%        ¦  «        fS )-zêRead PCD ASCII, binary, or binary_compressed into an Nx4 float32 XYZI.

    XYZ and intensity fields are selected by name. Missing intensity is NaN.
    Organized dimensions are exposed in the returned header (`WIDTH`, `HEIGHT`).
    ÚrbTzmissing DATA lineÚasciiznon-ASCII PCD headerNú#r   r   ÚDATAÚFIELDSÚFIELDÚSIZEÚ4ÚTYPEÚFÚCOUNTÚ1ÚWIDTHÚ0ÚHEIGHTÚPOINTSz(invalid PCD dimensions or field metadataF)ÚcommentsÚskiprowsú )ÚsepÚdtypezinvalid ASCII PCD payload)ÚbinaryÚbinary_compressedr@   r   ztruncated compressed PCDz<II)r>   ÚcountÚoffsetztruncated binary PCD payload)r>   ÚbufferrB   Ústrideszunsupported PCD DATA mode: c              3  ó    •K  — | ]}|‰v V — Œ	d S )Nr
   )Ú.0ÚkÚcolumnss     €r   ú	<genexpr>zread_pcd.<locals>.<genexpr>}   s'   øè è € Ð5Ð5 ˆq�Gˆ|Ð5Ð5Ð5Ð5Ð5Ð5r   )ÚxÚyÚzzPCD requires x, y, and z fieldsÚ	intensityrJ   rK   rL   )&r   ÚopenÚreadliner   ÚdecodeÚstripÚUnicodeDecodeErrorÚ
startswithÚsplitÚupperÚgetÚlistÚmapr   r   ÚstrÚzipÚlowerÚreadÚnpÚloadtxtÚ
fromstringÚfloat64ÚreshapeÚsumÚ
ValueErrorÚstructÚunpackr%   Ú_dtypeÚ
frombufferÚndarrayÚallÚfullÚnanÚcolumn_stackÚastypeÚfloat32)!r&   ÚfÚheaderÚlineÚtextÚexcÚpartsÚfieldsÚsizesÚtypesÚcountsÚwidthÚheightÚpointsÚoffsetsÚstrideÚnameÚsizeÚtyprA   ÚpayloadÚmodeÚtableÚrawÚcolÚcompressed_sizeÚuncompressed_sizeÚdecodedÚoffr>   ÚvaluesrM   rH   s!                                   @r   Úread_pcdr‹   0   s×  ø€ õ �‰:Œ:€DØ	�Š�4‰Œð ˜AØ')ˆð	Ø—:’:‘<”<ˆDØð :Ý$Ð%8Ñ9Ô9Ð9ðFØ—{’{ 7Ñ+Ô+×1Ò1Ñ3Ô3��øÝ%ð Fð Fð FÝ$Ð%;Ñ<Ô<À#ÐEøøøøðFøøøàð ˜4Ÿ?š?¨3Ñ/Ô/ð ØØ—J’J‘L”LˆEØ',¨Q¨R¨R¤yˆF�5˜”8—>’>Ñ#Ô#Ñ$Ø�QŒx�~Š~ÑÔ 6Ò)Ð)Øð	ð —’˜H f§j¢j°¸"Ñ&=Ô&=Ñ>Ô>ˆÝ•S�˜fŸjšj¨°#°½¸V¹¼Ñ1DÑEÔEÑFÔFÑGÔGˆØ—
’
˜6 C 5­3¨v©;¬;Ñ#6Ñ7Ô7ˆÝ•c�#˜vŸzšz¨'°C°5½3¸v¹;¼;Ñ3FÑGÔGÑHÔHÑIÔIˆÝ�F—J’J˜w¨¨Ñ.Ô.¨qÔ1Ñ2Ô2ˆÝ�V—Z’Z ¨3¨%Ñ0Ô0°Ô3Ñ4Ô4ˆÝ�V—Z’Z ­3¨u°v©~Ñ+>Ô+>Ð*?Ñ@Ô@ÀÔCÑDÔDˆØ�QŠ;ˆ;˜fˆ;­S°©[¬[½CÀ¹J¼JÐ-cÐ-cÒ-cÐ-cÍ#ÈeÉ*Ì*Ð-cÐ-cÒ-cÐ-cÕX[Ð\bÑXcÔXcÒ-cÐ-cÐ-cÐ-cÝ Ð!KÑLÔLÐLØˆØˆÝ&)¨&°%¸ÀÑ&GÔ&Gð 	#ð 	#Ñ"ˆD�$˜˜UØ%+¨T°3·9²9±;´;ÀÐ$FˆG�D—J’J‘L”LÑ!Ø�d˜U‘lÑ"ˆFˆFØ—&’&‘(”(ˆð=ð ð ñ ô ð ð ð ð ð ð øøøð ð ð ð ð> �&Œ>˜!Ô×"Ò"Ñ$Ô$€DØˆw‚€ØIMˆð	GÝ”- §¢¨wÑ 7Ô 7¸SÍÌ
ÐSÑSÔS×[Ò[Ð\bÕdgÐhnÑdoÔdoÑpÔpˆCˆCøÝÕ.Ð/ð 	Gð 	Gð 	GÝ Ð!<Ñ=Ô=À3ÐFøøøøð	GøøøàˆØˆÝ˜v vÑ.Ô.ð 	ð 	‰KˆD�%Ø$'¨¨¨¨3¨¤KˆG�D—J’J‘L”LÑ!Ø�5‰LˆCˆCñ	ð 
Ð0Ð	0Ñ	0ØÐ&Ò&Ð&Ý�7‰|Œ|˜aÒÐÝ$Ð%?Ñ@Ô@Ð@Ý17´¸uÀgÈbÈqÈbÄkÑ1RÔ1RÑ.ˆOÐ.Ý% g¨a°°OÑ0CÐ.CÔ&DÐFWÑXÔXˆGàˆGØˆCÝ*-¨f°e¸UÀFÑ*KÔ*Kð -ð -Ñ&��d˜C Ý˜s DÑ)Ô)�Ýœ w°eÀ6ÈEÁ>ÐZ]Ð^Ñ^Ô^�Ø(.¯ª°v¸uÑ(EÔ(EÀaÀaÀaÈÀdÔ(K�˜Ÿ
š
™œÑ%Ø�v ‘~¨Ñ,Ñ,��ð	-õ �7‰|Œ|˜f v™oÒ-Ð-Ý$Ð%CÑDÔDÐDØˆGØˆCÝ*-¨f°e¸UÀFÑ*KÔ*Kð $ð $Ñ&��d˜C Ý˜s DÑ)Ô)�Ýœ V¨U O¸5ÈÐY\ÐgmÐosÐftÐuÑuÔu�Ø(.¨q¨q¨q°!¨t¬�˜Ÿ
š
™œÑ%Ø�t˜e‘|Ñ#��ð	$õ ÐA¸4ÐAÐAÑBÔBÐBÝÐ5Ð5Ð5Ð5 _Ð5Ñ5Ô5Ñ5Ô5ð @ÝÐ>Ñ?Ô?Ð?Ø—’˜K­¬°½¼Ñ)@Ô)@ÑAÔA€IØ•2”? G¨C¤L°'¸#´,ÀÈÄÈiÐ#XÑYÔY×`Ò`ÕacÔakÑlÔlÐlÐlsO   ¦)MÁ'A8Á7MÁ8
BÂBÂBÂJ)MÍMÍMÎ AO ÏO<Ï'O7Ï7O<r€   rY   r   únp.dtypec                óô   — | dk    r|dv r|dk    rdnd}nM| dv r5|dv r1| dk    rd	nd
t          |¦  «        z   }t          j        d|z   ¦  «        S t          d| › |› �¦  «        ‚t          j        d|z   ¦  «        S )Nr3   )é   r   rŽ   ro   Úd)ÚIÚU)r   r   rŽ   r   r�   r    Úuú<zunsupported PCD field type )rY   r]   r>   r   )r€   r   Úcodes      r   rf   rf   ƒ   s›   € Ø
ˆc‚z€z�d˜f�n�nØ˜a’i�iˆsˆs SˆˆØ	�
Ð	Ð	˜t |Ð3Ð3Ø˜c’z�z�� s­c°$©i¬iÑ7ˆÝŒx˜˜d™
Ñ#Ô#Ð#åÐF¸3ÐFÀÐFÐFÑGÔGÐGÝŒ8�C˜$‘JÑÔÐr   )r   r   r   r   r   r   )r&   r'   r   r(   )r€   rY   r   r   r   rŒ   )Ú
__future__r   Úpathlibr   rd   Únumpyr]   rc   r   r%   r‹   rf   r
   r   r   ú<module>r˜      s¸   ðØ "Ð "Ð "Ð "Ð "Ð "à Ð Ð Ð Ð Ð Ø €€€à Ð Ð Ð ð	ð 	ð 	ð 	ð 	�Zñ 	ô 	ð 	ð ð  ð  ð  ðFPmð Pmð Pmð Pmðf ð  ð  ð  ð  ð  r   