source: cpp/common/2d.h @ 1130

Last change on this file since 1130 was 1130, checked in by Maciej Komosinski, 3 years ago

Used std::min(), std::max() explicitly to avoid compiler confusion. Used std::size() explicitly instead of the equivalent macro

  • Property svn:eol-style set to native
File size: 8.8 KB
Line 
1// This file is a part of Framsticks SDK.  http://www.framsticks.com/
2// Copyright (C) 1999-2021  Maciej Komosinski and Szymon Ulatowski.
3// See LICENSE.txt for details.
4
5#ifndef _2D_H_
6#define _2D_H_
7
8#include <math.h>
9#include <algorithm>
10
11//unification of old GUIXY and Pt2D
12template <typename T> class XY
13{
14public:
15        T x, y;
16        XY() {}
17        XY(T _x, T _y) :x(_x), y(_y) {}
18        template <typename Q> XY(const Q &other) : x(other.x), y(other.y) {}
19        template <typename Q> const XY &operator=(const Q &other) { x = other.x; y = other.y; return *this; }
20        template <typename Q> const XY operator()(const Q &other) { return XY(other.x, other.y); }
21        XY operator+(const XY &p) const { return XY(x + p.x, y + p.y); }
22        XY operator-(const XY &p) const { return XY(x - p.x, y - p.y); }
23        XY operator+=(const XY &p) { x += p.x; y += p.y; return *this; }
24        XY operator-=(const XY &p) { x -= p.x; y -= p.y; return *this; }
25        XY operator-() const { return XY(-x, -y); }
26        // allows float operations on ints
27        template <typename Q> XY operator*=(Q q) { x *= q; y *= q; return *this; }
28        template <typename Q> XY operator/=(Q q) { x /= q; y /= q; return *this; }
29        template <typename Q> XY operator/(Q q) const { return XY(x / q, y / q); }
30        template <typename Q> XY operator*(Q q) const { return XY(q * x, q * y); }
31        XY operator*=(const XY &q) { x *= q.x; y *= q.y; return *this; }
32        XY operator/=(const XY &q) { x /= q.x; y /= q.y; return *this; }
33        XY operator*(const XY &q) const { return XY(x * q.x, y * q.y); }
34        XY operator/(const XY &q) const { return XY(x / q.x, y / q.y); }
35        void set(T _x, T _y) { x = _x; y = _y; }
36        void add(T _x, T _y) { x += _x; y += _y; }
37        void sub(T _x, T _y) { x -= _x; y -= _y; }
38        bool operator==(const XY &p) const { return (fabs(double(x - p.x)) < 1e-20) && (fabs(double(y - p.y)) < 1e-20); }
39        bool operator!=(const XY &p) const { return !operator==(p); }
40        T distanceTo(const XY &p) const { return sqrt(distanceToSq(p)); }
41        T distanceToSq(const XY &p) const { return double((p.x - x) * (p.x - x) + (p.y - y) * (p.y - y)); }
42        T magnitude() const { return sqrt(x * x + y * y); }
43        T length() const { return sqrt(x * x + y * y); }
44        T lengthSq() const { return x * x + y * y; }
45        T dotProduct(const XY &v) const { return x * v.x + y * v.y; }
46        T crossProduct(const XY &v) const { return x * v.y - y * v.x; }
47        void normalize() { operator/=(length()); } // length becomes 1
48        static XY average(const XY &v1, const XY &v2) { return XY((v1.x + v2.x) * 0.5, (v1.y + v2.y) * 0.5); }
49        double getDirection() const { return atan2(y, x); }
50        static XY interpolate(const XY &v1, const XY &v2, double t) { return universal_lerp(v1, v2, t); }
51        XY toInt() const { return XY(int(x), int(y)); }
52        XY transpose() const { return XY(y, x); }
53        static const XY &zero() { static XY t(0, 0); return t; }
54        static const XY &one() { static XY t(1, 1); return t; }
55};
56
57//specialized: int equality not using fabs()
58template<> inline bool XY<int>::operator==(const XY<int> &p) const { return (x == p.x) && (y == p.y); }
59
60template <typename T> XY<T> xymin(const XY<T> &a, const XY<T> &b) { return XY<T>(std::min(a.x, b.x), std::min(a.y, b.y)); }
61template <typename T> XY<T> xymax(const XY<T> &a, const XY<T> &b) { return XY<T>(std::max(a.x, b.x), std::max(a.y, b.y)); }
62
63template <typename T>
64class XYMargin
65{
66public:
67        XYMargin(T x = 0) :left(x), top(x), right(x), bottom(x) {}
68        XYMargin(T l, T t, T r, T b) :left(l), top(t), right(r), bottom(b) {}
69        T left, top, right, bottom;
70        void operator=(T x) { left = top = right = bottom = x; }
71        XYMargin operator-() const { return XYMargin(-left, -top, -right, -bottom); }
72        void operator=(const XYMargin<T> &other) { left = other.left; top = other.top; right = other.right; bottom = other.bottom; }
73        T horizontal() const { return left + right; }
74        T vertical() const { return top + bottom; }
75        bool operator==(const XYMargin &other) const { return left == other.left && top == other.top && right == other.right && bottom == other.bottom; }
76        XYMargin normalized() const { return XYMargin(std::max(left, T(0)), std::max(top, T(0)), std::max(right, T(0)), std::max(bottom, T(0))); }
77};
78
79template <typename T>
80class XYRect
81{
82public:
83        XY<T> p, size;
84        XYRect() {}
85        XYRect(const XY<T> &p1, const XY<T> &s) :p(p1), size(s) {}
86        template <typename Q> XYRect(const Q &other) : p(other.p), size(other.size) {}
87        XYRect(T _x, T _y, T _w, T _h) :p(_x, _y), size(_w, _h) {}
88        static XYRect<T> centeredAt(const XY<T> &p, XY<T> s) { return XYRect<T>(p - s * 0.5, s); }
89
90        bool isEmpty() const { return (size.x < 0) || (size.y < 0); }
91        XYRect toInt() const { return XYRect(int(p.x), int(p.y), int(p.x + size.x) - int(p.x), int(p.y + size.y) - int(p.y)); }
92        bool operator==(const XYRect &r) const { return (p == r.p) && (size == r.size); }
93        template <typename Q> const XYRect &operator=(const Q &other) { p = other.p; size = other.size; return *this; }
94
95        T right() const { return p.x + size.x; }
96        T bottom() const { return p.y + size.y; }
97        T top() const { return p.y; }
98        T left() const { return p.x; }
99        XY<T> center() const { return p + size / 2; }
100        const XY<T> &topLeft() const { return p; }
101        XY<T> bottomRight() const { return p + size; }
102        XY<T> topRight() const { return XY<T>(p.x + size.x, p.y); }
103        XY<T> bottomLeft() const { return XY<T>(p.x, p.y + size.y); }
104
105        T area() const { return size.x * size.y; }
106
107        bool intersects(const XYRect &r) const
108        {
109                if (r.p.x >= (p.x + size.x)) return false;
110                if (r.p.y >= (p.y + size.y)) return false;
111                if ((r.p.x + r.size.x) <= p.x) return false;
112                if ((r.p.y + r.size.y) <= p.y) return false;
113                return true;
114        }
115
116        bool contains(const XY<T> &n) const
117        {
118                if (n.x < p.x) return false;
119                if (n.x > (p.x + size.x)) return false;
120                if (n.y < p.y) return false;
121                if (n.y > (p.y + size.y)) return false;
122                return true;
123        }
124
125        bool contains(const XYRect &r) const
126        {
127                return contains(r.p) && contains(r.p + r.size);
128        }
129
130        void add(const XY<T> &n)
131        {
132                if (n.x < p.x) { size.x += p.x - n.x; p.x = n.x; }
133                else if (n.x > (p.x + size.x)) size.x = n.x - p.x;
134                if (n.y < p.y) { size.y += p.y - n.y; p.y = n.y; }
135                else if (n.y > (p.y + size.y)) size.y = n.y - p.y;
136        }
137
138        XYRect extendBy(const XY<T> &border_size) const
139        {
140                return XYRect(p - border_size, size + border_size * 2);
141        }
142
143        XYRect shrinkBy(const XY<T> &border_size) const
144        {
145                return XYRect(p + border_size, size - border_size * 2);
146        }
147
148        XYRect extendBy(const XYMargin<T> &m) const
149        {
150                return XYRect(p.x - m.left, p.y - m.top, size.x + m.horizontal(), size.y + m.vertical());
151        }
152
153        XYRect shrinkBy(const XYMargin<T> &m) const
154        {
155                return XYRect(p.x + m.left, p.y + m.top, size.x - m.horizontal(), size.y - m.vertical());
156        }
157
158        XYMargin<T> marginTowards(const XYRect &r) const
159        {
160                return XYMargin<T>(r.p.x - p.x, r.p.y - p.y,
161                        (p.x + size.x) - (r.p.x + r.size.x), (p.y + size.y) - (r.p.y + r.size.y));
162        }
163
164        XYRect fitAspect(float aspect) const ///< place a new rectangle having 'aspect' inside the rectangle
165        {
166                XYRect r;
167                r.size = size;
168                if (size.x < size.y * aspect)
169                        r.size.y = r.size.x / aspect;
170                else
171                        r.size.x = r.size.y * aspect;
172                r.p = p + (size - r.size) * 0.5;
173                return r;
174        }
175
176        XYRect intersection(const XYRect &r) const
177        {
178                XYRect i;
179                XY<T> p2 = p + size;
180                XY<T> rp2 = r.p + r.size;
181                i.p.x = std::max(p.x, r.p.x);
182                i.p.y = std::max(p.y, r.p.y);
183                i.size.x = std::min(p2.x, rp2.x) - i.p.x;
184                i.size.y = std::min(p2.y, rp2.y) - i.p.y;
185                return i;
186        }
187
188        XYRect extensionContaining(const XY<T> &p) const
189        {
190                XY<T> p1 = xymin(topLeft(), p);
191                XY<T> p2 = xymax(bottomRight(), p);
192                return XYRect(p1, p2 - p1);
193        }
194
195        XYRect extensionContaining(const XYRect &r) const
196        {
197                XY<T> p1 = xymin(topLeft(), r.topLeft());
198                XY<T> p2 = xymax(bottomRight(), r.bottomRight());
199                return XYRect(p1, p2 - p1);
200        }
201
202        XYRect translation(const XY<T> &t) const
203        {
204                return XYRect(p + t, size);
205        }
206
207        T distanceTo(const XY<T> &n) const
208        {
209                XY<T> tp = n;
210                if (n.x < p.x) tp.x = p.x; else if (n.x >= (p.x + size.x)) tp.x = p.x + size.x;
211                if (n.y < p.y) tp.y = p.y; else if (n.y >= (p.y + size.y)) tp.y = p.y + size.y;
212                return tp.distanceTo(n);
213        }
214
215        T distanceTo(const XYRect<T> &r) const
216        {
217                bool r_above = (r.bottom() <= top());
218                bool r_below = (r.top() >= bottom());
219                bool r_left = (r.right() <= left());
220                bool r_right = (r.left() >= right());
221
222                if (r_above)
223                {
224                        if (r_left) return r.bottomRight().distanceTo(topLeft());
225                        else if (r_right) return r.bottomLeft().distanceTo(topRight());
226                        else return top() - r.bottom();
227                }
228                else if (r_below)
229                {
230                        if (r_left) return r.topRight().distanceTo(bottomLeft());
231                        else if (r_right) return r.topLeft().distanceTo(bottomRight());
232                        else return r.top() - bottom();
233                }
234                else if (r_left)
235                {
236                        return left() - r.right();
237                }
238                else if (r_right)
239                {
240                        return r.left() - right();
241                }
242                else
243                        return 0; //intersection
244        }
245
246        static const XYRect &zero() { static XYRect t(0, 0, 0, 0); return t; }
247        static const XYRect &one() { static XYRect t(0, 0, 1, 1); return t; }
248};
249
250typedef XY<int> IntXY;
251typedef XYRect<int> IntRect;
252
253typedef XY<float> FloatXY;
254typedef XYRect<float> FloatRect;
255
256#endif
Note: See TracBrowser for help on using the repository browser.