[filter] declarative paradigm

FrancoisCarouge · Jan 27, 2024 · 35d0e92 · 35d0e92
1 parent 4331741
commit 35d0e92
Show file tree

Hide file tree

Showing 22 changed files with 427 additions and 360 deletions.
diff --git a/benchmark/CMakeLists.txt b/benchmark/CMakeLists.txt
@@ -54,8 +54,12 @@ FetchContent_MakeAvailable(google_benchmark)
 
 set(PROCESSOR_AFFINITY TRUE)
 
-foreach(BENCHMARK "baseline.cpp" "predict_1x1x0.cpp" "predict_1x1x1.cpp"
-                  "update_1x1x0.cpp" "update_1x1x1.cpp")
+foreach(
+  BENCHMARK
+  "baseline.cpp"
+  # "predict_1x1x0.cpp" "predict_1x1x1.cpp" # "update_1x1x0.cpp"
+  # "update_1x1x1.cpp"
+)
   get_filename_component(NAME ${BENCHMARK} NAME_WE)
   add_executable(kalman_benchmark_${NAME}_driver ${BENCHMARK})
   target_include_directories(kalman_benchmark_${NAME}_driver PRIVATE "include")
@@ -75,66 +79,44 @@ foreach(BENCHMARK "baseline.cpp" "predict_1x1x0.cpp" "predict_1x1x1.cpp"
             "--benchmark_out=${NAME}.json")
 endforeach()
 
-foreach(BACKEND IN ITEMS "eigen" "naive")
-  foreach(STATE_SIZE RANGE 1 2)
-    foreach(INPUT_SIZE RANGE 1 2)
-      configure_file(predict_linalg_x1x.cpp
-                     predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}.cpp)
-      add_executable(
-        kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
-        predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}.cpp)
-      target_include_directories(
-        kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
-        PRIVATE "include")
-      set_target_properties(
-        kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
-        PROPERTIES CXX_STANDARD 23
-                   CXX_EXTENSIONS OFF
-                   INTERPROCEDURAL_OPTIMIZATION TRUE)
-      target_link_libraries(
-        kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
-        PRIVATE benchmark::benchmark benchmark::benchmark_main kalman
-                kalman_linalg_${BACKEND} kalman_options)
-      separate_arguments(TEST_COMMAND UNIX_COMMAND $ENV{COMMAND})
-      add_test(
-        NAME kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}
-        COMMAND
-          ${TEST_COMMAND}
-          $<TARGET_FILE:kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver>
-          "--benchmark_out=predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}.json"
-      )
-    endforeach()
-  endforeach()
-endforeach()
+# foreach(BACKEND IN ITEMS "eigen" "naive") foreach(STATE_SIZE RANGE 1 2)
+# foreach(INPUT_SIZE RANGE 1 2) configure_file(predict_linalg_x1x.cpp
+# predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}.cpp) add_executable(
+# kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
+# predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}.cpp)
+# target_include_directories(
+# kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
+# PRIVATE "include") set_target_properties(
+# kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
+# PROPERTIES CXX_STANDARD 23 CXX_EXTENSIONS OFF INTERPROCEDURAL_OPTIMIZATION
+# TRUE) target_link_libraries(
+# kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver
+# PRIVATE benchmark::benchmark benchmark::benchmark_main kalman
+# kalman_linalg_${BACKEND} kalman_options) separate_arguments(TEST_COMMAND
+# UNIX_COMMAND $ENV{COMMAND}) add_test( NAME
+# kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE} COMMAND
+# ${TEST_COMMAND}
+# $<TARGET_FILE:kalman_benchmark_predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}_driver>
+# "--benchmark_out=predict_${BACKEND}_${STATE_SIZE}x1x${INPUT_SIZE}.json" )
+# endforeach() endforeach() endforeach()
 
