collision.test.ts 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687
  1. import type { Curve, Degrees, GlobalPoint } from "../math";
  2. import {
  3. curve,
  4. degreesToRadians,
  5. lineSegment,
  6. lineSegmentRotate,
  7. pointFrom,
  8. pointRotateDegs,
  9. } from "../math";
  10. import { pointOnCurve, pointOnPolyline } from "./collision";
  11. import type { Polyline } from "./geometry/shape";
  12. describe("point and curve", () => {
  13. const c: Curve<GlobalPoint> = curve(
  14. pointFrom(1.4, 1.65),
  15. pointFrom(1.9, 7.9),
  16. pointFrom(5.9, 1.65),
  17. pointFrom(6.44, 4.84),
  18. );
  19. it("point on curve", () => {
  20. expect(pointOnCurve(c[0], c, 10e-5)).toBe(true);
  21. expect(pointOnCurve(c[3], c, 10e-5)).toBe(true);
  22. expect(pointOnCurve(pointFrom(2, 4), c, 0.1)).toBe(true);
  23. expect(pointOnCurve(pointFrom(4, 4.4), c, 0.1)).toBe(true);
  24. expect(pointOnCurve(pointFrom(5.6, 3.85), c, 0.1)).toBe(true);
  25. expect(pointOnCurve(pointFrom(5.6, 4), c, 0.1)).toBe(false);
  26. expect(pointOnCurve(c[1], c, 0.1)).toBe(false);
  27. expect(pointOnCurve(c[2], c, 0.1)).toBe(false);
  28. });
  29. });
  30. describe("point and polylines", () => {
  31. const polyline: Polyline<GlobalPoint> = [
  32. lineSegment(pointFrom(1, 0), pointFrom(1, 2)),
  33. lineSegment(pointFrom(1, 2), pointFrom(2, 2)),
  34. lineSegment(pointFrom(2, 2), pointFrom(2, 1)),
  35. lineSegment(pointFrom(2, 1), pointFrom(3, 1)),
  36. ];
  37. it("point on the line", () => {
  38. expect(pointOnPolyline(pointFrom(1, 0), polyline)).toBe(true);
  39. expect(pointOnPolyline(pointFrom(1, 2), polyline)).toBe(true);
  40. expect(pointOnPolyline(pointFrom(2, 2), polyline)).toBe(true);
  41. expect(pointOnPolyline(pointFrom(2, 1), polyline)).toBe(true);
  42. expect(pointOnPolyline(pointFrom(3, 1), polyline)).toBe(true);
  43. expect(pointOnPolyline(pointFrom(1, 1), polyline)).toBe(true);
  44. expect(pointOnPolyline(pointFrom(2, 1.5), polyline)).toBe(true);
  45. expect(pointOnPolyline(pointFrom(2.5, 1), polyline)).toBe(true);
  46. expect(pointOnPolyline(pointFrom(0, 1), polyline)).toBe(false);
  47. expect(pointOnPolyline(pointFrom(2.1, 1.5), polyline)).toBe(false);
  48. });
  49. it("point on the line with rotation", () => {
  50. const truePoints = [
  51. pointFrom(1, 0),
  52. pointFrom(1, 2),
  53. pointFrom(2, 2),
  54. pointFrom(2, 1),
  55. pointFrom(3, 1),
  56. ];
  57. truePoints.forEach((p) => {
  58. const rotation = (Math.random() * 360) as Degrees;
  59. const rotatedPoint = pointRotateDegs(p, pointFrom(0, 0), rotation);
  60. const rotatedPolyline = polyline.map((line) =>
  61. lineSegmentRotate(line, degreesToRadians(rotation), pointFrom(0, 0)),
  62. );
  63. expect(pointOnPolyline(rotatedPoint, rotatedPolyline)).toBe(true);
  64. });
  65. const falsePoints = [pointFrom(0, 1), pointFrom(2.1, 1.5)];
  66. falsePoints.forEach((p) => {
  67. const rotation = (Math.random() * 360) as Degrees;
  68. const rotatedPoint = pointRotateDegs(p, pointFrom(0, 0), rotation);
  69. const rotatedPolyline = polyline.map((line) =>
  70. lineSegmentRotate(line, degreesToRadians(rotation), pointFrom(0, 0)),
  71. );
  72. expect(pointOnPolyline(rotatedPoint, rotatedPolyline)).toBe(false);
  73. });
  74. });
  75. });