BSTerrainManager.cs 26 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585
  1. /*
  2. * Copyright (c) Contributors, http://opensimulator.org/
  3. * See CONTRIBUTORS.TXT for a full list of copyright holders.
  4. *
  5. * Redistribution and use in source and binary forms, with or without
  6. * modification, are permitted provided that the following conditions are met:
  7. * * Redistributions of source code must retain the above copyright
  8. * notice, this list of conditions and the following disclaimer.
  9. * * Redistributions in binary form must reproduce the above copyrightD
  10. * notice, this list of conditions and the following disclaimer in the
  11. * documentation and/or other materials provided with the distribution.
  12. * * Neither the name of the OpenSimulator Project nor the
  13. * names of its contributors may be used to endorse or promote products
  14. * derived from this software without specific prior written permission.
  15. *
  16. * THIS SOFTWARE IS PROVIDED BY THE DEVELOPERS ``AS IS'' AND ANY
  17. * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
  18. * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
  19. * DISCLAIMED. IN NO EVENT SHALL THE CONTRIBUTORS BE LIABLE FOR ANY
  20. * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  21. * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
  22. * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
  23. * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  24. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
  25. * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  26. */
  27. using System;
  28. using System.Collections.Generic;
  29. using System.Text;
  30. using OpenSim.Framework;
  31. using OpenSim.Region.Framework;
  32. using OpenSim.Region.CoreModules;
  33. using OpenSim.Region.Physics.Manager;
  34. using Nini.Config;
  35. using log4net;
  36. using OpenMetaverse;
  37. namespace OpenSim.Region.Physics.BulletSPlugin
  38. {
  39. // The physical implementation of the terrain is wrapped in this class.
  40. public abstract class BSTerrainPhys : IDisposable
  41. {
  42. public enum TerrainImplementation
  43. {
  44. Heightmap = 0,
  45. Mesh = 1
  46. }
  47. protected BSScene m_physicsScene { get; private set; }
  48. // Base of the region in world coordinates. Coordinates inside the region are relative to this.
  49. public Vector3 TerrainBase { get; private set; }
  50. public uint ID { get; private set; }
  51. public BSTerrainPhys(BSScene physicsScene, Vector3 regionBase, uint id)
  52. {
  53. m_physicsScene = physicsScene;
  54. TerrainBase = regionBase;
  55. ID = id;
  56. }
  57. public abstract void Dispose();
  58. public abstract float GetTerrainHeightAtXYZ(Vector3 pos);
  59. public abstract float GetWaterLevelAtXYZ(Vector3 pos);
  60. }
  61. // ==========================================================================================
  62. public sealed class BSTerrainManager : IDisposable
  63. {
  64. static string LogHeader = "[BULLETSIM TERRAIN MANAGER]";
  65. // These height values are fractional so the odd values will be
  66. // noticable when debugging.
  67. public const float HEIGHT_INITIALIZATION = 24.987f;
  68. public const float HEIGHT_INITIAL_LASTHEIGHT = 24.876f;
  69. public const float HEIGHT_GETHEIGHT_RET = 24.765f;
  70. public const float WATER_HEIGHT_GETHEIGHT_RET = 19.998f;
  71. // If the min and max height are equal, we reduce the min by this
  72. // amount to make sure that a bounding box is built for the terrain.
  73. public const float HEIGHT_EQUAL_FUDGE = 0.2f;
  74. // Until the whole simulator is changed to pass us the region size, we rely on constants.
  75. public Vector3 DefaultRegionSize = new Vector3(Constants.RegionSize, Constants.RegionSize, Constants.RegionHeight);
  76. // The scene that I am part of
  77. private BSScene m_physicsScene { get; set; }
  78. // The ground plane created to keep thing from falling to infinity.
  79. private BulletBody m_groundPlane;
  80. // If doing mega-regions, if we're region zero we will be managing multiple
  81. // region terrains since region zero does the physics for the whole mega-region.
  82. private Dictionary<Vector3, BSTerrainPhys> m_terrains;
  83. // Flags used to know when to recalculate the height.
  84. private bool m_terrainModified = false;
  85. // If we are doing mega-regions, terrains are added from TERRAIN_ID to m_terrainCount.
  86. // This is incremented before assigning to new region so it is the last ID allocated.
  87. private uint m_terrainCount = BSScene.CHILDTERRAIN_ID - 1;
  88. public uint HighestTerrainID { get {return m_terrainCount; } }
  89. // If doing mega-regions, this holds our offset from region zero of
  90. // the mega-regions. "parentScene" points to the PhysicsScene of region zero.
  91. private Vector3 m_worldOffset;
  92. // If the parent region (region 0), this is the extent of the combined regions
  93. // relative to the origin of region zero
  94. private Vector3 m_worldMax;
  95. private PhysicsScene MegaRegionParentPhysicsScene { get; set; }
  96. public BSTerrainManager(BSScene physicsScene, Vector3 regionSize)
  97. {
  98. m_physicsScene = physicsScene;
  99. DefaultRegionSize = regionSize;
  100. m_terrains = new Dictionary<Vector3,BSTerrainPhys>();
  101. // Assume one region of default size
  102. m_worldOffset = Vector3.Zero;
  103. m_worldMax = new Vector3(DefaultRegionSize);
  104. MegaRegionParentPhysicsScene = null;
  105. }
  106. public void Dispose()
  107. {
  108. ReleaseGroundPlaneAndTerrain();
  109. }
  110. // Create the initial instance of terrain and the underlying ground plane.
  111. // This is called from the initialization routine so we presume it is
  112. // safe to call Bullet in real time. We hope no one is moving prims around yet.
  113. public void CreateInitialGroundPlaneAndTerrain()
  114. {
  115. DetailLog("{0},BSTerrainManager.CreateInitialGroundPlaneAndTerrain,region={1}", BSScene.DetailLogZero, m_physicsScene.RegionName);
  116. // The ground plane is here to catch things that are trying to drop to negative infinity
  117. BulletShape groundPlaneShape = m_physicsScene.PE.CreateGroundPlaneShape(BSScene.GROUNDPLANE_ID, 1f, BSParam.TerrainCollisionMargin);
  118. Vector3 groundPlaneAltitude = new Vector3(0f, 0f, BSParam.TerrainGroundPlane);
  119. m_groundPlane = m_physicsScene.PE.CreateBodyWithDefaultMotionState(groundPlaneShape,
  120. BSScene.GROUNDPLANE_ID, groundPlaneAltitude, Quaternion.Identity);
  121. // Everything collides with the ground plane.
  122. m_groundPlane.collisionType = CollisionType.Groundplane;
  123. m_physicsScene.PE.AddObjectToWorld(m_physicsScene.World, m_groundPlane);
  124. m_physicsScene.PE.UpdateSingleAabb(m_physicsScene.World, m_groundPlane);
  125. // Ground plane does not move
  126. m_physicsScene.PE.ForceActivationState(m_groundPlane, ActivationState.DISABLE_SIMULATION);
  127. BSTerrainPhys initialTerrain = new BSTerrainHeightmap(m_physicsScene, Vector3.Zero, BSScene.TERRAIN_ID, DefaultRegionSize);
  128. lock (m_terrains)
  129. {
  130. // Build an initial terrain and put it in the world. This quickly gets replaced by the real region terrain.
  131. m_terrains.Add(Vector3.Zero, initialTerrain);
  132. }
  133. }
  134. // Release all the terrain structures we might have allocated
  135. public void ReleaseGroundPlaneAndTerrain()
  136. {
  137. DetailLog("{0},BSTerrainManager.ReleaseGroundPlaneAndTerrain,region={1}", BSScene.DetailLogZero, m_physicsScene.RegionName);
  138. if (m_groundPlane.HasPhysicalBody)
  139. {
  140. if (m_physicsScene.PE.RemoveObjectFromWorld(m_physicsScene.World, m_groundPlane))
  141. {
  142. m_physicsScene.PE.DestroyObject(m_physicsScene.World, m_groundPlane);
  143. }
  144. m_groundPlane.Clear();
  145. }
  146. ReleaseTerrain();
  147. }
  148. // Release all the terrain we have allocated
  149. public void ReleaseTerrain()
  150. {
  151. lock (m_terrains)
  152. {
  153. foreach (KeyValuePair<Vector3, BSTerrainPhys> kvp in m_terrains)
  154. {
  155. kvp.Value.Dispose();
  156. }
  157. m_terrains.Clear();
  158. }
  159. }
  160. // The simulator wants to set a new heightmap for the terrain.
  161. public void SetTerrain(float[] heightMap) {
  162. float[] localHeightMap = heightMap;
  163. // If there are multiple requests for changes to the same terrain between ticks,
  164. // only do that last one.
  165. m_physicsScene.PostTaintObject("TerrainManager.SetTerrain-"+ m_worldOffset.ToString(), 0, delegate()
  166. {
  167. if (m_worldOffset != Vector3.Zero && MegaRegionParentPhysicsScene != null)
  168. {
  169. // If a child of a mega-region, we shouldn't have any terrain allocated for us
  170. ReleaseGroundPlaneAndTerrain();
  171. // If doing the mega-prim stuff and we are the child of the zero region,
  172. // the terrain is added to our parent
  173. if (MegaRegionParentPhysicsScene is BSScene)
  174. {
  175. DetailLog("{0},SetTerrain.ToParent,offset={1},worldMax={2}", BSScene.DetailLogZero, m_worldOffset, m_worldMax);
  176. ((BSScene)MegaRegionParentPhysicsScene).TerrainManager.AddMegaRegionChildTerrain(
  177. BSScene.CHILDTERRAIN_ID, localHeightMap, m_worldOffset, m_worldOffset + DefaultRegionSize);
  178. }
  179. }
  180. else
  181. {
  182. // If not doing the mega-prim thing, just change the terrain
  183. DetailLog("{0},SetTerrain.Existing", BSScene.DetailLogZero);
  184. UpdateTerrain(BSScene.TERRAIN_ID, localHeightMap, m_worldOffset, m_worldOffset + DefaultRegionSize);
  185. }
  186. });
  187. }
  188. // Another region is calling this region and passing a terrain.
  189. // A region that is not the mega-region root will pass its terrain to the root region so the root region
  190. // physics engine will have all the terrains.
  191. private void AddMegaRegionChildTerrain(uint id, float[] heightMap, Vector3 minCoords, Vector3 maxCoords)
  192. {
  193. // Since we are called by another region's thread, the action must be rescheduled onto our processing thread.
  194. m_physicsScene.PostTaintObject("TerrainManager.AddMegaRegionChild" + minCoords.ToString(), id, delegate()
  195. {
  196. UpdateTerrain(id, heightMap, minCoords, maxCoords);
  197. });
  198. }
  199. // If called for terrain has has not been previously allocated, a new terrain will be built
  200. // based on the passed information. The 'id' should be either the terrain id or
  201. // BSScene.CHILDTERRAIN_ID. If the latter, a new child terrain ID will be allocated and used.
  202. // The latter feature is for creating child terrains for mega-regions.
  203. // If there is an existing terrain body, a new
  204. // terrain shape is created and added to the body.
  205. // This call is most often used to update the heightMap and parameters of the terrain.
  206. // (The above does suggest that some simplification/refactoring is in order.)
  207. // Called during taint-time.
  208. private void UpdateTerrain(uint id, float[] heightMap, Vector3 minCoords, Vector3 maxCoords)
  209. {
  210. // Find high and low points of passed heightmap.
  211. // The min and max passed in is usually the area objects can be in (maximum
  212. // object height, for instance). The terrain wants the bounding box for the
  213. // terrain so replace passed min and max Z with the actual terrain min/max Z.
  214. float minZ = float.MaxValue;
  215. float maxZ = float.MinValue;
  216. foreach (float height in heightMap)
  217. {
  218. if (height < minZ) minZ = height;
  219. if (height > maxZ) maxZ = height;
  220. }
  221. if (minZ == maxZ)
  222. {
  223. // If min and max are the same, reduce min a little bit so a good bounding box is created.
  224. minZ -= BSTerrainManager.HEIGHT_EQUAL_FUDGE;
  225. }
  226. minCoords.Z = minZ;
  227. maxCoords.Z = maxZ;
  228. DetailLog("{0},BSTerrainManager.UpdateTerrain,call,id={1},minC={2},maxC={3}",
  229. BSScene.DetailLogZero, id, minCoords, maxCoords);
  230. Vector3 terrainRegionBase = new Vector3(minCoords.X, minCoords.Y, 0f);
  231. lock (m_terrains)
  232. {
  233. BSTerrainPhys terrainPhys;
  234. if (m_terrains.TryGetValue(terrainRegionBase, out terrainPhys))
  235. {
  236. // There is already a terrain in this spot. Free the old and build the new.
  237. DetailLog("{0},BSTerrainManager.UpdateTerrain:UpdateExisting,call,id={1},base={2},minC={3},maxC={4}",
  238. BSScene.DetailLogZero, id, terrainRegionBase, minCoords, maxCoords);
  239. // Remove old terrain from the collection
  240. m_terrains.Remove(terrainRegionBase);
  241. // Release any physical memory it may be using.
  242. terrainPhys.Dispose();
  243. if (MegaRegionParentPhysicsScene == null)
  244. {
  245. // This terrain is not part of the mega-region scheme. Create vanilla terrain.
  246. BSTerrainPhys newTerrainPhys = BuildPhysicalTerrain(terrainRegionBase, id, heightMap, minCoords, maxCoords);
  247. m_terrains.Add(terrainRegionBase, newTerrainPhys);
  248. m_terrainModified = true;
  249. }
  250. else
  251. {
  252. // It's possible that Combine() was called after this code was queued.
  253. // If we are a child of combined regions, we don't create any terrain for us.
  254. DetailLog("{0},BSTerrainManager.UpdateTerrain:AmACombineChild,taint", BSScene.DetailLogZero);
  255. // Get rid of any terrain that may have been allocated for us.
  256. ReleaseGroundPlaneAndTerrain();
  257. // I hate doing this, but just bail
  258. return;
  259. }
  260. }
  261. else
  262. {
  263. // We don't know about this terrain so either we are creating a new terrain or
  264. // our mega-prim child is giving us a new terrain to add to the phys world
  265. // if this is a child terrain, calculate a unique terrain id
  266. uint newTerrainID = id;
  267. if (newTerrainID >= BSScene.CHILDTERRAIN_ID)
  268. newTerrainID = ++m_terrainCount;
  269. DetailLog("{0},BSTerrainManager.UpdateTerrain:NewTerrain,taint,newID={1},minCoord={2},maxCoord={3}",
  270. BSScene.DetailLogZero, newTerrainID, minCoords, maxCoords);
  271. BSTerrainPhys newTerrainPhys = BuildPhysicalTerrain(terrainRegionBase, id, heightMap, minCoords, maxCoords);
  272. m_terrains.Add(terrainRegionBase, newTerrainPhys);
  273. m_terrainModified = true;
  274. }
  275. }
  276. }
  277. // TODO: redo terrain implementation selection to allow other base types than heightMap.
  278. private BSTerrainPhys BuildPhysicalTerrain(Vector3 terrainRegionBase, uint id, float[] heightMap, Vector3 minCoords, Vector3 maxCoords)
  279. {
  280. m_physicsScene.Logger.DebugFormat("{0} Terrain for {1}/{2} created with {3}",
  281. LogHeader, m_physicsScene.RegionName, terrainRegionBase,
  282. (BSTerrainPhys.TerrainImplementation)BSParam.TerrainImplementation);
  283. BSTerrainPhys newTerrainPhys = null;
  284. switch ((int)BSParam.TerrainImplementation)
  285. {
  286. case (int)BSTerrainPhys.TerrainImplementation.Heightmap:
  287. newTerrainPhys = new BSTerrainHeightmap(m_physicsScene, terrainRegionBase, id,
  288. heightMap, minCoords, maxCoords);
  289. break;
  290. case (int)BSTerrainPhys.TerrainImplementation.Mesh:
  291. newTerrainPhys = new BSTerrainMesh(m_physicsScene, terrainRegionBase, id,
  292. heightMap, minCoords, maxCoords);
  293. break;
  294. default:
  295. m_physicsScene.Logger.ErrorFormat("{0} Bad terrain implementation specified. Type={1}/{2},Region={3}/{4}",
  296. LogHeader,
  297. (int)BSParam.TerrainImplementation,
  298. BSParam.TerrainImplementation,
  299. m_physicsScene.RegionName, terrainRegionBase);
  300. break;
  301. }
  302. return newTerrainPhys;
  303. }
  304. // Return 'true' of this position is somewhere in known physical terrain space
  305. public bool IsWithinKnownTerrain(Vector3 pos)
  306. {
  307. Vector3 terrainBaseXYZ;
  308. BSTerrainPhys physTerrain;
  309. return GetTerrainPhysicalAtXYZ(pos, out physTerrain, out terrainBaseXYZ);
  310. }
  311. // Return a new position that is over known terrain if the position is outside our terrain.
  312. public Vector3 ClampPositionIntoKnownTerrain(Vector3 pPos)
  313. {
  314. float edgeEpsilon = 0.1f;
  315. Vector3 ret = pPos;
  316. // First, base addresses are never negative so correct for that possible problem.
  317. if (ret.X < 0f || ret.Y < 0f)
  318. {
  319. ret.X = Util.Clamp<float>(ret.X, 0f, 1000000f);
  320. ret.Y = Util.Clamp<float>(ret.Y, 0f, 1000000f);
  321. DetailLog("{0},BSTerrainManager.ClampPositionToKnownTerrain,zeroingNegXorY,oldPos={1},newPos={2}",
  322. BSScene.DetailLogZero, pPos, ret);
  323. }
  324. // Can't do this function if we don't know about any terrain.
  325. if (m_terrains.Count == 0)
  326. return ret;
  327. int loopPrevention = 10;
  328. Vector3 terrainBaseXYZ;
  329. BSTerrainPhys physTerrain;
  330. while (!GetTerrainPhysicalAtXYZ(ret, out physTerrain, out terrainBaseXYZ))
  331. {
  332. // The passed position is not within a known terrain area.
  333. // NOTE that GetTerrainPhysicalAtXYZ will set 'terrainBaseXYZ' to the base of the unfound region.
  334. // Must be off the top of a region. Find an adjacent region to move into.
  335. // The returned terrain is always 'lower'. That is, closer to <0,0>.
  336. Vector3 adjacentTerrainBase = FindAdjacentTerrainBase(terrainBaseXYZ);
  337. if (adjacentTerrainBase.X < terrainBaseXYZ.X)
  338. {
  339. // moving down into a new region in the X dimension. New position will be the max in the new base.
  340. ret.X = adjacentTerrainBase.X + DefaultRegionSize.X - edgeEpsilon;
  341. }
  342. if (adjacentTerrainBase.Y < terrainBaseXYZ.Y)
  343. {
  344. // moving down into a new region in the X dimension. New position will be the max in the new base.
  345. ret.Y = adjacentTerrainBase.Y + DefaultRegionSize.Y - edgeEpsilon;
  346. }
  347. DetailLog("{0},BSTerrainManager.ClampPositionToKnownTerrain,findingAdjacentRegion,adjacentRegBase={1},oldPos={2},newPos={3}",
  348. BSScene.DetailLogZero, adjacentTerrainBase, pPos, ret);
  349. if (loopPrevention-- < 0f)
  350. {
  351. // The 'while' is a little dangerous so this prevents looping forever if the
  352. // mapping of the terrains ever gets messed up (like nothing at <0,0>) or
  353. // the list of terrains is in transition.
  354. DetailLog("{0},BSTerrainManager.ClampPositionToKnownTerrain,suppressingFindAdjacentRegionLoop", BSScene.DetailLogZero);
  355. break;
  356. }
  357. }
  358. return ret;
  359. }
  360. // Given an X and Y, find the height of the terrain.
  361. // Since we could be handling multiple terrains for a mega-region,
  362. // the base of the region is calcuated assuming all regions are
  363. // the same size and that is the default.
  364. // Once the heightMapInfo is found, we have all the information to
  365. // compute the offset into the array.
  366. private float lastHeightTX = 999999f;
  367. private float lastHeightTY = 999999f;
  368. private float lastHeight = HEIGHT_INITIAL_LASTHEIGHT;
  369. public float GetTerrainHeightAtXYZ(Vector3 pos)
  370. {
  371. float tX = pos.X;
  372. float tY = pos.Y;
  373. // You'd be surprized at the number of times this routine is called
  374. // with the same parameters as last time.
  375. if (!m_terrainModified && (lastHeightTX == tX) && (lastHeightTY == tY))
  376. return lastHeight;
  377. m_terrainModified = false;
  378. lastHeightTX = tX;
  379. lastHeightTY = tY;
  380. float ret = HEIGHT_GETHEIGHT_RET;
  381. Vector3 terrainBaseXYZ;
  382. BSTerrainPhys physTerrain;
  383. if (GetTerrainPhysicalAtXYZ(pos, out physTerrain, out terrainBaseXYZ))
  384. {
  385. ret = physTerrain.GetTerrainHeightAtXYZ(pos - terrainBaseXYZ);
  386. }
  387. else
  388. {
  389. m_physicsScene.Logger.ErrorFormat("{0} GetTerrainHeightAtXY: terrain not found: region={1}, x={2}, y={3}",
  390. LogHeader, m_physicsScene.RegionName, tX, tY);
  391. DetailLog("{0},BSTerrainManager.GetTerrainHeightAtXYZ,terrainNotFound,pos={1},base={2}",
  392. BSScene.DetailLogZero, pos, terrainBaseXYZ);
  393. }
  394. lastHeight = ret;
  395. return ret;
  396. }
  397. public float GetWaterLevelAtXYZ(Vector3 pos)
  398. {
  399. float ret = WATER_HEIGHT_GETHEIGHT_RET;
  400. Vector3 terrainBaseXYZ;
  401. BSTerrainPhys physTerrain;
  402. if (GetTerrainPhysicalAtXYZ(pos, out physTerrain, out terrainBaseXYZ))
  403. {
  404. ret = physTerrain.GetWaterLevelAtXYZ(pos);
  405. }
  406. else
  407. {
  408. m_physicsScene.Logger.ErrorFormat("{0} GetWaterHeightAtXY: terrain not found: pos={1}, terrainBase={2}, height={3}",
  409. LogHeader, m_physicsScene.RegionName, pos, terrainBaseXYZ, ret);
  410. }
  411. return ret;
  412. }
  413. // Given an address, return 'true' of there is a description of that terrain and output
  414. // the descriptor class and the 'base' fo the addresses therein.
  415. private bool GetTerrainPhysicalAtXYZ(Vector3 pos, out BSTerrainPhys outPhysTerrain, out Vector3 outTerrainBase)
  416. {
  417. bool ret = false;
  418. Vector3 terrainBaseXYZ = Vector3.Zero;
  419. if (pos.X < 0f || pos.Y < 0f)
  420. {
  421. // We don't handle negative addresses so just make up a base that will not be found.
  422. terrainBaseXYZ = new Vector3(-DefaultRegionSize.X, -DefaultRegionSize.Y, 0f);
  423. }
  424. else
  425. {
  426. int offsetX = ((int)(pos.X / (int)DefaultRegionSize.X)) * (int)DefaultRegionSize.X;
  427. int offsetY = ((int)(pos.Y / (int)DefaultRegionSize.Y)) * (int)DefaultRegionSize.Y;
  428. terrainBaseXYZ = new Vector3(offsetX, offsetY, 0f);
  429. }
  430. BSTerrainPhys physTerrain = null;
  431. lock (m_terrains)
  432. {
  433. ret = m_terrains.TryGetValue(terrainBaseXYZ, out physTerrain);
  434. }
  435. outTerrainBase = terrainBaseXYZ;
  436. outPhysTerrain = physTerrain;
  437. return ret;
  438. }
  439. // Given a terrain base, return a terrain base for a terrain that is closer to <0,0> than
  440. // this one. Usually used to return an out of bounds object to a known place.
  441. private Vector3 FindAdjacentTerrainBase(Vector3 pTerrainBase)
  442. {
  443. Vector3 ret = pTerrainBase;
  444. // Can't do this function if we don't know about any terrain.
  445. if (m_terrains.Count == 0)
  446. return ret;
  447. // Just some sanity
  448. ret.X = Util.Clamp<float>(ret.X, 0f, 1000000f);
  449. ret.Y = Util.Clamp<float>(ret.Y, 0f, 1000000f);
  450. ret.Z = 0f;
  451. lock (m_terrains)
  452. {
  453. // Once down to the <0,0> region, we have to be done.
  454. while (ret.X > 0f || ret.Y > 0f)
  455. {
  456. if (ret.X > 0f)
  457. {
  458. ret.X = Math.Max(0f, ret.X - DefaultRegionSize.X);
  459. DetailLog("{0},BSTerrainManager.FindAdjacentTerrainBase,reducingX,terrainBase={1}", BSScene.DetailLogZero, ret);
  460. if (m_terrains.ContainsKey(ret))
  461. break;
  462. }
  463. if (ret.Y > 0f)
  464. {
  465. ret.Y = Math.Max(0f, ret.Y - DefaultRegionSize.Y);
  466. DetailLog("{0},BSTerrainManager.FindAdjacentTerrainBase,reducingY,terrainBase={1}", BSScene.DetailLogZero, ret);
  467. if (m_terrains.ContainsKey(ret))
  468. break;
  469. }
  470. }
  471. }
  472. return ret;
  473. }
  474. // Although no one seems to check this, I do support combining.
  475. public bool SupportsCombining()
  476. {
  477. return true;
  478. }
  479. // This routine is called two ways:
  480. // One with 'offset' and 'pScene' zero and null but 'extents' giving the maximum
  481. // extent of the combined regions. This is to inform the parent of the size
  482. // of the combined regions.
  483. // and one with 'offset' as the offset of the child region to the base region,
  484. // 'pScene' pointing to the parent and 'extents' of zero. This informs the
  485. // child of its relative base and new parent.
  486. public void Combine(PhysicsScene pScene, Vector3 offset, Vector3 extents)
  487. {
  488. m_worldOffset = offset;
  489. m_worldMax = extents;
  490. MegaRegionParentPhysicsScene = pScene;
  491. if (pScene != null)
  492. {
  493. // We are a child.
  494. // We want m_worldMax to be the highest coordinate of our piece of terrain.
  495. m_worldMax = offset + DefaultRegionSize;
  496. }
  497. DetailLog("{0},BSTerrainManager.Combine,offset={1},extents={2},wOffset={3},wMax={4}",
  498. BSScene.DetailLogZero, offset, extents, m_worldOffset, m_worldMax);
  499. }
  500. // Unhook all the combining that I know about.
  501. public void UnCombine(PhysicsScene pScene)
  502. {
  503. // Just like ODE, we don't do anything yet.
  504. DetailLog("{0},BSTerrainManager.UnCombine", BSScene.DetailLogZero);
  505. }
  506. private void DetailLog(string msg, params Object[] args)
  507. {
  508. m_physicsScene.PhysicsLogging.Write(msg, args);
  509. }
  510. }
  511. }