§
    JÝ¸jy
  ã                   ó´   — d dl Zd dlmc mZ d dlmZ d dlZd dl	Z
d dlmZ d dlZd dlmZmZmZ d dlmZmZ d dlmZmZmZ d dlmZmZmZ d„ Zd	„ Zd
„ Zd„ Z dS )é    N)Úreplace)ÚImage)ÚFrameRecordÚscan_datasetÚcanonical_records)Úcache_frameÚ
load_frame)Úbuild_registryÚattach_registryÚprojection_evidence)Úfile_digestÚload_protocolÚ
write_jsonc           	      óÂ  — d\  }}t           j        d |…d |…f         \  }}t          j        ||fd¦  «        }t          j        ||dz
  z  dz  dz
  |z  dz  ||dz
  z  dz  dz
  |z  dz  |t          j        |d¦  «        fd¬	¦  «                             d
¦  «        }| dz  }|                     ¦   «          |dz  }|                     d|› d|› d||z  › d�                     ¦   «         | 	                    ¦   «         z   ¦  «         t          j        |dz                       d¦  «        ¦  «                             |dz  ¦  «         t          t          | ¦  «        ¦  «        |fS )N©é   é    g       @é   é   g      à?gš™™™™™Ù?é   éÿÿÿÿ)Úaxisz<f4Ú
2024_10_30z(point_cloud_xyzi_30-10-2024_12-00-00.pcdzEFIELDS x y z intensity
SIZE 4 4 4 4
TYPE F F F F
COUNT 1 1 1 1
WIDTH z
HEIGHT z
POINTS z
DATA binary
éè  Úuint16z#depth_image_30-10-2024_12-00-00.png)ÚnpÚmgridÚfullÚstackÚ	full_likeÚastypeÚmkdirÚwrite_bytesÚencodeÚtobytesr   Ú	fromarrayÚsaver   r   )	Útmp_pathÚhÚwÚvÚuÚzÚxyzÚrootÚpaths	            úC/root/private/project/pallet_detection_v2/tests/test_protocol_v3.pyÚ_sensorr2      s±  € Ø�C€A€aÝ
Œ��!��B�Q�B�Œ�C€A€aÝ„gˆq�ˆe�CÑÔ€AÝ
Œ�1�a˜‘c‘7˜1‘9˜Q‘; ‘/ "Ñ$ a¨¨1©¡g¨a¡i°¡k°1¡_°RÑ%7¸½"¼,ÀqÈÑ:LÔ:LÐMÐSUÐVÑVÔV×]Ò]Ð^cÑdÔd€CØ	�,Ñ	€D˜tŸzšz™|œ|˜|Ø	Ð8Ñ	8€DØ×Òð  OÐbcð  Oð  OÐnoð  Oð  OÐz{Ð|}Ñz}ð  Oð  Oð  O÷  Wò  Wñ  Yô  Yð  Z]÷  Zeò  Zeñ  Zgô  Zgñ  gñ  hô  hð  hÝ	„O�Q�t‘V—O’O HÑ-Ô-Ñ.Ô.×3Ò3°DÐ9^Ñ4^Ñ_Ô_Ð_Ý�\¨(Ñ3Ô3Ñ4Ô4°SÐ8Ð8ó    c                 ó,  — t          | ¦  «        \  }}t          |                     dd¦  «        d¦  «        d         }d}||k    }|slt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }d	d
|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}}t          || dz  ¦  «        }t          ||¦  «        d         }	|	j
        d         }|s:ddt          j        |¦  «        iz  }
t          t          j        |
¦  «        ¦  «        ‚d }|	j
        d         }d}||k    }|slt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }d	d
|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}}|	j
        d         }d}||k    }|slt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }d	d
