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
|
/*
* Copyright (c) 2020 Samsung Electronics Co., Ltd. All rights reserved.
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
* The above copyright notice and this permission notice shall be included in all
* copies or substantial portions of the Software.
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
* SOFTWARE.
*/
#ifndef VLINE_H
#define VLINE_H
#include "vector_vglobal.h"
#include "vector_vpoint.h"
V_BEGIN_NAMESPACE
class VLine {
public:
VLine() = default;
VLine(float x1, float y1, float x2, float y2)
: mX1(x1), mY1(y1), mX2(x2), mY2(y2)
{
}
VLine(const VPointF &p1, const VPointF &p2)
: mX1(p1.x()), mY1(p1.y()), mX2(p2.x()), mY2(p2.y())
{
}
float length() const { return length(mX1, mY1, mX2, mY2);}
void splitAtLength(float length, VLine &left, VLine &right) const;
VPointF p1() const { return {mX1, mY1}; }
VPointF p2() const { return {mX2, mY2}; }
float angle() const;
static float length(float x1, float y1, float x2, float y2);
private:
float mX1{0};
float mY1{0};
float mX2{0};
float mY2{0};
};
inline float VLine::angle() const
{
static constexpr float K_PI = 3.141592f;
const float dx = mX2 - mX1;
const float dy = mY2 - mY1;
const float theta = std::atan2(dy, dx) * 180.0f / K_PI;
return theta;
}
// approximate sqrt(x*x + y*y) using alpha max plus beta min algorithm.
// With alpha = 1, beta = 3/8, giving results with the largest error less
// than 7% compared to the exact value.
inline V_ALWAYS_INLINE float VLine::length(float x1, float y1, float x2, float y2)
{
float x = x2 - x1;
float y = y2 - y1;
x = x < 0 ? -x : x;
y = y < 0 ? -y : y;
return (x > y ? x + 0.375f * y : y + 0.375f * x);
}
inline void VLine::splitAtLength(float lengthAt, VLine &left, VLine &right) const
{
float len = length();
float dx = ((mX2 - mX1) / len) * lengthAt;
float dy = ((mY2 - mY1) / len) * lengthAt;
left.mX1 = mX1;
left.mY1 = mY1;
left.mX2 = left.mX1 + dx;
left.mY2 = left.mY1 + dy;
right.mX1 = left.mX2;
right.mY1 = left.mY2;
right.mX2 = mX2;
right.mY2 = mY2;
}
#endif //VLINE_H
|
