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
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
|
/* This file is part of the Spring engine (GPL v2 or later), see LICENSE.html */
#ifndef MYMATH_H
#define MYMATH_H
#include "Sim/Misc/GlobalConstants.h"
#include "System/Vec2.h"
#include "System/float3.h"
#ifdef __GNUC__
#define _const __attribute__((const))
#define _warn_unused_result __attribute__((warn_unused_result))
#else
#define _const
#define _warn_unused_result
#endif
static const float INVPI = 1.0f / PI;
static const float TWOPI = 2.0f * PI;
static const float HALFPI = 0.5f * PI;
static const int SHORTINT_MAXVALUE = 32768;
static const int SPRING_CIRCLE_DIVS = (SHORTINT_MAXVALUE << 1);
#define HEADING_CHECKSUM_1024 0x617a9968
#define HEADING_CHECKSUM_4096 0x3d51b476
#define NUM_HEADINGS 4096
#if (NUM_HEADINGS == 1024)
#define HEADING_CHECKSUM HEADING_CHECKSUM_1024
#elif (NUM_HEADINGS == 4096)
#define HEADING_CHECKSUM HEADING_CHECKSUM_4096
#else
#error "HEADING_CHECKSUM not set, invalid NUM_HEADINGS?"
#endif
enum FacingMap {
FACING_NORTH = 2,
FACING_SOUTH = 0,
FACING_EAST = 1,
FACING_WEST = 3,
NUM_FACINGS = 4,
};
class CMyMath {
public:
static void Init();
static float2 headingToVectorTable[NUM_HEADINGS];
};
struct shortint2 {
short int x, y;
};
short int GetHeadingFromFacing(int facing);
int GetFacingFromHeading(short int heading);
float GetHeadingFromVectorF(float dx, float dz);
short int GetHeadingFromVector(float dx, float dz);
shortint2 GetHAndPFromVector(const float3& vec); // vec should be normalized
float2 GetHAndPFromVectorF(const float3& vec); // vec should be normalized
float3 GetVectorFromHeading(short int heading);
float3 GetVectorFromHAndPExact(short int heading,short int pitch);
float3 CalcBeizer(float i, const float3& p1, const float3& p2, const float3& p3, const float3& p4);
float LinePointDist(const float3& l1, const float3& l2, const float3& p);
float3 ClosestPointOnLine(const float3& l1, const float3& l2, const float3& p);
/**
* @brief Returns the intersection points of a ray with the map boundary (2d only)
* @param start float3 the start point of the line
* @param dir float3 direction of the ray
* @return <near,far> std::pair<float,float> distance to the intersection points in mulitples of `dir`
*/
std::pair<float,float> GetMapBoundaryIntersectionPoints(const float3& start, const float3& dir);
/**
* @brief clamps a line (start & end points) to the map boundaries
* @param start float3 the start point of the line
* @param end float3 the end point of the line
* @return true if either `end` or `start` was changed
*/
bool ClampLineInMap(float3& start, float3& end);
/**
* @brief clamps a ray (just the end point) to the map boundaries
* @param start const float3 the start point of the line
* @param end float3 the `end` point of the line
* @return true if changed
*/
bool ClampRayInMap(const float3& start, float3& end);
float smoothstep(const float edge0, const float edge1, const float value) _warn_unused_result;
float3 smoothstep(const float edge0, const float edge1, float3 vec) _warn_unused_result;
template<class T> T mix(const T& v1, const T& v2, const float& a) _warn_unused_result;
template<class T> T Blend(const T& v1, const T& v2, const float& a) _warn_unused_result;
template<class T> inline T Blend(const T& v1, const T& v2, const float& a) { return mix(v1, v2, a); }
float Square(const float x) _const _warn_unused_result;
int Round(const float f) _const _warn_unused_result;
template<class T> T Clamp(const T& v, const T& min, const T& max) _warn_unused_result;
/**
* @brief Clamps an radian angle between 0 .. 2*pi
* @param f float* value to clamp
*/
float ClampRad(float f) _const;
/**
* @brief Clamps an radian angle between 0 .. 2*pi
* @param f float* value to clamp
*/
void ClampRad(float* f);
/**
* @brief Checks if 2 radian values discribe the same angle
* @param f1 float* first compare value
* @param f2 float* second compare value
*/
bool RadsAreEqual(const float f1, const float f2) _const;
/**
*/
float GetRadFromXY(const float dx, const float dy) _const;
/**
* convert a color in HS(V) space to RGB
*/
float3 hs2rgb(float h, float s);
#include "myMath.inl"
#undef _const
#endif // MYMATH_H
|
