Kalman VS PythonRobotics

Since you mentioned C++ and Kalman filters, I author this Kalman filter library which helped me to get reacquainted to control theory, tries to be approachable, and lists a variety of sources to ease in the topic with examples.

Yes, and here's one for sanitizers. Other tools, documentation, and coverage in the neigbhorong files.

I've been learning FectContent as well with some successes and failures.

My goal with this Kalman filter for C++ is to solve your exact question.

I released a first version of a generic Kalman filter.

I use fmt and others in my project with CMake fetch and it's been a good experience so far: fetch, declare, link in a few lines. Hope this can be useful to someome.

Gratuitous French codebase self-promotion though. /s

Would you be open to exploring an implementation collaboration? I author a C++ Kalman library and would like to expand demonstrators.

A façade (example) included only for your GCC builds and with the fmt library would allow you to generically use the std::format support in your code. Avoiding the fmt:: and dependencies with MSVC. When the support lands in GCC, only that file would need to be deleted.

I use it with boilerplate similar to this: https://github.com/FrancoisCarouge/Kalman/blob/develop/benchmark/benchmark.cpp and run the executables with priority and pining: nice -n 20 tasker -- cpu-list 0

I usually start here: https://github.com/AtsushiSakai/PythonRobotics , but I'm not sure how much is extended to 3D off the top of my head.

Code is on github. You could try to start with the main method here: https://github.com/AtsushiSakai/PythonRobotics/blob/master/PathPlanning/AStar/a_star.py

Also another good source of material https://atsushisakai.github.io/PythonRobotics/

Look into the following source. Its not implemented in ROS but there are examples of implementation of Robotics algorithms in python. From there it should be easy to implement them in ROS after you understand how ROS work. https://atsushisakai.github.io/PythonRobotics/

This was partly inspired by PythonRobotics (which I love!). However, I don't want this repo to become a huge collection of unorganized algorithms. I want the focus to be on quality over quantity. At the same time, I don't want this repo to be only "educational". While I want to include as many examples as possible for educational (and documentation) purpose, I want this library to be fast so that it can be used in practical applications.

check out python robotics https://github.com/AtsushiSakai/PythonRobotics

https://github.com/AtsushiSakai/PythonRobotics#linearquadratic-regulator-lqr-speed-and-steering-control