Supervisor::createCoreTasks() Supervisor::createTask() - eventLogServer Supervisor::createTask() - workSite Supervisor::createTask() - vehicleConfigurationServer Supervisor::createTask() - externalCommsServer S: Initializing worksiteServer upervisor::: WorkSite::WorkSite -- Adding attributes create: WorkSite::WorkSite -- Loading parameters from file /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/workSite.cfg Task() - navigationServer : Using default vehicle config file "/home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/vehicle.cfg" : starting LC: layeredControlServer -plan 2017_WallTest_1v3Ed.cfg.pp -abort abortSimPlan.cfg Supervisor::createTask() - layeredControlServer -plan 2017_WallTest_1v3Ed.cfg.pp -abort abortSimPlan.cfg Supervisor::createTask() - dynamicControlServer : Creating NavigationServer... : *** NavigationServer::NavigationServer()... Supervisor::createTask() - simulator : WorkSite::WorkSite -- Finished loading parameters : WorkSite::WorkSite -- Starting Depth is 0.000000 meters : 0: 1 600674.187500E 4067388.750000N 73.699997 m 10.000000 ms channel:2 : 1: 2 600531.687500E 4065156.000000N 73.199997 m 10.000000 ms channel:4 : 2: 3 598447.000000E 4067412.250000N 91.400002 m 10.000000 ms channel:5 : 3: 4 600848.125000E 4069389.500000N 80.199997 m 10.000000 ms channel:6 : 4: 5 602732.187500E 4067093.000000N 57.299999 m 10.000000 ms channel:7 : WorkSite server: 0x23204 : *** NavigationServer::NavigationServer() - DONE : Done creating NavigationServer... : layeredControlServer - creating non dynamic version Supervisor::createTask() - simDepthSensor : Navigation::Navigation - Setting start depth to 0.0 meters. : Supervisor: configDirPath = /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging Supervisor::createTask() - simKearfott : Navigation::Navigation _logOnly = 1 : Navigation - Using only the Dvl to compute altitude. : **** FastTime ctor [0007d140] **** : ****Time::gettime using FastTime instance [0007d140] : Navigation/EchoSounder:: epoch = (1489084972,52036980) : Navigation: Opening Acoustic Modem Interface: Supervisor::createTask() - simAhrs : Create simulator... : **** FastTime ctor [0007b608] **** : ****Time::gettime using FastTime instance [0007b608] : Create VehicleConfigurationIF... : Okay... : Create attributes... : Simulator::Simulator() - msSimDelay = 0 : Simulator:: initPsi = 0.000000 Super: Done creating attributes. Parse 'em... vis: SimulatedDepthSensor - connecting... or::cre: SimulatedDepthSensor - connected OK ateTask() - simTailCone S: **** FastTime ctor [000a30b8] **** : ****Time::gettime using FastTime instance [000a30b8] upervi: SimulatedKearfott:: Constructor. sor::crea: SimulatedKearfott::Setting utm zone to 10 teTas: Running SimulatedKearfott now k() - simGps Supervisor::createTask() - simDvl Superv: Simulator:: initPsi = 225.000000 isor::: Simulator:: zMax = 210.000000 createTask(: The utm zone is 10 ) - sim: Simulator: The lat/long in workSite.cfg is 0.642245, -2.12882 DvlSid: Simulator: The lat/long in workSite.cfg, cvt'ed to UTM is 4.07295e+006, 591684 e : Simulator: _nydepths = 10 : Simulator: 0 _depth=100.0, _ydepth-_position0[2]=-450.0 : Simulator: 1 _depth=100.0, _ydepth-_position0[2]=-390.0 : Simulator: 2 _depth=100.0, _ydepth-_position0[2]=-312.0 : Simulator: 3 _depth=100.0, _ydepth-_position0[2]=-310.0 : Simulator: 4 _depth=100.0, _ydepth-_position0[2]=-230.0 : Simulator: 5 _depth=100.0, _ydepth-_position0[2]=-220.0 : Simulator: 6 _depth=100.0, _ydepth-_position0[2]=-140.0 : Simulator: 7 _depth=100.0, _ydepth-_position0[2]=-130.0 : Simulator: 8 _depth=100.0, _ydepth-_position0[2]=-50.0 : Simulator: 9 _depth=100.0, _ydepth-_position0[2]=0.0 : Simulator: _nydepths = 10 : Simulator: 0 _depth=100.0, _ydepth-_position0[2]=-450.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 1 _depth=100.0, _ydepth-_position0[2]=-390.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 2 _depth=100.0, _ydepth-_position0[2]=-312.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 3 _depth=100.0, _ydepth-_position0[2]=-310.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 4 _depth=100.0, _ydepth-_position0[2]=-230.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 5 _depth=100.0, _ydepth-_position0[2]=-220.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 6 _depth=100.0, _ydepth-_position0[2]=-140.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 7 _depth=100.0, _ydepth-_position0[2]=-130.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 8 _depth=100.0, _ydepth-_position0[2]=-50.0, _slope=0.00e+000, _yinter=1.00e+002 : Simulator: 9 _depth=100.0, _ydepth-_position0[2]=0.0, _slope=0.00e+000, _yinter=0.00e+000 : Octree map file = /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/TheWall_2m.bo : Simulator:: Octree map = /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/TheWall_2m.bo Supervisor::createTask() - simDeltaT Supervisor::createTask() - simCtd : Running SimDvl now Supervisor::createTask() - simBlue: Running SimDvlSide now finBatt Supervisor::creat: **** FastTime ctor [0002d5f4] **** eTask(: ****Time::gettime using FastTime instance [0002d5f4] ) - si: SimulatedDeltaT::Constructor starting at t = 0 mHydr: SimulatedDeltaT::minGrazing = 0.00 deg. oscat Supervisor::createTask() - simIsus Supervisor::createTask() - simGulper Supervisor::createTask() - simReson Supervisor::createTask() - simModem S: Begin simGulper. upervisor::cr: Begin SimulatedGulperServer constructor. eateTask() - simUsbl Supervis: gulperLog:: Constructor completed. or::cre: End SimulatedGulperServer constructor. ateTask() - simTerrainAid Supervisor::createTask() - simCathx Superv: SimulatedUsbl:: Initial beacon interrogation address is V7_7 isor::createTask() - simCarl : Navigation: acommsIF = 0x81540 : Navigation::connectSensors core - connecting to Nav->DepthSensor at t = 0. : Navigation::connectSensors core - connecting to Nav->TailCone at t = 0. : Navigation::connectSensors core - connecting to Nav->KearfottServer at t = 0. : Navigation::connectSensors core - connecting to Nav->Dvl at t = 0. : Navigation::connectSensors aux - connecting to Nav->Gps at t = 0. : Navigation::connectSensors aux - connecting to Nav->EchoSounder at t = 0. : SimulatedUsbl:: There are 5 beacons in the table. : SimulatedUsbl:: beacon 27 V11_2 lat=36.81249 lon=-121.97346 SimulatedUsbl:: northing = 4074563.1 easting=591562.4 : SimulatedUsbl:: beacon 50 V4_5 lat=36.81611 lon=-121.98352 SimulatedUsbl:: northing = 4074955.6 easting=590661.2 : SimulatedUsbl:: beacon 28 V12_2 lat=36.81249 lon=-121.97346 SimulatedUsbl:: northing = 4074563.1 easting=591562.4 : SimulatedUsbl:: beacon 29 V13_2 lat=36.81349 lon=-121.97746 SimulatedUsbl:: northing = 4074670.2 easting=591204.4 : SimulatedUsbl:: beacon 0 V7_7 lat=36.60682 lon=-121.87457 SimulatedUsbl:: northing = 4051846.5 easting=600651.5 : SimulatedUsbl:: Changing to beacon 0 at (4051846.5, 600651.5) : Simulating Usbl with Gaussian noise. : Running SimUsbl now Supervisor::createTask: TerrainAidServer::TerrainAidServer - sim () - cameraServer -dev tcp:172.20.64.214: cathxServer - initializing... : cathxServer - running... :1000: Configuration file = /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/terrainAid.cfg 2 -sim Supervisor::createTask() - simEchoSounder Supervisor::createTask() - sysDataDriver -f5 : WaypointWall::Converted lastLatitude = 36.77941200 degrees to 4070872.06 m : WaypointWall::Converted lastLongitude = -121.99624900 degrees to 589568.46 m : WaypointWall::validInput() - Opening IF to rangeInst = 3 : Using range finder 3. : WaypointWall::Converted lastLatitude = 36.77680900 degrees to 4070574.12 m : WaypointWall::Converted lastLongitude = -122.00609700 degrees to 588692.66 m : WaypointWall::validInput() - Opening IF to rangeInst = 3 : Using range finder 3. : WaypointWall::validInput() - Opening IF to rangeInst = 3 : Using range finder 3. : WaypointWall::Converted lastLatitude = 36.77622700 degrees to 4070514.57 m : WaypointWall::Converted lastLongitude = -122.00070300 degrees to 589174.69 m : WaypointWall::validInput() - Opening IF to rangeInst = 3 : Using range finder 3. : WaypointWall::validInput() - Opening IF to rangeInst = 3 : Using range finder 3. : WaypointWall::Converted lastLatitude = 36.77480900 degrees to 4070363.88 m : WaypointWall::Converted lastLongitude = -121.99363600 degrees to 589807.00 m : WaypointWall::validInput() - Opening IF to rangeInst = 3 : Using range finder 3. : WaypointWall::validInput() - Opening IF to rangeInst = 3 : Using range finder 3. : PeriodicTask::run() (layeredControl) - sampleInterval=2000, maxInterval=0 : CameraDriver:: Before navigation IF. : PeriodicTask::run() (cameraDriver) - sampleInterval=200, maxInterval=200 : TerrainAid -- configuration: : mapFileName = TheWall_2m.bo : map_type = 2 : particlesName = particles_900v1.cfg : vehicleCfgName = mappingAUV_specsSide20.cfg : terrainNavServer = 134.89.10.239:27027 : forceLowGradeFilter = false : allowFilterReinits = true : useModifiedWeighting = true : samplePeriod = 3000 : maxNorthingCov = -1.00 : maxEastingCov = -1.00 : maxNorthingError = -1.00 : maxEastingError = -1.00 : useIDTData = true : useDVLSide = true : Vehicle Configuration now : Vehicle configuration file = /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/mappingAUV_specsSide20.cfg : Map file = /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/TheWall_2m.bo : TerrainAidDriver:: RollOffset is 0.00 : TerrainAidDriver: Using TerrainNavClient at 134.89.10.239 on port 27027 and map TheWall_2m.bo : TerrainAidDriver - logs/latest is 2017.068.05-TRN/ : **** FastTime ctor [0003bfd8] **** : ****Time::gettime using FastTime instance [0003bfd8] : SimulatedEchoSounder::Constructor starting at t = 0 : SimulatedEchoSounder::minGrazing = 0.00 deg. : Simulator::Octree Map /home/henthorn/AUV/auv-qnx/auv/altex/onboard/config/imaging/TheWall_2m.bo loaded successfully. : Simulator::Octree lower bounds ( 4069512.00 586730.00 100.00 ) : Simulator::Octree upper bounds ( 4077704.00 594922.00 8292.00 ) : Simulator::Octree number of branch nodes = 1370579. : Simulator::Octree number of leaf nodes = 9594054. : Simulator::Octree size in RAM >= 98681693 bytes. : **** FastTime ctor [00084b80] **** : ****Simulator::init_simulation [0006b478] using FastTime instance [00084b80] : Invoke simulator->run()... : SimulatedDeltaT:: _verticalMount = 0, _fwdEnabled = 1 : SimulatedDeltaT:: _tbeams = 210, _nbeams = 120 : SimulatedEchoSounder - sector = 30. : SimulatedEchoSounder:: epoch = (1489084972,52036980) : SimulatedEchoSounder::Constructor finished at t = 0 : Running SimEchoSounder now : Navigation::connectSensors aux - connecting to Nav->Velocimeter at t = 0. : Navigation: Server for aux sensor "Nav->Velocimeter" not found : Navigation::connectSensors aux - connecting to Nav->Usbl at t = 0. : Navigation: Setting simulator callback : Navigation::Navigation(). _es->valid() = 0 at t = 0. : PeriodicTask::run() (navigation) - sampleInterval=2000, maxInterval=0 : ============== Navigation giving simulation a push start in 2... : SimulatedDeltaT:: epoch = (1489084972,52036980) : SimulatedDeltaT::Constructor finished at t = 0 : sysDataDriver: Frequency is 5 : sysDataDriver - frequency = 5 : PeriodicTask::run() (sysdata) - sampleInterval=200, maxInterval=200 : **** FastTime ctor [00021458] **** : ****Time::gettime using FastTime instance [00021458] : **** FastTime ctor [000201dc] **** : ****Time::gettime using FastTime instance [000201dc] : **** FastTime ctor [0003b1f4] **** : ****Time::gettime using FastTime instance [0003b1f4] : **** FastTime ctor [000313b8] **** : ****Time::gettime using FastTime instance [000313b8] : **** FastTime ctor [0004ad20] **** : ****Time::gettime using FastTime instance [0004ad20] : Navigation:: deltaT = 0.00 is impermissible. : **** EventTriggers::add() - attaching proxy : Reson Behavior::log=0,sbp=0,0.000000 | hiss=0,0.000000,-1.000000,200.000000 | loss=0,0.000000,-1.000000,200.000000 | mb=1,0.000000,3.000000,200.000000,33.000000,0.000030,0.000000 | pulse="","" : Reson Behavior: Stopping subbottom profiler : Reson Behavior: Setting SBP gain to 128.000000 : Reson Behavior: Setting SBP duration to 300.000000 : Reson Behavior: Setting SSLo range to 200.000000 : Reson Behavior: Stopping lo-freq SS : Reson Behavior: Setting SSHi range to 200.000000 : Reson Behavior: Stopping hi-freq SS : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB power to 0.000000 : Reson Behavior: Setting MB range to 200.000000 : Reson Behavior: Setting MB rate to 3.000000 : Reson Behavior: Setting MB gain to 33.000000 : Reson Behavior: Setting MB pulse width to 0.000030 : Reson Behavior: Setting MB Bottom detection filter 15.000000:200.000000:0.000000:200.000000 : Reson Behavior: Turning on snippet control - window size = 200 : Reson Behavior: Turning on bottom detection modes: 0, 1 : Reson Behavior: Starting MB pinging : Reson Behavior: Stopping logging : Reson Behavior: Stopping 7k Center Logging : LayeredControl::execute() -- (t = 0.000000) Behavior reson:-1 has changed to state Active : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 1 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 1 of 10 needed : LayeredControl::execute() -- (t = 0.000000) Behavior getgps:-1 has changed to state Active : LayeredControl::execute() -- (t = 0.000000) Behavior depthEnvelope:-1 has changed to state Active : LayeredControl::execute() -- (t = 0.000000) Behavior missionTimer:-1 has changed to state Active : **** FastTime ctor [0003af7c] **** : ****Time::gettime using FastTime instance [0003af7c] : **** EventTriggers::add() - attaching proxy : *** Mission started *** : **** EventTriggers::add() - attaching proxy : !!!! Simulator::missionStatusCallback() - Got event 0 from "layeredControl" : Event received at _simTime=0.02 : Simulator::missionStatusCallback() - mission started : TerrainAidDriver::Connected to server. : TerrainAidDriver::TerrainAidDriver - ctor complete : Running simTerrainAid now : **** FastTime ctor [0002a7b0] **** : ****Time::gettime using FastTime instance [0002a7b0] : TerrainAidDriver:: _navTime0 = 0.00 : TerrainAidDriver:: _dvlTime0 = 0.00 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072945.70, 591683.55) : _tercom->outstandingMeas() = 0 : **** FastTime ctor [000dd1b4] **** : ****Time::gettime using FastTime instance [000dd1b4] : Simulator:: Before the call to motion(): simTime = 0.00, (simTime - realTime) = 0.00 Heading = 225.00 Depth = 0.00 Speed = 0.00 Pitch = 0.00 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 2 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 2 of 10 needed : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 3 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 3 of 10 needed : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 4 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 4 of 10 needed : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072945.70, 591683.55) : _tercom->outstandingMeas() = 0 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 5 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 5 of 10 needed : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 6 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 6 of 10 needed : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : Reson Behavior::log=-1,sbp=-1,0.000000 | hiss=-1,0.000000,-1.000000,-1.000000 | loss=-1,0.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 7 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 7 of 10 needed : SimulatedDeltaT: Surface detected at simtime = 6.00. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072945.70, 591683.55) : _tercom->outstandingMeas() = 0 : Behavior reson - Timed out! : LayeredControl::execute() -- (t = 6.200000) Behavior reson:-1 has changed to state Finished : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 8 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 8 of 10 needed : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 9 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 9 of 10 needed : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS: fix.quality = 1 : GetGPS::execute() -- Got a new GPS hit: 10 of 10 needed : GetGPS::execute(): Depth loop open > 1 minute: 0 Gps data processed: 1 Gps data rejected: 0 Dvl data processed: 0 Dvl data rejected: 0 ZUPT processed 0 Valid Dvl height 0 : GetGPS::execute() -- The Keafott accepted the Gps hit: 10 of 10 needed : LayeredControl::execute() -- (t = 9.000000) Behavior getgps:-1 has changed to state Finished : LayeredControl::execute() -- (t = 9.000000) Behavior setpoint:-1 has changed to state Active : DynamicControlServer::Begin horizontal mode 1 at t = 9.00 sec. : DynamicControlServer::Begin vertical mode 1 at t = 9.00 sec. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072945.69, 591683.53) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 112.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072945.40, 591683.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072944.60, 591682.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072943.28, 591681.16) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072941.44, 591679.66) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 112.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 13.26, IDT[75] = 0.00 : _navData-> (x,y) = (4072939.09, 591678.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 13.26, IDT[75] = 0.00 : _navData-> (x,y) = (4072936.29, 591676.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 7.27, IDT[75] = 0.00 : _navData-> (x,y) = (4072933.15, 591676.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 7.27, IDT[75] = 0.00 : _navData-> (x,y) = (4072929.77, 591675.89) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 114.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 8.18, IDT[75] = 0.00 : _navData-> (x,y) = (4072926.23, 591675.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 8.18, IDT[75] = 0.00 : _navData-> (x,y) = (4072922.57, 591676.01) : _tercom->outstandingMeas() = 0 : Behavior setpoint - Timed out! : LayeredControl::execute() -- (t = 39.200000) Behavior setpoint:-1 has changed to state Finished : LayeredControl::execute() -- (t = 39.200000) Behavior descend:-1 has changed to state Active : TerrainAidDriver::readData() - IDT[45] = 12.56, IDT[75] = 0.00 : _navData-> (x,y) = (4072918.83, 591676.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 12.56, IDT[75] = 0.00 : _navData-> (x,y) = (4072915.21, 591676.54) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 118.0 Dvl range = 8.4, range = 19.5 numValidBeams = 2 beam1 range = 14.7, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 4.7, iterations = 0, grazing = 0.0 bottomStatus = 3c : TerrainAidDriver::readData() - IDT[45] = 21.70, IDT[75] = 0.00 : _navData-> (x,y) = (4072911.90, 591676.81) : _tercom->outstandingMeas() = 0 : Descend::execute() - Descend terminating on depth 3.029176 > 3.000000 at time 50.200000 : LayeredControl::execute() -- (t = 50.200000) Behavior descend:-1 has changed to state Finished : sending status via acoustic modem : LayeredControl::execute() -- (t = 50.200000) Behavior acousticUpdate:-1 has changed to state Finished : Waypoint Initialization: Begin waypoint control at t= 50.20 (wplog) The current location (N,E) = 4072909.7 , 591677.0 (wplog) The next waypoint = 4073031.6 , 591706.5 (wplog) The bearing to the next w.p. is 13.6 Degrees. : LayeredControl::execute() -- (t = 50.200000) Behavior waypoint:-1 has changed to state Active : DynamicControlServer::Begin horizontal mode 3 at t = 50.20 sec. : DynamicControlServer::Begin vertical mode 2 at t = 50.20 sec. : TerrainAidDriver::readData() - IDT[45] = 21.70, IDT[75] = 0.00 : _navData-> (x,y) = (4072908.88, 591677.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 36.28, IDT[75] = 0.00 : _navData-> (x,y) = (4072906.10, 591677.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 36.28, IDT[75] = 0.00 : _navData-> (x,y) = (4072903.31, 591677.66) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 120.0 Dvl range = 24.4, range = 56.2 numValidBeams = 2 beam1 range = 36.1, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 20.1, iterations = 0, grazing = 0.0 bottomStatus = 3c : TerrainAidDriver::readData() - IDT[45] = 75.71, IDT[75] = 0.00 : _navData-> (x,y) = (4072900.49, 591678.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 75.71, IDT[75] = 0.00 : _navData-> (x,y) = (4072897.80, 591679.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 82.17, IDT[75] = 0.00 : _navData-> (x,y) = (4072895.46, 591681.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 82.17, IDT[75] = 0.00 : _navData-> (x,y) = (4072893.66, 591684.14) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 120.0 Dvl range = 44.7, range = 103.3 numValidBeams = 2 beam1 range = 78.1, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 25.2, iterations = 0, grazing = 0.0 bottomStatus = 3c : TerrainAidDriver::readData() - IDT[45] = 69.23, IDT[75] = 0.00 : _navData-> (x,y) = (4072892.51, 591686.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 69.23, IDT[75] = 0.00 : _navData-> (x,y) = (4072892.00, 591689.01) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 71.43, IDT[75] = 0.00 : _navData-> (x,y) = (4072892.05, 591691.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 71.43, IDT[75] = 0.00 : _navData-> (x,y) = (4072892.57, 591693.29) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 120.0 Dvl range = 91.3, range = 210.8 numValidBeams = 2 beam1 range = 175.9, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 34.9, iterations = 0, grazing = 0.0 bottomStatus = 3c : TerrainAidDriver::readData() - IDT[45] = 80.49, IDT[75] = 0.00 : _navData-> (x,y) = (4072893.47, 591695.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 80.49, IDT[75] = 0.00 : _navData-> (x,y) = (4072894.67, 591696.53) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 90.75, IDT[75] = 0.00 : _navData-> (x,y) = (4072896.11, 591697.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 90.75, IDT[75] = 0.00 : _navData-> (x,y) = (4072897.71, 591698.59) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 118.0 Dvl range = 104.6, range = 241.6 numValidBeams = 2 beam1 range = 197.8, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 43.8, iterations = 0, grazing = 0.0 bottomStatus = 3c : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072899.43, 591699.14) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072901.21, 591699.38) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 100.00, (simTime - realTime) = 0.00 Heading = -11.08 Depth = 17.29 Speed = 0.61 Pitch = -35.30 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072902.99, 591699.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072904.73, 591698.93) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 116.0 Dvl range = 44.7, range = 51.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 51.6, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072906.38, 591698.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072907.91, 591697.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072909.31, 591696.20) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072910.63, 591694.97) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 116.0 Dvl range = 50.4, range = 58.2 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 58.2, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072911.89, 591693.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072913.15, 591692.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072914.44, 591691.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072915.81, 591690.17) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 116.0 Dvl range = 57.0, range = 65.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 65.8, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072917.25, 591689.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072918.77, 591688.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072920.36, 591687.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072922.01, 591687.25) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 114.0 Dvl range = 64.0, range = 73.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 73.9, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072923.69, 591686.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072925.40, 591686.58) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072927.12, 591686.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072928.84, 591686.30) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 114.0 Dvl range = 70.8, range = 81.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 81.8, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072930.57, 591686.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072932.30, 591686.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072934.03, 591686.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072935.75, 591686.40) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 112.0 Dvl range = 78.2, range = 90.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 90.3, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072937.47, 591686.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072939.20, 591686.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072940.92, 591686.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072942.64, 591686.31) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 112.0 Dvl range = 85.5, range = 98.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 98.8, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072944.36, 591686.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072946.08, 591686.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072947.80, 591686.20) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072949.52, 591686.22) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 110.0 Dvl range = 92.7, range = 107.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 107.0, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072951.23, 591686.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072952.95, 591686.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072954.66, 591686.57) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 200.00, (simTime - realTime) = 0.00 Heading = 9.09 Depth = 41.95 Speed = 0.60 Pitch = -39.71 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072956.36, 591686.78) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 110.0 Dvl range = 99.9, range = 115.4 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 115.4, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072958.06, 591687.04) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072959.75, 591687.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072961.43, 591687.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072963.11, 591688.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 110.0 Dvl range = 137.3, range = 317.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 193.4, iterations = 0, grazing = 0.0 beam4 range = 123.8, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072964.78, 591688.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072966.44, 591688.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072968.11, 591689.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072969.79, 591689.92) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 108.0 Dvl range = 137.2, range = 316.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 183.9, iterations = 0, grazing = 0.0 beam4 range = 132.9, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072971.48, 591690.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072973.19, 591691.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072974.93, 591691.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072976.70, 591692.30) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 108.0 Dvl range = 137.7, range = 317.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 175.2, iterations = 0, grazing = 0.0 beam4 range = 142.8, iterations = 0, grazing = 0.0 bottomStatus = f : SimulatedDeltaT: Surface lost at simtime = 240.00. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072978.51, 591692.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072980.37, 591693.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072982.28, 591694.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072984.25, 591695.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 108.0 Dvl range = 139.4, range = 321.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 167.5, iterations = 0, grazing = 0.0 beam4 range = 154.4, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072986.29, 591695.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072988.42, 591696.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072990.64, 591697.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072992.95, 591697.94) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 106.0 Dvl range = 144.1, range = 332.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 163.1, iterations = 0, grazing = 0.0 beam4 range = 169.7, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072995.39, 591698.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072997.94, 591699.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073000.64, 591700.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073003.47, 591700.74) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 106.0 Dvl range = 155.0, range = 357.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 166.8, iterations = 0, grazing = 0.0 beam4 range = 191.1, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073006.46, 591701.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073009.61, 591702.09) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073012.92, 591702.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073016.39, 591703.43) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 104.0 Dvl range = 151.8, range = 175.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 175.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073020.01, 591704.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073023.78, 591704.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073027.69, 591705.58) : _tercom->outstandingMeas() = 0 : Waypoint has set the state to finished. : Waypoint (4073031.6, 591706.5), reached at t = 297.00 (wplog) : Vehicle Position is error is (-0.1, 0.2) : LayeredControl::execute() -- (t = 297.000000) Behavior waypoint:-1 has changed to state Finished : Reson Behavior::log=0,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,218.000000,3.000000,200.000000,33.000000,0.000030,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB power to 218.000000 : Reson Behavior: Setting MB range to 200.000000 : Reson Behavior: Setting MB rate to 3.000000 : Reson Behavior: Setting MB gain to 33.000000 : Reson Behavior: Setting MB pulse width to 0.000030 : Reson Behavior: Setting MB Bottom detection filter 15.000000:200.000000:0.000000:200.000000 : Reson Behavior: Turning on snippet control - window size = 200 : Reson Behavior: Turning on bottom detection modes: 0, 1 : Reson Behavior: Stopping logging : Reson Behavior: Stopping 7k Center Logging : LayeredControl::execute() -- (t = 297.000000) Behavior reson:-1 has changed to state Finished : Reson Behavior::log=2,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000,-1.000000 | pulse="","" : Reson Behavior: Stopping logging : Reson Behavior: Starting 7k Center Logging : LayeredControl::execute() -- (t = 297.000000) Behavior reson:-1 has changed to state Finished : sending status via acoustic modem : LayeredControl::execute() -- (t = 297.000000) Behavior acousticUpdate:-1 has changed to state Finished : Reson Behavior::log=-1,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,200.000000,-1.000000,-1.000000,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB range to 200.000000 : LayeredControl::execute() -- (t = 297.000000) Behavior reson:-1 has changed to state Finished : WaypointDepth initialization: Begin waypoint control at t= 297.00 (wplog) The current location (N,E) = 4073031.7 , 591706.4 (wplog) The next waypoint = 4071994.6 , 591781.7 (wplog) The bearing to the next w.p. is 175.8 Degrees. The distance to the next w.p. is 1039.8 Meters. The slope to the next w.p. is -0.2359. The initial commanded depth is 56.1 meters. The final commanded depth is 301.5 meters. : LayeredControl::execute() -- (t = 297.000000) Behavior waypoint_depth:-1 has changed to state Active : DynamicControlServer::Begin horizontal mode 4 at t = 297.00 sec. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073031.72, 591706.38) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 104.0 Dvl range = 169.3, range = 195.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 195.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073035.85, 591707.22) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 300.00, (simTime - realTime) = 0.00 Heading = 15.36 Depth = 61.01 Speed = 1.41 Pitch = 0.26 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073039.89, 591708.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073043.50, 591710.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073046.37, 591713.53) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 104.0 Dvl range = 171.5, range = 198.1 numValidBeams = 1 beam1 range = 198.1, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = fc : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073048.25, 591717.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073049.02, 591721.11) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073048.60, 591725.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073047.03, 591728.86) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 104.0 Dvl range = 169.2, range = 390.8 numValidBeams = 2 beam1 range = 190.8, iterations = 0, grazing = 0.0 beam2 range = 200.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = f0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073044.46, 591731.98) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073041.11, 591734.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073037.29, 591735.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073033.36, 591735.53) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 104.0 Dvl range = 159.2, range = 183.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 183.8, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073029.64, 591734.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073026.42, 591732.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073023.87, 591730.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073021.85, 591727.16) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 104.0 Dvl range = 148.5, range = 171.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 171.5, iterations = 0, grazing = 0.0 bottomStatus = 3f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073020.04, 591724.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073018.15, 591721.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073016.00, 591718.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073013.52, 591716.02) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 106.0 Dvl range = 161.2, range = 372.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 187.8, iterations = 0, grazing = 0.0 beam4 range = 184.5, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073010.72, 591714.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073007.67, 591712.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073004.43, 591711.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4073001.07, 591710.40) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 106.0 Dvl range = 151.1, range = 349.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 157.8, iterations = 0, grazing = 0.0 beam4 range = 191.2, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072997.64, 591709.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072994.18, 591709.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072990.71, 591709.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072987.23, 591708.93) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 108.0 Dvl range = 147.6, range = 341.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 144.9, iterations = 0, grazing = 0.0 beam4 range = 196.0, iterations = 0, grazing = 0.0 bottomStatus = f : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072983.77, 591708.86) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072980.33, 591708.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072976.90, 591708.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072973.49, 591709.13) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 108.0 Dvl range = 114.3, range = 131.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 131.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072970.10, 591709.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072966.73, 591709.66) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 400.00, (simTime - realTime) = 0.00 Heading = 173.69 Depth = 69.35 Speed = 1.16 Pitch = -20.39 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072963.37, 591710.01) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072960.03, 591710.40) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 110.0 Dvl range = 106.1, range = 122.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 122.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072956.71, 591710.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072953.39, 591711.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072950.08, 591711.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072946.77, 591712.17) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 110.0 Dvl range = 105.4, range = 121.7 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 121.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072943.46, 591712.61) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072940.15, 591713.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072936.84, 591713.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072933.52, 591713.81) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 112.0 Dvl range = 136.0, range = 314.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 197.1, iterations = 0, grazing = 0.0 beam3 range = 117.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072930.20, 591714.15) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072926.87, 591714.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072923.54, 591714.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072920.21, 591715.01) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 116.0 Dvl range = 125.6, range = 290.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 176.9, iterations = 0, grazing = 0.0 beam3 range = 113.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072916.86, 591715.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072913.48, 591715.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072910.07, 591715.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072906.63, 591715.84) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 118.0 Dvl range = 112.3, range = 259.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 150.1, iterations = 0, grazing = 0.0 beam3 range = 109.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072903.15, 591716.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072899.64, 591716.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072896.09, 591716.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072892.53, 591716.55) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 122.0 Dvl range = 110.2, range = 254.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 144.2, iterations = 0, grazing = 0.0 beam3 range = 110.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072888.96, 591716.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072885.37, 591716.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072881.79, 591717.16) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072878.19, 591717.39) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 122.0 Dvl range = 106.8, range = 246.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 139.1, iterations = 0, grazing = 0.0 beam3 range = 107.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072874.59, 591717.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072870.98, 591717.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072867.38, 591718.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072863.79, 591718.40) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 128.0 Dvl range = 105.6, range = 243.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 141.2, iterations = 0, grazing = 0.0 beam3 range = 102.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072860.22, 591718.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072856.67, 591718.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072853.13, 591719.23) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 500.00, (simTime - realTime) = 0.00 Heading = 175.43 Depth = 95.35 Speed = 1.20 Pitch = -18.20 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072849.60, 591719.51) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 132.0 Dvl range = 104.8, range = 242.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 137.2, iterations = 0, grazing = 0.0 beam3 range = 104.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072846.09, 591719.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072842.59, 591720.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072839.10, 591720.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072835.64, 591720.61) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 136.0 Dvl range = 101.6, range = 234.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 132.8, iterations = 0, grazing = 0.0 beam3 range = 101.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072832.19, 591720.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072828.76, 591721.14) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072825.34, 591721.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072821.92, 591721.65) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 138.0 Dvl range = 98.3, range = 227.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 126.1, iterations = 0, grazing = 0.0 beam3 range = 101.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072818.53, 591721.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072815.14, 591722.15) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072811.78, 591722.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072808.44, 591722.63) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 142.0 Dvl range = 100.8, range = 232.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 130.6, iterations = 0, grazing = 0.0 beam3 range = 102.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072805.11, 591722.86) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072801.78, 591723.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072798.44, 591723.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072795.09, 591723.56) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 146.0 Dvl range = 96.6, range = 223.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 118.3, iterations = 0, grazing = 0.0 beam3 range = 104.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072791.74, 591723.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072788.40, 591724.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072785.07, 591724.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072781.75, 591724.51) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 148.0 Dvl range = 100.2, range = 231.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 125.6, iterations = 0, grazing = 0.0 beam3 range = 105.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072778.44, 591724.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072775.14, 591724.98) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072771.84, 591725.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072768.56, 591725.46) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 152.0 Dvl range = 99.5, range = 229.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 123.2, iterations = 0, grazing = 0.0 beam3 range = 106.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072765.29, 591725.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072762.03, 591725.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072758.79, 591726.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072755.56, 591726.41) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 154.0 Dvl range = 98.9, range = 228.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 120.4, iterations = 0, grazing = 0.0 beam3 range = 107.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072752.33, 591726.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072749.10, 591726.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072745.87, 591727.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072742.63, 591727.35) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 158.0 Dvl range = 100.3, range = 231.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 121.9, iterations = 0, grazing = 0.0 beam3 range = 109.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072739.40, 591727.59) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 600.00, (simTime - realTime) = 0.00 Heading = 175.79 Depth = 124.37 Speed = 1.11 Pitch = -21.44 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072736.16, 591727.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072732.92, 591728.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072729.67, 591728.30) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 160.0 Dvl range = 101.0, range = 233.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 121.0, iterations = 0, grazing = 0.0 beam3 range = 112.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072726.40, 591728.54) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072723.13, 591728.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072719.84, 591729.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072716.53, 591729.26) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 164.0 Dvl range = 102.5, range = 236.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 121.2, iterations = 0, grazing = 0.0 beam3 range = 115.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072713.21, 591729.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072709.87, 591729.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072706.52, 591729.99) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072703.16, 591730.24) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 168.0 Dvl range = 105.5, range = 243.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 124.7, iterations = 0, grazing = 0.0 beam3 range = 118.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072699.79, 591730.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072696.40, 591730.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072693.01, 591730.98) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072689.61, 591731.23) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 170.0 Dvl range = 107.4, range = 248.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 130.1, iterations = 0, grazing = 0.0 beam3 range = 118.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072686.20, 591731.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072682.78, 591731.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072679.37, 591731.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072675.94, 591732.22) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 176.0 Dvl range = 108.6, range = 250.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 132.9, iterations = 0, grazing = 0.0 beam3 range = 117.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072672.52, 591732.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072669.09, 591732.71) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072665.66, 591732.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072662.22, 591733.21) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 180.0 Dvl range = 109.9, range = 253.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 133.1, iterations = 0, grazing = 0.0 beam3 range = 120.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072658.79, 591733.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072655.36, 591733.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072651.92, 591733.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072648.49, 591734.20) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 182.0 Dvl range = 112.5, range = 259.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 136.3, iterations = 0, grazing = 0.0 beam3 range = 123.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072645.05, 591734.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072641.62, 591734.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072638.18, 591734.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072634.75, 591735.19) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 186.0 Dvl range = 115.1, range = 265.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 139.8, iterations = 0, grazing = 0.0 beam3 range = 126.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072631.31, 591735.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072627.88, 591735.69) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 700.00, (simTime - realTime) = 0.00 Heading = 175.83 Depth = 151.38 Speed = 1.17 Pitch = -18.93 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072624.44, 591735.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072621.01, 591736.19) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 190.0 Dvl range = 119.0, range = 274.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 146.0, iterations = 0, grazing = 0.0 beam3 range = 128.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072617.58, 591736.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072614.15, 591736.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072610.71, 591736.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072607.28, 591737.19) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 194.0 Dvl range = 119.8, range = 276.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 145.3, iterations = 0, grazing = 0.0 beam3 range = 131.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072603.85, 591737.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072600.42, 591737.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072596.99, 591737.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072593.56, 591738.18) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 198.0 Dvl range = 121.8, range = 281.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 147.2, iterations = 0, grazing = 0.0 beam3 range = 134.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072590.13, 591738.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072586.70, 591738.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072583.27, 591738.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072579.84, 591739.18) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 202.0 Dvl range = 123.9, range = 286.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 149.3, iterations = 0, grazing = 0.0 beam3 range = 136.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072576.41, 591739.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072572.99, 591739.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072569.56, 591739.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072566.13, 591740.18) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 204.0 Dvl range = 124.3, range = 287.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 154.7, iterations = 0, grazing = 0.0 beam3 range = 132.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072562.70, 591740.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072559.27, 591740.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072555.85, 591740.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072552.42, 591741.17) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 208.0 Dvl range = 131.1, range = 302.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 160.7, iterations = 0, grazing = 0.0 beam3 range = 142.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072548.99, 591741.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072545.56, 591741.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072542.14, 591741.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072538.71, 591742.16) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 212.0 Dvl range = 131.0, range = 302.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 157.8, iterations = 0, grazing = 0.0 beam3 range = 144.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072535.28, 591742.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072531.86, 591742.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072528.43, 591742.91) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072525.00, 591743.16) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 216.0 Dvl range = 131.9, range = 304.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 157.1, iterations = 0, grazing = 0.0 beam3 range = 147.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072521.58, 591743.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072518.15, 591743.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072514.73, 591743.91) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 800.00, (simTime - realTime) = 0.00 Heading = 175.83 Depth = 178.34 Speed = 1.17 Pitch = -19.02 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072511.30, 591744.15) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 220.0 Dvl range = 132.6, range = 306.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 163.1, iterations = 0, grazing = 0.0 beam3 range = 143.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072507.87, 591744.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072504.45, 591744.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072501.02, 591744.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072497.60, 591745.15) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 222.0 Dvl range = 136.3, range = 314.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 169.0, iterations = 0, grazing = 0.0 beam3 range = 145.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072494.17, 591745.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072490.75, 591745.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072487.32, 591745.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072483.90, 591746.14) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 224.0 Dvl range = 138.4, range = 319.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 171.2, iterations = 0, grazing = 0.0 beam3 range = 148.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072480.47, 591746.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072477.05, 591746.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072473.62, 591746.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072470.20, 591747.14) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 228.0 Dvl range = 139.1, range = 321.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 170.1, iterations = 0, grazing = 0.0 beam3 range = 151.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072466.77, 591747.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072463.35, 591747.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072459.92, 591747.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072456.50, 591748.13) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 230.0 Dvl range = 142.6, range = 329.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 175.5, iterations = 0, grazing = 0.0 beam3 range = 153.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072453.07, 591748.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072449.65, 591748.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072446.22, 591748.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072442.80, 591749.13) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 234.0 Dvl range = 144.5, range = 333.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 177.3, iterations = 0, grazing = 0.0 beam3 range = 156.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072439.37, 591749.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072435.95, 591749.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072432.52, 591749.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072429.10, 591750.12) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 236.0 Dvl range = 148.2, range = 342.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 183.2, iterations = 0, grazing = 0.0 beam3 range = 159.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072425.67, 591750.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072422.25, 591750.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072418.82, 591750.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072415.40, 591751.12) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 240.0 Dvl range = 149.3, range = 344.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 183.0, iterations = 0, grazing = 0.0 beam3 range = 161.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072411.97, 591751.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072408.55, 591751.61) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072405.13, 591751.86) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072401.70, 591752.11) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 244.0 Dvl range = 143.2, range = 330.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 173.4, iterations = 0, grazing = 0.0 beam3 range = 157.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072398.28, 591752.36) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 900.00, (simTime - realTime) = 0.00 Heading = 175.84 Depth = 205.33 Speed = 1.17 Pitch = -19.03 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072394.85, 591752.61) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072391.43, 591752.86) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072388.00, 591753.10) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 248.0 Dvl range = 150.2, range = 346.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 186.8, iterations = 0, grazing = 0.0 beam3 range = 160.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072384.58, 591753.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072381.15, 591753.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072377.73, 591753.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072374.30, 591754.10) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 250.0 Dvl range = 153.3, range = 354.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 191.4, iterations = 0, grazing = 0.0 beam3 range = 162.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072370.88, 591754.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072367.46, 591754.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072364.03, 591754.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072360.61, 591755.09) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 254.0 Dvl range = 150.3, range = 347.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 181.7, iterations = 0, grazing = 0.0 beam3 range = 165.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072357.18, 591755.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072353.76, 591755.59) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072350.33, 591755.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072346.91, 591756.09) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 258.0 Dvl range = 154.4, range = 356.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 188.6, iterations = 0, grazing = 0.0 beam3 range = 168.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072343.49, 591756.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072340.06, 591756.58) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072336.64, 591756.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072333.21, 591757.08) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 262.0 Dvl range = 148.3, range = 342.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 178.8, iterations = 0, grazing = 0.0 beam3 range = 163.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072329.79, 591757.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072326.36, 591757.58) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072322.94, 591757.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072319.51, 591758.08) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 264.0 Dvl range = 156.5, range = 361.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 195.1, iterations = 0, grazing = 0.0 beam3 range = 166.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072316.09, 591758.32) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072312.67, 591758.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072309.24, 591758.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072305.82, 591759.07) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 268.0 Dvl range = 140.3, range = 162.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 162.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072302.39, 591759.32) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072298.97, 591759.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072295.54, 591759.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072292.12, 591760.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 272.0 Dvl range = 142.6, range = 164.7 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 164.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072288.70, 591760.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072285.27, 591760.56) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1000.00, (simTime - realTime) = 0.00 Heading = 175.84 Depth = 232.33 Speed = 1.17 Pitch = -19.03 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072281.85, 591760.81) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072278.42, 591761.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 276.0 Dvl range = 150.8, range = 348.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 186.1, iterations = 0, grazing = 0.0 beam3 range = 162.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072275.00, 591761.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072271.57, 591761.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072268.15, 591761.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072264.73, 591762.05) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 280.0 Dvl range = 141.1, range = 163.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 163.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072261.30, 591762.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072257.88, 591762.55) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072254.45, 591762.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072251.03, 591763.05) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 284.0 Dvl range = 143.4, range = 165.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 165.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072247.60, 591763.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072244.18, 591763.54) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072240.76, 591763.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072237.33, 591764.04) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 286.0 Dvl range = 139.7, range = 161.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 161.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072233.91, 591764.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072230.48, 591764.54) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072227.06, 591764.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072223.63, 591765.04) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 290.0 Dvl range = 142.0, range = 164.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 164.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072220.21, 591765.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072216.79, 591765.53) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072213.36, 591765.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072209.94, 591766.03) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 294.0 Dvl range = 138.2, range = 159.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 159.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072206.51, 591766.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072203.09, 591766.53) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072199.66, 591766.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072196.24, 591767.02) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 298.0 Dvl range = 153.4, range = 354.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 191.9, iterations = 0, grazing = 0.0 beam3 range = 162.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072192.82, 591767.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072189.39, 591767.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072185.97, 591767.77) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072182.54, 591768.02) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 302.0 Dvl range = 153.4, range = 354.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 196.4, iterations = 0, grazing = 0.0 beam3 range = 157.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072179.12, 591768.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072175.70, 591768.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072172.27, 591768.76) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1100.00, (simTime - realTime) = 0.00 Heading = 175.84 Depth = 259.34 Speed = 1.17 Pitch = -19.03 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072168.85, 591769.01) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 304.0 Dvl range = 139.1, range = 160.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 160.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072165.42, 591769.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072162.00, 591769.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072158.57, 591769.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072155.15, 591770.01) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 308.0 Dvl range = 150.3, range = 347.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 190.8, iterations = 0, grazing = 0.0 beam3 range = 156.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072151.73, 591770.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072148.30, 591770.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072144.88, 591770.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072141.45, 591771.00) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 312.0 Dvl range = 146.7, range = 338.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 182.9, iterations = 0, grazing = 0.0 beam3 range = 155.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072138.03, 591771.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072134.60, 591771.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072131.18, 591771.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072127.76, 591772.00) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 314.0 Dvl range = 142.0, range = 328.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 173.5, iterations = 0, grazing = 0.0 beam3 range = 154.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072124.33, 591772.24) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072120.91, 591772.49) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072117.48, 591772.74) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072114.06, 591772.99) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 318.0 Dvl range = 142.6, range = 329.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 179.1, iterations = 0, grazing = 0.0 beam3 range = 150.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072110.63, 591773.24) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072107.21, 591773.49) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072103.79, 591773.74) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072100.36, 591773.98) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 322.0 Dvl range = 143.6, range = 331.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 185.9, iterations = 0, grazing = 0.0 beam3 range = 145.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072096.94, 591774.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072093.51, 591774.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072090.09, 591774.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072086.66, 591774.98) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 326.0 Dvl range = 147.0, range = 339.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 191.0, iterations = 0, grazing = 0.0 beam3 range = 148.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072083.24, 591775.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072079.82, 591775.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072076.39, 591775.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072072.97, 591775.97) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 328.0 Dvl range = 141.4, range = 326.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 182.2, iterations = 0, grazing = 0.0 beam3 range = 144.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072069.54, 591776.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072066.12, 591776.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072062.69, 591776.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072059.27, 591776.97) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 332.0 Dvl range = 144.7, range = 334.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 187.3, iterations = 0, grazing = 0.0 beam3 range = 146.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072055.85, 591777.22) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1200.00, (simTime - realTime) = 0.00 Heading = 175.84 Depth = 286.34 Speed = 1.17 Pitch = -19.03 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072052.42, 591777.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072049.00, 591777.71) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072045.57, 591777.96) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 334.0 Dvl range = 144.4, range = 333.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 190.9, iterations = 0, grazing = 0.0 beam3 range = 142.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072042.15, 591778.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072038.72, 591778.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072035.30, 591778.71) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072031.88, 591778.96) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 338.0 Dvl range = 143.2, range = 330.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 185.5, iterations = 0, grazing = 0.0 beam3 range = 145.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072028.45, 591779.20) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072025.03, 591779.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072021.60, 591779.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072018.18, 591779.95) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 342.0 Dvl range = 137.0, range = 316.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 175.5, iterations = 0, grazing = 0.0 beam3 range = 140.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072014.76, 591780.20) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072011.33, 591780.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072007.91, 591780.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072004.48, 591780.94) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 344.0 Dvl range = 140.8, range = 325.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 179.8, iterations = 0, grazing = 0.0 beam3 range = 145.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4072001.06, 591781.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071997.63, 591781.44) : _tercom->outstandingMeas() = 0 : WaypointDepth has set the state to finished. : Waypoint (4071994.6, 591781.7), reached at t = 1253.80 (wplog) : Vehicle Position error is (0.2, 0.0) : LayeredControl::execute() -- (t = 1253.800000) Behavior waypoint_depth:-1 has changed to state Finished : Reson Behavior::log=-1,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,200.000000,-1.000000,-1.000000,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB range to 200.000000 : LayeredControl::execute() -- (t = 1253.800000) Behavior reson:-1 has changed to state Finished : WaypointDepth initialization: Begin waypoint control at t= 1253.80 (wplog) The current location (N,E) = 4071994.4 , 591781.7 (wplog) The next waypoint = 4070394.7 , 590832.7 (wplog) The bearing to the next w.p. is 210.7 Degrees. The distance to the next w.p. is 1860.0 Meters. The slope to the next w.p. is -0.2474. The initial commanded depth is 301.5 meters. The final commanded depth is 761.7 meters. : LayeredControl::execute() -- (t = 1253.800000) Behavior waypoint_depth:-1 has changed to state Active : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071994.21, 591781.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071990.79, 591781.95) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 348.0 Dvl range = 148.9, range = 171.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 171.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071987.41, 591781.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071984.15, 591781.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071981.15, 591780.11) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071978.44, 591778.31) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 352.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071975.95, 591776.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071973.59, 591773.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071971.30, 591771.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071969.02, 591769.05) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 354.0 Dvl range = 172.5, range = 199.1 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 199.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071966.72, 591766.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071964.38, 591764.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071961.98, 591761.99) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071959.50, 591759.77) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 358.0 Dvl range = 162.6, range = 187.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 187.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071956.93, 591757.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071954.28, 591755.62) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1300.00, (simTime - realTime) = 0.00 Heading = 214.25 Depth = 312.76 Speed = 1.14 Pitch = -19.82 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071951.55, 591753.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071948.74, 591751.88) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 362.0 Dvl range = 149.7, range = 172.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 172.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071945.87, 591750.16) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071942.95, 591748.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071939.98, 591746.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071936.98, 591745.47) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 366.0 Dvl range = 157.4, range = 363.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 196.7, iterations = 0, grazing = 0.0 beam3 range = 166.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071933.96, 591744.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071930.92, 591742.59) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071927.87, 591741.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071924.83, 591739.77) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 370.0 Dvl range = 146.2, range = 168.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 168.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071921.79, 591738.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071918.77, 591736.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071915.76, 591735.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071912.78, 591733.86) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 372.0 Dvl range = 148.5, range = 171.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 171.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071909.81, 591732.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071906.87, 591730.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071903.95, 591729.00) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071901.05, 591727.30) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 376.0 Dvl range = 150.6, range = 173.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 173.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071898.17, 591725.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071895.31, 591723.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071892.46, 591722.00) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071889.62, 591720.19) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 380.0 Dvl range = 162.8, range = 376.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 199.8, iterations = 0, grazing = 0.0 beam3 range = 176.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071886.79, 591718.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071883.96, 591716.54) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071881.13, 591714.71) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071878.30, 591712.89) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 382.0 Dvl range = 157.5, range = 363.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 192.2, iterations = 0, grazing = 0.0 beam3 range = 171.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071875.46, 591711.08) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071872.61, 591709.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071869.75, 591707.49) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071866.88, 591705.72) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 386.0 Dvl range = 156.8, range = 362.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 190.2, iterations = 0, grazing = 0.0 beam3 range = 172.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071864.00, 591703.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071861.12, 591702.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071858.22, 591700.49) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1400.00, (simTime - realTime) = 0.00 Heading = 210.35 Depth = 340.56 Speed = 1.15 Pitch = -19.83 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071855.31, 591698.78) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 390.0 Dvl range = 153.9, range = 355.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 186.3, iterations = 0, grazing = 0.0 beam3 range = 169.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071852.40, 591697.08) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071849.49, 591695.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071846.57, 591693.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071843.65, 591692.01) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 394.0 Dvl range = 152.9, range = 353.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 188.7, iterations = 0, grazing = 0.0 beam3 range = 164.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071840.72, 591690.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071837.80, 591688.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071834.88, 591686.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071831.96, 591685.29) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 396.0 Dvl range = 153.5, range = 354.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 187.9, iterations = 0, grazing = 0.0 beam3 range = 166.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071829.04, 591683.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071826.12, 591681.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071823.21, 591680.20) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071820.30, 591678.50) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 398.0 Dvl range = 151.1, range = 349.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 187.0, iterations = 0, grazing = 0.0 beam3 range = 162.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071817.40, 591676.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071814.50, 591675.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071811.60, 591673.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071808.70, 591671.62) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 402.0 Dvl range = 149.7, range = 345.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 188.3, iterations = 0, grazing = 0.0 beam3 range = 157.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071805.80, 591669.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071802.91, 591668.16) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071800.02, 591666.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071797.13, 591664.69) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 404.0 Dvl range = 147.5, range = 340.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 187.1, iterations = 0, grazing = 0.0 beam3 range = 153.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071794.23, 591662.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071791.34, 591661.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071788.45, 591659.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071785.55, 591657.75) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 406.0 Dvl range = 145.2, range = 335.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 185.9, iterations = 0, grazing = 0.0 beam3 range = 149.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071782.66, 591656.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071779.76, 591654.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071776.86, 591652.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071773.96, 591650.84) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 410.0 Dvl range = 146.5, range = 338.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 188.0, iterations = 0, grazing = 0.0 beam3 range = 150.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071771.06, 591649.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071768.16, 591647.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071765.26, 591645.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071762.35, 591643.96) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 412.0 Dvl range = 146.7, range = 338.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 187.5, iterations = 0, grazing = 0.0 beam3 range = 151.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071759.45, 591642.24) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1500.00, (simTime - realTime) = 0.00 Heading = 210.56 Depth = 368.41 Speed = 1.15 Pitch = -19.81 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071756.54, 591640.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071753.64, 591638.81) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071750.73, 591637.09) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 416.0 Dvl range = 142.1, range = 328.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 180.1, iterations = 0, grazing = 0.0 beam3 range = 148.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071747.83, 591635.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071744.92, 591633.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071742.02, 591631.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071739.12, 591630.23) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 418.0 Dvl range = 139.0, range = 321.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 170.7, iterations = 0, grazing = 0.0 beam3 range = 150.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071736.21, 591628.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071733.31, 591626.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071730.41, 591625.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071727.50, 591623.35) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 422.0 Dvl range = 137.7, range = 318.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 165.5, iterations = 0, grazing = 0.0 beam3 range = 152.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071724.60, 591621.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071721.70, 591619.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071718.80, 591618.18) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071715.90, 591616.46) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 424.0 Dvl range = 136.1, range = 314.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 166.0, iterations = 0, grazing = 0.0 beam3 range = 148.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071713.00, 591614.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071710.10, 591613.01) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071707.20, 591611.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071704.29, 591609.56) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 428.0 Dvl range = 137.5, range = 317.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 165.3, iterations = 0, grazing = 0.0 beam3 range = 152.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071701.39, 591607.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071698.49, 591606.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071695.59, 591604.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071692.69, 591602.67) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 430.0 Dvl range = 140.1, range = 323.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 164.1, iterations = 0, grazing = 0.0 beam3 range = 159.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071689.79, 591600.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071686.89, 591599.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071683.98, 591597.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071681.08, 591595.78) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 432.0 Dvl range = 141.9, range = 327.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 165.9, iterations = 0, grazing = 0.0 beam3 range = 161.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071678.18, 591594.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071675.28, 591592.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071672.37, 591590.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071669.47, 591588.90) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 436.0 Dvl range = 145.2, range = 335.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 171.2, iterations = 0, grazing = 0.0 beam3 range = 164.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071666.57, 591587.18) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071663.67, 591585.46) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1600.00, (simTime - realTime) = 0.00 Heading = 210.65 Depth = 396.25 Speed = 1.15 Pitch = -19.80 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071660.76, 591583.74) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071657.86, 591582.02) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 438.0 Dvl range = 147.9, range = 341.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 176.6, iterations = 0, grazing = 0.0 beam3 range = 165.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071654.96, 591580.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071652.06, 591578.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071649.15, 591576.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071646.25, 591575.13) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 442.0 Dvl range = 147.7, range = 341.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 179.4, iterations = 0, grazing = 0.0 beam3 range = 161.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071643.35, 591573.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071640.45, 591571.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071637.55, 591569.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071634.64, 591568.25) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 446.0 Dvl range = 151.2, range = 349.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 185.2, iterations = 0, grazing = 0.0 beam3 range = 164.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071631.74, 591566.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071628.84, 591564.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071625.94, 591563.08) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071623.04, 591561.36) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 448.0 Dvl range = 153.1, range = 353.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 190.3, iterations = 0, grazing = 0.0 beam3 range = 163.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071620.13, 591559.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071617.23, 591557.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071614.33, 591556.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071611.43, 591554.47) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 452.0 Dvl range = 150.4, range = 347.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 182.9, iterations = 0, grazing = 0.0 beam3 range = 164.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071608.52, 591552.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071605.62, 591551.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071602.72, 591549.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071599.82, 591547.59) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 454.0 Dvl range = 154.2, range = 356.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 192.1, iterations = 0, grazing = 0.0 beam3 range = 163.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071596.92, 591545.86) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071594.01, 591544.14) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071591.11, 591542.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071588.21, 591540.70) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 460.0 Dvl range = 155.3, range = 358.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 192.4, iterations = 0, grazing = 0.0 beam3 range = 166.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071585.31, 591538.98) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071582.41, 591537.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071579.50, 591535.53) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071576.60, 591533.81) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 462.0 Dvl range = 157.8, range = 364.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 196.0, iterations = 0, grazing = 0.0 beam3 range = 168.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071573.70, 591532.09) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071570.80, 591530.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071567.89, 591528.65) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1700.00, (simTime - realTime) = 0.00 Heading = 210.66 Depth = 424.08 Speed = 1.15 Pitch = -19.80 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071564.99, 591526.93) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 464.0 Dvl range = 159.2, range = 367.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 196.9, iterations = 0, grazing = 0.0 beam3 range = 170.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071562.09, 591525.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071559.19, 591523.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071556.28, 591521.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071553.38, 591520.04) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 468.0 Dvl range = 158.2, range = 365.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 192.3, iterations = 0, grazing = 0.0 beam3 range = 173.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071550.48, 591518.32) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071547.58, 591516.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071544.68, 591514.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071541.77, 591513.15) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 472.0 Dvl range = 161.5, range = 373.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 197.6, iterations = 0, grazing = 0.0 beam3 range = 175.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071538.87, 591511.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071535.97, 591509.71) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071533.07, 591507.99) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071530.16, 591506.27) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 476.0 Dvl range = 154.5, range = 178.4 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 178.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071527.26, 591504.55) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071524.36, 591502.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071521.46, 591501.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071518.56, 591499.38) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 480.0 Dvl range = 158.3, range = 182.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 182.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071515.65, 591497.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071512.75, 591495.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071509.85, 591494.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071506.95, 591492.49) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 482.0 Dvl range = 168.3, range = 388.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 199.4, iterations = 0, grazing = 0.0 beam3 range = 189.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071504.04, 591490.77) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071501.14, 591489.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071498.24, 591487.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071495.34, 591485.61) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 488.0 Dvl range = 165.9, range = 191.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 191.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071492.44, 591483.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071489.53, 591482.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071486.63, 591480.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071483.73, 591478.72) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 490.0 Dvl range = 167.9, range = 193.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 193.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071480.83, 591477.00) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071477.92, 591475.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071475.02, 591473.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071472.12, 591471.84) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 494.0 Dvl range = 171.5, range = 198.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 198.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071469.22, 591470.11) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1800.00, (simTime - realTime) = 0.00 Heading = 210.66 Depth = 451.91 Speed = 1.15 Pitch = -19.80 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071466.32, 591468.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071463.41, 591466.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071460.51, 591464.95) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 498.0 Dvl range = 171.9, range = 198.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 198.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071457.61, 591463.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071454.71, 591461.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071451.80, 591459.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071448.90, 591458.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 502.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071446.00, 591456.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071443.10, 591454.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071440.20, 591452.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071437.29, 591451.18) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 504.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071434.39, 591449.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071431.49, 591447.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071428.59, 591446.01) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071425.68, 591444.29) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 508.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071422.78, 591442.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071419.88, 591440.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071416.98, 591439.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071414.08, 591437.40) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 512.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071411.17, 591435.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071408.27, 591433.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071405.37, 591432.24) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071402.47, 591430.52) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 516.0 Dvl range = 169.8, range = 196.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 196.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071399.56, 591428.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071396.66, 591427.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071393.76, 591425.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071390.86, 591423.63) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 520.0 Dvl range = 171.7, range = 198.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 198.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071387.95, 591421.91) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071385.05, 591420.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071382.15, 591418.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071379.25, 591416.74) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 524.0 Dvl range = 167.7, range = 193.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 193.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071376.35, 591415.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071373.44, 591413.30) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 1900.00, (simTime - realTime) = 0.00 Heading = 210.66 Depth = 479.75 Speed = 1.15 Pitch = -19.80 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071370.54, 591411.58) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071367.64, 591409.86) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 528.0 Dvl range = 166.7, range = 192.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 192.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071364.74, 591408.14) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071361.83, 591406.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071358.93, 591404.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071356.03, 591402.97) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 532.0 Dvl range = 165.7, range = 191.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 191.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071353.13, 591401.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071350.23, 591399.53) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071347.32, 591397.81) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071344.42, 591396.09) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 534.0 Dvl range = 167.6, range = 193.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 193.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071341.52, 591394.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071338.62, 591392.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071335.71, 591390.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071332.81, 591389.20) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 538.0 Dvl range = 163.6, range = 188.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 188.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071329.91, 591387.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071327.01, 591385.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071324.11, 591384.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071321.20, 591382.31) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 540.0 Dvl range = 161.5, range = 186.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 186.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071318.30, 591380.59) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071315.40, 591378.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071312.50, 591377.15) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071309.59, 591375.43) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 542.0 Dvl range = 157.8, range = 182.2 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 182.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071306.69, 591373.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071303.79, 591371.98) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071300.89, 591370.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071297.99, 591368.54) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 546.0 Dvl range = 151.8, range = 175.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 175.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071295.08, 591366.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071292.18, 591365.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071289.28, 591363.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071286.38, 591361.65) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 548.0 Dvl range = 159.5, range = 184.2 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 184.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071283.47, 591359.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071280.57, 591358.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071277.67, 591356.49) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2000.00, (simTime - realTime) = 0.00 Heading = 210.66 Depth = 507.58 Speed = 1.15 Pitch = -19.80 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071274.77, 591354.77) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 552.0 Dvl range = 152.9, range = 176.6 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 176.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071271.87, 591353.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071268.96, 591351.32) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071266.06, 591349.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071263.16, 591347.88) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 554.0 Dvl range = 150.7, range = 174.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 174.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071260.26, 591346.16) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071257.35, 591344.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071254.45, 591342.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071251.55, 591340.99) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 558.0 Dvl range = 148.9, range = 171.9 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 171.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071248.65, 591339.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071245.74, 591337.55) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071242.84, 591335.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071239.94, 591334.11) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 560.0 Dvl range = 147.6, range = 170.4 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 170.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071237.04, 591332.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071234.14, 591330.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071231.23, 591328.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071228.33, 591327.22) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 562.0 Dvl range = 145.3, range = 167.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 167.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071225.43, 591325.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071222.53, 591323.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071219.62, 591322.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071216.72, 591320.33) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 564.0 Dvl range = 141.3, range = 163.2 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 163.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071213.82, 591318.61) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071210.92, 591316.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071208.02, 591315.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071205.11, 591313.45) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 568.0 Dvl range = 137.3, range = 158.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 158.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071202.21, 591311.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071199.31, 591310.01) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071196.41, 591308.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071193.50, 591306.56) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 570.0 Dvl range = 135.3, range = 156.2 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 156.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071190.60, 591304.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071187.70, 591303.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071184.80, 591301.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071181.90, 591299.68) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 574.0 Dvl range = 135.2, range = 156.1 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 156.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071178.99, 591297.95) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2100.00, (simTime - realTime) = 0.00 Heading = 210.66 Depth = 535.41 Speed = 1.15 Pitch = -19.80 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071176.09, 591296.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071173.19, 591294.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071170.29, 591292.79) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 576.0 Dvl range = 131.2, range = 151.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 151.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071167.38, 591291.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071164.48, 591289.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071161.58, 591287.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071158.68, 591285.90) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 578.0 Dvl range = 148.4, range = 342.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 195.9, iterations = 0, grazing = 0.0 beam3 range = 146.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071155.78, 591284.18) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071152.87, 591282.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071149.97, 591280.74) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071147.07, 591279.02) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 582.0 Dvl range = 147.4, range = 340.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 192.7, iterations = 0, grazing = 0.0 beam3 range = 147.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071144.17, 591277.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071141.26, 591275.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071138.36, 591273.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071135.46, 591272.13) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 584.0 Dvl range = 145.0, range = 334.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 190.3, iterations = 0, grazing = 0.0 beam3 range = 144.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071132.56, 591270.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071129.66, 591268.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071126.75, 591266.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071123.85, 591265.24) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 586.0 Dvl range = 141.2, range = 326.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 186.3, iterations = 0, grazing = 0.0 beam3 range = 139.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071120.95, 591263.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071118.05, 591261.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071115.14, 591260.08) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071112.24, 591258.36) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 588.0 Dvl range = 139.5, range = 322.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 184.8, iterations = 0, grazing = 0.0 beam3 range = 137.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071109.34, 591256.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071106.44, 591254.91) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071103.53, 591253.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071100.63, 591251.47) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 592.0 Dvl range = 134.4, range = 310.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 179.8, iterations = 0, grazing = 0.0 beam3 range = 130.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071097.73, 591249.75) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071094.82, 591248.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071091.92, 591246.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071089.01, 591244.57) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 594.0 Dvl range = 134.4, range = 310.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 176.8, iterations = 0, grazing = 0.0 beam3 range = 133.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071086.09, 591242.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071083.17, 591241.11) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2200.00, (simTime - realTime) = 0.00 Heading = 210.67 Depth = 563.15 Speed = 1.16 Pitch = -18.56 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071080.22, 591239.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071077.26, 591237.61) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 596.0 Dvl range = 130.6, range = 301.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 170.0, iterations = 0, grazing = 0.0 beam3 range = 131.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071074.29, 591235.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071071.29, 591234.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071068.27, 591232.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071065.22, 591230.46) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 598.0 Dvl range = 129.8, range = 299.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 165.9, iterations = 0, grazing = 0.0 beam3 range = 133.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071062.14, 591228.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071059.04, 591226.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071055.93, 591224.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071052.82, 591223.12) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 602.0 Dvl range = 129.4, range = 298.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 163.1, iterations = 0, grazing = 0.0 beam3 range = 135.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071049.69, 591221.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071046.57, 591219.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071043.43, 591217.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071040.30, 591215.70) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 604.0 Dvl range = 125.9, range = 290.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 157.5, iterations = 0, grazing = 0.0 beam3 range = 133.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071037.16, 591213.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071034.02, 591211.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071030.87, 591210.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071027.72, 591208.23) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 608.0 Dvl range = 132.4, range = 305.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 168.3, iterations = 0, grazing = 0.0 beam3 range = 137.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071024.56, 591206.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071021.42, 591204.49) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071018.29, 591202.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071015.17, 591200.78) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 610.0 Dvl range = 129.7, range = 299.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 166.4, iterations = 0, grazing = 0.0 beam3 range = 133.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071012.06, 591198.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071008.95, 591197.08) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071005.84, 591195.24) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4071002.76, 591193.41) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 616.0 Dvl range = 130.4, range = 301.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 174.4, iterations = 0, grazing = 0.0 beam3 range = 126.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070999.71, 591191.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070996.68, 591189.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070993.68, 591188.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070990.69, 591186.24) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 620.0 Dvl range = 130.3, range = 300.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 172.9, iterations = 0, grazing = 0.0 beam3 range = 128.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070987.72, 591184.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070984.76, 591182.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070981.83, 591180.98) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2300.00, (simTime - realTime) = 0.00 Heading = 210.67 Depth = 587.82 Speed = 1.16 Pitch = -20.88 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070978.92, 591179.25) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 624.0 Dvl range = 128.4, range = 296.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 175.5, iterations = 0, grazing = 0.0 beam3 range = 121.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070976.03, 591177.54) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070973.17, 591175.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070970.33, 591174.16) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070967.50, 591172.48) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 630.0 Dvl range = 124.0, range = 286.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 171.1, iterations = 0, grazing = 0.0 beam3 range = 115.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070964.67, 591170.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070961.84, 591169.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070959.02, 591167.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070956.21, 591165.78) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 632.0 Dvl range = 124.0, range = 286.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 170.8, iterations = 0, grazing = 0.0 beam3 range = 115.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070953.40, 591164.11) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070950.59, 591162.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070947.80, 591160.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070945.01, 591159.14) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 634.0 Dvl range = 119.5, range = 276.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 165.4, iterations = 0, grazing = 0.0 beam3 range = 110.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070942.23, 591157.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070939.45, 591155.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070936.68, 591154.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070933.90, 591152.56) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 638.0 Dvl range = 112.6, range = 259.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 153.5, iterations = 0, grazing = 0.0 beam3 range = 106.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070931.12, 591150.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070928.34, 591149.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070925.55, 591147.61) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070922.74, 591145.95) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 640.0 Dvl range = 109.7, range = 253.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 145.1, iterations = 0, grazing = 0.0 beam3 range = 108.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070919.93, 591144.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070917.10, 591142.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070914.28, 591140.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070911.47, 591139.26) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 644.0 Dvl range = 105.3, range = 243.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 140.5, iterations = 0, grazing = 0.0 beam3 range = 102.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070908.65, 591137.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070905.84, 591135.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070903.02, 591134.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070900.20, 591132.58) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 648.0 Dvl range = 100.9, range = 233.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 134.2, iterations = 0, grazing = 0.0 beam3 range = 98.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070897.36, 591130.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070894.51, 591129.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070891.66, 591127.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070888.81, 591125.82) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 652.0 Dvl range = 99.6, range = 230.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 130.3, iterations = 0, grazing = 0.0 beam3 range = 99.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070885.97, 591124.14) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2400.00, (simTime - realTime) = 0.00 Heading = 210.65 Depth = 617.26 Speed = 1.13 Pitch = -21.24 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070883.15, 591122.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070880.32, 591120.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070877.50, 591119.12) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 656.0 Dvl range = 97.5, range = 225.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 130.3, iterations = 0, grazing = 0.0 beam3 range = 95.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070874.68, 591117.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070871.88, 591115.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070869.10, 591114.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070866.34, 591112.49) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 660.0 Dvl range = 98.7, range = 228.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 134.0, iterations = 0, grazing = 0.0 beam3 range = 94.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070863.60, 591110.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070860.88, 591109.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070858.17, 591107.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070855.46, 591106.03) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 666.0 Dvl range = 94.2, range = 217.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 122.9, iterations = 0, grazing = 0.0 beam3 range = 94.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070852.76, 591104.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070850.07, 591102.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070847.39, 591101.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070844.71, 591099.64) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 668.0 Dvl range = 89.4, range = 206.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 117.9, iterations = 0, grazing = 0.0 beam3 range = 88.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070842.05, 591098.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070839.37, 591096.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070836.69, 591094.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070834.00, 591093.28) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 672.0 Dvl range = 87.3, range = 201.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 110.9, iterations = 0, grazing = 0.0 beam3 range = 90.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070831.29, 591091.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070828.56, 591090.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070825.82, 591088.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070823.05, 591086.80) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 676.0 Dvl range = 85.8, range = 198.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 107.9, iterations = 0, grazing = 0.0 beam3 range = 90.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070820.27, 591085.15) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070817.46, 591083.49) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070814.64, 591081.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070811.81, 591080.15) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 678.0 Dvl range = 84.8, range = 195.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 104.6, iterations = 0, grazing = 0.0 beam3 range = 91.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070808.96, 591078.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070806.09, 591076.77) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070803.22, 591075.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070800.34, 591073.36) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 680.0 Dvl range = 83.7, range = 193.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 100.5, iterations = 0, grazing = 0.0 beam3 range = 92.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070797.45, 591071.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070794.55, 591069.94) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2500.00, (simTime - realTime) = 0.00 Heading = 210.67 Depth = 646.74 Speed = 1.15 Pitch = -19.43 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070791.65, 591068.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070788.75, 591066.49) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 684.0 Dvl range = 85.9, range = 198.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 104.4, iterations = 0, grazing = 0.0 beam3 range = 93.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070785.84, 591064.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070782.93, 591063.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070780.01, 591061.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070777.10, 591059.57) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 686.0 Dvl range = 83.2, range = 192.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 101.2, iterations = 0, grazing = 0.0 beam3 range = 91.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070774.18, 591057.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070771.26, 591056.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070768.35, 591054.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070765.43, 591052.63) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 686.0 Dvl range = 84.8, range = 195.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 102.4, iterations = 0, grazing = 0.0 beam3 range = 93.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070762.51, 591050.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070759.59, 591049.16) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070756.67, 591047.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070753.75, 591045.70) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 692.0 Dvl range = 84.5, range = 195.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 103.1, iterations = 0, grazing = 0.0 beam3 range = 92.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070750.84, 591043.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070747.92, 591042.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070745.00, 591040.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070742.08, 591038.77) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 696.0 Dvl range = 82.8, range = 191.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 99.9, iterations = 0, grazing = 0.0 beam3 range = 91.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070739.17, 591037.04) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070736.25, 591035.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070733.33, 591033.58) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070730.42, 591031.85) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 698.0 Dvl range = 85.3, range = 196.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 103.4, iterations = 0, grazing = 0.0 beam3 range = 93.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070727.50, 591030.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070724.58, 591028.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070721.67, 591026.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070718.76, 591024.94) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 702.0 Dvl range = 87.4, range = 201.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 105.9, iterations = 0, grazing = 0.0 beam3 range = 95.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070715.84, 591023.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070712.93, 591021.49) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070710.01, 591019.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070707.09, 591018.02) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 706.0 Dvl range = 85.2, range = 196.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 104.9, iterations = 0, grazing = 0.0 beam3 range = 91.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070704.16, 591016.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070701.23, 591014.55) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070698.30, 591012.81) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2600.00, (simTime - realTime) = 0.00 Heading = 210.65 Depth = 674.20 Speed = 1.16 Pitch = -19.71 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070695.38, 591011.08) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 708.0 Dvl range = 85.8, range = 198.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 105.2, iterations = 0, grazing = 0.0 beam3 range = 92.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070692.46, 591009.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070689.55, 591007.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070686.64, 591005.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070683.74, 591004.18) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 712.0 Dvl range = 85.7, range = 197.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 108.8, iterations = 0, grazing = 0.0 beam3 range = 89.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070680.84, 591002.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070677.93, 591000.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070675.02, 590999.00) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070672.11, 590997.27) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 716.0 Dvl range = 84.4, range = 194.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 103.5, iterations = 0, grazing = 0.0 beam3 range = 91.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070669.20, 590995.54) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070666.29, 590993.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070663.39, 590992.09) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070660.48, 590990.37) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 720.0 Dvl range = 86.2, range = 199.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 105.6, iterations = 0, grazing = 0.0 beam3 range = 93.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070657.58, 590988.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070654.69, 590986.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070651.79, 590985.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070648.90, 590983.50) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 724.0 Dvl range = 87.6, range = 202.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 107.4, iterations = 0, grazing = 0.0 beam3 range = 95.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070646.01, 590981.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070643.12, 590980.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070640.22, 590978.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070637.33, 590976.64) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 730.0 Dvl range = 90.2, range = 208.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 110.3, iterations = 0, grazing = 0.0 beam3 range = 97.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070634.43, 590974.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070631.54, 590973.20) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070628.64, 590971.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070625.74, 590969.77) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 734.0 Dvl range = 90.6, range = 209.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 109.2, iterations = 0, grazing = 0.0 beam3 range = 100.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070622.84, 590968.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070619.94, 590966.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070617.04, 590964.61) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070614.14, 590962.89) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 740.0 Dvl range = 88.7, range = 204.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 109.1, iterations = 0, grazing = 0.0 beam3 range = 95.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070611.24, 590961.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070608.34, 590959.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070605.44, 590957.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070602.54, 590956.00) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 744.0 Dvl range = 88.3, range = 204.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 106.9, iterations = 0, grazing = 0.0 beam3 range = 97.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070599.63, 590954.28) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2700.00, (simTime - realTime) = 0.00 Heading = 210.66 Depth = 702.12 Speed = 1.15 Pitch = -19.78 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070596.73, 590952.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070593.83, 590950.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070590.93, 590949.12) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 748.0 Dvl range = 87.2, range = 201.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 105.7, iterations = 0, grazing = 0.0 beam3 range = 95.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070588.02, 590947.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070585.12, 590945.67) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070582.22, 590943.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070579.31, 590942.23) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 752.0 Dvl range = 89.1, range = 205.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 109.1, iterations = 0, grazing = 0.0 beam3 range = 96.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070576.41, 590940.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070573.51, 590938.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070570.60, 590937.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070567.70, 590935.34) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 758.0 Dvl range = 89.0, range = 205.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 107.6, iterations = 0, grazing = 0.0 beam3 range = 97.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070564.80, 590933.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070561.90, 590931.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070558.99, 590930.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070556.09, 590928.45) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 762.0 Dvl range = 88.6, range = 204.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 104.4, iterations = 0, grazing = 0.0 beam3 range = 100.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070553.19, 590926.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070550.28, 590925.00) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070547.38, 590923.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070544.48, 590921.56) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 764.0 Dvl range = 88.6, range = 204.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 109.0, iterations = 0, grazing = 0.0 beam3 range = 95.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070541.57, 590919.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070538.67, 590918.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070535.77, 590916.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070532.87, 590914.67) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 766.0 Dvl range = 88.2, range = 203.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 110.3, iterations = 0, grazing = 0.0 beam3 range = 93.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070529.96, 590912.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070527.06, 590911.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070524.16, 590909.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070521.26, 590907.79) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 770.0 Dvl range = 86.2, range = 199.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 107.1, iterations = 0, grazing = 0.0 beam3 range = 91.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070518.35, 590906.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070515.45, 590904.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070512.55, 590902.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070509.64, 590900.90) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 772.0 Dvl range = 85.5, range = 197.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 108.8, iterations = 0, grazing = 0.0 beam3 range = 88.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070506.74, 590899.18) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070503.84, 590897.46) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2800.00, (simTime - realTime) = 0.00 Heading = 210.66 Depth = 729.94 Speed = 1.15 Pitch = -19.80 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070500.94, 590895.73) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070498.03, 590894.01) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 772.0 Dvl range = 80.8, range = 186.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 102.7, iterations = 0, grazing = 0.0 beam3 range = 83.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070495.13, 590892.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070492.23, 590890.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070489.33, 590888.85) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070486.42, 590887.12) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 774.0 Dvl range = 78.5, range = 181.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 99.3, iterations = 0, grazing = 0.0 beam3 range = 82.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070483.52, 590885.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070480.62, 590883.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070477.72, 590881.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070474.81, 590880.24) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 776.0 Dvl range = 74.5, range = 172.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 94.2, iterations = 0, grazing = 0.0 beam3 range = 77.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070471.91, 590878.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070469.01, 590876.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070466.11, 590875.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070463.21, 590873.35) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 776.0 Dvl range = 70.9, range = 163.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 93.1, iterations = 0, grazing = 0.0 beam3 range = 70.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070460.30, 590871.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070457.40, 590869.91) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070454.50, 590868.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070451.60, 590866.46) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 778.0 Dvl range = 68.9, range = 159.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 89.9, iterations = 0, grazing = 0.0 beam3 range = 69.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070448.69, 590864.74) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070445.79, 590863.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070442.89, 590861.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070439.99, 590859.58) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 780.0 Dvl range = 65.9, range = 152.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 84.6, iterations = 0, grazing = 0.0 beam3 range = 67.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070437.08, 590857.86) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070434.18, 590856.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070431.26, 590854.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070428.32, 590852.65) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 782.0 Dvl range = 60.1, range = 138.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 73.5, iterations = 0, grazing = 0.0 beam3 range = 65.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070425.35, 590850.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070422.34, 590849.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070419.29, 590847.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070416.22, 590845.47) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 784.0 Dvl range = 61.0, range = 140.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 74.8, iterations = 0, grazing = 0.0 beam3 range = 66.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070413.12, 590843.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070410.01, 590841.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070406.88, 590839.95) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 2900.00, (simTime - realTime) = 0.00 Heading = 210.60 Depth = 756.29 Speed = 1.23 Pitch = -15.29 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070403.74, 590838.09) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 788.0 Dvl range = 60.4, range = 139.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 74.2, iterations = 0, grazing = 0.0 beam3 range = 65.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070400.59, 590836.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070397.44, 590834.36) : _tercom->outstandingMeas() = 0 : WaypointDepth has set the state to finished. : Waypoint (4070394.7, 590832.7), reached at t = 2909.80 (wplog) : Vehicle Position error is (0.2, 0.1) : LayeredControl::execute() -- (t = 2909.800000) Behavior waypoint_depth:-1 has changed to state Finished : Reson Behavior::log=-1,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,200.000000,-1.000000,-1.000000,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB range to 200.000000 : LayeredControl::execute() -- (t = 2909.800000) Behavior reson:-1 has changed to state Finished : WaypointDepth initialization: Begin waypoint control at t= 2909.80 (wplog) The current location (N,E) = 4070394.5 , 590832.6 (wplog) The next waypoint = 4070235.3 , 590698.4 (wplog) The bearing to the next w.p. is 220.1 Degrees. The distance to the next w.p. is 208.3 Meters. The slope to the next w.p. is -0.2416. The initial commanded depth is 761.7 meters. The final commanded depth is 812.1 meters. : LayeredControl::execute() -- (t = 2909.800000) Behavior waypoint_depth:-1 has changed to state Active : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070394.30, 590832.51) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070391.18, 590830.65) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 794.0 Dvl range = 62.1, range = 143.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 74.1, iterations = 0, grazing = 0.0 beam3 range = 69.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070388.19, 590828.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070385.37, 590826.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070382.73, 590824.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070380.21, 590821.79) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 800.0 Dvl range = 68.0, range = 157.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 77.7, iterations = 0, grazing = 0.0 beam3 range = 79.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070377.77, 590819.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070375.36, 590816.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070372.95, 590814.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070370.54, 590812.07) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 802.0 Dvl range = 69.8, range = 161.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 80.0, iterations = 0, grazing = 0.0 beam3 range = 81.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070368.11, 590809.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070365.66, 590807.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.20, 590805.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070360.74, 590803.02) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 806.0 Dvl range = 69.4, range = 160.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 80.7, iterations = 0, grazing = 0.0 beam3 range = 79.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070358.28, 590800.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070355.83, 590798.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070353.37, 590796.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070350.91, 590794.91) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 812.0 Dvl range = 69.1, range = 159.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 79.8, iterations = 0, grazing = 0.0 beam3 range = 79.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070348.45, 590792.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070345.99, 590791.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070343.52, 590789.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070341.06, 590787.19) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 814.0 Dvl range = 69.4, range = 160.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 83.9, iterations = 0, grazing = 0.0 beam3 range = 76.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070338.60, 590785.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070336.14, 590783.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070333.66, 590781.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070331.19, 590779.41) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 818.0 Dvl range = 69.5, range = 160.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 88.5, iterations = 0, grazing = 0.0 beam3 range = 72.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070328.71, 590777.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070326.22, 590775.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070323.72, 590773.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070321.22, 590771.26) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 822.0 Dvl range = 69.4, range = 160.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 89.1, iterations = 0, grazing = 0.0 beam3 range = 71.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070318.71, 590769.16) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3000.00, (simTime - realTime) = 0.00 Heading = 220.23 Depth = 785.37 Speed = 1.12 Pitch = -19.99 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070316.20, 590767.04) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070313.68, 590764.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070311.16, 590762.73) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 824.0 Dvl range = 64.4, range = 148.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 80.1, iterations = 0, grazing = 0.0 beam3 range = 68.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070308.63, 590760.55) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070306.09, 590758.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070303.55, 590756.15) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070301.00, 590753.93) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 828.0 Dvl range = 65.1, range = 150.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 78.8, iterations = 0, grazing = 0.0 beam3 range = 71.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070298.44, 590751.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070295.87, 590749.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 99.20 : _navData-> (x,y) = (4070293.30, 590747.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 99.20 : _navData-> (x,y) = (4070290.72, 590745.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 830.0 Dvl range = 62.5, range = 144.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 75.1, iterations = 0, grazing = 0.0 beam3 range = 69.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 98.05 : _navData-> (x,y) = (4070288.13, 590742.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 98.05 : _navData-> (x,y) = (4070285.54, 590740.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 94.40 : _navData-> (x,y) = (4070282.94, 590738.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 94.40 : _navData-> (x,y) = (4070280.33, 590736.22) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 834.0 Dvl range = 61.7, range = 142.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 75.8, iterations = 0, grazing = 0.0 beam3 range = 66.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 89.37 : _navData-> (x,y) = (4070277.72, 590734.01) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 89.37 : _navData-> (x,y) = (4070275.10, 590731.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 86.30 : _navData-> (x,y) = (4070272.49, 590729.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 86.30 : _navData-> (x,y) = (4070269.86, 590727.43) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 834.0 Dvl range = 60.1, range = 138.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 74.4, iterations = 0, grazing = 0.0 beam3 range = 64.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 86.83 : _navData-> (x,y) = (4070267.24, 590725.24) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 86.83 : _navData-> (x,y) = (4070264.62, 590723.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 84.04 : _navData-> (x,y) = (4070261.99, 590720.86) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 84.04 : _navData-> (x,y) = (4070259.37, 590718.67) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 834.0 Dvl range = 92.2, range = 319.4 numValidBeams = 3 beam1 range = 184.9, iterations = 0, grazing = 0.0 beam2 range = 73.1, iterations = 0, grazing = 0.0 beam3 range = 61.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 82.21 : _navData-> (x,y) = (4070256.75, 590716.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 82.21 : _navData-> (x,y) = (4070254.12, 590714.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 85.34 : _navData-> (x,y) = (4070251.47, 590712.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 85.34 : _navData-> (x,y) = (4070248.81, 590709.82) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 836.0 Dvl range = 55.2, range = 127.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 68.0, iterations = 0, grazing = 0.0 beam3 range = 59.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 83.63 : _navData-> (x,y) = (4070246.11, 590707.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 83.63 : _navData-> (x,y) = (4070243.39, 590705.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 98.98, IDT[75] = 84.83 : _navData-> (x,y) = (4070240.63, 590702.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 98.98, IDT[75] = 84.83 : _navData-> (x,y) = (4070237.86, 590700.61) : _tercom->outstandingMeas() = 0 : WaypointDepth has set the state to finished. : Waypoint (4070235.3, 590698.4), reached at t = 3095.80 (wplog) : Vehicle Position error is (0.0, 0.0) : LayeredControl::execute() -- (t = 3095.800000) Behavior waypoint_depth:-1 has changed to state Finished : Reson Behavior::log=-1,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,200.000000,-1.000000,-1.000000,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB range to 200.000000 : LayeredControl::execute() -- (t = 3095.800000) Behavior reson:-1 has changed to state Finished : WaypointDepth initialization: Begin waypoint control at t= 3095.80 (wplog) The current location (N,E) = 4070235.3 , 590698.4 (wplog) The next waypoint = 4070104.4 , 590495.1 (wplog) The bearing to the next w.p. is 237.2 Degrees. The distance to the next w.p. is 241.8 Meters. The slope to the next w.p. is -0.2114. The initial commanded depth is 812.1 meters. The final commanded depth is 863.2 meters. : LayeredControl::execute() -- (t = 3095.800000) Behavior waypoint_depth:-1 has changed to state Active : SimulatedDvlSide::get() waterDepth(0.,0.) = 840.0 Dvl range = 53.6, range = 123.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 65.1, iterations = 0, grazing = 0.0 beam3 range = 58.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 95.31, IDT[75] = 82.55 : _navData-> (x,y) = (4070235.07, 590698.26) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 95.31, IDT[75] = 82.55 : _navData-> (x,y) = (4070232.28, 590695.91) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3100.00, (simTime - realTime) = 0.00 Heading = 227.20 Depth = 811.04 Speed = 1.22 Pitch = -16.08 : TerrainAidDriver::readData() - IDT[45] = 98.39, IDT[75] = 87.07 : _navData-> (x,y) = (4070229.75, 590693.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 98.39, IDT[75] = 87.07 : _navData-> (x,y) = (4070227.58, 590690.53) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 848.0 Dvl range = 60.7, range = 140.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 71.8, iterations = 0, grazing = 0.0 beam3 range = 68.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 99.00 : _navData-> (x,y) = (4070225.73, 590687.52) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 99.00 : _navData-> (x,y) = (4070224.13, 590684.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070222.69, 590681.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070221.33, 590678.14) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 854.0 Dvl range = 61.3, range = 141.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 73.3, iterations = 0, grazing = 0.0 beam3 range = 68.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070220.00, 590675.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070218.64, 590671.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 96.52 : _navData-> (x,y) = (4070217.24, 590668.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 96.52 : _navData-> (x,y) = (4070215.76, 590665.98) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 858.0 Dvl range = 62.2, range = 143.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 72.7, iterations = 0, grazing = 0.0 beam3 range = 70.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 94.62 : _navData-> (x,y) = (4070214.19, 590663.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 94.62 : _navData-> (x,y) = (4070212.54, 590660.18) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 91.33 : _navData-> (x,y) = (4070210.81, 590657.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 91.33 : _navData-> (x,y) = (4070208.99, 590654.53) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 866.0 Dvl range = 62.1, range = 143.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 70.4, iterations = 0, grazing = 0.0 beam3 range = 73.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 91.71 : _navData-> (x,y) = (4070207.10, 590651.74) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 91.71 : _navData-> (x,y) = (4070205.15, 590648.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 98.71, IDT[75] = 88.19 : _navData-> (x,y) = (4070203.15, 590646.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 98.71, IDT[75] = 88.19 : _navData-> (x,y) = (4070201.11, 590643.45) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 870.0 Dvl range = 60.8, range = 140.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 70.4, iterations = 0, grazing = 0.0 beam3 range = 70.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 97.45, IDT[75] = 86.10 : _navData-> (x,y) = (4070199.03, 590640.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 97.45, IDT[75] = 86.10 : _navData-> (x,y) = (4070196.95, 590637.91) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 97.46, IDT[75] = 85.64 : _navData-> (x,y) = (4070194.85, 590635.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 97.46, IDT[75] = 85.64 : _navData-> (x,y) = (4070192.77, 590632.31) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 870.0 Dvl range = 61.9, range = 142.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 75.6, iterations = 0, grazing = 0.0 beam3 range = 67.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 98.45, IDT[75] = 82.76 : _navData-> (x,y) = (4070190.69, 590629.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 98.45, IDT[75] = 82.76 : _navData-> (x,y) = (4070188.64, 590626.59) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 83.25 : _navData-> (x,y) = (4070186.61, 590623.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 83.25 : _navData-> (x,y) = (4070184.61, 590620.77) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 874.0 Dvl range = 60.5, range = 139.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 72.8, iterations = 0, grazing = 0.0 beam3 range = 66.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 96.44, IDT[75] = 85.74 : _navData-> (x,y) = (4070182.64, 590617.81) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 96.44, IDT[75] = 85.74 : _navData-> (x,y) = (4070180.70, 590614.83) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 97.72, IDT[75] = 66.56 : _navData-> (x,y) = (4070178.78, 590611.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 97.72, IDT[75] = 66.56 : _navData-> (x,y) = (4070176.88, 590608.80) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 876.0 Dvl range = 58.9, range = 136.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 69.6, iterations = 0, grazing = 0.0 beam3 range = 66.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 94.10, IDT[75] = 0.00 : _navData-> (x,y) = (4070175.00, 590605.77) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 94.10, IDT[75] = 0.00 : _navData-> (x,y) = (4070173.13, 590602.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 94.09, IDT[75] = 0.00 : _navData-> (x,y) = (4070171.28, 590599.66) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3200.00, (simTime - realTime) = 0.00 Heading = 238.80 Depth = 837.11 Speed = 1.21 Pitch = -17.08 : TerrainAidDriver::readData() - IDT[45] = 94.09, IDT[75] = 0.00 : _navData-> (x,y) = (4070169.42, 590596.61) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 876.0 Dvl range = 56.2, range = 129.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 67.2, iterations = 0, grazing = 0.0 beam3 range = 62.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 97.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070167.57, 590593.55) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 97.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070165.71, 590590.49) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070163.85, 590587.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070161.97, 590584.40) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 878.0 Dvl range = 56.4, range = 130.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 69.1, iterations = 0, grazing = 0.0 beam3 range = 61.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070160.09, 590581.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070158.19, 590578.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 65.61, IDT[75] = 0.00 : _navData-> (x,y) = (4070156.28, 590575.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 65.61, IDT[75] = 0.00 : _navData-> (x,y) = (4070154.36, 590572.30) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 882.0 Dvl range = 57.4, range = 132.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 68.4, iterations = 0, grazing = 0.0 beam3 range = 64.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 64.43, IDT[75] = 0.00 : _navData-> (x,y) = (4070152.43, 590569.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 64.43, IDT[75] = 0.00 : _navData-> (x,y) = (4070150.49, 590566.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070148.54, 590563.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070146.59, 590560.31) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 884.0 Dvl range = 56.4, range = 130.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 67.0, iterations = 0, grazing = 0.0 beam3 range = 63.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070144.64, 590557.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070142.68, 590554.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070140.72, 590551.37) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070138.76, 590548.38) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 886.0 Dvl range = 59.5, range = 137.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 67.9, iterations = 0, grazing = 0.0 beam3 range = 69.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070136.81, 590545.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070134.85, 590542.42) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070132.91, 590539.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070130.96, 590536.45) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 888.0 Dvl range = 62.2, range = 143.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 68.1, iterations = 0, grazing = 0.0 beam3 range = 75.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070129.02, 590533.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070127.09, 590530.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070125.16, 590527.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070123.23, 590524.48) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 892.0 Dvl range = 67.2, range = 155.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 74.5, iterations = 0, grazing = 0.0 beam3 range = 80.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070121.30, 590521.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070119.38, 590518.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070117.46, 590515.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070115.55, 590512.48) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 896.0 Dvl range = 76.4, range = 176.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 81.6, iterations = 0, grazing = 0.0 beam3 range = 94.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070113.63, 590509.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070111.71, 590506.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070109.79, 590503.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070107.88, 590500.48) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 888.0 Dvl range = 77.8, range = 179.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 89.0, iterations = 0, grazing = 0.0 beam3 range = 90.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070105.96, 590497.48) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3300.00, (simTime - realTime) = 0.00 Heading = 237.35 Depth = 862.02 Speed = 1.21 Pitch = -17.30 : WaypointDepth has set the state to finished. : Waypoint (4070104.4, 590495.1), reached at t = 3302.40 (wplog) : Vehicle Position error is (0.0, 0.0) : LayeredControl::execute() -- (t = 3302.400000) Behavior waypoint_depth:-1 has changed to state Finished : Reson Behavior::log=-1,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,200.000000,-1.000000,-1.000000,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB range to 200.000000 : LayeredControl::execute() -- (t = 3302.400000) Behavior reson:-1 has changed to state Finished : WaypointDepth initialization: Begin waypoint control at t= 3302.40 (wplog) The current location (N,E) = 4070104.4 , 590495.1 (wplog) The next waypoint = 4070362.1 , 590015.0 (wplog) The bearing to the next w.p. is 298.2 Degrees. The distance to the next w.p. is 544.9 Meters. The slope to the next w.p. is -0.0702. The initial commanded depth is 863.2 meters. The final commanded depth is 901.4 meters. : LayeredControl::execute() -- (t = 3302.400000) Behavior waypoint_depth:-1 has changed to state Active : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070104.04, 590494.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070102.11, 590491.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070100.49, 590488.33) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 892.0 Dvl range = 89.5, range = 103.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 103.3, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = f3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070099.52, 590484.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070099.35, 590481.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070100.03, 590478.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070101.53, 590474.95) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 892.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070103.78, 590472.24) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070106.60, 590469.89) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070109.79, 590467.74) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070113.19, 590465.56) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 880.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070116.62, 590463.14) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070119.92, 590460.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070123.03, 590457.33) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070125.90, 590454.08) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 906.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070128.50, 590450.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070130.84, 590447.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070132.97, 590444.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070134.94, 590440.91) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 910.0 Dvl range = 163.8, range = 189.1 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 189.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070136.79, 590437.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070138.57, 590434.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070140.29, 590431.01) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070141.98, 590427.63) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 914.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070143.65, 590424.19) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070145.31, 590420.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070146.97, 590417.15) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070148.66, 590413.55) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 918.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070150.37, 590409.91) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070152.12, 590406.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070153.91, 590402.55) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070155.74, 590398.84) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 920.0 Dvl range = 0.0, range = 0.0 numValidBeams = 0 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 0.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = ff : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070157.62, 590395.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070159.54, 590391.41) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3400.00, (simTime - realTime) = 0.00 Heading = 297.96 Depth = 872.39 Speed = 1.40 Pitch = -6.99 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070161.50, 590387.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070163.50, 590383.98) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 920.0 Dvl range = 171.0, range = 197.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 197.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070165.52, 590380.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070167.57, 590376.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070169.63, 590372.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070171.70, 590369.18) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 924.0 Dvl range = 167.4, range = 193.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 193.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070173.77, 590365.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070175.84, 590361.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070177.90, 590358.10) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070179.95, 590354.40) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 924.0 Dvl range = 155.2, range = 179.2 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 179.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070182.00, 590350.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070184.03, 590346.99) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070186.05, 590343.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070188.05, 590339.56) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 924.0 Dvl range = 152.0, range = 175.5 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 175.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070190.05, 590335.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070192.04, 590332.12) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070194.02, 590328.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070195.99, 590324.67) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 926.0 Dvl range = 154.3, range = 178.1 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 178.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070197.96, 590320.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070199.94, 590317.22) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070201.91, 590313.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070203.88, 590309.78) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 928.0 Dvl range = 150.0, range = 173.2 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 173.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070205.85, 590306.06) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070207.83, 590302.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070209.81, 590298.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070211.79, 590294.92) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 926.0 Dvl range = 146.3, range = 169.0 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 169.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070213.78, 590291.21) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070215.77, 590287.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070217.76, 590283.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070219.75, 590280.09) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 926.0 Dvl range = 155.6, range = 359.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 193.1, iterations = 0, grazing = 0.0 beam3 range = 166.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070221.75, 590276.39) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070223.74, 590272.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070225.74, 590268.98) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3500.00, (simTime - realTime) = 0.00 Heading = 298.32 Depth = 881.33 Speed = 1.40 Pitch = -8.06 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070227.73, 590265.28) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 926.0 Dvl range = 148.8, range = 343.6 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 188.9, iterations = 0, grazing = 0.0 beam3 range = 154.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070229.72, 590261.58) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070231.72, 590257.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070233.71, 590254.18) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070235.70, 590250.48) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 926.0 Dvl range = 147.1, range = 339.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 184.7, iterations = 0, grazing = 0.0 beam3 range = 155.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070237.69, 590246.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070239.68, 590243.08) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070241.66, 590239.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070243.65, 590235.67) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 928.0 Dvl range = 141.5, range = 326.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 176.2, iterations = 0, grazing = 0.0 beam3 range = 150.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070245.63, 590231.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070247.62, 590228.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070249.60, 590224.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070251.59, 590220.87) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 928.0 Dvl range = 137.7, range = 318.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 172.0, iterations = 0, grazing = 0.0 beam3 range = 146.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070253.57, 590217.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070255.55, 590213.46) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070257.54, 590209.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070259.52, 590206.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 928.0 Dvl range = 134.7, range = 311.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 167.8, iterations = 0, grazing = 0.0 beam3 range = 143.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070261.51, 590202.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070263.49, 590198.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070265.47, 590194.96) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070267.46, 590191.27) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 926.0 Dvl range = 130.1, range = 300.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 163.5, iterations = 0, grazing = 0.0 beam3 range = 136.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070269.44, 590187.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070271.43, 590183.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070273.41, 590180.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070275.40, 590176.47) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 928.0 Dvl range = 129.9, range = 300.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 167.7, iterations = 0, grazing = 0.0 beam3 range = 132.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070277.39, 590172.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070279.37, 590169.08) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070281.36, 590165.38) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070283.34, 590161.68) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 928.0 Dvl range = 116.2, range = 268.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 147.2, iterations = 0, grazing = 0.0 beam3 range = 121.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070285.33, 590157.99) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070287.31, 590154.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070289.29, 590150.59) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070291.28, 590146.89) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 928.0 Dvl range = 115.4, range = 399.9 numValidBeams = 3 beam1 range = 134.2, iterations = 0, grazing = 0.0 beam2 range = 144.6, iterations = 0, grazing = 0.0 beam3 range = 121.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070293.26, 590143.20) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3600.00, (simTime - realTime) = 0.00 Heading = 298.22 Depth = 891.02 Speed = 1.40 Pitch = -8.17 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070295.25, 590139.50) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070297.23, 590135.80) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070299.21, 590132.11) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 930.0 Dvl range = 112.4, range = 389.4 numValidBeams = 3 beam1 range = 132.9, iterations = 0, grazing = 0.0 beam2 range = 140.5, iterations = 0, grazing = 0.0 beam3 range = 116.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070301.20, 590128.41) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070303.18, 590124.71) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070305.17, 590121.02) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070307.15, 590117.32) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 932.0 Dvl range = 108.1, range = 249.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 136.1, iterations = 0, grazing = 0.0 beam3 range = 113.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070309.13, 590113.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070311.12, 590109.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070313.10, 590106.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070315.08, 590102.53) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 930.0 Dvl range = 107.7, range = 248.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 136.1, iterations = 0, grazing = 0.0 beam3 range = 112.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070317.07, 590098.84) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070319.05, 590095.14) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070321.03, 590091.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070323.02, 590087.75) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 932.0 Dvl range = 110.0, range = 381.0 numValidBeams = 3 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 119.4, iterations = 0, grazing = 0.0 beam3 range = 128.1, iterations = 0, grazing = 0.0 beam4 range = 133.5, iterations = 0, grazing = 0.0 bottomStatus = 3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070325.00, 590084.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070326.99, 590080.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070328.97, 590076.66) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070330.95, 590072.96) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 934.0 Dvl range = 107.5, range = 248.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 117.2, iterations = 0, grazing = 0.0 beam3 range = 131.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070332.94, 590069.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070334.92, 590065.57) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070336.90, 590061.87) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070338.89, 590058.18) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 936.0 Dvl range = 109.1, range = 252.0 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 115.1, iterations = 0, grazing = 0.0 beam3 range = 136.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070340.87, 590054.48) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070342.85, 590050.79) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070344.84, 590047.09) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070346.82, 590043.39) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 938.0 Dvl range = 115.5, range = 266.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 121.2, iterations = 0, grazing = 0.0 beam3 range = 145.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070348.80, 590039.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070350.79, 590036.00) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070352.77, 590032.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070354.75, 590028.61) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 938.0 Dvl range = 129.2, range = 298.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 139.9, iterations = 0, grazing = 0.0 beam3 range = 158.5, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070356.74, 590024.92) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070358.72, 590021.22) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3700.00, (simTime - realTime) = 0.00 Heading = 298.22 Depth = 900.82 Speed = 1.40 Pitch = -8.19 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070360.70, 590017.52) : _tercom->outstandingMeas() = 0 : WaypointDepth has set the state to finished. : Waypoint (4070362.1, 590015.0), reached at t = 3704.20 (wplog) : Vehicle Position error is (-0.1, 0.2) : LayeredControl::execute() -- (t = 3704.200000) Behavior waypoint_depth:-1 has changed to state Finished : Reson Behavior::log=-1,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,200.000000,-1.000000,-1.000000,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB range to 200.000000 : LayeredControl::execute() -- (t = 3704.200000) Behavior reson:-1 has changed to state Finished : WaypointDepth initialization: Begin waypoint control at t= 3704.20 (wplog) The current location (N,E) = 4070362.2 , 590014.8 (wplog) The next waypoint = 4070363.9 , 589807.0 (wplog) The bearing to the next w.p. is 270.5 Degrees. The distance to the next w.p. is 207.8 Meters. The slope to the next w.p. is 0.0551. The initial commanded depth is 901.4 meters. The final commanded depth is 890.0 meters. : LayeredControl::execute() -- (t = 3704.200000) Behavior waypoint_depth:-1 has changed to state Active : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070362.69, 590013.83) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 942.0 Dvl range = 120.9, range = 279.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 127.0, iterations = 0, grazing = 0.0 beam3 range = 152.2, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070364.61, 590010.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070365.92, 590006.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070366.39, 590002.25) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070366.15, 589998.20) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 942.0 Dvl range = 120.3, range = 277.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 154.4, iterations = 0, grazing = 0.0 beam3 range = 123.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070365.42, 589994.17) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070364.38, 589990.14) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.20, 589986.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070362.03, 589981.93) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 944.0 Dvl range = 115.5, range = 266.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 139.7, iterations = 0, grazing = 0.0 beam3 range = 126.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070361.02, 589977.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070360.22, 589973.36) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070359.69, 589968.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070359.43, 589964.45) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 946.0 Dvl range = 115.8, range = 267.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 122.4, iterations = 0, grazing = 0.0 beam3 range = 145.0, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070359.42, 589959.91) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070359.62, 589955.35) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070360.00, 589950.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070360.51, 589946.17) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 950.0 Dvl range = 124.7, range = 288.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 136.7, iterations = 0, grazing = 0.0 beam3 range = 151.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070361.08, 589941.56) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070361.67, 589936.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070362.24, 589932.30) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070362.76, 589927.65) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 950.0 Dvl range = 123.5, range = 285.3 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 134.6, iterations = 0, grazing = 0.0 beam3 range = 150.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.20, 589922.99) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.54, 589918.32) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.79, 589913.65) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.95, 589908.97) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 950.0 Dvl range = 128.4, range = 296.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 139.7, iterations = 0, grazing = 0.0 beam3 range = 156.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070364.02, 589904.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070364.02, 589899.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.97, 589894.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.88, 589890.27) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 950.0 Dvl range = 129.1, range = 298.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 144.8, iterations = 0, grazing = 0.0 beam3 range = 153.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.76, 589885.60) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.64, 589880.93) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.52, 589876.27) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3800.00, (simTime - realTime) = 0.00 Heading = 268.87 Depth = 894.50 Speed = 1.56 Pitch = 0.14 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.42, 589871.60) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 950.0 Dvl range = 135.1, range = 311.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 154.4, iterations = 0, grazing = 0.0 beam3 range = 157.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.34, 589866.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.28, 589862.27) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.25, 589857.61) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.25, 589852.94) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 950.0 Dvl range = 136.9, range = 316.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 157.9, iterations = 0, grazing = 0.0 beam3 range = 158.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.27, 589848.28) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.32, 589843.62) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.38, 589838.95) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.45, 589834.29) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 952.0 Dvl range = 142.6, range = 329.4 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 157.6, iterations = 0, grazing = 0.0 beam3 range = 171.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.53, 589829.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.61, 589824.97) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.69, 589820.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.77, 589815.65) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 952.0 Dvl range = 142.0, range = 327.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 158.0, iterations = 0, grazing = 0.0 beam3 range = 169.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.84, 589811.00) : _tercom->outstandingMeas() = 0 : WaypointDepth has set the state to finished. : Waypoint (4070363.9, 589807.0), reached at t = 3842.60 (wplog) : Vehicle Position error is (0.0, 0.0) : LayeredControl::execute() -- (t = 3842.600000) Behavior waypoint_depth:-1 has changed to state Finished : sending status via acoustic modem : LayeredControl::execute() -- (t = 3842.600000) Behavior acousticUpdate:-1 has changed to state Finished : Reson Behavior::log=-1,sbp=-1,-1.000000 | hiss=-1,-1.000000,-1.000000,-1.000000 | loss=-1,-1.000000,-1.000000,-1.000000 | mb=-1,-1.000000,-1.000000,200.000000,-1.000000,-1.000000,0.000000 | pulse="","" : Reson Behavior: Tell Multibeam to set MB sound velocity : Reson Behavior: Setting MB range to 200.000000 : LayeredControl::execute() -- (t = 3842.600000) Behavior reson:-1 has changed to state Finished : WaypointWall::Escape - escape is true. Check to see if a wall was present. : WaypointWall::Escape - wallAbsentTime = 70.0, : WaypointWall::Escape - _lastWallTime = 0.0, mission time = 3842.60, _wallBearing = 0.0 : WaypointWall::Escape - Wall absent for 1489088814.7 seconds at 1489088814.65 . Terminate. : WaypointWall::Escape - current position (4070363.9, 589807.0), reached at t = 3842.60 : LayeredControl::execute() -- (t = 3842.600000) Behavior waypoint_wall:-1 has changed to state Finished : WaypointWall initialization: Begin waypoint control at t= 3842.60 (wplog) The current location (N,E) = 4070363.9 , 589807.0 (wplog) The next waypoint = 4070208.0 , 589628.6 (wplog) The bearing to the next w.p. is 228.9 Degrees. The distance to the next w.p. is 236.9 Meters. The slope to the next w.p. is 0.0000. The initial commanded depth is 890.0 meters. The final commanded depth is 890.0 meters. : WaypointWall:: standOff = 50.00 at 3842.60 : WaypointWall:: projection = 3 at 3842.60 : WaypointWall:: windowLen = 31 at 3842.60 : WaypointWall:: filterType = 3 at 3842.60 : WaypointWall:: escape = 0 at 3842.60 : WaypointWall:: waypointPriority = 0 at 3842.60 : WaypointWall::Forward-looking DeltaT IS enabled at t=3842.60 sec. : WaypointWall: Number of beams in the array = 210, beamOverlap=30 fwdCutover=15 : WaypointWall::Total number of beams is 210, t=3842.60 sec. : LayeredControl::execute() -- (t = 3842.600000) Behavior waypoint_wall:-1 has changed to state Active : DynamicControlServer::Begin horizontal mode 5 at t = 3842.60 sec. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.91, 589806.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.95, 589801.70) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070363.39, 589797.20) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 952.0 Dvl range = 156.0, range = 360.2 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 199.9, iterations = 0, grazing = 0.0 beam3 range = 160.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070361.76, 589793.13) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070359.13, 589789.76) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070355.84, 589787.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070352.23, 589784.71) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 952.0 Dvl range = 151.4, range = 174.8 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 174.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070348.48, 589782.54) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070344.76, 589780.31) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070341.15, 589777.90) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070337.69, 589775.27) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 954.0 Dvl range = 126.7, range = 146.3 numValidBeams = 1 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 0.0, iterations = 0, grazing = 0.0 beam3 range = 146.3, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = cf : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070334.41, 589772.44) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070331.28, 589769.43) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070328.27, 589766.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070325.33, 589763.06) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 952.0 Dvl range = 134.6, range = 310.8 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 177.0, iterations = 0, grazing = 0.0 beam3 range = 133.8, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070322.45, 589759.78) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070319.59, 589756.45) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070316.72, 589753.11) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070313.85, 589749.76) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 952.0 Dvl range = 131.1, range = 302.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 178.1, iterations = 0, grazing = 0.0 beam3 range = 124.6, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070310.97, 589746.41) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 3900.00, (simTime - realTime) = 0.00 Heading = 229.16 Depth = 889.70 Speed = 1.47 Pitch = -3.84 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070308.08, 589743.07) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070305.17, 589739.72) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070302.25, 589736.37) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 954.0 Dvl range = 125.4, range = 289.5 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 161.9, iterations = 0, grazing = 0.0 beam3 range = 127.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070299.33, 589733.03) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070296.41, 589729.68) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070293.48, 589726.34) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070290.55, 589722.99) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 956.0 Dvl range = 110.4, range = 254.9 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 144.0, iterations = 0, grazing = 0.0 beam3 range = 110.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070287.62, 589719.64) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070284.69, 589716.29) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070281.76, 589712.94) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070278.83, 589709.59) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 956.0 Dvl range = 101.6, range = 234.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 129.7, iterations = 0, grazing = 0.0 beam3 range = 105.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070275.90, 589706.23) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070272.97, 589702.88) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070270.04, 589699.53) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070267.11, 589696.17) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 956.0 Dvl range = 100.1, range = 231.1 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 128.0, iterations = 0, grazing = 0.0 beam3 range = 103.1, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070264.18, 589692.82) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070261.25, 589689.47) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070258.32, 589686.11) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070255.39, 589682.76) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 956.0 Dvl range = 94.7, range = 218.7 numValidBeams = 2 beam1 range = 0.0, iterations = 0, grazing = 0.0 beam2 range = 113.0, iterations = 0, grazing = 0.0 beam3 range = 105.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c3 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070252.46, 589679.40) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070249.53, 589676.05) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070246.59, 589672.69) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070243.66, 589669.34) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 956.0 Dvl range = 100.5, range = 348.1 numValidBeams = 3 beam1 range = 145.6, iterations = 0, grazing = 0.0 beam2 range = 108.1, iterations = 0, grazing = 0.0 beam3 range = 94.4, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070240.73, 589665.98) : _tercom->outstandingMeas() = 0 : WaypointWall::-45 < angle-to-wall < 45 deg. in B; Setting RHT at t=3972.20 sec. : DynamicControlServer:: RHT set to 1 at 3972.20 : DynamicControlServer:: wallPresent set to 1 at 3972.20 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070237.80, 589662.63) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070235.22, 589659.11) : _tercom->outstandingMeas() = 0 : DynamicControlServer:: RHT set to 0 at 3979.40 : DynamicControlServer:: _wallBearing reset to 5.14 at 3979.40 by L/RHT. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070233.56, 589655.22) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 956.0 Dvl range = 78.6, range = 272.4 numValidBeams = 3 beam1 range = 117.9, iterations = 0, grazing = 0.0 beam2 range = 74.8, iterations = 0, grazing = 0.0 beam3 range = 79.7, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 99.29 : _navData-> (x,y) = (4070232.99, 589651.11) : _tercom->outstandingMeas() = 0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070232.65, 589646.96) : _tercom->outstandingMeas() = 0 : WaypointWall::-45 < angle-to-wall < 45 deg. in B; Setting RHT at t=3989.60 sec. : DynamicControlServer:: RHT set to 1 at 3989.60 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 93.99 : _navData-> (x,y) = (4070231.73, 589642.94) : _tercom->outstandingMeas() = 0 : DynamicControlServer:: RHT set to 0 at 3990.00 : DynamicControlServer:: _wallBearing reset to 5.05 at 3990.00 by L/RHT. : WaypointWall::-45 < angle-to-wall < 45 deg. in B; Setting RHT at t=3990.60 sec. : DynamicControlServer:: RHT set to 1 at 3990.60 : WaypointWall::>5 Returns in sector 0 to 30 deg. in B; Setting RHT at t=3991.80 sec. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070229.93, 589639.31) : _tercom->outstandingMeas() = 0 : SimulatedDvlSide::get() waterDepth(0.,0.) = 942.0 Dvl range = 105.4, range = 365.1 numValidBeams = 3 beam1 range = 177.5, iterations = 0, grazing = 0.0 beam2 range = 112.7, iterations = 0, grazing = 0.0 beam3 range = 74.9, iterations = 0, grazing = 0.0 beam4 range = 0.0, iterations = 0, grazing = 0.0 bottomStatus = c0 : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 0.00 : _navData-> (x,y) = (4070227.37, 589636.17) : _tercom->outstandingMeas() = 0 : WaypointWall::-45 < angle-to-wall < 45 deg. in B; Setting RHT at t=3998.60 sec. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 92.75 : _navData-> (x,y) = (4070224.84, 589632.98) : _tercom->outstandingMeas() = 0 : Simulator:: Before the call to motion(): simTime = 4000.00, (simTime - realTime) = 0.00 Heading = 244.41 Depth = 889.70 Speed = 1.34 Pitch = -4.93 : DynamicControlServer:: RHT set to 0 at 4001.60 : DynamicControlServer:: _wallBearing reset to 5.15 at 4001.60 by L/RHT. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 86.21 : _navData-> (x,y) = (4070222.92, 589629.43) : _tercom->outstandingMeas() = 0 : WaypointWall::-45 < angle-to-wall < 45 deg. in B; Setting RHT at t=4002.20 sec. : DynamicControlServer:: RHT set to 1 at 4002.20 : DynamicControlServer:: RHT set to 0 at 4003.00 : DynamicControlServer:: _wallBearing reset to 5.16 at 4003.00 by L/RHT. : WaypointWall::-45 < angle-to-wall < 45 deg. in B; Setting RHT at t=4003.40 sec. : DynamicControlServer:: RHT set to 1 at 4003.40 : DynamicControlServer:: RHT set to 0 at 4003.80 : DynamicControlServer:: _wallBearing reset to 5.39 at 4003.80 by L/RHT. : TerrainAidDriver::readData() - IDT[45] = 0.00, IDT[75] = 78.56 : _navData-> (x,y) = (4070221.93, 589625.61) : _tercom->outstandingMeas() = 0 : TaskServer::signalHandler() for task WorkSiteIFServer - exit() on signal 2 : ****Time::cleanup FastTime instance[0007d140]] : TaskServer::signalHandler() for task InsIFServer - exit() on signal 2 : TaskServer::signalHandler() for task TailConeIFServer - exit() on signal 2 : TaskServer::signalHandler() for task GpsIFServer - exit() on signal 2 : TaskServer::signalHandler() for task DvlIFServer - exit() on signal 2 : TaskServer::signalHandler() for task UsblIFServer - exit() on signal 2 : TaskServer::signalHandler() for task EchoSounderIFServer - exit() on signal 2 : **** FastTime dtor [0007d140] **** : ****Time::cleanup FastTime instance[0003b1f4]] : ****Time::cleanup FastTime instance[000201dc]] : ****Time::cleanup FastTime instance[0004ad20]] : ****Time::cleanup FastTime instance[000313b8]] : ****Time::cleanup FastTime instance[0003bfd8]] : **** SharedData destructor for object FastTime **** : **** FastTime dtor [0003b1f4] **** : **** FastTime dtor [000201dc] **** : **** FastTime dtor [0004ad20] **** : **** FastTime dtor [000313b8] **** : **** FastTime dtor [0003bfd8] **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : destroying segment FastTime : destroying prot sem FastTime_prot : destroying segment FastTime : destroying segment FastTime : destroying segment FastTime : destroying segment FastTime : destroying segment FastTime : destroying notify sem FastTime_notify : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : TaskServer::signalHandler() for task VehicleConfigurationIFServer - exit() on signal 2 : TaskServer::signalHandler() for task DynamicControlIFServer - exit() on signal 2 : ****Time::cleanup FastTime instance[000a30b8]] : TaskServer::signalHandler() for task SimulatorIFServer - exit() on signal 2 : TaskServer::signalHandler() for task DepthSensorIFServer - exit() on signal 2 : TaskServer::signalHandler() for task DvlSideIFServer - exit() on signal 2 : TaskServer::signalHandler() for task DeltaTIFServer - exit() on signal 2 : TaskServer::signalHandler() for task Reson6046IFServer - exit() on signal 2 : TaskServer::signalHandler() for task BenthosModemServer - exit() on signal 2 : ****Time::cleanup FastTime instance[0003af7c]] : **** FastTime dtor [000a30b8] **** : ****Time::cleanup FastTime instance[0007b608]] : ****Time::cleanup FastTime instance[00021458]] : ****Time::cleanup FastTime instance[0002a7b0]] : ****Time::cleanup FastTime instance[0002d5f4]] : **** FastTime dtor [0003af7c] **** : **** SharedData destructor for object FastTime **** : **** FastTime dtor [0007b608] **** : **** FastTime dtor [00021458] **** : **** FastTime dtor [0002a7b0] **** : **** FastTime dtor [0002d5f4] **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : **** SharedData destructor for object FastTime **** : destroying segment FastTime : destroying segment FastTime : destroying segment FastTime : destroying segment FastTime : destroying segment FastTime : destroying segment FastTime : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying prot sem FastTime_prot : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : destroying notify sem FastTime_notify : **** SharedData destructor for object LayeredControlOutput_ShmemName **** : DynamicControlServer::Destructor. Difference between clock time and accumulated sample periods is 0.00, at t=4005.00. : destroying segment LayeredControlOutput_ShmemName : destroying prot sem LayeredControlOutput_ShmemName_prot : destroying notify sem LayeredControlOutput_ShmemName_notify : **** SharedData destructor for object LayeredControlInput_ShmemName **** : destroying segment LayeredControlInput_ShmemName : destroying prot sem LayeredControlInput_ShmemName_prot : destroying notify sem LayeredControlInput_ShmemName_notify //1/home/henthorn/AUV/auv-qnx/auv/altex/onboard/bin/layeredControl terminated (SIGSEGV) at 0007:0005C458. : NavigationOutput::~NavigationOutput() : **** SharedData destructor for object navigationOutput **** : destroying segment navigationOutput : destroying prot sem navigationOutput_prot : destroying notify sem navigationOutput_notify : CameraDestructor Executing. : TaskServer::signalHandler() for task NavigationIFServer - exit() on signal 18 : TaskServer::signalHandler() for task LayeredControlIFServer - exit() on signal 18 : TaskServer::signalHandler() for task CathxIFServer - exit() on signal 2 : TaskServer::signalHandler() for task CameraIFServer - exit() on signal 2 : SerialDeviceExt::closeSD() - closed : Supervisor::signalHandler - caught signal 2 : TaskServer::signalHandler() for task EventLogIFServer - exit() on signal 2 : TaskServer::signalHandler() for task ExternalCommsIFServer - exit() on signal 2 : TaskServer::signalHandler() for task AhrsIFServer - exit() on signal 2 : TaskServer::signalHandler() for task ctdDriver - exit() on signal 2 : TaskServer::signalHandler() for task BluefinBatteryIFServer - exit() on signal 2 : TaskServer::signalHandler() for task HydroscatIFServer - exit() on signal 2 : TaskServer::signalHandler() for task IsusIFServer - exit() on signal 2 : TaskServer::signalHandler() for task GulperIFServer - exit() on signal 2 : TaskServer::signalHandler() for task CARL_IFServer - exit() on signal 2 : TaskServer::signalHandler() for task TerrainAidIFServer - exit() on signal 2 : NavigationOutput::~NavigationOutput() : **** SharedData destructor for object LayeredControlInput_ShmemName **** : **** SharedData destructor for object CameraOutput **** : **** SharedData destructor for object CameraOutput **** : **** FastTime dtor [00084b80] **** : **** SharedData destructor for object FastTime **** : destroying segment FastTime : destroying prot sem FastTime_prot : destroying notify sem FastTime_notify : **** SharedData destructor for object navigationOutput **** : destroying segment LayeredControlInput_ShmemName : destroying segment CameraOutput : destroying segment CameraOutput : destroying segment navigationOutput : destroying prot sem LayeredControlInput_ShmemName_prot : destroying prot sem CameraOutput_prot : destroying prot sem CameraOutput_prot : destroying prot sem navigationOutput_prot : destroying notify sem CameraOutput_notify : destroying notify sem LayeredControlInput_ShmemName_notify : destroying notify sem CameraOutput_notify : destroying notify sem navigationOutput_notify : TaskServer::signalHandler() for task ExternalCommsIFServer - exit() on signal 18 : Supervisor::signalHandler - setting exit flag [1] : **** SharedData destructor for object GulperOutput **** : ****Time::cleanup FastTime instance[000dd1b4]] : **** SharedData destructor for object LayeredControlOutput_ShmemName **** : failed to unlink queue NavigationInput : destroying segment LayeredControlOutput_ShmemName : destroying prot sem LayeredControlOutput_ShmemName_prot : destroying notify sem LayeredControlOutput_ShmemName_notify : Supervisor::run - caught stop signal - exiting run loop : **** FastTime dtor [000dd1b4] **** : destroying segment GulperOutput : Supervisor::run - calling shutdown/exit : **** SharedData destructor for object FastTime **** : destroying prot sem GulperOutput_prot : Supervisor::shutdown - signaling processes : destroying segment FastTime : destroying notify sem GulperOutput_notify : Supervisor::signalHandler - caught signal 2 : destroying prot sem FastTime_prot : Supervisor::signalHandler possible duplicate signal[2] : destroying notify sem FastTime_notify : Supervisor::signalHandler - setting exit flag [2] : TerrainAidDestructor Executing. : Supervisor::shutdown - cleaning up : Supervisor::shutdown - deleting FastTime [0001d1b8] : **** FastTime dtor [0001d1b8] **** : **** SharedData destructor for object FastTime **** : destroying segment FastTime : destroying prot sem FastTime_prot : destroying notify sem FastTime_notify : Supervisor::shutdown - deleting output : **** SharedData destructor for object SupervisorOutout **** : destroying segment SupervisorOutout : destroying prot sem SupervisorOutout_prot : destroying notify sem SupervisorOutout_notify : Supervisor::shutdown - done : **** SharedData destructor for object TerrainAidOutput **** : Supervisor::~Supervisor - dtor : Supervisor::~Supervisor - deleting FastTime [0001d1b8] : destroying segment TerrainAidOutput : **** FastTime dtor [0001d1b8] **** : destroying prot sem TerrainAidOutput_prot : **** SharedData destructor for object  **** : destroying notify sem TerrainAidOutput_notify : destroying segment  : failed to unlink queue TerrainAidMsgs : destroying prot sem D : **** SharedData destructor for object TerrainAidOutput **** : destroying notify sem FastTime_notify : ****Time::cleanup FastTime instance[0001d2a8]] : destroying segment TerrainAidOutput : **** FastTime dtor [0001d2a8] **** : destroying prot sem TerrainAidOutput_prot : **** SharedData destructor for object FastTime **** : destroying notify sem TerrainAidOutput_notify : destroying segment FastTime : destroying prot sem FastTime_prot : destroying notify sem FastTime_notify : SysData Destructor Executing.