pandemonium_engine/modules/steering_ai/gsai_utils.cpp

#include "gsai_utils.h"

// Math and vector utility functions.;
// @Category - Utilities;
// Returns the `vector` with its length capped to `limit`.;

Vector3 GSAIUtils::clampedv3(const Vector3 &vector, const float limit) {
	float length_squared = vector.length_squared();
	float limit_squared = limit * limit;

	if (length_squared > limit_squared) {
		vector *= sqrt(limit_squared / length_squared);
	}

	return vector;
}

// Returns an angle in radians between the positive X axis and the `vector`.;
//;
// This assumes orientation for 3D agents that are upright and rotate;
// around the Y axis.;

float GSAIUtils::vector3_to_angle(const Vector3 &vector) {
	return atan2(vector.x, vector.z);
}

// Returns an angle in radians between the positive X axis and the `vector`.;

float GSAIUtils::vector2_to_angle(const Vector2 &vector) {
	return atan2(vector.x, -vector.y);
}

// Returns a directional vector from the given orientation angle.;
//;
// This assumes orientation for 2D agents or 3D agents that are upright and;
// rotate around the Y axis.;

Vector2 GSAIUtils::angle_to_vector2(const float angle) {
	return Vector2(sin(-angle), cos(angle));
}

// Returns a vector2 with `vector`'s x and y components.;

Vector2 GSAIUtils::to_vector2(const Vector3 &vector) {
	return Vector2(vector.x, vector.y);
}

// Returns a vector3 with `vector`'s x and y components and 0 in z.;

Vector3 GSAIUtils::to_vector3(const Vector2 &vector) {
	return Vector3(vector.x, vector.y, 0);
}
}

GSAIUtils::GSAIUtils() {
}

GSAIUtils::~GSAIUtils() {
}

static void GSAIUtils::_bind_methods() {
}