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
|
## 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 ray = bisector(varargin)
%BISECTOR Return the bisector of two lines, or 3 points.
%
% RAY = bisector(LINE1, LINE2);
% create the bisector of the two lines, given as [x0 y0 dx dy].
%
% RAY = bisector(P1, P2, P3);
% create the bisector of lines (P2 P1) and (P2 P3).
%
% The result has the form [x0 y0 dx dy], with [x0 y0] being the origin
% point ans [dx dy] being the direction vector, normalized to have unit
% norm.
%
% See also
% lines2d, rays2d
% ------
% Author: David Legland
% E-mail: david.legland@inrae.fr
% Created: 2003-10-31
% Copyright 2003-2023 INRA - Cepia Software Platform
if length(varargin)==2
% two lines
line1 = varargin{1};
line2 = varargin{2};
point = intersectLines(line1, line2);
elseif length(varargin)==3
% three points
p1 = varargin{1};
p2 = varargin{2};
p3 = varargin{3};
line1 = createLine(p2, p1);
line2 = createLine(p2, p3);
point = p2;
elseif length(varargin)==1
% three points, given in one array
var = varargin{1};
p1 = var(1, :);
p2 = var(2, :);
p3 = var(3, :);
line1 = createLine(p2, p1);
line2 = createLine(p2, p3);
point = p2;
end
% compute line angles
a1 = lineAngle(line1);
a2 = lineAngle(line2);
% compute bisector angle (angle of first line + half angle between lines)
angle = mod(a1 + mod(a2-a1+2*pi, 2*pi)/2, pi*2);
% create the resulting ray
ray = [point cos(angle) sin(angle)];
|
