Advanced Trajectory Estimation and Heterogeneous Sensor Fusion