Function lupnt::RangeRate(const VecX&, const VecX&, const VecX&, const VecX&)

Function Documentation

Vec1 lupnt::RangeRate(const VecX &r1, const VecX &r2, const VecX &v1, const VecX &v2)

Compute the range-rate (radial relative velocity) between two point masses given their positions and velocities.

Companion to Range() for generic range-rate/Doppler measurement models used in filter examples and tests.

Parameters:
  • r1 – First position [m], any common frame

  • r2 – Second position [m], same frame as r1

  • v1 – First velocity [m/s], same frame as r1

  • v2 – Second velocity [m/s], same frame as r1

Returns:

Range rate (v2-v1).dot(r2-r1) / ||r2-r1|| [m/s] as a length-1 vector