|
|
|
@ -89,7 +89,7 @@ def fill_model_msg(base_msg: capnp._DynamicStructBuilder, extended_msg: capnp._D |
|
|
|
|
fill_xyzt(modelV2.orientationRate, ModelConstants.T_IDXS, *net_output_data['plan'][0,:,Plan.ORIENTATION_RATE].T) |
|
|
|
|
|
|
|
|
|
# temporal pose |
|
|
|
|
temporal_pose = modelV2.temporalPose |
|
|
|
|
#temporal_pose = modelV2.temporalPose |
|
|
|
|
#temporal_pose.trans = net_output_data['sim_pose'][0,:ModelConstants.POSE_WIDTH//2].tolist() |
|
|
|
|
#temporal_pose.transStd = net_output_data['sim_pose_stds'][0,:ModelConstants.POSE_WIDTH//2].tolist() |
|
|
|
|
#temporal_pose.rot = net_output_data['sim_pose'][0,ModelConstants.POSE_WIDTH//2:].tolist() |
|
|
|
|