2019-05-29 22:47:33 +00:00
|
|
|
#pragma once
|
2019-05-29 18:02:58 +00:00
|
|
|
|
2019-05-15 14:52:37 +00:00
|
|
|
class CGeneral
|
|
|
|
{
|
|
|
|
public:
|
|
|
|
static float GetATanOfXY(float x, float y){
|
2019-05-29 16:06:33 +00:00
|
|
|
if(x == 0.0f && y == 0.0f)
|
|
|
|
return 0.0f;
|
2019-07-10 15:18:26 +00:00
|
|
|
float xabs = Abs(x);
|
|
|
|
float yabs = Abs(y);
|
2019-05-29 16:06:33 +00:00
|
|
|
|
|
|
|
if(xabs < yabs){
|
|
|
|
if(y > 0.0f){
|
|
|
|
if(x > 0.0f)
|
2019-07-10 15:18:26 +00:00
|
|
|
return 0.5f*PI - Atan2(x / y, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
else
|
2019-07-10 15:18:26 +00:00
|
|
|
return 0.5f*PI + Atan2(-x / y, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
}else{
|
|
|
|
if(x > 0.0f)
|
2019-07-10 15:18:26 +00:00
|
|
|
return 1.5f*PI + Atan2(x / -y, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
else
|
2019-07-10 15:18:26 +00:00
|
|
|
return 1.5f*PI - Atan2(-x / -y, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
}
|
|
|
|
}else{
|
|
|
|
if(y > 0.0f){
|
|
|
|
if(x > 0.0f)
|
2019-07-10 15:18:26 +00:00
|
|
|
return Atan2(y / x, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
else
|
2019-07-10 15:18:26 +00:00
|
|
|
return PI - Atan2(y / -x, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
}else{
|
|
|
|
if(x > 0.0f)
|
2019-07-10 15:18:26 +00:00
|
|
|
return 2.0f*PI - Atan2(-y / x, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
else
|
2019-07-10 15:18:26 +00:00
|
|
|
return PI + Atan2(-y / -x, 1.0f);
|
2019-05-29 16:06:33 +00:00
|
|
|
}
|
|
|
|
}
|
2019-05-15 14:52:37 +00:00
|
|
|
}
|
|
|
|
|
2019-07-15 12:11:40 +00:00
|
|
|
static float LimitAngle(float angle)
|
|
|
|
{
|
|
|
|
float result = angle;
|
|
|
|
|
|
|
|
while (result >= 180.0f) {
|
|
|
|
result -= 2 * 180.0f;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (result < -180.0f) {
|
|
|
|
result += 2 * 180.0f;
|
|
|
|
}
|
|
|
|
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2019-06-20 11:22:44 +00:00
|
|
|
static float LimitRadianAngle(float angle)
|
|
|
|
{
|
2019-09-16 17:32:58 +00:00
|
|
|
float result = clamp(angle, -25.0f, 25.0f);
|
2019-06-20 11:22:44 +00:00
|
|
|
|
|
|
|
while (result >= PI) {
|
|
|
|
result -= 2 * PI;
|
|
|
|
}
|
|
|
|
|
|
|
|
while (result < -PI) {
|
|
|
|
result += 2 * PI;
|
|
|
|
}
|
|
|
|
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
|
2019-08-09 17:42:18 +00:00
|
|
|
// Returns an angle such that x2/y2 looks at x1/y1 with its forward vector if rotated by that angle
|
2019-06-20 11:22:44 +00:00
|
|
|
static float GetRadianAngleBetweenPoints(float x1, float y1, float x2, float y2)
|
|
|
|
{
|
|
|
|
float x = x2 - x1;
|
|
|
|
float y = y2 - y1;
|
|
|
|
|
|
|
|
if (y == 0.0f)
|
|
|
|
y = 0.0001f;
|
|
|
|
|
|
|
|
if (x > 0.0f) {
|
|
|
|
if (y > 0.0f)
|
2019-07-10 15:18:26 +00:00
|
|
|
return PI - Atan2(x / y, 1.0f);
|
2019-06-20 11:22:44 +00:00
|
|
|
else
|
2019-07-10 15:34:11 +00:00
|
|
|
return -Atan2(x / y, 1.0f);
|
2019-06-20 11:22:44 +00:00
|
|
|
} else {
|
|
|
|
if (y > 0.0f)
|
2019-07-10 15:18:26 +00:00
|
|
|
return -(PI + Atan2(x / y, 1.0f));
|
2019-06-20 11:22:44 +00:00
|
|
|
else
|
2019-07-10 15:34:11 +00:00
|
|
|
return -Atan2(x / y, 1.0f);
|
2019-06-20 11:22:44 +00:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2019-08-10 15:15:22 +00:00
|
|
|
// should return direction in 0-8 range. fits perfectly to peds' path directions.
|
2019-08-16 18:17:15 +00:00
|
|
|
static int GetNodeHeadingFromVector(float x, float y)
|
2019-08-10 15:15:22 +00:00
|
|
|
{
|
|
|
|
float angle = CGeneral::GetRadianAngleBetweenPoints(x, y, 0.0f, 0.0f);
|
|
|
|
if (angle < 0.0f)
|
|
|
|
angle += TWOPI;
|
|
|
|
|
|
|
|
angle = DEGTORAD(22.5f) + TWOPI - angle;
|
|
|
|
|
|
|
|
if (angle >= TWOPI)
|
|
|
|
angle -= TWOPI;
|
|
|
|
|
|
|
|
return (int)floorf(angle / DEGTORAD(45.0f));
|
|
|
|
}
|
|
|
|
|
2019-05-15 14:52:37 +00:00
|
|
|
// not too sure about all these...
|
|
|
|
static uint16 GetRandomNumber(void)
|
2019-07-04 21:10:04 +00:00
|
|
|
{ return myrand() & MYRAND_MAX; }
|
2019-08-10 07:44:19 +00:00
|
|
|
static bool GetRandomTrueFalse(void)
|
|
|
|
{ return GetRandomNumber() < MYRAND_MAX / 2; }
|
2019-05-15 14:52:37 +00:00
|
|
|
// Probably don't want to ever reach high
|
|
|
|
static float GetRandomNumberInRange(float low, float high)
|
2019-05-30 21:49:06 +00:00
|
|
|
{ return low + (high - low)*(GetRandomNumber()/float(MYRAND_MAX + 1)); }
|
2019-05-29 18:02:58 +00:00
|
|
|
|
2019-06-16 22:16:38 +00:00
|
|
|
static int32 GetRandomNumberInRange(int32 low, int32 high)
|
2019-05-30 21:49:06 +00:00
|
|
|
{ return low + (high - low)*(GetRandomNumber()/float(MYRAND_MAX + 1)); }
|
2019-05-15 14:52:37 +00:00
|
|
|
};
|