F5/unison
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

mobility: Fix velocity when nodes are standing still

Browse Source
This commit is contained in:
Tommaso Pecorella
2024-05-08 17:08:08 +02:00
parent d6f2faebc8
commit 64e826f3f8
1 changed files with 10 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
src/mobility/model/random-waypoint-mobility-model.cc
View File

@@ -66,15 +66,19 @@ RandomWaypointMobilityModel::BeginWalk()
Vector m_current = m_helper.GetCurrentPosition();
NS_ASSERT_MSG(m_position, "No position allocator added before using this model");
Vector destination = m_position->GetNext();
Vector delta = destination - m_current;
double distance = delta.GetLength();
double speed = m_speed->GetValue();
double dx = (destination.x - m_current.x);
double dy = (destination.y - m_current.y);
double dz = (destination.z - m_current.z);
double k = speed / std::sqrt(dx * dx + dy * dy + dz * dz);
m_helper.SetVelocity(Vector(k * dx, k * dy, k * dz));
NS_ASSERT_MSG(speed > 0, "Speed must be strictly positive.");
// Note: the following two lines are needed to prevent corner cases where
// the distance is null (and the Velocity is undefined).
double k = distance ? speed / distance : 0;
Time travelDelay = distance ? Seconds(distance / speed) : Time(0);
m_helper.SetVelocity(k * delta);
m_helper.Unpause();
Time travelDelay = Seconds(CalculateDistance(destination, m_current) / speed);
m_event.Cancel();
m_event =
Simulator::Schedule(travelDelay, &RandomWaypointMobilityModel::DoInitializePrivate, this);