Parallelize constraint group solving

.github/workflows/ci_windows.yml

@@ -51,6 +51,7 @@ jobs:
             opengl
             osg
             pagmo2
+            taskflow
             tinyxml2
             tracy
             urdfdom

.github/workflows/publish_dartpy.yml

@@ -116,6 +116,7 @@ jobs:
             opengl
             osg
             pagmo2
+            taskflow
             tinyxml2
             urdfdom
           triplet: x64-windows

cmake/DARTFindDependencies.cmake

@@ -106,6 +106,9 @@ else()
   )
 endif()
 
+# Taskflow
+dart_find_package(Taskflow)
+
 #=======================
 # Optional dependencies
 #=======================

cmake/DARTFindTaskflow.cmake

@@ -0,0 +1,9 @@
+# Copyright (c) 2011-2024, The DART development contributors
+# All rights reserved.
+#
+# The list of contributors can be found at:
+#   https://github.com/dartsim/dart/blob/main/LICENSE
+#
+# This file is provided under the "BSD-style" License
+
+find_package(Taskflow)

dart/CMakeLists.txt

@@ -222,6 +222,20 @@ if(spdlog_FOUND)
   add_component_dependency_packages(${PROJECT_NAME} dart spdlog)
 endif()
 
+# Taskflow settings
+if(Taskflow_FOUND)
+  if(TARGET spdlog::spdlog_header_only)
+    add_component_dependency_packages(${PROJECT_NAME} dart Taskflow)
+    target_link_libraries(dart PUBLIC Taskflow::Taskflow)
+    target_compile_definitions(dart PUBLIC -DDART_HAVE_Taskflow=1)
+  else()
+    message(WARNING "Taskflow found, but no target is found. Expected Taskflow::Taskflow")
+    target_compile_definitions(dart PUBLIC -DDART_HAVE_Taskflow=0)
+  endif()
+else()
+  target_compile_definitions(dart PUBLIC -DDART_HAVE_Taskflow=0)
+endif()
+
 if(MSVC)
   set_target_properties(
     dart PROPERTIES