public void calcPositions() {
   mid_position =
       new BlockPosition(
           Math.round((red_position.x + green_position.x) / 2),
           Math.round((red_position.y + green_position.y) / 2),
           Math.round((red_position.z + green_position.z) / 2));
   if (red_position.distance(green_position) <= 8.0f) {
     way_red_position.cloneFrom(mid_position);
     way_green_position.cloneFrom(mid_position);
   } else {
     way_red_position =
         new BlockPosition(
             Math.round((((red_position.x + mid_position.x) / 2) + mid_position.x) / 2),
             Math.round((((red_position.y + mid_position.y) / 2) + mid_position.y) / 2),
             Math.round((((red_position.z + mid_position.z) / 2) + mid_position.z) / 2));
     way_green_position =
         new BlockPosition(
             Math.round((((green_position.x + mid_position.x) / 2) + mid_position.x) / 2),
             Math.round((((green_position.y + mid_position.y) / 2) + mid_position.y) / 2),
             Math.round((((green_position.z + mid_position.z) / 2) + mid_position.z) / 2));
   }
 }