inertia.inl 2.7 KB
Newer Older
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
///////////////////////////////////////////////////////////////////////////////////////////////////
// OpenGL Mathematics Copyright (c) 2005 - 2012 G-Truc Creation (www.g-truc.net)
///////////////////////////////////////////////////////////////////////////////////////////////////
// Created : 2006-04-21
// Updated : 2006-12-06
// Licence : This source is under MIT License
// File    : glm/gtx/inertia.inl
///////////////////////////////////////////////////////////////////////////////////////////////////

namespace glm
{
	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat3x3<T> boxInertia3
	(
		T const & Mass, 
		detail::tvec3<T> const & Scale
	)
	{
		detail::tmat3x3<T> Result(T(1));
		Result[0][0] = (Scale.y * Scale.y + Scale.z * Scale.z) * Mass / T(12);
		Result[1][1] = (Scale.x * Scale.x + Scale.z * Scale.z) * Mass / T(12);
		Result[2][2] = (Scale.x * Scale.x + Scale.y * Scale.y) * Mass / T(12);
		return Result;
	}

	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat4x4<T> boxInertia4
	(
		T const & Mass, 
		detail::tvec3<T> const & Scale
	)
	{
		detail::tmat4x4<T> Result(T(1));
		Result[0][0] = (Scale.y * Scale.y + Scale.z * Scale.z) * Mass / T(12);
		Result[1][1] = (Scale.x * Scale.x + Scale.z * Scale.z) * Mass / T(12);
		Result[2][2] = (Scale.x * Scale.x + Scale.y * Scale.y) * Mass / T(12);
		return Result;
	}

	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat3x3<T> diskInertia3
	(
		T const & Mass, 
		T const & Radius
	)
	{
		T a = Mass * Radius * Radius / T(2);
		detail::tmat3x3<T> Result(a);
		Result[2][2] *= T(2);
		return Result;
	}

	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat4x4<T> diskInertia4
	(
		T const & Mass, 
		T const & Radius
	)
	{
		T a = Mass * Radius * Radius / T(2);
		detail::tmat4x4<T> Result(a);
		Result[2][2] *= T(2);
		Result[3][3] = T(1);
		return Result;
	}

	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat3x3<T> ballInertia3
	(
		T const & Mass, 
		T const & Radius
	)
	{
		T a = T(2) * Mass * Radius * Radius / T(5);
		return detail::tmat3x3<T>(a);
	}

	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat4x4<T> ballInertia4
	(
		T const & Mass, 
		T const & Radius
	)
	{
		T a = T(2) * Mass * Radius * Radius / T(5);
		detail::tmat4x4<T> Result(a);
		Result[3][3] = T(1);
		return Result;
	}

	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat3x3<T> sphereInertia3
	(
		T const & Mass, 
		T const & Radius
	)
	{
		T a = T(2) * Mass * Radius * Radius / T(3);
		return detail::tmat3x3<T>(a);
	}

	template <typename T>
	GLM_FUNC_QUALIFIER detail::tmat4x4<T> sphereInertia4
	(
		T const & Mass, 
		T const & Radius
	)
	{
		T a = T(2) * Mass * Radius * Radius / T(3);
		detail::tmat4x4<T> Result(a);
		Result[3][3] = T(1);
		return Result;
	}
}//namespace glm