| | | 1 | | using NUnit.Framework; |
| | | 2 | | using System.Collections; |
| | | 3 | | using System.Collections.Generic; |
| | | 4 | | using System.Linq; |
| | | 5 | | using UnityEngine; |
| | | 6 | | using UnityEngine.TestTools; |
| | | 7 | | |
| | | 8 | | public class IterativeLaunchPlannerTest { |
| | | 9 | | private class DummyLaunchAngleDataInterpolator : LaunchAngleDataInterpolator { |
| | 3 | 10 | | public DummyLaunchAngleDataInterpolator() : base() {} |
| | | 11 | | |
| | | 12 | | // Generate the list of launch angle data points to interpolate. |
| | 1 | 13 | | protected override List<LaunchAngleDataPoint> GenerateData() { |
| | 1 | 14 | | return new List<LaunchAngleDataPoint> { |
| | | 15 | | new LaunchAngleDataPoint(new LaunchAngleInput(distance: 1, altitude: 100), |
| | | 16 | | new LaunchAngleOutput(launchAngle: 90, timeToPosition: 10)), |
| | | 17 | | new LaunchAngleDataPoint(new LaunchAngleInput(distance: 60, altitude: 1), |
| | | 18 | | new LaunchAngleOutput(launchAngle: 20, timeToPosition: 13)), |
| | | 19 | | new LaunchAngleDataPoint(new LaunchAngleInput(distance: 80, altitude: 1), |
| | | 20 | | new LaunchAngleOutput(launchAngle: 15, timeToPosition: 16)), |
| | | 21 | | new LaunchAngleDataPoint(new LaunchAngleInput(distance: 100, altitude: 1), |
| | | 22 | | new LaunchAngleOutput(launchAngle: 10, timeToPosition: 20)), |
| | | 23 | | }; |
| | 1 | 24 | | } |
| | | 25 | | } |
| | | 26 | | |
| | 1 | 27 | | private static ILaunchAnglePlanner _launchAnglePlanner = new DummyLaunchAngleDataInterpolator(); |
| | | 28 | | |
| | 6 | 29 | | public static Agent GenerateAgent(in Vector3 position, in Vector3 velocity) { |
| | 6 | 30 | | Agent agent = new GameObject().AddComponent<DummyAgent>(); |
| | 6 | 31 | | Rigidbody rb = agent.gameObject.AddComponent<Rigidbody>(); |
| | 6 | 32 | | agent.transform.position = position; |
| | 6 | 33 | | rb.linearVelocity = velocity; |
| | 6 | 34 | | return agent; |
| | 6 | 35 | | } |
| | | 36 | | |
| | | 37 | | [Test] |
| | 1 | 38 | | public void TestInterceptAtDataPoint() { |
| | 1 | 39 | | Agent agent = GenerateAgent(position: new Vector3(1, 110, 0), velocity: new Vector3(0, -1, 0)); |
| | 1 | 40 | | LinearExtrapolator predictor = new LinearExtrapolator(agent); |
| | 1 | 41 | | IterativeLaunchPlanner planner = new IterativeLaunchPlanner(_launchAnglePlanner, predictor); |
| | 1 | 42 | | LaunchPlan plan = planner.Plan(); |
| | 1 | 43 | | Assert.IsTrue(plan.ShouldLaunch); |
| | 1 | 44 | | Assert.AreEqual(90, plan.LaunchAngle); |
| | 1 | 45 | | Assert.AreEqual(new Vector3(1, 100, 0), plan.InterceptPosition); |
| | 1 | 46 | | } |
| | | 47 | | |
| | | 48 | | [Test] |
| | 1 | 49 | | public void TestInterceptAroundDataPoint() { |
| | 1 | 50 | | Agent agent = |
| | | 51 | | GenerateAgent(position: new Vector3(1, 110, 0), velocity: new Vector3(0, -1.1f, 0)); |
| | 1 | 52 | | LinearExtrapolator predictor = new LinearExtrapolator(agent); |
| | 1 | 53 | | IterativeLaunchPlanner planner = new IterativeLaunchPlanner(_launchAnglePlanner, predictor); |
| | 1 | 54 | | LaunchPlan plan = planner.Plan(); |
| | 1 | 55 | | Assert.IsTrue(plan.ShouldLaunch); |
| | 1 | 56 | | Assert.AreEqual(90, plan.LaunchAngle); |
| | 1 | 57 | | Assert.AreEqual(new Vector3(1, 99, 0), plan.InterceptPosition); |
| | 1 | 58 | | } |
| | | 59 | | |
| | | 60 | | [Test] |
| | 1 | 61 | | public void TestInterceptAcrossMultipleDataPoints() { |
| | 1 | 62 | | Agent agent = GenerateAgent(position: new Vector3(126, 1, 0), velocity: new Vector3(-5, 0, 0)); |
| | 1 | 63 | | LinearExtrapolator predictor = new LinearExtrapolator(agent); |
| | 1 | 64 | | IterativeLaunchPlanner planner = new IterativeLaunchPlanner(_launchAnglePlanner, predictor); |
| | 1 | 65 | | LaunchPlan plan = planner.Plan(); |
| | 1 | 66 | | Assert.IsTrue(plan.ShouldLaunch); |
| | 1 | 67 | | Assert.AreEqual(20, plan.LaunchAngle); |
| | 1 | 68 | | Assert.AreEqual(new Vector3(61, 1, 0), plan.InterceptPosition); |
| | 1 | 69 | | } |
| | | 70 | | |
| | | 71 | | [Test] |
| | 1 | 72 | | public void TestLaunchDivergingFromOrigin() { |
| | 1 | 73 | | Agent agent = GenerateAgent(position: new Vector3(0, 1, -80), velocity: new Vector3(0, 0, -1)); |
| | 1 | 74 | | LinearExtrapolator predictor = new LinearExtrapolator(agent); |
| | 1 | 75 | | IterativeLaunchPlanner planner = new IterativeLaunchPlanner(_launchAnglePlanner, predictor); |
| | 1 | 76 | | LaunchPlan plan = planner.Plan(); |
| | 1 | 77 | | Assert.IsFalse(plan.ShouldLaunch); |
| | 1 | 78 | | } |
| | | 79 | | |
| | | 80 | | [Test] |
| | 1 | 81 | | public void TestNoLaunchDivergingFromInterceptPoint() { |
| | 1 | 82 | | Agent agent = GenerateAgent(position: new Vector3(1, 105, 0), velocity: new Vector3(0, 1, 0)); |
| | 1 | 83 | | LinearExtrapolator predictor = new LinearExtrapolator(agent); |
| | 1 | 84 | | IterativeLaunchPlanner planner = new IterativeLaunchPlanner(_launchAnglePlanner, predictor); |
| | 1 | 85 | | LaunchPlan plan = planner.Plan(); |
| | 1 | 86 | | Assert.IsFalse(plan.ShouldLaunch); |
| | 1 | 87 | | } |
| | | 88 | | |
| | | 89 | | [Test] |
| | 1 | 90 | | public void TestNoLaunchTooFarFromInterceptPoint() { |
| | 1 | 91 | | Agent agent = GenerateAgent(position: new Vector3(1, 2000, 0), velocity: new Vector3(0, -1, 0)); |
| | 1 | 92 | | LinearExtrapolator predictor = new LinearExtrapolator(agent); |
| | 1 | 93 | | IterativeLaunchPlanner planner = new IterativeLaunchPlanner(_launchAnglePlanner, predictor); |
| | 1 | 94 | | LaunchPlan plan = planner.Plan(); |
| | 1 | 95 | | Assert.IsFalse(plan.ShouldLaunch); |
| | 1 | 96 | | } |
| | | 97 | | } |