§
    ÃÂÓj!4  ã                  ó  — 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Zddl	m
Z
 ddlZddlZddlZddlmZmZ ddlmZmZmZmZmZ dd	lmZ dd
lmZmZmZmZmZ ddl m!Z!m"Z" d„ Z#d„ Z$d„ Z%d„ Z&dd„Z'd„ Z(e)dk    r e(¦   «          dS dS )a0  One frozen, post-selection held-out evaluation and portable model bundle.

Oracle-ROI pose regression and actual detector-driven inference are reported
separately. A matched detection is chosen for scoring only after all boxes have
been predicted and their poses inferred without access to ground truth.
é    )ÚannotationsN)ÚCounter)ÚPathé   )ÚdigestÚprotected_snapshot)ÚPROJECTÚprotected_writeÚ	safe_pathÚ
write_jsonÚ
write_rows)ÚPalletPosePredictor)ÚTASKSÚ	box_arrayÚgrouped_metricsÚpose_metricsÚtarget_array)Úatomic_torchÚ
load_indexc                óP  — t          j        | t          ¬¦  «        t          j        |t          ¬¦  «        }} t          j        | d d…         |d d…         ¦  «        }t          j        | d d…         | dd …         z   |d d…         |dd …         z   ¦  «        }t          j        ||z
  d¦  «                             ¦   «         }t          |t          t          | dd …                              ¦   «         |dd …                              ¦   «         z   |z
  ¦  «        d¦  «        z  ¦  «        S )N©Údtypeé   r   gê-�™—q=)ÚnpÚasarrayÚfloatÚmaximumÚminimumÚprodÚmax)ÚaÚbÚlowÚhighÚintersections        úpallet/pose_evaluation.pyÚbox_iour'      só   € Ý
Œ
�1�5Ð!Ñ!Ô!¥"¤*¨QµUÐ";Ñ";Ô";€a€AÝ
Œ
�1�R�a�R”5˜˜2˜A˜2œÑÔ€C¥R¤Z°°"°1°"´°a¸¸¸´e±¸A¸b¸q¸b¼EÀ!ÀAÀBÀBÄ%¹KÑ%HÔ%H Ý”˜D ™H QÑ'Ô'×,Ò,Ñ.Ô.€LÝ��c¥%¨¨!¨"¨"¬¯
ª
©¬°Q°q°r°r´U·Z²Z±\´\Ñ(AÀ,Ñ(NÑ"OÔ"OÐPUÑVÔVÑVÑWÔWÐWó    c                ó�  ‡‡— | dz  Š‰                      d¬¦  «         ‰dz  }t          |t          |d         ¦  «                             ¦   «         ¦  «         t	          |¦  «        |d         k    rt          d¦  «        ‚i }dt          d	         d
fdt          d         dffD ]ü\  }}}|d         |         }	t	          |	d         ¦  «        |	d         k    rt          d¦  «        ‚t          j        |	d         dd¬¦  «        }
‰|z  }| 	                    ¦   «         st          |||
d         dœ¦  «         net          j        |dd¬¦  «        Š‰d         |k    s3t          ˆfd„|
d                              ¦   «         D ¦   «         ¦  «        rt          d¦  «        ‚|||<   Œý|d         d         }t	          |d         ¦  «        |d         k    rt          d¦  «        ‚t          ‰dz  t          |d         ¦  «                             ¦   «         ¦  «         d„ |‰dz  gˆfd„|                     ¦   «         D ¦   «         ¢R D ¦   «         }i dd“d d“d!|“d"d“d#|d#         “d$|d%         “d&|d'         d(         “d)|d'         d*         “d+d,“d-|d'         d.         “d/|d         “d0|d         “d1|“d2d“d3d“d4d“}t          ‰d5z  |¦  «         ‰S )6NÚ
deploymentT©Úexist_okzdetector.ptÚbestÚbest_sha256z"Detector publication hash mismatchÚpointnetr   zplanar_pointnet.ptÚnormal_pointnetr   znormal_pointnet.ptÚweightsÚpathÚsha256zFrozen pose weights changedÚcpuF)Úmap_locationÚweights_onlyÚmodel)Útaskr7   r8   c              3  ób   •K  — | ])\  }}t          j        ‰d          |         |¦  «         V — Œ*dS )r7   N)ÚtorchÚequal)Ú.0ÚkÚvÚolds      €r&   ú	<genexpr>zmake_bundle.<locals>.<genexpr>1   s?   øè è € Ð'mÐ'mÉsÈqÐQR­E¬K¸¸G¼ÀQ¼ÈÑ,JÔ,JÐ(JÐ'mÐ'mÐ'mÐ'mÐ'mÐ'mr(   z8Portable network differs from frozen training checkpointÚridgezFrozen ridge changedz
ridge.jsonc                ó8   — i | ]}|j         t          |¦  «        “ŒS © )Únamer   )r<   Úps     r&   ú
<dictcomp>zmake_bundle.<locals>.<dictcomp>7   s"   € Ð
jÐ
jÐ
j ˆ1Œ6•&˜‘)”)Ð
jÐ
jÐ
jr(   c                ó   •— g | ]}‰|z  ‘ŒS rC   rC   )r<   ÚnÚbundles     €r&   ú
<listcomp>zmake_bundle.<locals>.<listcomp>7   s   ø€ ÐBhÐBhÐBhÐPQÀ6È!Á8ÐBhÐBhÐBhr(   ÚversionÚdetector_weightsÚpointnet_weightsÚridge_weightsÚselected_planar_familyÚpose_featuresÚposeÚdetector_imgszÚdetectorÚimgszÚdetector_confÚconfÚdetector_nms_iougffffffæ?Údetector_max_detÚmax_detÚsource_weightsÚdetector_source_sha256ÚfilesÚfull_six_dof_availableÚrobot_calibration_verifiedÚnormal_heldout_availableúinference_config.json)Úmkdirr
   r   Ú
