MATLAB: The target state vector is generated in spherical coordinates but how do you reconstruct in cartesian

Sensor Fusion and Tracking Toolbox

In the following example:
The target state vector is generated in spherical coordinates but how do you reconstruct in cartesian?

Best Answer

  1. We define the input to the trackers as an objectDetection. The objectDetection itself is agnostic to the measurement space you’re using (spherical or rectangular, how you define the measurements), the same way that the trackers are agnostic to your state space model.
  2. The objectDetection contains a property called MeasurementParameters, which can be used to help the filter initialization function and the measurement function to convert from measurement space to state space and vice versa, respectively.
  3. The MeasurementParameters can be put in an array so that you can move from sensor spherical coordinates to body rectangular coordinates and then to global (north-east-down) coordinates.
  4. These MeasurementParameters are also used by the StaticDetectionFuser to calculate the combinations of angle-only detections to fuse into fully observable detections to the tracker.