|iz  }t          t          j        |¦  «        ¦  «        ‚d x}x}}t          |	¦  «        }t          j                             |d         d¦  «         t          j        }t          |d         ¦  «        d         }d}||k    } ||¦  «        }|sÚt          j        d|fd||f¦  «        t          j        |¦  «        t          j        |¦  «        dœz  }ddt!          j        ¦   «         v st          j        t          ¦  «        rt          j        t          ¦  «        ndt          j        |¦  «        |t          j        |¦  «        dœz  }t          t          j        |¦  «        ¦  «        ‚d x}x}x}x}}d S )Nr   é   r   r   r   ©ú==©z%(py1)s == %(py4)s©Úpy1Úpy4úassert %(py6)sÚpy6zsensors.jsonr   Údepth_availablezassert %(py1)sr:   Ú
depth_axisÚscale_to_mmr   ).r   iÐ  ).r   )z%(py4)s == %(py7)s)r;   Úpy7zGassert %(py11)s
{%(py11)s = %(py2)s
{%(py2)s = %(py0)s.all
}(%(py9)s)
}r   )Úpy0Úpy2Úpy9Úpy11)r2   r   ÚreshapeÚ
@pytest_arÚ_call_reprcompareÚ	_safereprÚAssertionErrorÚ_format_explanationr
   r   Úsensor_configr	   r   ÚtestingÚassert_allcloseÚallÚ@py_builtinsÚlocalsÚ_should_repr_global_name)r(   ÚrecordsÚpointsÚ@py_assert0Ú@py_assert3Ú@py_assert2Ú@py_format5Ú@py_format7ÚregistryÚ
registeredÚ@py_format2ÚframeÚ@py_assert1Ú@py_assert6Ú@py_assert5Ú@py_assert10Ú@py_format8Ú@py_format12s                     r1   Ú;test_paired_metric_evidence_recovers_z_axis_not_universal_xrd      s  € Ý˜8Ñ$Ô$�N€GˆFÝ˜vŸ~š~¨b°Ñ3Ô3°GÑ<Ô<¸VÔDÐGÀaÐGÐDÀaÒGÐGÐGÐGÕGÔGÐGÐGÐGÐGÐDÀaÐGÑGÔGÕGÔGÐDÑGÔGÕGÔGÀaÑGÔGÐGÐGÑGÐGÐGÐGÐGÐGÑGÐGÕGÕGÔGÐGÑGÔGÑGÔGÐGÐGÐGÐGÐGÐGÐGÝ˜G H¨^Ñ$;Ñ<Ô<€HÝ˜w xÑ0Ô0°Ô3€JØÔ#Ð$5Ô6Ð6Ð6Ð6Ð6Ð6Õ6Ô6Ð6Ñ6Ô6Ð6Ñ6Ð6Õ6Õ6Ô6Ð6Ñ6Ô6Ñ6Ô6Ð6Ð6Ð6ØÔ# LÔ1Ð4°1Ð4Ð1°1Ò4Ð4Ð4Ð4Õ4Ô4Ð4Ð4Ð4Ð4Ð1°1Ð4Ñ4Ô4Õ4Ô4Ð1Ñ4Ô4Õ4Ô4°1Ñ4Ô4Ð4Ð4Ñ4Ð4Ð4Ð4Ð4Ð4Ñ4Ð4Õ4Õ4Ô4Ð4Ñ4Ô4Ñ4Ô4Ð4Ð4Ð4Ð4Ð4Ð4Ð4ØÔ# MÔ2Ð8°DÐ8Ð2°DÒ8Ð8Ð8Ð8Õ8Ô8Ð8Ð8Ð8Ð8Ð2°DÐ8Ñ8Ô8Õ8Ô8Ð2Ñ8Ô8Õ8Ô8°DÑ8Ô8Ð8Ð8Ñ8Ð8Ð8Ð8Ð8Ð8Ñ8Ð8Õ8Õ8Ô8Ð8Ñ8Ô8Ñ8Ô8Ð8Ð8Ð8Ð8Ð8Ð8Ð8Ý
�ZÑ
 Ô
 €EÝ„J×Ò˜u Uœ|¨DÑ1Ô1Ð1ÝŒ6Ð3•*˜W QœZÑ(Ô(¨Ô/Ð3°Ð3Ð/°Ò2Ð3ˆ6ˆ6Ð3Ñ3Ô3Ð3Ð3Ð3Õ3Ô3Ð3Ð3Ð3Ð3Ð/°Ð3Ñ3Ô3Õ3Ô3Ð/Ñ3Ô3Õ3Ô3°Ñ3Ô3Ð3Ð3Ñ3Ð3Ð3Ð3Õ3Ô3Ñ3Ô3Ð3Ð3Õ3Ô3�2Ñ3Ô3Ð3Õ3Ô3�2Ñ3Ô3Ð3Ð3Õ3Ô3ˆ6Ñ3Ô3Ð3Õ3Ô3Ð3Ñ3Ô3Ð3Ð3Ñ3Ð3Õ3Õ3Ô3Ð3Ñ3Ô3Ñ3Ô3Ð3Ð3Ð3Ð3Ð3Ð3Ð3Ð3Ð3Ð3Ð3Ð3Ð3r3   c                 ó  — t          | ¦  «        \  }}t          |t          || dz  ¦  «        ¦  «        d         }t          |t	          |j        ¦  «        ¬¦  «        }t          || dz  ¦  «        }t          j         	                    t          |¦  «        t          |¦  «        ¦  «         t          |i |j        ¥ddi¥¬¦  «        }t          j        t          d¬	¦  «        5  t          |¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )
Nzs.jsonr   )Úsource_sha256z	frame.npzr@   r   )rL   zfrozen source/policy©Úmatch)r2   r   r
   r   r   Úpcdr   r   rM   Úassert_array_equalr	   rL   ÚpytestÚraisesÚ
