Home Explore Help
Sign In
cpp
/
JoltPhysics
mirror of https://github.com/jrouwe/JoltPhysics.git
2
0
Fork 0
Files Issues 0 Wiki
Tree: b8953791f3
Branches Tags
JoltPhysics
/
Samples
/
Tests
/
Test.cpp

Test.cpp 13 KB
History Raw

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183 
  1. // SPDX-FileCopyrightText: 2021 Jorrit Rouwe
    2. 

  2. // SPDX-License-Identifier: MIT
    3. 

  3. 

  4. #include <TestFramework.h>
    5. 

  5. 

  6. #include <Tests/Test.h>
    7. 

  7. #include <Math/Perlin.h>
    8. 

  8. #include <Physics/Collision/Shape/BoxShape.h>
    9. 

  9. #include <Physics/Collision/Shape/MeshShape.h>
    10. 

  10. #include <Physics/Collision/Shape/HeightFieldShape.h>
    11. 

  11. #include <Physics/Body/BodyCreationSettings.h>
    12. 

  12. #include <Layers.h>
    13. 

  13. 

  14. JPH_IMPLEMENT_RTTI_ABSTRACT(Test)
    15. 

  15. {
    16. 

  16. }
    17. 

  17. 

  18. Body &Test::CreateFloor()
    19. 

  19. {
    20. 

  20. 	const float scale = GetWorldScale();
    21. 

  21. 

  22. 	Body &floor = *mBodyInterface->CreateBody(BodyCreationSettings(new BoxShape(scale * Vec3(100.0f, 1.0f, 100.0f), 0.0f), scale * Vec3(0.0f, -1.0f, 0.0f), Quat::sIdentity(), EMotionType::Static, Layers::NON_MOVING));
    23. 

  23. #ifdef _DEBUG
    24. 

  24. 	floor.SetDebugName("Floor");
    25. 

  25. #endif
    26. 

  26. 	mBodyInterface->AddBody(floor.GetID(), EActivation::DontActivate);
    27. 

  27. 	return floor;
    28. 

  28. }
    29. 

  29. 

  30. Body &Test::CreateLargeTriangleFloor()
    31. 

  31. {
    32. 

  32. 	TriangleList triangles = {
    33. 

  33. 		Triangle(Float3(427.941376f, 0.000027f, -456.470642f), Float3(427.941376f, 0.000024f, -399.411774f), Float3(512.0f, 0.000031f, -511.999969f)),
    34. 

  34. 		Triangle(Float3(0.0f, 0.000031f, -511.999969f), Float3(28.529310f, 0.000027f, -456.470642f), Float3(427.941376f, 0.000027f, -456.470642f)),
    35. 

  35. 		Triangle(Float3(427.941376f, 0.000027f, -456.470642f), Float3(512.0f, 0.000031f, -511.999969f), Float3(0.0f, 0.000031f, -511.999969f)),
    36. 

  36. 		Triangle(Float3(285.294067f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(313.823395f, 0.000027f, -456.470642f)),
    37. 

  37. 		Triangle(Float3(313.823395f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(342.352936f, 0.000027f, -456.470642f)),
    38. 

  38. 		Triangle(Float3(342.352936f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(370.882507f, 0.000027f, -456.470642f)),
    39. 

  39. 		Triangle(Float3(399.411804f, 0.000024f, -399.411774f), Float3(427.941376f, 0.000024f, -399.411774f), Float3(370.882507f, 0.000027f, -456.470642f)),
    40. 

  40. 		Triangle(Float3(370.882507f, 0.000027f, -456.470642f), Float3(427.941376f, 0.000024f, -399.411774f), Float3(399.411804f, 0.000027f, -456.470642f)),
    41. 

  41. 		Triangle(Float3(399.411804f, 0.000027f, -456.470642f), Float3(427.941376f, 0.000024f, -399.411774f), Float3(427.941376f, 0.000027f, -456.470642f)),
    42. 

  42. 		Triangle(Float3(256.764771f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(285.294067f, 0.000027f, -456.470642f)),
    43. 

  43. 		Triangle(Float3(85.588173f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(114.117729f, 0.000027f, -456.470642f)),
    44. 

  44. 		Triangle(Float3(114.117729f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(142.647034f, 0.000027f, -456.470642f)),
    45. 

  45. 		Triangle(Float3(142.647034f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(171.176590f, 0.000027f, -456.470642f)),
    46. 

  46. 		Triangle(Float3(171.176590f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(199.705902f, 0.000027f, -456.470642f)),
    47. 

  47. 		Triangle(Float3(199.705902f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(228.235214f, 0.000027f, -456.470642f)),
    48. 

  48. 		Triangle(Float3(228.235214f, 0.000027f, -456.470642f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(256.764771f, 0.000027f, -456.470642f)),
    49. 

  49. 		Triangle(Float3(85.588173f, 0.000024f, -399.411774f), Float3(399.411804f, 0.000024f, -399.411774f), Float3(85.588173f, 0.000027f, -456.470642f)),
    50. 

  50. 		Triangle(Float3(427.941376f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(512.0f, 0.000031f, -511.999969f)),
    51. 

  51. 		Triangle(Float3(399.411804f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(427.941376f, 0.000024f, -399.411774f)),
    52. 

  52. 		Triangle(Float3(285.294067f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(313.823395f, 0.000024f, -399.411774f)),
    53. 

  53. 		Triangle(Float3(313.823395f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(342.352936f, 0.000024f, -399.411774f)),
    54. 

  54. 		Triangle(Float3(342.352936f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(370.882507f, 0.000024f, -399.411774f)),
    55. 

  55. 		Triangle(Float3(370.882507f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(399.411804f, 0.000024f, -399.411774f)),
    56. 

  56. 		Triangle(Float3(256.764771f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(285.294067f, 0.000024f, -399.411774f)),
    57. 

  57. 		Triangle(Float3(228.235214f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(256.764771f, 0.000024f, -399.411774f)),
    58. 

  58. 		Triangle(Float3(199.705902f, 0.000024f, -399.411774f), Float3(512.0f, 0.000019f, -313.823364f), Float3(228.235214f, 0.000024f, -399.411774f)),
    59. 

  59. 		Triangle(Float3(228.235214f, 0.000019f, -313.823364f), Float3(512.0f, 0.000019f, -313.823364f), Float3(199.705902f, 0.000024f, -399.411774f)),
    60. 

  60. 		Triangle(Float3(142.647034f, 0.000024f, -399.411774f), Float3(228.235214f, 0.000019f, -313.823364f), Float3(171.176590f, 0.000024f, -399.411774f)),
    61. 

  61. 		Triangle(Float3(171.176590f, 0.000024f, -399.411774f), Float3(228.235214f, 0.000019f, -313.823364f), Float3(199.705902f, 0.000024f, -399.411774f)),
    62. 

  62. 		Triangle(Float3(85.588173f, 0.000022f, -370.882477f), Float3(228.235214f, 0.000019f, -313.823364f), Float3(142.647034f, 0.000024f, -399.411774f)),
    63. 

  63. 		Triangle(Float3(85.588173f, 0.000022f, -370.882477f), Float3(199.705902f, 0.000019f, -313.823364f), Float3(228.235214f, 0.000019f, -313.823364f)),
    64. 

  64. 		Triangle(Float3(114.117729f, 0.000024f, -399.411774f), Float3(85.588173f, 0.000022f, -370.882477f), Float3(142.647034f, 0.000024f, -399.411774f)),
    65. 

  65. 		Triangle(Float3(85.588173f, 0.000024f, -399.411774f), Float3(85.588173f, 0.000022f, -370.882477f), Float3(114.117729f, 0.000024f, -399.411774f)),
    66. 

  66. 		Triangle(Float3(28.529310f, 0.000019f, -313.823364f), Float3(199.705902f, 0.000019f, -313.823364f), Float3(85.588173f, 0.000022f, -370.882477f)),
    67. 

  67. 		Triangle(Float3(57.058865f, 0.000019f, -313.823364f), Float3(0.0f, 0.000017f, -285.294037f), Float3(85.588173f, 0.000019f, -313.823364f)),
    68. 

  68. 		Triangle(Float3(28.529310f, 0.000019f, -313.823364f), Float3(0.0f, 0.000017f, -285.294037f), Float3(57.058865f, 0.000019f, -313.823364f)),
    69. 

  69. 		Triangle(Float3(28.529310f, 0.000027f, -456.470642f), Float3(0.0f, 0.000017f, -285.294037f), Float3(57.058865f, 0.000027f, -456.470642f)),
    70. 

  70. 		Triangle(Float3(0.0f, 0.000017f, -285.294037f), Float3(28.529310f, 0.000027f, -456.470642f), Float3(0.0f, 0.000031f, -511.999969f)),
    71. 

  71. 		Triangle(Float3(0.0f, 0.000017f, -285.294037f), Float3(85.588173f, 0.000022f, -370.882477f), Float3(85.588173f, 0.000024f, -399.411774f)),
    72. 

  72. 		Triangle(Float3(0.0f, 0.000017f, -285.294037f), Float3(85.588173f, 0.000024f, -399.411774f), Float3(57.058865f, 0.000027f, -456.470642f)),
    73. 

  73. 		Triangle(Float3(57.058865f, 0.000027f, -456.470642f), Float3(85.588173f, 0.000024f, -399.411774f), Float3(85.588173f, 0.000027f, -456.470642f)),
    74. 

  74. 		Triangle(Float3(399.411804f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(456.470673f, 0.000019f, -313.823364f)),
    75. 

  75. 		Triangle(Float3(456.470673f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(512.0f, 0.000019f, -313.823364f)),
    76. 

  76. 		Triangle(Float3(228.235214f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(256.764771f, 0.000019f, -313.823364f)),
    77. 

  77. 		Triangle(Float3(256.764771f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(285.294067f, 0.000019f, -313.823364f)),
    78. 

  78. 		Triangle(Float3(285.294067f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(313.823395f, 0.000019f, -313.823364f)),
    79. 

  79. 		Triangle(Float3(313.823395f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(342.352936f, 0.000019f, -313.823364f)),
    80. 

  80. 		Triangle(Float3(342.352936f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(370.882507f, 0.000019f, -313.823364f)),
    81. 

  81. 		Triangle(Float3(370.882507f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(399.411804f, 0.000019f, -313.823364f)),
    82. 

  82. 		Triangle(Float3(0.0f, 0.000017f, -285.294037f), Float3(0.0f, 0.000009f, -142.647018f), Float3(512.0f, 0.000003f, -57.058861f)),
    83. 

  83. 		Triangle(Float3(199.705902f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(228.235214f, 0.000019f, -313.823364f)),
    84. 

  84. 		Triangle(Float3(171.176590f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(199.705902f, 0.000019f, -313.823364f)),
    85. 

  85. 		Triangle(Float3(0.0f, 0.000017f, -285.294037f), Float3(512.0f, 0.000003f, -57.058861f), Float3(85.588173f, 0.000019f, -313.823364f)),
    86. 

  86. 		Triangle(Float3(85.588173f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(142.647034f, 0.000019f, -313.823364f)),
    87. 

  87. 		Triangle(Float3(142.647034f, 0.000019f, -313.823364f), Float3(512.0f, 0.000003f, -57.058861f), Float3(171.176590f, 0.000019f, -313.823364f)),
    88. 

  88. 		Triangle(Float3(485.0f, 0.000002f, -28.529308f), Float3(512.0f, 0.0f, 0.0f), Float3(512.0f, 0.000002f, -28.529308f)),
    89. 

  89. 		Triangle(Float3(512.0f, 0.0f, 0.0f), Float3(427.941376f, 0.000002f, -28.529308f), Float3(285.294067f, 0.000002f, -28.529308f)),
    90. 

  90. 		Triangle(Float3(456.470673f, 0.000002f, -28.529308f), Float3(512.0f, 0.0f, 0.0f), Float3(485.0f, 0.000002f, -28.529308f)),
    91. 

  91. 		Triangle(Float3(427.941376f, 0.000002f, -28.529308f), Float3(512.0f, 0.0f, 0.0f), Float3(456.470673f, 0.000002f, -28.529308f)),
    92. 

  92. 		Triangle(Float3(171.176590f, 0.0f, 0.0f), Float3(512.0f, 0.0f, 0.0f), Float3(285.294067f, 0.000002f, -28.529308f)),
    93. 

  93. 		Triangle(Float3(285.294067f, 0.000002f, -28.529308f), Float3(512.0f, 0.000002f, -28.529308f), Float3(512.0f, 0.000003f, -57.058861f)),
    94. 

  94. 		Triangle(Float3(0.0f, 0.000009f, -142.647018f), Float3(285.294067f, 0.000002f, -28.529308f), Float3(512.0f, 0.000003f, -57.058861f)),
    95. 

  95. 		Triangle(Float3(0.0f, 0.000007f, -114.117722f), Float3(171.176590f, 0.0f, 0.0f), Float3(0.0f, 0.000009f, -142.647018f)),
    96. 

  96. 		Triangle(Float3(0.0f, 0.0f, 0.0f), Float3(171.176590f, 0.0f, 0.0f), Float3(0.0f, 0.000007f, -114.117722f)),
    97. 

  97. 		Triangle(Float3(0.0f, 0.000009f, -142.647018f), Float3(171.176590f, 0.0f, 0.0f), Float3(285.294067f, 0.000002f, -28.529308f))
    98. 

  98. 	};
    99. 

  99. 	MeshShapeSettings mesh_settings(triangles);
    100. 

  100. 	mesh_settings.SetEmbedded();
    101. 

  101. 	BodyCreationSettings floor_settings(&mesh_settings, Vec3(-256.0f, 0.0f, 256.0f), Quat::sIdentity(), EMotionType::Static, Layers::NON_MOVING);
    102. 

  102. 	Body &floor = *mBodyInterface->CreateBody(floor_settings);
    103. 

  103. #ifdef _DEBUG
    104. 

  104. 	floor.SetDebugName("Floor");
    105. 

  105. #endif
    106. 

  106. 	mBodyInterface->AddBody(floor.GetID(), EActivation::DontActivate);
    107. 

  107. 	return floor;
    108. 

  108. }
    109. 

  109. 

  110. Body &Test::CreateMeshTerrain()
    111. 

  111. {
    112. 

  112. 	const float scale = GetWorldScale();
    113. 

  113. 

  114. #ifdef _DEBUG
    115. 

  115. 	const int n = 50;
    116. 

  116. 	const float cell_size = scale * 2.0f;
    117. 

  117. #else
    118. 

  118. 	const int n = 100;
    119. 

  119. 	const float cell_size = scale * 1.0f;
    120. 

  120. #endif
    121. 

  121. 	const float max_height = scale * 3.0f;
    122. 

  122. 

  123. 	// Create heights
    124. 

  124. 	float heights[n + 1][n + 1];
    125. 

  125. 	for (int x = 0; x <= n; ++x)
    126. 

  126. 		for (int z = 0; z <= n; ++z)
    127. 

  127. 			heights[x][z] = max_height * PerlinNoise3(float(x) * 8.0f / n, 0, float(z) * 8.0f / n, 256, 256, 256);
    128. 

  128. 

  129. 	// Create regular grid of triangles
    130. 

  130. 	TriangleList triangles;
    131. 

  131. 	for (int x = 0; x < n; ++x)
    132. 

  132. 		for (int z = 0; z < n; ++z)
    133. 

  133. 		{
    134. 

  134. 			float center = n * cell_size / 2;
    135. 

  135. 

  136. 			float x1 = cell_size * x - center;
    137. 

  137. 			float z1 = cell_size * z - center;
    138. 

  138. 			float x2 = x1 + cell_size;
    139. 

  139. 			float z2 = z1 + cell_size;
    140. 

  140. 

  141. 			Float3 v1 = Float3(x1, heights[x][z], z1);
    142. 

  142. 			Float3 v2 = Float3(x2, heights[x + 1][z], z1);
    143. 

  143. 			Float3 v3 = Float3(x1, heights[x][z + 1], z2);
    144. 

  144. 			Float3 v4 = Float3(x2, heights[x + 1][z + 1], z2);
    145. 

  145. 

  146. 			triangles.push_back(Triangle(v1, v3, v4));
    147. 

  147. 			triangles.push_back(Triangle(v1, v4, v2));
    148. 

  148. 		}
    149. 

  149. 

  150. 	// Floor
    151. 

  151. 	Body &floor = *mBodyInterface->CreateBody(BodyCreationSettings(new MeshShapeSettings(triangles), Vec3::sZero(), Quat::sIdentity(), EMotionType::Static, Layers::NON_MOVING));
    152. 

  152. #ifdef _DEBUG
    153. 

  153. 	floor.SetDebugName("Terrain");
    154. 

  154. #endif
    155. 

  155. 	mBodyInterface->AddBody(floor.GetID(), EActivation::DontActivate);
    156. 

  156. 	return floor;
    157. 

  157. }
    158. 

  158. 

  159. Body &Test::CreateHeightFieldTerrain()
    160. 

  160. {
    161. 

  161. 	const float scale = GetWorldScale();
    162. 

  162. 

  163. 	const int n = 128;
    164. 

  164. 	const float cell_size = scale * 1.0f;
    165. 

  165. 	const float max_height = scale * 5.0f;
    166. 

  166. 

  167. 	// Create height samples
    168. 

  168. 	float heights[n * n];
    169. 

  169. 	for (int y = 0; y < n; ++y)
    170. 

  170. 		for (int x = 0; x < n; ++x)
    171. 

  171. 			heights[y * n + x] = max_height * PerlinNoise3(float(x) * 8.0f / n, 0, float(y) * 8.0f / n, 256, 256, 256);
    172. 

  172. 

  173. 	// Create height field
    174. 

  174. 	RefConst<ShapeSettings> height_field = new HeightFieldShapeSettings(heights, Vec3(-0.5f * cell_size * n, 0.0f, -0.5f * cell_size * n), Vec3(cell_size, 1.0f, cell_size), n);
    175. 

  175. 

  176. 	// Floor
    177. 

  177. 	Body &floor = *mBodyInterface->CreateBody(BodyCreationSettings(height_field, Vec3::sZero(), Quat::sIdentity(), EMotionType::Static, Layers::NON_MOVING));
    178. 

  178. #ifdef _DEBUG
    179. 

  179. 	floor.SetDebugName("Terrain");
    180. 

  180. #endif
    181. 

  181. 	mBodyInterface->AddBody(floor.GetID(), EActivation::DontActivate);
    182. 

  182. 	return floor;
    183. 

  183. }
    184.