POSScene.cs 9.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270
  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 copyright
  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 Nini.Config;
  30. using OpenMetaverse;
  31. using OpenSim.Framework;
  32. using OpenSim.Region.Physics.Manager;
  33. namespace OpenSim.Region.Physics.POSPlugin
  34. {
  35. public class POSScene : PhysicsScene
  36. {
  37. private List<POSCharacter> _characters = new List<POSCharacter>();
  38. private List<POSPrim> _prims = new List<POSPrim>();
  39. private float[] _heightMap;
  40. private const float gravity = -9.8f;
  41. //protected internal string sceneIdentifier;
  42. public POSScene(String _sceneIdentifier)
  43. {
  44. //sceneIdentifier = _sceneIdentifier;
  45. }
  46. public override void Initialise(IMesher meshmerizer, IConfigSource config)
  47. {
  48. }
  49. public override void Dispose()
  50. {
  51. }
  52. public override PhysicsActor AddAvatar(string avName, Vector3 position, Vector3 size, bool isFlying)
  53. {
  54. POSCharacter act = new POSCharacter();
  55. act.Position = position;
  56. act.Flying = isFlying;
  57. _characters.Add(act);
  58. return act;
  59. }
  60. public override void RemovePrim(PhysicsActor prim)
  61. {
  62. POSPrim p = (POSPrim) prim;
  63. if (_prims.Contains(p))
  64. {
  65. _prims.Remove(p);
  66. }
  67. }
  68. public override void RemoveAvatar(PhysicsActor character)
  69. {
  70. POSCharacter act = (POSCharacter) character;
  71. if (_characters.Contains(act))
  72. {
  73. _characters.Remove(act);
  74. }
  75. }
  76. /*
  77. public override PhysicsActor AddPrim(Vector3 position, Vector3 size, Quaternion rotation)
  78. {
  79. return null;
  80. }
  81. */
  82. public override PhysicsActor AddPrimShape(string primName, PrimitiveBaseShape pbs, Vector3 position,
  83. Vector3 size, Quaternion rotation, bool isPhysical, uint localid)
  84. {
  85. POSPrim prim = new POSPrim();
  86. prim.Position = position;
  87. prim.Orientation = rotation;
  88. prim.Size = size;
  89. _prims.Add(prim);
  90. return prim;
  91. }
  92. private bool isColliding(POSCharacter c, POSPrim p)
  93. {
  94. Vector3 rotatedPos = new Vector3(c.Position.X - p.Position.X, c.Position.Y - p.Position.Y,
  95. c.Position.Z - p.Position.Z) * Quaternion.Inverse(p.Orientation);
  96. Vector3 avatarSize = new Vector3(c.Size.X, c.Size.Y, c.Size.Z) * Quaternion.Inverse(p.Orientation);
  97. return (Math.Abs(rotatedPos.X) < (p.Size.X*0.5 + Math.Abs(avatarSize.X)) &&
  98. Math.Abs(rotatedPos.Y) < (p.Size.Y*0.5 + Math.Abs(avatarSize.Y)) &&
  99. Math.Abs(rotatedPos.Z) < (p.Size.Z*0.5 + Math.Abs(avatarSize.Z)));
  100. }
  101. private bool isCollidingWithPrim(POSCharacter c)
  102. {
  103. foreach (POSPrim p in _prims)
  104. {
  105. if (isColliding(c, p))
  106. {
  107. return true;
  108. }
  109. }
  110. return false;
  111. }
  112. public override void AddPhysicsActorTaint(PhysicsActor prim)
  113. {
  114. }
  115. public override float Simulate(float timeStep)
  116. {
  117. float fps = 0;
  118. for (int i = 0; i < _characters.Count; ++i)
  119. {
  120. fps++;
  121. POSCharacter character = _characters[i];
  122. float oldposX = character.Position.X;
  123. float oldposY = character.Position.Y;
  124. float oldposZ = character.Position.Z;
  125. if (!character.Flying)
  126. {
  127. character._target_velocity.Z += gravity * timeStep;
  128. }
  129. Vector3 characterPosition = character.Position;
  130. characterPosition.X += character._target_velocity.X * timeStep;
  131. characterPosition.Y += character._target_velocity.Y * timeStep;
  132. characterPosition.X = Util.Clamp(character.Position.X, 0.01f, Constants.RegionSize - 0.01f);
  133. characterPosition.Y = Util.Clamp(character.Position.Y, 0.01f, Constants.RegionSize - 0.01f);
  134. bool forcedZ = false;
  135. float terrainheight = _heightMap[(int)character.Position.Y * Constants.RegionSize + (int)character.Position.X];
  136. if (character.Position.Z + (character._target_velocity.Z * timeStep) < terrainheight + 2)
  137. {
  138. characterPosition.Z = terrainheight + character.Size.Z;
  139. forcedZ = true;
  140. }
  141. else
  142. {
  143. characterPosition.Z += character._target_velocity.Z*timeStep;
  144. }
  145. /// this is it -- the magic you've all been waiting for! Ladies and gentlemen --
  146. /// Completely Bogus Collision Detection!!!
  147. /// better known as the CBCD algorithm
  148. if (isCollidingWithPrim(character))
  149. {
  150. characterPosition.Z = oldposZ; // first try Z axis
  151. if (isCollidingWithPrim(character))
  152. {
  153. characterPosition.Z = oldposZ + character.Size.Z / 4.4f; // try harder
  154. if (isCollidingWithPrim(character))
  155. {
  156. characterPosition.Z = oldposZ + character.Size.Z / 2.2f; // try very hard
  157. if (isCollidingWithPrim(character))
  158. {
  159. characterPosition.X = oldposX;
  160. characterPosition.Y = oldposY;
  161. characterPosition.Z = oldposZ;
  162. characterPosition.X += character._target_velocity.X * timeStep;
  163. if (isCollidingWithPrim(character))
  164. {
  165. characterPosition.X = oldposX;
  166. }
  167. characterPosition.Y += character._target_velocity.Y * timeStep;
  168. if (isCollidingWithPrim(character))
  169. {
  170. characterPosition.Y = oldposY;
  171. }
  172. }
  173. else
  174. {
  175. forcedZ = true;
  176. }
  177. }
  178. else
  179. {
  180. forcedZ = true;
  181. }
  182. }
  183. else
  184. {
  185. forcedZ = true;
  186. }
  187. }
  188. characterPosition.X = Util.Clamp(character.Position.X, 0.01f, Constants.RegionSize - 0.01f);
  189. characterPosition.Y = Util.Clamp(character.Position.Y, 0.01f, Constants.RegionSize - 0.01f);
  190. character.Position = characterPosition;
  191. character._velocity.X = (character.Position.X - oldposX)/timeStep;
  192. character._velocity.Y = (character.Position.Y - oldposY)/timeStep;
  193. if (forcedZ)
  194. {
  195. character._velocity.Z = 0;
  196. character._target_velocity.Z = 0;
  197. ((PhysicsActor)character).IsColliding = true;
  198. character.RequestPhysicsterseUpdate();
  199. }
  200. else
  201. {
  202. ((PhysicsActor)character).IsColliding = false;
  203. character._velocity.Z = (character.Position.Z - oldposZ)/timeStep;
  204. }
  205. }
  206. return fps;
  207. }
  208. public override void GetResults()
  209. {
  210. }
  211. public override bool IsThreaded
  212. {
  213. // for now we won't be multithreaded
  214. get { return (false); }
  215. }
  216. public override void SetTerrain(float[] heightMap)
  217. {
  218. _heightMap = heightMap;
  219. }
  220. public override void DeleteTerrain()
  221. {
  222. }
  223. public override void SetWaterLevel(float baseheight)
  224. {
  225. }
  226. public override Dictionary<uint, float> GetTopColliders()
  227. {
  228. Dictionary<uint, float> returncolliders = new Dictionary<uint, float>();
  229. return returncolliders;
  230. }
  231. }
  232. }