ValueError)r(   rS   Ú_ÚrecordÚcachedÚchangeds         r1   Ú7test_cached_sensor_policy_is_not_silently_reinterpretedrr   '   s;  € Ý�hÑÔ�I€GˆAÝ˜7¥>°'¸(À8Ñ:KÑ#LÔ#LÑMÔMÈaÔP€FÝ�6­°F´JÑ(?Ô(?Ð@Ñ@Ô@€FÝ�v˜h {Ñ2Ñ3Ô3€FÝ„J×!Ò!¥*¨VÑ"4Ô"4µZÀÑ5GÔ5GÑHÔHÐHÝ�FÐ)Q¨FÔ,@Ð)QÀÈqÐ)QÐ)QÐRÑRÔR€GÝ	Œ•zÐ(>Ð	?Ñ	?Ô	?ð ð Ý�7ÑÔÐðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   Ã!C>Ã>DÄDc                 ó®  ‡— | dz  Š‰                      ¦   «          t          ‰dz  di i¦  «         ‰dz                       d¦  «         t          ‰dz  dˆfd„d	D ¦   «         i¦  «         t          ‰¦  «        d
         }g }||k    }|slt	          j        d|fd||f¦  «        t	          j        |¦  «        t	          j        |¦  «        dœz  }dd|iz  }t          t	          j        |¦  «        ¦  «        ‚d x}x}}‰dz                       d¦  «         t          j
        t          d¬¦  «        5  t          ‰¦  «         d d d ¦  «         d S # 1 swxY w Y   d S )NÚprotocolúsplits.jsonÚassignmentsúmanifest.jsonlÚ zprotocol.jsonÚfilesc                 ó6   •— i | ]}|t          ‰|z  ¦  «        “ŒS © )r   )Ú.0ÚnameÚfolders     €r1   ú
<dictcomp>zAtest_frozen_protocol_rejects_manifest_rewrite.<locals>.<dictcomp>6   s(   ø€ Ð/{Ð/{Ð/{ÐRV°µ[ÀÈÁÑ5MÔ5MÐ/{Ð/{Ð/{r3   )ru   rw   r   r6   r8   r9   r<   r=   z{}
zfrozen protocol file changedrg   )r"   r   Ú
write_textr   rG   rH   rI   rJ   rK   rk   rl   rm   )r(   rU   rV   rW   rX   rY   r~   s         @r1   Ú-test_frozen_protocol_rejects_manifest_rewriter�   2   sÐ  ø€ Ø�JÑ€F˜vŸ|š|™~œ~˜~Ýˆv�mÑ# ]°2Ð$6Ñ7Ô7Ð7ØÐÑ×(Ò(¨Ñ,Ô,Ð,Ýˆv�oÑ% wÐ/{Ð/{Ð/{Ð/{ÐZzÐ/{Ñ/{Ô/{Ð&|Ñ}Ô}Ð}Ý˜Ñ Ô  Ô#Ð' RÐ'Ð# RÒ'Ð'Ð'Ð'Õ'Ô'Ð'Ð'Ð'Ð'Ð# RÐ'Ñ'Ô'Õ'Ô'Ð#Ñ'Ô'Õ'Ô' RÑ'Ô'Ð'Ð'Ñ'Ð'Ð'Ð'Ð'Ð'Ñ'Ð'Õ'Õ'Ô'Ð'Ñ'Ô'Ñ'Ô'Ð'Ð'Ð'Ð'Ð'Ð'Ð'ØÐÑ×(Ò(¨Ñ0Ô0Ð0Ý	Œ•zÐ(FÐ	GÑ	GÔ	Gð ð Ý�fÑÔÐðð ð ñ ô ð ð ð ð ð ð ð øøøð ð ð ð ð ð s   Ä-E
Å
EÅE)!ÚbuiltinsrP   Ú_pytest.assertion.rewriteÚ	assertionÚrewriterG   Údataclassesr   ÚjsonÚnumpyr   ÚPILr   rk   Úpallet.data.manifestr   r   r   Úpallet.data.loaderr   r	   Úpallet.data.sensorsr
   r   r   Úpallet.data.protocolr   r   r   r2   rd   rr   r�   r{   r3   r1   ú<module>rŽ      s  ðØ  € € € € € € € € € € € € Ð Ð Ð Ð Ð Ð Ø €€€à Ð Ð Ð Ø Ð Ð Ð Ð Ð Ø €€€à MÐ MÐ MÐ MÐ MÐ MÐ MÐ MÐ MÐ MØ 6Ð 6Ð 6Ð 6Ð 6Ð 6Ð 6Ð 6Ø TÐ TÐ TÐ TÐ TÐ TÐ TÐ TÐ TÐ TØ GÐ GÐ GÐ GÐ GÐ GÐ GÐ GÐ GÐ Gð	9ð 	9ð 	9ð
4ð 
4ð 
4ðð ð ðð ð ð ð r3   