read_bytesr   Ú
ValueErrorr   r:   ÚloadÚexistsr   ÚanyÚitemsÚvaluesr   )ÚoutÚconfigÚplanrS   ÚtargetÚ	pointnetsÚkeyr8   rD   ÚsourceÚstaterE   rA   r\   ÚspecrI   r?   s                  @@r&   Úmake_bundlerr   "   sh  øø€ Øˆ|Ñ€F˜FŸLšL°$˜LÑ7Ô7Ð7Ø�-Ñ€FÝ�F�4 ¨Ô 0Ñ1Ô1×<Ò<Ñ>Ô>Ñ?Ô?Ð?Ýˆf�~„~�x Ô.Ò.Ð.µZÐ@dÑ5eÔ5eÐ/eØ€IØ%¥e¨A¤hÐ/CÐDØ,­U°1¬XÐ6JÐKðMð ð ‰ˆˆD�à�IŒ˜sÔ#ˆÝ�&˜”.Ñ!Ô! 6¨(Ô#3Ò3Ð3½*ÐEbÑ:cÔ:cÐ4cÝŒj˜ œ°UÈÐNÑNÔNˆØ
�‰+ˆØ�xŠx‰zŒzð 	]�, q°¸eÀG¼nÐ)MÐ)MÑNÔNÐNÐNå”
˜1¨%¸TÐBÑBÔBˆCØ�6Œ{˜DÒ Ð ¥CÐ'mÐ'mÐ'mÐ'mÐV[Ð\cÔVd×VjÒVjÑVlÔVlÐ'mÑ'mÔ'mÑ$mÔ$mÐ Ý Ð![Ñ\Ô\Ð\Øˆ	�$‰ˆØ
ˆyŒ/˜'Ô
"€EÝˆe�FŒmÑÔ˜e HœoÒ-Ð-µJÐ?UÑ4VÔ4VÐ.VÝ�F˜<Ñ'­¨U°6¬]Ñ(;Ô(;×(FÒ(FÑ(HÔ(HÑIÔIÐIØ
jÐ
j f¨V°LÑ-@Ð%iÐBhÐBhÐBhÐBhÐU^×UeÒUeÑUgÔUgÐBhÑBhÔBhÐ%iÐ%iÐ
jÑ
jÔ
j€Eð
*ˆ)�Að 
*Ð(¨ð 
*Ð7IÈ)ð 
*ÐTcÐdpð 
*Ø  Ð&>Ô!?ð
*Ø@OÐPVÐW]ÔP^ð
*à˜ 
Ô+¨GÔ4ð
*à5DÀVÈJÔEWÐX^ÔE_ð
*ð 	˜2ð
*ð 1°¸
Ô1CÀIÔ1Nð
*ð 	˜˜iœð	
*ð *BÀ(È=ÔBYð	
*ð
 	�ð
*ð
 /¨uð
*ð
 6RÐRWð
*ð 	# 5ð
*€Dõ ˆvÐ-Ñ-¨dÑ3Ô3Ð3Ø€Mr(   c                ó²   ‡ — t          t          t          ‰ ¦  «        ¦  «        ˆ fd„¬¦  «        D ]&}t          ‰ |         d         |¦  «        |k    r|c S Œ'd S )Nc                ó"   •— ‰|          d          S )NÚ
confidencerC   )ÚiÚ
detectionss    €r&   ú<lambda>z$selected_detection.<locals>.<lambda>F   s   ø€ ¸ZÈ¼]È<Ô=XÐ<X€ r(   )rn   Úbox_xywh)ÚsortedÚrangeÚlenr'   )rw   ÚtruthÚ	thresholdÚindexs   `   r&   Úselected_detectionr€   C   sj   ø€ õ ��c *™oœoÑ.Ô.Ð3XÐ3XÐ3XÐ3XÐYÑYÔYð Pð PˆÝ�:˜eÔ$ ZÔ0°Ñ7Ô7¸ÒBÐBÈ%À<À<À<ÐBØˆ4r(   c                ó²  ‡— t          j        | t          ¬¦  «        }t          |¦  «        r(t          j        |¦  «                             d¬¦  «        nt          j        dt          ¬¦  «        }t          j        |¦  «        }t          |¦  «        rGt          ||         t          j        |¦  «        |         ˆfd„|D ¦   «         t          d         ¦  «        nddii dœ}t          ‰¦  «        |d<   t          ‰¦  «        t          |¦  «        z
  |d	<   ‰r<|d
                              dd¦  «        t          |¦  «        z  t          ‰¦  «        z  nd |d<   |S )Nr   r   )Úaxisr   c                ó    •— g | ]
}‰|         ‘ŒS rC   rC   ©r<   rv   Úrowss     €r&   rJ   z"oracle_summary.<locals>.<listcomp>O   s   ø€ Ð?YÐ?YÐ?YÈAÀÀQÄÐ?YÐ?YÐ?Yr(   Úsamples)ÚoverallÚby_groupÚattempted_samplesÚinput_failuresr‡   Úsuccess_50mm_5degÚ"success_rate_all_samples_50mm_5deg)r   r   r   r|   ÚisfiniteÚallÚzerosÚboolÚflatnonzeror   r   Úget)ÚpredictionsÚtargetsr…   rE   ÚvalidÚindicesÚresults     `    r&   Úoracle_summaryr˜   K   sh  ø€ Ý„j�¥5Ð)Ñ)Ô)€AÝ(+¨A©¬Ð
J�"Œ+�a‰.Œ.×
Ò
 !Ð
Ñ
$Ô
$Ð
$µB´H¸QÅTÐ4JÑ4JÔ4J€EÝŒN˜5Ñ!Ô!€GÝgjÐkrÑgsÔgsð  a�?˜1˜Uœ8¥B¤J¨wÑ$7Ô$7¸Ô$>Ð?YÐ?YÐ?YÐ?YÐQXÐ?YÑ?YÔ?YÕZ_Ð`aÔZbÑcÔcÐcð  FOð  PQð  ERð  ^`ð  zað  za€FÝ # D¡	¤	€FÐÑÝ  ™YœY¥s¨7¡|¤|Ñ3€FÐÑØz~ð  2I°&¸Ô2C×2GÒ2GÐH[Ð\]Ñ2^Ô2^Õ_bÐcjÑ_kÔ_kÑ2kÕloÐptÑluÔluÑ2uÐ2uð  EI€FÐ/Ñ0Ø€Mr(   r4   c                ó<  ‡?‡@‡A‡B‡C— t          | ¦  «                             ¦   «         } t          j        |                      ¦   «         ¦  «        }t
          |d         z  }t
          |d         z  }|dz  }t          j        |                     ¦   «         ¦  «        }t          j        |dz                       ¦   «         ¦  «        }|d         dk    s|dz                       ¦   «         st          d¦  «        ‚t          | ¦  «        |d	         k    st          |d
z  ¦  «        |d         k    rt          d¦  «        ‚|d          	                    ¦   «         D ]L\  }}	t          t          t          ¦  «                             |¦  «        ¦  «        |	k    rt          d¦  «        ‚ŒMt          ||||¦  «        }
|dz  }|                     d¬¦  «         t          |¦  «        |d         t          |
dz  ¦  «        d„ dD ¦   «         t          |dz  ¦  «        ddœ}t          |dz  |¦  «         |dz  }|                     ¦   «         r&t          j        |                     ¦   «         ¦  «        S t          t          j        t
          |d         z                       ¦   «         ¦  «        d         ¦  «        }t          |¦  «        }t          j        |d
z                       ¦   «         ¦  «        }t!          |
|d¬¦  «        }t#          |t$          d         d¦  «        ŠB‰Bst          d ¦  «        ‚g }g ŠCd!„ d"D ¦   «         }g }g }g }g }d}d}d}d}t'          j        ¦   «         }dd l}t-          ‰B¦  «        D �]\  }}d#D ]J} t          t/          |||          ¦  «        ¦  «        |d$         ||                   k    rt          d%¦  «        ‚ŒK|                     t3          t/          ||d&         ¦  «        ¦  «        |j        ¦  «        }!t7          j        t/          ||d'         ¦  «        d¬(¦  «        5 }"|"d)         |"d*         }$}#d d d ¦  «         n# 1 swxY w Y   |!j        \  }%}&t'          j        ¦   «         }'|                     |!|#|$t$          d         |d+         ¬,¦  «        }(t'          j        ¦   «         |'z
  })|(d-         }*|t?          |*¦  «        z  }tA          |d.         ¦  «        }+tC          |t$          d         ¦  «        },‰C "                    |,¦  «         tG          |*|+|d/         ¦  «        }-|d0         |d1         |d2         |d+         d u|+ $                    ¦   «         |, $                    ¦   «         |(|-|)d3œ	}.|D ]Ä}/	 | %                    |#|$|+|&|%t$          d         |d+         |/¬4¦  «        }0||/          "                    |0d5         ¦  «         nX# t          $ rK}1t3          |1¦  «        d d6did7œ}0||/          "                    tM          d8¦  «        gd9z  ¦  «         Y d }1~1nd }1~1ww xY w|0|. '                    d:i ¦  «        |/<   ŒÅ|-�ë|d;z  }|*|-         }2tQ          |2d.         |+¦  «        |.d<<   |2d5         �¸t7          j)        |2d5         ¦  «        }3tU          |3d          |,d          t$          d         ¦  «        }4|4|.d=<   |tW          |4d>         d?k    ¦  «        z  }| "                    |3¦  «         | "                    |,¦  «         | "                    |¦  «         | "                    |¦  «         n|d;z  }| "                    |.¦  «         tY          t          j-        d@|d;z   t?          ‰B¦  «        dAœd¬B¦  «        d¬C¦  «         �Œt7          j)        ‰C¦  «        ŠCˆBˆCfdD„| 	                    ¦   «         D ¦   «         }5i }6dED ]E\  Š?}7ˆ?fdF„t-          ‰B¦  «        D ¦   «         ŠAˆAˆBˆCfdG„| 	                    ¦   «         D ¦   «         |6|7<   ŒF|rAt]          t7          j)        |¦  «        t7          j)        |¦  «        |t$          d         ¦  «        nd }8i }9t_          dH„ ‰BD ¦   «         ¦  «        D ]OŠ@ˆ@fdI„|D ¦   «         }:ta          dJ„ |:D ¦   «         ¦  «        };t?          |:¦  «        |;|;t?          |:¦  «        z  dKœ|9‰@<   ŒPi dd“dLt$          d         “dMt?          ‰B¦  «        “dNt?          |9¦  «        “dO|dP         “dQd“dRd“dS|5“dT|6“dU|||t?          ‰B¦  «        z  |r||z  ndV||8||t?          ‰B¦  «        z  d|9dWœ
“dXd“dYd“dZd“d[d“d\ta          d]„ |D ¦   «         ¦  «        “d^ta          d_„ ‰BD ¦   «         ¦  «        “d`t'          j        ¦   «         |z
  “dadb|d/         |dc         ddœdedddfœ¥}0t          |¦  «        |k    rt          dg¦  «        ‚t?          |¦  «        |0dh<   tc          |diz  |¦  «         te          j3        dj¬k¦  «        }<dl}=ti          j5        |<|=¬m¦  «        }>|> 6                    ¦   «          |D ]�}| 7                    d=i ¦  «        }4|> 8                    |d1         |d2         |dn         | 7                    d<¦  «        |do         d u|4 7                    dp¦  «        |4 7                    dq¦  «        |4 7                    d>d¦  «        dlœ¦  «         Œžts          |drz  ds|< :                    ¦   «         z    ;                    ¦   «         ¦  «         t          ||0¦  «         tY          t          j-        |0d¬B¦  «        d¬C¦  «         |0S )tNÚoutputÚpose_datasetz pose/frozen_evaluation_plan.jsonzdetector_completed.jsonrp   Úcompletezpose/completed.jsonzDBoth detector and pose training must complete before test evaluationÚconfig_sha256zmanifest.jsonÚpose_manifest_sha256z)Training/evaluation input binding differsÚsource_hashesz!Frozen model/trainer code changedÚ
