ObjectPlacementBoxStackSegment.cs 15 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394
  1. #if UNITY_EDITOR
  2. using UnityEngine;
  3. using System.Collections.Generic;
  4. namespace O3DWB
  5. {
  6. public class ObjectPlacementBoxStackSegment
  7. {
  8. #region Private Variables
  9. private Vector3 _firstStackBasePosition;
  10. private Vector3 _growAxis = Vector3.up;
  11. private Vector3 _extensionDirection = Vector3.forward;
  12. private Quaternion _stackRotation = Quaternion.identity;
  13. private float _paddingAlongStackGrowDirection = 0.0f;
  14. private float _paddingAlongExtensionDirection = 0.0f;
  15. private Vector3 _boxSize = Vector3.one;
  16. private List<ObjectPlacementBoxStack> _stacks = new List<ObjectPlacementBoxStack>();
  17. #endregion
  18. #region Public Static Properties
  19. public static float MinPadding { get { return 0.0f; } }
  20. #endregion
  21. #region Public Properties
  22. public int NumberOfStacks { get { return _stacks.Count; } }
  23. public Vector3 BoxSize { get { return _boxSize; } }
  24. public Vector3 GrowAxis { get { return _growAxis; } }
  25. public Quaternion StackRotation { get { return _stackRotation; } }
  26. public Quaternion Rotation { get { return Quaternion.LookRotation(_extensionDirection, _growAxis); } }
  27. public TransformMatrix RotationMatrix { get { return new TransformMatrix(Vector3.zero, Rotation, Vector3.one); } }
  28. public Vector3 ExtensionDirection { get { return _extensionDirection; } }
  29. public Vector3 FirstStackBasePosition { get { return _firstStackBasePosition; } }
  30. public Vector3 LastStackBasePosition { get { return NumberOfStacks == 0 ? FirstStackBasePosition : _stacks[NumberOfStacks - 1].BasePosition; } }
  31. #endregion
  32. #region Public Methods
  33. public List<OrientedBox> GetAllOrientedBoxes()
  34. {
  35. var allOrientedBoxes = new List<OrientedBox>();
  36. foreach (var stack in _stacks) allOrientedBoxes.AddRange(stack.GetAllOrientedBoxes());
  37. return allOrientedBoxes;
  38. }
  39. public List<ObjectPlacementBoxStack> GetAllStacks()
  40. {
  41. return new List<ObjectPlacementBoxStack>(_stacks);
  42. }
  43. public ObjectPlacementBoxStack GetStackByIndex(int stackIndex)
  44. {
  45. return _stacks[stackIndex];
  46. }
  47. public float GetBoxSizeAlongNormalizedDirection(Vector3 normalizedDirection)
  48. {
  49. if (NumberOfStacks == 0) return _boxSize.magnitude;
  50. else return GetStackByIndex(0).GetBoxSizeAlongNormalizedDirection(normalizedDirection);
  51. }
  52. public void SetBoxSizeForAllStacks(Vector3 boxSize)
  53. {
  54. _boxSize = boxSize;
  55. foreach (ObjectPlacementBoxStack stack in _stacks)
  56. {
  57. stack.SetBoxSize(boxSize);
  58. }
  59. RefreshStackBasePositions();
  60. }
  61. public void SetRotationForAllStacks(Quaternion rotation)
  62. {
  63. _stackRotation = rotation;
  64. foreach (ObjectPlacementBoxStack stack in _stacks)
  65. {
  66. stack.SetRotation(rotation);
  67. }
  68. RefreshStackBasePositions();
  69. }
  70. public void LookStacksAlongExtensionDirection()
  71. {
  72. _stackRotation = Quaternion.LookRotation(_extensionDirection, _growAxis);
  73. SetRotationForAllStacks(_stackRotation);
  74. }
  75. public void LookStacksAlongDirection(Vector3 direction)
  76. {
  77. direction.Normalize();
  78. _stackRotation = Quaternion.LookRotation(direction, _growAxis);
  79. SetRotationForAllStacks(_stackRotation);
  80. }
  81. public void SetFirstStackBasePosition(Vector3 firstStackBasePosition)
  82. {
  83. if(firstStackBasePosition != FirstStackBasePosition)
  84. {
  85. Vector3 stackMoveVector = firstStackBasePosition - _firstStackBasePosition;
  86. _firstStackBasePosition = firstStackBasePosition;
  87. MoveBasePositionsOfAllStacks(stackMoveVector);
  88. }
  89. }
  90. public void SetExtensionDirection(Vector3 extensionDirection)
  91. {
  92. if (extensionDirection.magnitude < 1e-5f || extensionDirection == _extensionDirection) return;
  93. _extensionDirection = extensionDirection;
  94. _extensionDirection.Normalize();
  95. int numberOfStacks = NumberOfStacks;
  96. List<int> allStackHeightValues = GetHeightValuesOfAllStacks();
  97. RemoveAllStacks();
  98. Extend(numberOfStacks, allStackHeightValues);
  99. }
  100. public void SetGrowAxis(Vector3 growAxis)
  101. {
  102. if (growAxis.magnitude < 1e-5f || growAxis == _growAxis) return;
  103. _growAxis = growAxis;
  104. _growAxis.Normalize();
  105. int numberOfStacks = NumberOfStacks;
  106. List<int> allStackHeightValues = GetHeightValuesOfAllStacks();
  107. RemoveAllStacks();
  108. Extend(numberOfStacks, allStackHeightValues);
  109. }
  110. public void SetPaddingAlongStackGrowDirection(float paddingAlongStackDirection)
  111. {
  112. if (_paddingAlongStackGrowDirection == paddingAlongStackDirection) return;
  113. _paddingAlongStackGrowDirection = paddingAlongStackDirection;
  114. SetPaddingAlongGrowDirectionForAllStacks(_paddingAlongStackGrowDirection);
  115. }
  116. public void SetPaddingAlongExtensionDirection(float paddingAlongExtensionDirection)
  117. {
  118. if (_paddingAlongExtensionDirection == paddingAlongExtensionDirection) return;
  119. _paddingAlongExtensionDirection = paddingAlongExtensionDirection;
  120. RefreshStackBasePositions();
  121. }
  122. public void ConnectFirstStackToLastStackInSegment(ObjectPlacementBoxStackSegment destinationSegment, Vector3 connectionOffset)
  123. {
  124. Vector3 newFirstStackBasePos = destinationSegment.LastStackBasePosition + connectionOffset;
  125. SetFirstStackBasePosition(newFirstStackBasePos);
  126. }
  127. public void ConnectFirstStackToFirstStackInSegment(ObjectPlacementBoxStackSegment destinationSegment, Vector3 connectionOffset)
  128. {
  129. Vector3 newFirstStackBasePos = destinationSegment.FirstStackBasePosition + connectionOffset;
  130. SetFirstStackBasePosition(newFirstStackBasePos);
  131. }
  132. public void ReverseExtensionDirection()
  133. {
  134. SetExtensionDirection(-_extensionDirection);
  135. }
  136. public void SetHeightForAllStacks(int height)
  137. {
  138. for (int stackIndex = 0; stackIndex < NumberOfStacks; ++stackIndex)
  139. {
  140. _stacks[stackIndex].SetHeight(height);
  141. }
  142. }
  143. public void SetHeightForAllStacks(List<int> heightValues)
  144. {
  145. if (NumberOfStacks != heightValues.Count) return;
  146. for (int stackIndex = 0; stackIndex < NumberOfStacks; ++stackIndex)
  147. {
  148. _stacks[stackIndex].SetHeight(heightValues[stackIndex]);
  149. }
  150. }
  151. public void SetHeightForStacksStartingAt(int indexOfFirstStack, int heightValueForAllStacks)
  152. {
  153. for (int stackIndex = indexOfFirstStack; stackIndex < NumberOfStacks; ++stackIndex)
  154. {
  155. _stacks[stackIndex].SetHeight(heightValueForAllStacks);
  156. }
  157. }
  158. public void SetHeightForStacksStartingAt(int indexOfFirstStack, List<int> stackHeightValues)
  159. {
  160. int numberOfStacksToAdjust = NumberOfStacks - indexOfFirstStack;
  161. if (numberOfStacksToAdjust != stackHeightValues.Count) return;
  162. for (int stackIndex = indexOfFirstStack; stackIndex < NumberOfStacks; ++stackIndex)
  163. {
  164. _stacks[stackIndex].SetHeight(stackHeightValues[stackIndex - indexOfFirstStack]);
  165. }
  166. }
  167. public List<int> GetHeightValuesOfAllStacks()
  168. {
  169. var stackHeightValues = new List<int>(NumberOfStacks);
  170. for (int stackIndex = 0; stackIndex < NumberOfStacks; ++stackIndex)
  171. {
  172. stackHeightValues.Add(_stacks[stackIndex].Height);
  173. }
  174. return stackHeightValues;
  175. }
  176. public void MarkAllStacksAsNotOverlapped()
  177. {
  178. for (int stackIndex = 0; stackIndex < NumberOfStacks; ++stackIndex)
  179. {
  180. _stacks[stackIndex].IsOverlappedByAnotherStack = false;
  181. }
  182. }
  183. public void Extend(int amount)
  184. {
  185. if (amount <= 0) return;
  186. CreateNewStacksAlongExtensionDirection(amount);
  187. }
  188. public void Extend(int amount, List<int> stackHeightValues)
  189. {
  190. if (amount <= 0 || amount != stackHeightValues.Count) return;
  191. int indexOfFirstNewStack = NumberOfStacks;
  192. Extend(amount);
  193. SetHeightForStacksStartingAt(indexOfFirstNewStack, stackHeightValues);
  194. }
  195. public void Shrink(int amount)
  196. {
  197. if (amount <= 0) return;
  198. RemoveLastStacks(amount);
  199. }
  200. public void RemoveAllStacks()
  201. {
  202. _stacks.Clear();
  203. }
  204. public Plane GetBasePlane()
  205. {
  206. Vector3 pointOnPlane = FirstStackBasePosition - _growAxis * GetBoxSizeAlongNormalizedDirection(_growAxis) * 0.5f;
  207. return new Plane(_growAxis, pointOnPlane);
  208. }
  209. public bool ExtensionVectorIntersects(ObjectPlacementBoxStackSegment querySegment)
  210. {
  211. if (NumberOfStacks == 0 || querySegment.NumberOfStacks == 0) return false;
  212. if (_extensionDirection.IsPerpendicularTo(querySegment.ExtensionDirection))
  213. {
  214. Plane segmentBasePlane = GetBasePlane();
  215. Vector3 thisSegmentStart = segmentBasePlane.ProjectPoint(FirstStackBasePosition);
  216. Vector3 thisSegmentEnd = segmentBasePlane.ProjectPoint(LastStackBasePosition);
  217. if (NumberOfStacks == 1) thisSegmentEnd = thisSegmentStart + _extensionDirection * 0.5f * GetBoxSizeAlongNormalizedDirection(_extensionDirection);
  218. Vector3 querySegmentStart = segmentBasePlane.ProjectPoint(querySegment.FirstStackBasePosition);
  219. Vector3 querySegmentEnd = segmentBasePlane.ProjectPoint(querySegment.LastStackBasePosition);
  220. if (querySegment.NumberOfStacks == 1) querySegmentEnd = querySegmentStart + querySegment.ExtensionDirection * 0.5f * querySegment.GetBoxSizeAlongNormalizedDirection(querySegment.ExtensionDirection);
  221. Segment3D thisSegment3D = new Segment3D(thisSegmentStart, thisSegmentEnd);
  222. Segment3D querySegment3D = new Segment3D(querySegmentStart, querySegmentEnd);
  223. return thisSegment3D.IntersectsWith(querySegment3D);
  224. }
  225. return false;
  226. }
  227. public bool ExtensionVectorOverlaps(ObjectPlacementBoxStackSegment querySegment)
  228. {
  229. if (NumberOfStacks == 0 || querySegment.NumberOfStacks == 0) return false;
  230. if(_extensionDirection.IsAlignedWith(querySegment.ExtensionDirection))
  231. {
  232. Plane segmentBasePlane = GetBasePlane();
  233. Vector3 thisSegmentStart = segmentBasePlane.ProjectPoint(FirstStackBasePosition);
  234. Vector3 thisSegmentEnd = segmentBasePlane.ProjectPoint(LastStackBasePosition);
  235. if (NumberOfStacks == 1) thisSegmentEnd = thisSegmentStart + _extensionDirection * 0.5f * GetBoxSizeAlongNormalizedDirection(_extensionDirection);
  236. Vector3 querySegmentStart = segmentBasePlane.ProjectPoint(querySegment.FirstStackBasePosition);
  237. Vector3 querySegmentEnd = segmentBasePlane.ProjectPoint(querySegment.LastStackBasePosition);
  238. if (querySegment.NumberOfStacks == 1) querySegmentEnd = querySegmentStart + querySegment.ExtensionDirection * 0.5f * querySegment.GetBoxSizeAlongNormalizedDirection(querySegment.ExtensionDirection);
  239. return querySegmentStart.IsOnSegment(thisSegmentStart, thisSegmentEnd) || querySegmentEnd.IsOnSegment(thisSegmentStart, thisSegmentEnd) ||
  240. thisSegmentStart.IsOnSegment(querySegmentStart, querySegmentEnd) || thisSegmentEnd.IsOnSegment(querySegmentStart, querySegmentEnd);
  241. }
  242. return false;
  243. }
  244. public void ClearHideFlagInAllStacks(ObjectPlacementBoxHideFlags hideFlag)
  245. {
  246. foreach(ObjectPlacementBoxStack stack in _stacks)
  247. {
  248. stack.ClearHideFlagForAllBoxes(hideFlag);
  249. }
  250. }
  251. public void SetHideFlagInAllStacks(ObjectPlacementBoxHideFlags hideFlag)
  252. {
  253. foreach (ObjectPlacementBoxStack stack in _stacks)
  254. {
  255. stack.SetHideFlagForAllBoxes(hideFlag);
  256. }
  257. }
  258. #endregion
  259. #region Private Methods
  260. private void RemoveLastStacks(int numberOfStacksToRemove)
  261. {
  262. numberOfStacksToRemove = Mathf.Min(NumberOfStacks, numberOfStacksToRemove);
  263. for(int stackIndex = 0; stackIndex < numberOfStacksToRemove; ++stackIndex)
  264. {
  265. _stacks.RemoveAt(NumberOfStacks - 1);
  266. }
  267. }
  268. private void SetHeightForAllStackss(int height)
  269. {
  270. foreach (ObjectPlacementBoxStack stack in _stacks)
  271. {
  272. stack.SetHeight(height);
  273. }
  274. }
  275. private void SetPaddingAlongGrowDirectionForAllStacks(float paddingAlongGrowDirection)
  276. {
  277. foreach (ObjectPlacementBoxStack stack in _stacks)
  278. {
  279. stack.SetPaddingAlongGrowDirection(paddingAlongGrowDirection);
  280. }
  281. }
  282. private void CreateNewStacksAlongExtensionDirection(int numberOfStacks)
  283. {
  284. for(int stackIndex = 0; stackIndex < numberOfStacks; ++stackIndex)
  285. {
  286. CreateNewStackAtEndOfSegment();
  287. }
  288. }
  289. private void CreateNewStackAtEndOfSegment()
  290. {
  291. var newStack = new ObjectPlacementBoxStack();
  292. newStack.SetRotation(_stackRotation);
  293. newStack.SetBoxSize(_boxSize);
  294. newStack.SetGrowDirection(_growAxis);
  295. newStack.SetBasePosition(CalculateStackBasePositionToSitAtEndOfSegment());
  296. newStack.SetPaddingAlongGrowDirection(_paddingAlongStackGrowDirection);
  297. newStack.GrowUpwards(1);
  298. _stacks.Add(newStack);
  299. }
  300. private void RefreshStackBasePositions()
  301. {
  302. for (int stackIndex = 1; stackIndex < NumberOfStacks; ++stackIndex)
  303. {
  304. _stacks[stackIndex].SetBasePosition(CalculateStackBasePositionToSitRightAfterStack(_stacks[stackIndex - 1]));
  305. }
  306. }
  307. private Vector3 CalculateStackBasePositionToSitAtEndOfSegment()
  308. {
  309. if (NumberOfStacks == 0) return FirstStackBasePosition;
  310. return CalculateStackBasePositionToSitRightAfterStack(_stacks[NumberOfStacks - 1]);
  311. }
  312. private Vector3 CalculateStackBasePositionToSitRightAfterStack(ObjectPlacementBoxStack afterStack)
  313. {
  314. return afterStack.BasePosition + _extensionDirection * (GetBoxSizeAlongNormalizedDirection(_extensionDirection) + _paddingAlongExtensionDirection);
  315. }
  316. private void MoveBasePositionsOfAllStacks(Vector3 moveVector)
  317. {
  318. foreach(ObjectPlacementBoxStack stack in _stacks)
  319. {
  320. stack.MoveBasePosition(moveVector);
  321. }
  322. }
  323. #endregion
  324. }
  325. }
  326. #endif