Kalman-and-Bayesian-Filters-in-Python
Kalman-and-Bayesian-Filters-in-Python copied to clipboard
Charpter 10 function "_isct" in ukf_internal
i can't understand the function "_isct" in ukf_internal,expecially "I then computed the (𝑥,𝑦) coordinate corresponding to the two noisy bearing measurements and plotted them with red dots to show the distribution of the noisy measurements in 𝑥 and 𝑦 ." in charpter 10 Can you give me more details and mathematical explanation about how the "red dots“ paint and how then function "_isct" works?
_isct just implements line-line intersection using determinents:
https://en.wikipedia.org/wiki/Line%E2%80%93line_intersection
Plotting just adds a bit of random error to the angles, computes the intersections of the lines formed by the slight angle change, and scatter plots them.