-foreach(BACKEND IN ITEMS "eigen")
-  foreach(STATE_SIZE RANGE 1 2)
-    foreach(OUTPUT_SIZE RANGE 1 2)
-      configure_file(update_linalg_xx0.cpp
-                     update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0.cpp)
-      add_executable(
-        kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
-        update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0.cpp)
-      target_include_directories(
-        kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
-        PRIVATE "include")
-      set_target_properties(
-        kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
-        PROPERTIES CXX_STANDARD 23
-                   CXX_EXTENSIONS OFF
-                   INTERPROCEDURAL_OPTIMIZATION TRUE)
-      target_link_libraries(
-        kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
-        PRIVATE benchmark::benchmark benchmark::benchmark_main kalman
-                kalman_linalg_${BACKEND} kalman_options)
-      separate_arguments(TEST_COMMAND UNIX_COMMAND $ENV{COMMAND})
-      add_test(
-        NAME kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0
-        COMMAND
-          ${TEST_COMMAND}
-          $<TARGET_FILE:kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver>
-          "--benchmark_out=update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0.json"
-      )
-    endforeach()
-  endforeach()
-endforeach()
+# foreach(BACKEND IN ITEMS "eigen") foreach(STATE_SIZE RANGE 1 2)
+# foreach(OUTPUT_SIZE RANGE 1 2) configure_file(update_linalg_xx0.cpp
+# update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0.cpp) add_executable(
+# kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
+# update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0.cpp)
+# target_include_directories(
+# kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
+# PRIVATE "include") set_target_properties(
+# kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
+# PROPERTIES CXX_STANDARD 23 CXX_EXTENSIONS OFF INTERPROCEDURAL_OPTIMIZATION
+# TRUE) target_link_libraries(
+# kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver
+# PRIVATE benchmark::benchmark benchmark::benchmark_main kalman
+# kalman_linalg_${BACKEND} kalman_options) separate_arguments(TEST_COMMAND
+# UNIX_COMMAND $ENV{COMMAND}) add_test( NAME
+# kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0 COMMAND
+# ${TEST_COMMAND}
+# $<TARGET_FILE:kalman_benchmark_update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0_driver>
+# "--benchmark_out=update_${BACKEND}_${STATE_SIZE}x${OUTPUT_SIZE}x0.json" )
+# endforeach() endforeach() endforeach()
diff --git a/include/fcarouge/internal/format.hpp b/include/fcarouge/internal/format.hpp
@@ -45,27 +45,23 @@ For more information, please refer to <https://unlicense.org> */
 #include <type_traits>
 
 namespace fcarouge {
-template <typename, typename, typename, typename, typename> class kalman;
+template <typename> class kalman;
 } // namespace fcarouge
 
-template <typename State, typename Output, typename Input, typename UpdateTypes,
-          typename PredictionTypes, typename Char>
+template <typename Filter, typename Char>
 // It is allowed to add template specializations for any standard library class
 // template to the namespace std only if the declaration depends on at least one
 // program-defined type and the specialization satisfies all requirements for
 // the original template, except where such specializations are prohibited.
 // NOLINTNEXTLINE(cert-dcl58-cpp)
-struct std::formatter<
-    fcarouge::kalman<State, Output, Input, UpdateTypes, PredictionTypes>,
-    Char> {
+struct std::formatter<fcarouge::kalman<Filter>, Char> {
   constexpr auto parse(std::basic_format_parse_context<Char> &parse_context) {
     return parse_context.begin();
   }
 
   //! @todo P2585 may be useful in simplifying and standardizing the support.
   template <typename OutputIt>
-  auto format(const fcarouge::kalman<State, Output, Input, UpdateTypes,
-                                     PredictionTypes> &filter,
+  auto format(const fcarouge::kalman<Filter> &filter,
               std::basic_format_context<OutputIt, Char> &format_context) const
       -> OutputIt {
     format_context.advance_to(
@@ -80,17 +76,19 @@ struct std::formatter<
                                         R"("h": {}, "k": {}, "p": {}, )",
                                         filter.h(), filter.k(), filter.p()));
 
-    {
-      constexpr auto end{fcarouge::internal::repack_s<PredictionTypes>};
+    [&]<template <typename> typename Type, typename InternalFilter>(
+        const Type<InternalFilter> &f) {
+      constexpr auto end{fcarouge::internal::repack_s<
+          typename InternalFilter::prediction_types>};
       constexpr decltype(end) begin{0};
       constexpr decltype(end) next{1};
       fcarouge::internal::for_constexpr<begin, end, next>(
-          [&format_context, &filter](auto position) {
+          [&format_context, &f](auto position) {
             format_context.advance_to(
                 format_to(format_context.out(), R"("prediction_{}": {}, )",
-                          position(), filter.template predict<position>()));
+                          position(), f.template predict<position>()));
           });
-    }
+    }(filter);
 
     format_context.advance_to(format_to(format_context.out(),
                                         R"("q": {}, "r": {}, "s": {}, )",
@@ -101,17 +99,19 @@ struct std::formatter<
           format_to(format_context.out(), R"("u": {}, )", filter.u()));
     }
 
-    {
-      constexpr auto end{fcarouge::internal::repack_s<UpdateTypes>};
+    [&]<template <typename> typename Type, typename InternalFilter>(
+        const Type<InternalFilter> &f) {
+      constexpr auto end{
+          fcarouge::internal::repack_s<typename InternalFilter::update_types>};
       constexpr decltype(end) begin{0};
       constexpr decltype(end) next{1};
-      fcarouge::internal::for_constexpr<begin, end, next>(
-          [&format_context, &filter](auto position) {
-            format_context.advance_to(
-                format_to(format_context.out(), R"("update_{}": {}, )",
-                          position(), filter.template update<position>()));
-          });
-    }
+      fcarouge::internal::for_constexpr<begin, end, next>([&format_context,
+                                                           &f](auto position) {
+        format_context.advance_to(format_to(format_context.out(),
+                                            R"("update_{}": {}, )", position(),
+                                            f.template update<position>()));
+      });
+    }(filter);
 
     format_context.advance_to(format_to(format_context.out(),
                                         R"("x": {}, "y": {}, "z": {}}})",