public void recalculate() { Enumeration<Editable> numer = getSegments().elements(); WorldLocation thisOrigin = getOrigin(); HiResDate thisDate = getStartDate(); while (numer.hasMoreElements()) { Editable editable = (Editable) numer.nextElement(); PlanningSegment seg = (PlanningSegment) editable; PlanningCalc theCalc = null; int model = seg.getCalculation(); switch (model) { case PlanningLegCalcModelPropertyEditor.RANGE_SPEED: theCalc = new FromRangeSpeed(); break; case PlanningLegCalcModelPropertyEditor.RANGE_TIME: theCalc = new FromRangeTime(); break; case PlanningLegCalcModelPropertyEditor.SPEED_TIME: theCalc = new FromSpeedTime(); break; } // see if this is the closing segment if (seg instanceof ClosingSegment) { // what's the range and bearing back to the origin WorldVector offset = getOrigin().subtract(thisOrigin); // and store it. seg.setSpeedSilent(new WorldSpeed(12, WorldSpeed.Kts)); seg.setDistanceSilent(new WorldDistance(offset.getRange(), WorldDistance.DEGS)); seg.setCourseSilent(MWC.Algorithms.Conversions.Rads2Degs(offset.getBearing())); seg.setDepthSilent(new WorldDistance(offset.getDepth(), WorldDistance.METRES)); } theCalc.construct(seg, thisOrigin, thisDate); // did we generate anything? if (seg.size() > 0) { // ok, now update the date/location thisOrigin = seg.last().getBounds().getCentre(); thisDate = seg.endDTG(); } } // ok, sort out the symbol & label freq HiResDate symFreq = this.getSymbolFrequency(); HiResDate labelFreq = this.getLabelFrequency(); this.setSymbolFrequency(new HiResDate(0)); this.setLabelFrequency(new HiResDate(0)); // and restore them setSymbolFrequency(symFreq); setLabelFrequency(labelFreq); }
// TODO FIX-TEST public void NtestLaunch() { final double rngToHim = 5000; final double crseToHim = 45; final WorldLocation origin = new WorldLocation(0, 0, 0); final WorldLocation hisLoc = origin.add( new WorldVector( MWC.Algorithms.Conversions.Degs2Rads(crseToHim), MWC.Algorithms.Conversions.Yds2Degs(rngToHim), 0)); final Status blueStat = new Status(13, 0); blueStat.setLocation(origin); blueStat.setCourse(0); blueStat.setSpeed(new WorldSpeed(4, WorldSpeed.M_sec)); final Status redStat = new Status(blueStat); redStat.setLocation(hisLoc); // setup a couple of targets final ASSET.Models.Vessels.SSN ssn = new ASSET.Models.Vessels.SSN(1); ssn.setName("ssn"); ssn.setMovementChars( SSMovementCharacteristics.generateDebug("scrap", 1, 1, 0, 20, 1, 300, 1, 1, 10, 100)); ssn.setCategory( new ASSET.Participants.Category( Category.Force.BLUE, Category.Environment.SUBSURFACE, Category.Type.SUBMARINE)); ssn.setStatus(blueStat); final ASSET.Models.Sensor.Initial.OpticSensor periscope = new ASSET.Models.Sensor.Initial.OpticSensor(12); ssn.addSensor(periscope); RadiatedCharacteristics rc = new RadiatedCharacteristics(); rc.add(EnvironmentType.VISUAL, new Optic(12, new WorldDistance(12, WorldDistance.METRES))); ssn.setRadiatedChars(rc); final ASSET.Models.Vessels.Surface su = new ASSET.Models.Vessels.Surface(4); su.setName("su"); su.setMovementChars( SurfaceMovementCharacteristics.generateDebug("scrap", 1, 1, 0.001, 14, 1, 299)); su.setCategory( new ASSET.Participants.Category( Category.Force.RED, Category.Environment.SURFACE, Category.Type.CARRIER)); su.setStatus(redStat); rc = new RadiatedCharacteristics(); rc.add(EnvironmentType.VISUAL, new Optic(12, new WorldDistance(12, WorldDistance.METRES))); su.setRadiatedChars(rc); /** create the scenario */ final CoreScenario scenario = new CoreScenario(); scenario.setScenarioStepTime(10000); scenario.setTime(0); scenario.setName("Testing weapon launch"); // get somebody to listen to the tracks final ASSET.Scenario.Observers.Recording.DebriefReplayObserver debrief_writer = new ASSET.Scenario.Observers.Recording.DebriefReplayObserver( "�test_reports", null, true, "test observer", true); debrief_writer.setup(scenario); // DON'T BOTHER RECORDING JUST YET! debrief_writer.setActive(false); /** now the behaviours */ final Trail trailRed = new Trail(new WorldDistance(2000, WorldDistance.YARDS)); final TargetType getRed = new TargetType(); getRed.addTargetType(Category.Force.RED); trailRed.setTargetType(getRed); final LaunchWeapon launchWeapon = new LaunchWeapon(); launchWeapon.setTargetType(getRed); launchWeapon.setLaunchRange(new WorldDistance(4000, WorldDistance.YARDS)); launchWeapon.setCoolOffTime(new Duration(Duration.DAYS, 3)); // 24 hr cool off time launchWeapon.setLaunchType(launchBehaviour); final Waterfall blueWaterfall = new Waterfall(); blueWaterfall.insertAtFoot(trailRed); blueWaterfall.insertAtHead(launchWeapon); ssn.setDecisionModel(blueWaterfall); scenario.addParticipant(1, ssn); scenario.addParticipant(4, su); // move forward a while boolean found = false; double lastRange = -1; double thisRange = -1; int counter = 0; while (!found && counter <= 100000) { scenario.step(); final WorldVector sep = ssn.getStatus().getLocation().subtract(su.getStatus().getLocation()); thisRange = MWC.Algorithms.Conversions.Degs2Yds(sep.getRange()); if (lastRange == -1) { lastRange = thisRange; } if (ssn.getActivity().equals(LaunchWeapon.LAUNCH_MESSAGE)) { found = true; System.out.println("LAUNCHED"); } else { lastRange = thisRange; } // just do "MAD" check to ensure we don't go on for ever counter++; } // check we didn't time out assertTrue(" we just ran to end of loop (no fire)", counter < 100000); // check we launched at the right point final double launchYds = launchWeapon.getLaunchRange().getValueIn(WorldDistance.YARDS); assertTrue("didn't fire too soon", lastRange > launchYds); assertTrue( "didn't fire too late, got:" + launchYds + " but wanted:" + thisRange, thisRange <= launchYds); // so, we've launched the weapon - see how many participants are in the scenario assertEquals("New participant created", 3, scenario.getListOfParticipants().length); // find the weapon // final ParticipantType torpedo = // scenario.getThisParticipant(scenario.getListOfParticipants()[0].intValue()); // check if the torpedo gets to the target while (scenario.getListOfParticipants().length == 3) { scenario.step(); } // check that the torpedo destroys the SU, and they are both removed assertEquals("surface participant destroyed", 1, scenario.getListOfParticipants().length); // move a bit further just to give us some more blue track for (int ii = 0; ii < 20; ii++) { scenario.step(); } }
/** * decide the course of action to take, or return null to no be used * * @param status the current status of the participant * @param detections the current list of detections for this participant * @param time the time this decision was made */ public DemandedStatus decide( final Status status, ASSET.Models.Movement.MovementCharacteristics chars, DemandedStatus demStatus, final DetectionList detections, final ASSET.Scenario.ScenarioActivityMonitor monitor, final long time) { // produce a steady-state demanded course - so we continue // what we're doing during the weapons launch DemandedStatus res = null; // clear the activity flag String activity = "Not in trail"; // is it time to fire another yet? if ((_lastLaunch == -1) || (time > _lastLaunch + _coolOffTime.getValueIn(Duration.MILLISECONDS))) { // do we have any detections? if (detections != null) { // get bearing to first detection final int len = detections.size(); if (len > 0) { for (int i = 0; i < len; i++) { final ASSET.Models.Detection.DetectionEvent de = detections.getDetection(i); final Float brg = de.getBearing(); if (brg != null) { // do we have a target type? if (_myTarget != null) { // is this of our target type final ASSET.Participants.Category thisTarget = de.getTargetType(); if (_myTarget.matches(thisTarget)) { // do we have range? if (de.getRange() != null) { // work out distance from us to the target, not from the sensor to the target WorldLocation sensorLocation = de.getSensorLocation(); // Work out the estimated target location WorldVector sensorToTarget = new WorldVector( MWC.Algorithms.Conversions.Degs2Rads(de.getBearing().doubleValue()), de.getRange().getValueIn(WorldDistance.DEGS), 0); WorldLocation targetLocation = sensorLocation.add(sensorToTarget); // how are are we from the target location WorldVector meToTarget = status.getLocation().subtract(targetLocation); double yds_to_target = MWC.Algorithms.Conversions.Degs2Yds(meToTarget.getRange()); double brg_to_target_degs = MWC.Algorithms.Conversions.Rads2Degs(meToTarget.getBearing()); // is it within range? if (yds_to_target < _launchRange.getValueIn(WorldDistance.YARDS)) { // continue in steady state res = new SimpleDemandedStatus(time, status); // remember the launch time _lastLaunch = time; // start the launch steps launchWeapon(de, monitor, status, brg_to_target_degs, time); activity = LaunchWeapon.LAUNCH_MESSAGE; // ok, drop out, we don't need to launch any more weapons return res; } } } } } // if we know the bearing } // looping through the detections } // if we have any detections } // if the detections object was received } // whether it's time to launch another else { // } super.setLastActivity(activity); // always return null, since we continue in steady state return res; }