evaluationTr+   r.   r`   c                óx   — i | ]7}|t          t          t          ¦  «                             |¦  «        ¦  «        “Œ8S rC   )r   r   Ú__file__Ú	with_name)r<   rD   s     r&   rF   zevaluate.<locals>.<dictcomp>e   s6   € Ð|Ð|Ð|È˜�f¥T­(¡^¤^×%=Ò%=¸dÑ%CÔ%CÑDÔDÐ|Ð|Ð|r(   )zpose_evaluation.pyzpose_inference.pyz*indices/overlap/planar_xy_theta/test.jsonlF)Úfrozen_plan_sha256Údetector_sha256Úinference_config_sha256rŸ   Útest_index_sha256Ú"model_selection_after_test_allowedzbinding.jsonzresults.jsonÚformal_configÚdataset)Úallow_unverified_unitsr   Útestz&No original held-out planar referencesc                ó   — i | ]}|g “ŒS rC   rC   )r<   r=   s     r&   rF   zevaluate.<locals>.<dictcomp>q   s   € Ð!PÐ!PÐ!P¨1 ! BÐ!PÐ!PÐ!Pr(   )ÚgeometryrA   r/   )ÚpointsÚimager\   zHeld-out input changedr°   r¯   )Úallow_pickleÚpoints_xyziÚpixel_to_source_indexÚpointcloud_scale_to_m)r8   Ú
scale_to_mrw   ry   Ú	match_iouÚ	sample_idÚ
sample_keyÚgroup_id)	r·   r¸   r¹   Úpoint_units_verifiedÚgt_box_xywhrl   ÚpipelineÚmatched_detection_indexÚ-inference_seconds_including_first_call_warmup)r8   rµ   ÚfamilyÚ
predictionÚplane_success)ÚerrorrÀ   Úinput_qualityÚnané   Ú
oracle_roir   Úmatched_iouÚmatched_pose_metricsr‹   g      ð?Úfrozen_test)ÚstageÚ	completedÚtotal)Úensure_ascii)Úflushc                ó:   •— i | ]\  }}|t          |‰‰¦  «        “ŒS rC   )r˜   )r<   r¿   rh   r…   r”   s      €€r&   rF   zevaluate.<locals>.<dictcomp>Ÿ   s+   ø€ ÐcÐcÐcÁ=À6È&�F�>¨&°¸Ñ>Ô>ÐcÐcÐcr(   ))TÚregistered_point_units)FÚ$unverified_units_research_assumptionc                ó6   •— g | ]\  }}|d          du‰k    ¯|‘ŒS ©r´   NrC   )r<   rv   ÚrÚflags      €r&   rJ   zevaluate.<locals>.<listcomp>¢   s4   ø€ Ð`Ð`Ð`‘s�q˜°!Ð4KÔ2LÐTXÐ2XÐ[_Ò1_Ð1_�Ð1_Ð1_Ð1_r(   c           	     óŽ   •— i | ]A\  }}|t          t          j        |¦  «        ‰         ‰‰         ˆfd „‰D ¦   «         ¦  «        “ŒBS )c                ó    •— g | ]
}‰|         ‘ŒS rC   rC   r„   s     €r&   rJ   z'evaluate.<locals>.<dictcomp>.<listcomp>£   s!   ø€ ÐZtÐZtÐZtÐghÐ[_Ð`aÔ[bÐZtÐZtÐZtr(   )r˜   r   r   )r<   r¿   rh   r–   r…   r”   s      €€€r&   rF   zevaluate.<locals>.<dictcomp>£   sf   ø€ ð 1ð 1ð 1Ù��vð �n­R¬Z¸Ñ-?Ô-?ÀÔ-HÈÐQXÔIYÐZtÐZtÐZtÐZtÐlsÐZtÑZtÔZtÑuÔuð 1ð 1ð 1r(   c                ó   — h | ]
}|d          ’ŒS ©r¹   rC   ©r<   rÔ   s     r&   ú	<setcomp>zevaluate.<locals>.<setcomp>§   s   € Ð5Ð5Ð5¨1˜˜:œÐ5Ð5Ð5r(   c                ó,   •— g | ]}|d          ‰k    ¯|‘ŒS rÙ   rC   )r<   rÔ   Úgroups     €r&   rJ   zevaluate.<locals>.<listcomp>¨   s'   ø€ ÐBÐBÐB˜Q¨Q¨z¬]¸EÒ-AÐ-A�qÐ-AÐ-AÐ-Ar(   c              3  ór   K  — | ]2}|                      d i ¦  «                              dd¦  «        dk    V — Œ3dS )rÈ   r‹   r   r   N)r’   rÚ   s     r&   r@   zevaluate.<locals>.<genexpr>©   sI   è è € ÐjÐjÐWX�A—E’EÐ0°Ñ4Ô4×8Ò8Ð9LÈQÑOÔOÐQRÒRÐjÐjÐjÐjÐjÐjr(   )r†   Úend_to_end_successes_50mm_5degÚend_to_end_success_rater8   Úoriginal_test_samplesÚoriginal_test_groupsÚselected_family_before_testrO   Útest_used_for_selectionÚ.ground_truth_used_for_detector_or_pipeline_roiÚoracle_roi_not_end_to_endÚoracle_unit_stratar¼   g        )
Úpredicted_boxesÚmatched_gt_boxes_at_iou_0_5Údetector_recall_on_pose_subsetÚ!detector_precision_on_pose_subsetÚ$pose_input_failures_on_matched_boxesÚ conditional_matched_pose_metricsrß   Ú!end_to_end_success_rate_50mm_5degÚ,all_gt_samples_remain_in_success_denominatorrˆ   r_   Únormal_generalization_evaluatedr]   Úglobal_robot_frame_verifiedÚ'geometry_default_x_normal_fallback_usedc              3  óL   K  — | ]}|d          d         d         d          V — Œ dS )rÆ   r®   rÃ   rÁ   NrC   rÚ   s     r&   r@   zevaluate.<locals>.<genexpr>º   sS   è è € ð  6Jð  6JÐ|}¸!¸L¼/È*Ô:UÐVeÔ:fÐgvÔ:wÐ6wð  6Jð  6Jð  6Jð  6Jð  6Jð  6Jr(   Ú"unverified_point_unit_test_samplesc              3  ó*   K  — | ]}|d          du V — ŒdS rÓ   rC   rÚ   s     r&   r@   zevaluate.<locals>.<genexpr>»   s.   è è € Ð0bÐ0bÐXY°Ð3JÔ1KÈtÐ1SÐ0bÐ0bÐ0bÐ0bÐ0bÐ0br(   Úruntime_secondsgš™™™™™©?g      @Údetection_confidence)Ú
position_mÚangle_degreesr'   ru   Ú>49_held_out_planar_samples_not_full_detector_test_not_6d_ADD_S)Úthresholds_frozen_before_testÚmetrics_scopeÚ&historical_auxiliary_checkpoint_reusedÚrobot_command_eligiblez'Formal labels changed during evaluationÚ protected_formal_files_unchangedzpredictions.jsonlÚ )Únewline)r¸   r¹   rº   rÇ   ÚmatchedÚposition_error_mmÚangle_error_degreesr‹   )Ú
fieldnamesrº   r½   Úposition_mae_mmÚangle_mae_degreeszpipeline_predictions.csvu   ï»¿)<r   ÚresolveÚjsonÚloadsÚ	read_textr	   re   rc   r   rg   r¢   r£   rr   ra   r   r   r   r   r   ÚtimeÚ	monotonicÚcv2Ú	enumerater   ÚimreadÚstrÚIMREAD_GRAYSCALEr   rd   ÚshapeÚpredictr|   r   r   Úappendr€   ÚtolistrQ   r   Ú
setdefaultr'   r   r   ÚintÚprintÚdumpsr   rz   Úsumr   ÚioÚStringIOÚcsvÚ
DictWriterÚwriteheaderr’   Úwriterowr
   ÚgetvalueÚencode)DÚconfig_pathÚdevicerj   ri   ÚrootÚ	plan_pathrk   rS   rD   ÚexpectedrI   r    ÚbindingrË   ÚformalÚbeforeÚfrozen_manifestÚ	predictorÚrecordsÚoracleÚ
