The idea is to handle angle states and measurements that wrap in the range of +/-Pi.
It is inspired by this paper: https://arxiv.org/pdf/1708.05551.pdf
Class constructor is overloaded for retro compatibility.
States and measurements to wrap are designated at object creation to keep Predict and Update interfaces.
The idea is to handle angle states and measurements that wrap in the range of +/-Pi. It is inspired by this paper: https://arxiv.org/pdf/1708.05551.pdf Class constructor is overloaded for retro compatibility. States and measurements to wrap are designated at object creation to keep Predict and Update interfaces.