1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126
|
## Copyright (C) 2024 David Legland
## All rights reserved.
##
## Redistribution and use in source and binary forms, with or without
## modification, are permitted provided that the following conditions are met:
##
## 1 Redistributions of source code must retain the above copyright notice,
## this list of conditions and the following disclaimer.
## 2 Redistributions in binary form must reproduce the above copyright
## notice, this list of conditions and the following disclaimer in the
## documentation and/or other materials provided with the distribution.
##
## THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS ''AS IS''
## AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
## IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
## ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR
## ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
## DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
## SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
## CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
## OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
## OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
##
## The views and conclusions contained in the software and documentation are
## those of the authors and should not be interpreted as representing official
## policies, either expressed or implied, of the copyright holders.
function edge = clipLine3d(line, box)
%CLIPLINE3D Clip a line with a box and return an edge.
%
% EDGE = clipLine3d(LINE, BOX);
% Clips the line LINE with the bounds given in BOX, and returns the
% corresponding edge.
%
% If the line lies totally outside of the box, returns a 1-by-6 row array
% containing only NaN's.
%
% If LINE is a N-by-6 array, with one line by row, returns the clipped
% edge coresponding to each line in a N-by-6 array.
%
% See also
% lines3d, edges3d, createLine3d, clipRay3d
%
% ------
% Author: David Legland
% E-mail: david.legland@inrae.fr
% Created: 2008-10-30, from drawLine3d
% Copyright 2008-2023 INRA - TPV URPOI - BIA IMASTE
% get box limits
xmin = box(1); xmax = box(2);
ymin = box(3); ymax = box(4);
zmin = box(5); zmax = box(6);
% extreme corners of the box
p000 = [xmin ymin zmin];
p111 = [xmax ymax zmax];
% main vectors
ex = [1 0 0];
ey = [0 1 0];
ez = [0 0 1];
% box faces parallel to Oxy
planeZ0 = [p000 ex ey];
planeZ1 = [p111 ex ey];
% box faces parallel to Oxz
planeY0 = [p000 ex ez];
planeY1 = [p111 ex ez];
% box faces parallel to Oyz
planeX0 = [p000 ey ez];
planeX1 = [p111 ey ez];
% number of lines
nLines = size(line, 1);
% allocate memory for result
edge = zeros(nLines, 6);
% iterate over lines to clip
for i = 1:nLines
% compute intersection point with each plane
ipZ0 = intersectLinePlane(line(i,:), planeZ0);
ipZ1 = intersectLinePlane(line(i,:), planeZ1);
ipY0 = intersectLinePlane(line(i,:), planeY0);
ipY1 = intersectLinePlane(line(i,:), planeY1);
ipX1 = intersectLinePlane(line(i,:), planeX1);
ipX0 = intersectLinePlane(line(i,:), planeX0);
% concatenate resulting points
points = [ipX0;ipX1;ipY0;ipY1;ipZ0;ipZ1];
% compute position of each point on the line
pos = linePosition3d(points, line(i,:));
% keep only defined points
ind = find(~isnan(pos));
pos = pos(ind);
points = points(ind,:);
% sort points with respect to their position
[pos, ind] = sort(pos); %#ok<ASGLU>
points = points(ind, :);
% keep median points wrt to position. These points define the limit of
% the clipped edge.
nv = length(ind)/2;
% create resulting edge.
edge(i,:) = [points(nv, :) points(nv+1, :)];
end
% check that middle point of the edge is contained in the box
midX = mean(edge(:, [1 4]), 2);
xOk = xmin <= midX & midX <= xmax;
midY = mean(edge(:, [2 5]), 2);
yOk = ymin <= midY & midY <= ymax;
midZ = mean(edge(:, [3 6]), 2);
zOk = zmin <= midZ & midZ <= zmax;
% if one of the bounding condition is not met, set edge to NaN
edge (~(xOk & yOk & zOk), :) = NaN;
|