joint_predÚjoint_targetsÚ
joint_rowsÚjoint_indicesÚdetections_countÚmatched_countÚquality_failuresÚpose_successesÚstartr  rv   rÔ   Úfieldr°   Úcloudr¯   ÚmappingÚheightÚwidthÚtimedÚ	inferenceÚelapsedrw   r}   ÚyÚchosenÚrecordr¿   r—   rÂ   Ú	detectionÚpredÚmetricÚoracle_metricsÚstrataÚlabelÚconditionalrˆ   Úgroup_recordsÚsuccessÚstreamÚfieldsÚwriterrÕ   rÝ   r–   r…   r”   sD                                                                  @@@@@r&   ÚevaluaterP  V   s¯  øøøøø€ Ý�[Ñ!Ô!×)Ò)Ñ+Ô+€Kµ4´:¸k×>SÒ>SÑ>UÔ>UÑ3VÔ3V¨FÝ��xÔ Ñ €C¥g¨f°^Ô.DÑ&D ØÐ4Ñ4€I½$¼*ÀY×EXÒEXÑEZÔEZÑ:[Ô:[°TÝŒZ˜Ð6Ñ6×AÒAÑCÔCÑDÔD€HØ�Ô˜*Ò$Ð$¨SÐ1FÑ-F×,NÒ,NÑ,PÔ,PÐ$ÝÐ_Ñ`Ô`Ð`ÝˆkÑÔ˜D Ô1Ò1Ð1µV¸DÀÑ<PÑ5QÔ5QÐSWÐXnÔSoÒ5oÐ5oÝÐDÑEÔEÐEØ˜oÔ.×4Ò4Ñ6Ô6ð rð r‰ˆˆXÝ•$•x‘.”.×*Ò*¨4Ñ0Ô0Ñ1Ô1°8Ò;Ð;Å*ÐMpÑBqÔBqÐ<qÐ;Ý�s˜6 $ xÑ0Ô0€FØ�<Ñ€J 
× 0Ò 0¸$Ð 0Ñ ?Ô ?Ð ?Ý"(¨Ñ"3Ô"3ÀhÈ}ÔF]Ý"(¨Ð0GÑ)GÑ"HÔ"HØ|Ð|ÐQ{Ð|Ñ|Ô|Ý" 4Ð(TÑ#TÑUÔUØ-2ð	4ð 4€Gõ
 ˆz˜.Ñ(¨Ñ1Ô1Ð1Ø˜Ñ'€IØ×ÒÑÔÐB¥¤¨I×,?Ò,?Ñ,AÔ,AÑ!BÔ!BÐBÝ•”
�G F¨?Ô$;Ñ;×FÒFÑHÔHÑIÔIÈ)ÔTÑUÔU€FÝ˜fÑ%Ô%€FÝ”J  _Ñ 4×?Ò?ÑAÔAÑBÔB€OÝ! &¨ÀtÐLÑLÔL€IÝ	�D�˜qœ &Ñ	)Ô	)€DØÐJ•jÐ!IÑJÔJÐJØ€G�rˆwÐ!PÐ!PÐ0OÐ!PÑ!PÔ!P˜&Ø€J �-¨b :¸r°ØÐ Q�}¸Ð'7È¸.Ý
Œ.Ñ
Ô
€EØ€J€J€JÝ˜‰Œð 'sñ 's‰ˆˆ!Ø'ð 	ð 	ˆEÝ•i  Q u¤XÑ.Ô.Ñ/Ô/°ÀÔ1IÈ!ÈEÌ(Ô1SÒSÐSÕZdÐe}ÑZ~ÔZ~ÐT~ÐSØ�jŠj��Y t¨A¨g¬JÑ7Ô7Ñ8Ô8¸Ô9MÑNÔNˆÝŒW•Y˜t A h¤KÑ0Ô0¸eÐDÑDÔDð 	OÈØ  Ô/°Ð6MÔ0N�7ˆFð	Oð 	Oð 	Oñ 	Oô 	Oð 	Oð 	Oð 	Oð 	Oð 	Oð 	Oøøøð 	Oð 	Oð 	Oð 	Oà”[‰ˆˆuåŒnÑÔˆØ×#Ò# E¨&°½eÀA¼hÐRSÐTkÔRlÐ#ÑmÔmˆ	Ý”Ñ Ô  Ñ&ˆØ˜\Ô*ˆ
Ð+;½SÀ¹_¼_Ñ+LÐ+;Ý˜˜*œÑ&Ô&ˆ­°a½¸a¼Ñ)AÔ)A qÀ'Ç.Â.ÐQRÑBSÔBSÐBSÝ! *¨U°4¸Ô3DÑEÔEˆØ˜kœN¸¸,¼ÐSTÐU_ÔS`Ø#$Ð%<Ô#=ÀTÐ#IØŸ,š,™.œ.°!·(²(±*´*È	Ø&,Ð]dðfð fˆð ð 	>ð 	>ˆFð8Ø —~’~ f¨W°U¸5ÀÍUÐSTÌXØ Ð!8Ô9Àð &ñ Iô I�à�v”×%Ò% f¨\Ô&:Ñ;Ô;Ð;Ð;øÝð 8ð 8ð 8Ý # E¡
¤
¸ÈoÐ^cÐMdÐeÐe�Ø�v”×%Ò%¥u¨U¡|¤| n°QÑ&6Ñ7Ô7Ð7Ð7Ð7Ð7Ð7Ð7øøøøð8øøøð 8>ˆF×Ò˜l¨2Ñ.Ô.¨vÑ6Ð6ØÐØ˜1ÑˆMØ  Ô(ˆIÝ")¨)°JÔ*?ÀÑ"FÔ"FˆF�=Ñ!Ø˜Ô&Ð2Ý”Z 	¨,Ô 7Ñ8Ô8�Ý# D¨¤J¨q°¬wµu¸Q´xÑ@Ô@�Ø/5�Ð-Ñ.Ø¥ FÐ+>Ô$?ÀÒ$CÑ DÔ DÑD�Ø×!Ò! $Ñ'Ô'Ð'¨×(<Ò(<¸QÑ(?Ô(?Ð(?À
×@QÒ@QÐRSÑ@TÔ@TÐ@TÐUb×UiÒUiÐjkÑUlÔUlÐUlÐUlØ! 1Ñ$Ð!Ø�Š�vÑÔÐÝ�dŒj -¸A¸a¹CÍÈDÉ	Ì	ÐRÐRÐ`eÐfÑfÔfÐmqÐrÑrÔrÐrÑrÝŒJ�wÑÔ€GØcÐcÐcÐcÐcÐTZ×T`ÒT`ÑTbÔTbÐcÑcÔc€NØ€FØfð 1ð 1‰
ˆˆUØ`Ð`Ð`Ð`�i¨™oœoÐ`Ñ`Ô`ˆð1ð 1ð 1ð 1ð 1ð 1Ø!'§¢¡¤ð1ñ 1ô 1ˆˆu‰ˆàisÐ}•¥¤
¨:Ñ 6Ô 6µr´zÀ-Ñ7PÔ7PÐQ[Õ\aÐbcÔ\dÑeÔeÐeÐy}€KØ€HÝÐ5Ð5°Ð5Ñ5Ô5Ñ6Ô6ð Bð BˆØBÐBÐBÐB 'ÐBÑBÔBˆÝÐjÐjÐ\iÐjÑjÔjÑjÔjˆÝ#& }Ñ#5Ô#5ÐW^Ø&-­c°-Ñ.@Ô.@Ñ&@ðBð Bˆ�‰ˆðWˆG�Jð W˜v¥e¨A¤hð WÐ/FÅsÈ4ÁyÄyð WØ�s 8™}œ}ðWØ-JÈ4ÐPhÔKiðWà! %ðWà(XÐY^ðWð 	$ NðWð 4HÈðWð 	Ð&6ÐUbØ-:½3¸t¹9¼9Ñ-DØRbÐ0j°Ð>NÑ0NÐ0NÐhjØ3CØ/:Ø-;Ø0>½sÀ4¹y¼yÑ0HØ;?È8ðUð Uð	Wð 	# 5ðWð *KÈ5ðWð 	! ðWð (EÀUðWð 	2µ#ð  6Jð  6Jð  BIð  6Jñ  6Jô  6Jñ  3Jô  3JðWð 	-­SÐ0bÐ0bÐ]aÐ0bÑ0bÔ0bÑ-bÔ-bðWð  	�$œ.Ñ*Ô*¨5Ñ0ð!Wð" 7:È"ÐW[Ð\gÔWhØÐ4Ô5ð)7ð )7àXØ16ÐPUð)Wð Wð W€Fõ* ˜&Ñ!Ô! 6Ò)Ð)µ
Ð;dÑ0eÔ0eÐ*eÝ/2°6©{¬{€FÐ-Ñ.ÝˆzÐ-Ñ-¨gÑ6Ô6Ð6ÝŒ;˜rÐ"Ñ"Ô"€FðG€FåŒ>˜&¨FÐ3Ñ3Ô3€F°F×4FÒ4FÑ4HÔ4HÐ4HØð zð zˆØ�uŠuÐ+¨BÑ/Ô/ˆØ�Š a¨¤oÀÀ:ÄØ#$Ð%;Ô#<È1Ï5Ê5ÐQ^ÑK_ÔK_ØÐ1Ô2¸$Ð>ÐSY×S]ÒS]Ð^oÑSpÔSpØ"(§*¢*Ð-@Ñ"AÔ"AÐV\×V`ÒV`ÐatÐuvÑVwÔVwðyð yñ 	zô 	zð 	zð 	zõ �JÐ9Ñ9¸8ÀFÇOÂOÑDUÔDUÑ;U×:]Ò:]Ñ:_Ô:_Ñ`Ô`Ð`Ýˆy˜Ñ Ô Ð Ý	�$Œ*�V¨Ð
/Ñ
/Ô
/°dÐ;Ñ;Ô;Ð;Ø€Ms,   Ð P=Ð=Q	ÑQ	Õ+AV;Ö;
X×AXØXc                 ó  — t          j        t          ¬¦  «        } |                      dt          t
          dz  ¬¦  «         |                      dd¬¦  «         |                      ¦   «         }t          |j        |j	        ¦  «         d S )N)Údescriptionz--configz$configs/pallet_pose_training_v1.json)ÚtypeÚdefaultz--devicer4   )rT  )
ÚargparseÚArgumentParserÚ__doc__Úadd_argumentr   r	   Ú
parse_argsrP  rj   r%  )ÚparserÚargss     r&   Úmainr\  Ô   sy   € ÝÔ"­wÐ7Ñ7Ô7€FØ
×Ò˜
­µWÐ=cÑ5cÐÑdÔdÐdØ
×Ò˜
¨5ÐÑ1Ô1Ð1Ø	×	Ò	Ñ	Ô	€D�X d¤k°$´+Ñ>Ô>Ð>Ð>Ð>r(   Ú__main__)r4   )*rW  Ú
__future__r   rU  Úcollectionsr   r  r  r	  Úpathlibr   r  Únumpyr   r:   Úcluster_targetsr   r   r›   r	   r
   r   r   r   Úpose_inferencer   Ú
pose_modelr   r   r   r   r   Úpose_trainingr   r   r'   rr   r€   r˜   rP  r\  Ú__name__rC   r(   r&   ú<module>rg     s¨  ððð ð #Ð "Ð "Ð "Ð "Ð "à €€€Ø Ð Ð Ð Ð Ð Ø 
€
€
€
Ø 	€	€	€	Ø €€€Ø Ð Ð Ð Ð Ð Ø €€€à Ð Ð Ð Ø €€€à 7Ð 7Ð 7Ð 7Ð 7Ð 7Ð 7Ð 7Ø UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UØ /Ð /Ð /Ð /Ð /Ð /Ø UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UÐ UØ 3Ð 3Ð 3Ð 3Ð 3Ð 3Ð 3Ð 3ðXð Xð Xðð ð ðBð ð ðð ð ð{ð {ð {ð {ð|?ð ?ð ?ð ˆZÒÐ˜˜™œ˜˜˜ÐÐr(   