|  |  | @ -228,24 +228,19 @@ void fill_plan(cereal::ModelDataV2::Builder &framed, const ModelOutputPlanPredic | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  | void fill_lane_lines(cereal::ModelDataV2::Builder &framed, const std::array<float, TRAJECTORY_SIZE> &plan_t, |  |  |  | void fill_lane_lines(cereal::ModelDataV2::Builder &framed, const std::array<float, TRAJECTORY_SIZE> &plan_t, | 
			
		
	
		
		
			
				
					
					|  |  |  |                      const ModelOutputLaneLines &lanes) { |  |  |  |                      const ModelOutputLaneLines &lanes) { | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  |  | 
			
		
	
		
		
			
				
					
					|  |  |  |   const auto &left_far = lanes.get_lane_idx(0); |  |  |  |  | 
			
		
	
		
		
			
				
					
					|  |  |  |   const auto &left_near = lanes.get_lane_idx(1); |  |  |  |  | 
			
		
	
		
		
			
				
					
					|  |  |  |   const auto &right_near = lanes.get_lane_idx(2); |  |  |  |  | 
			
		
	
		
		
			
				
					
					|  |  |  |   const auto &right_far = lanes.get_lane_idx(3); |  |  |  |  | 
			
		
	
		
		
			
				
					
					|  |  |  |   std::array<float, TRAJECTORY_SIZE> left_far_y, left_far_z; |  |  |  |   std::array<float, TRAJECTORY_SIZE> left_far_y, left_far_z; | 
			
		
	
		
		
			
				
					
					|  |  |  |   std::array<float, TRAJECTORY_SIZE> left_near_y, left_near_z; |  |  |  |   std::array<float, TRAJECTORY_SIZE> left_near_y, left_near_z; | 
			
		
	
		
		
			
				
					
					|  |  |  |   std::array<float, TRAJECTORY_SIZE> right_near_y, right_near_z; |  |  |  |   std::array<float, TRAJECTORY_SIZE> right_near_y, right_near_z; | 
			
		
	
		
		
			
				
					
					|  |  |  |   std::array<float, TRAJECTORY_SIZE> right_far_y, right_far_z; |  |  |  |   std::array<float, TRAJECTORY_SIZE> right_far_y, right_far_z; | 
			
		
	
		
		
			
				
					
					|  |  |  |   for (int j=0; j<TRAJECTORY_SIZE; j++) { |  |  |  |   for (int j=0; j<TRAJECTORY_SIZE; j++) { | 
			
		
	
		
		
			
				
					
					|  |  |  |     left_far_y[j] = left_far.mean[j].y; |  |  |  |     left_far_y[j] = lanes.mean.left_far[j].y; | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     left_far_z[j] = left_far.mean[j].z; |  |  |  |     left_far_z[j] = lanes.mean.left_far[j].z; | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     left_near_y[j] = left_near.mean[j].y; |  |  |  |     left_near_y[j] = lanes.mean.left_near[j].y; | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     left_near_z[j] = left_near.mean[j].z; |  |  |  |     left_near_z[j] = lanes.mean.left_near[j].z; | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     right_near_y[j] = right_near.mean[j].y; |  |  |  |     right_near_y[j] = lanes.mean.right_near[j].y; | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     right_near_z[j] = right_near.mean[j].z; |  |  |  |     right_near_z[j] = lanes.mean.right_near[j].z; | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     right_far_y[j] = right_far.mean[j].y; |  |  |  |     right_far_y[j] = lanes.mean.right_far[j].y; | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     right_far_z[j] = right_far.mean[j].z; |  |  |  |     right_far_z[j] = lanes.mean.right_far[j].z; | 
			
				
				
			
		
	
		
		
	
		
		
	
		
		
	
		
		
	
		
		
	
		
		
	
		
		
	
		
		
	
		
		
			
				
					
					|  |  |  |   } |  |  |  |   } | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  |   auto lane_lines = framed.initLaneLines(4); |  |  |  |   auto lane_lines = framed.initLaneLines(4); | 
			
		
	
	
		
		
			
				
					|  |  | @ -255,10 +250,10 @@ void fill_lane_lines(cereal::ModelDataV2::Builder &framed, const std::array<floa | 
			
		
	
		
		
			
				
					
					|  |  |  |   fill_xyzt(lane_lines[3], plan_t, X_IDXS_FLOAT, right_far_y, right_far_z); |  |  |  |   fill_xyzt(lane_lines[3], plan_t, X_IDXS_FLOAT, right_far_y, right_far_z); | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  |   framed.setLaneLineStds({ |  |  |  |   framed.setLaneLineStds({ | 
			
		
	
		
		
			
				
					
					|  |  |  |     exp(left_far.std[0].y), |  |  |  |     exp(lanes.std.left_far[0].y), | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     exp(left_near.std[0].y), |  |  |  |     exp(lanes.std.left_near[0].y), | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     exp(right_near.std[0].y), |  |  |  |     exp(lanes.std.right_near[0].y), | 
			
				
				
			
		
	
		
		
			
				
					
					|  |  |  |     exp(right_far.std[0].y), |  |  |  |     exp(lanes.std.right_far[0].y), | 
			
				
				
			
		
	
		
		
	
		
		
	
		
		
	
		
		
	
		
		
			
				
					
					|  |  |  |   }); |  |  |  |   }); | 
			
		
	
		
		
			
				
					
					|  |  |  | 
 |  |  |  | 
 | 
			
		
	
		
		
			
				
					
					|  |  |  |   framed.setLaneLineProbs({ |  |  |  |   framed.setLaneLineProbs({ | 
			
		
	
	
		
		
			
				
					|  |  | 
 |