Fixed various errors in the localisation component. I still have a problem, though: the ray tracing is very slow, so I have to find a way to speed it up; otherwise, the filter will not operate in real time