Skip to content

Fix indexing bugs related to different LCS discretizations for cost c…

0ef7a85
Select commit
Loading
Failed to load commit list.
Draft

example(sampling-c3) : Use C3's new cost computation helpers #404

Fix indexing bugs related to different LCS discretizations for cost c…
0ef7a85
Select commit
Loading
Failed to load commit list.
Cirrus CI / build_jammy failed Apr 7, 2026 in 6m 47s

Task Summary

Instruction test failed in 06:19

Details

⚠️ Not enough compute credits to prioritize tasks!
ℹ️ Scheduling was delayed due to a concurrency limit on community tasks

✅ 00:26 clone
❌ 06:19 test

      |                   ~~^~~~~~~~~~~~~~~~~~~~~~~~~~~~
[11,360 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 21s remote-cache, processwrapper-sandbox ... (8 actions, 6 running)
INFO: From Compiling examples/sampling_c3/generate_samples.cc:
In file included from examples/sampling_c3/generate_samples.h:9,
                 from examples/sampling_c3/generate_samples.cc:1:
./examples/sampling_c3/parameter_headers/sampling_c3_options.h: In member function 'std::pair<int, std::vector<int> > SamplingC3Options::ProcessPlanarContactInformation(const std::vector<int>&, const std::vector<int>&, int)':
./examples/sampling_c3/parameter_headers/sampling_c3_options.h:571:23: warning: comparison of integer expressions of different signedness: 'int' and 'std::vector<int>::size_type' {aka 'long unsigned int'} [-Wsign-compare]
  571 |     for (int i = 0; i < resolve_contacts_to_list.size(); ++i) {
      |                     ~~^~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
examples/sampling_c3/generate_samples.cc: In function 'Eigen::VectorXd dairlib::systems::MeshNormalSampling(const int&, const int&, const int&, const VectorXd&, drake::multibody::MultibodyPlant<double>&, drake::systems::Context<double>*, drake::multibody::MultibodyPlant<Eigen::AutoDiffScalar<Eigen::Matrix<double, -1, 1> > >&, drake::systems::Context<Eigen::AutoDiffScalar<Eigen::Matrix<double, -1, 1> > >*, const SamplingParams&, const drake::geometry::QueryObject<double>&, std::vector<dairlib::systems::Face>, std::vector<double>)':
examples/sampling_c3/generate_samples.cc:476:21: warning: comparison of integer expressions of different signedness: 'int' and 'std::vector<dairlib::systems::Face>::size_type' {aka 'long unsigned int'} [-Wsign-compare]
  476 |   for (int i = 0; i < faces.size(); i++) {
      |                   ~~^~~~~~~~~~~~~~
examples/sampling_c3/generate_samples.cc: In function 'Eigen::VectorXd dairlib::systems::MeshNormalSamplingMultiObject(const int&, const int&, const int&, const VectorXd&, drake::multibody::MultibodyPlant<double>&, drake::systems::Context<double>*, drake::multibody::MultibodyPlant<Eigen::AutoDiffScalar<Eigen::Matrix<double, -1, 1> > >&, drake::systems::Context<Eigen::AutoDiffScalar<Eigen::Matrix<double, -1, 1> > >*, const std::vector<std::vector<drake::SortedPair<drake::geometry::GeometryId> > >&, const SamplingParams&, const SamplingC3Options&, const drake::geometry::QueryObject<double>&, std::vector<std::vector<dairlib::systems::Face> >, std::vector<std::vector<double> >, std::vector<double>, std::vector<bool>)':
examples/sampling_c3/generate_samples.cc:611:23: warning: comparison of integer expressions of different signedness: 'int' and 'std::vector<bool>::size_type' {aka 'long unsigned int'} [-Wsign-compare]
  611 |     for (int i = 0; i < object_on_target.size(); i++) {
      |                     ~~^~~~~~~~~~~~~~~~~~~~~~~~~
examples/sampling_c3/generate_samples.cc:718:49: warning: comparison of integer expressions of different signedness: 'int' and 'std::vector<drake::geometry::SignedDistanceToPoint<double>, std::allocator<drake::geometry::SignedDistanceToPoint<double> > >::size_type' {aka 'long unsigned int'} [-Wsign-compare]
  718 |           for (int i = results.size()-offset; i < results.size(); i++) {
      |                                               ~~^~~~~~~~~~~~~~~~
examples/sampling_c3/generate_samples.cc:575:12: warning: unused variable 'distance' [-Wunused-variable]
  575 |     double distance = 0;
      |            ^~~~~~~~
examples/sampling_c3/generate_samples.cc:581:21: warning: variable 'ee_position' set but not used [-Wunused-but-set-variable]
  581 |     Eigen::Vector3d ee_position = x_lcs.head(3);
      |                     ^~~~~~~~~~~
examples/sampling_c3/generate_samples.cc: In function 'bool dairlib::systems::IsSampleWithinDistanceOfSurface(const int&, const int&, const int&, const double&, const VectorXd&, drake::multibody::MultibodyPlant<double>&, drake::systems::Context<double>*, drake::multibody::MultibodyPlant<Eigen::AutoDiffScalar<Eigen::Matrix<double, -1, 1> > >&, drake::systems::Context<Eigen::AutoDiffScalar<Eigen::Matrix<double, -1, 1> > >*, const std::vector<std::vector<drake::SortedPair<drake::geometry::GeometryId> > >&, SamplingC3Options, int&)':
examples/sampling_c3/generate_samples.cc:825:21: warning: comparison of integer expressions of different signedness: 'int' and 'std::vector<drake::SortedPair<drake::geometry::GeometryId> >::size_type' {aka 'long unsigned int'} [-Wsign-compare]
  825 |   for (int i = 0; i < contact_geoms.at(1).size(); i++) {
      |                   ~~^~~~~~~~~~~~~~~~~~~~~~~~~~~~
[11,368 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 22s remote-cache, processwrapper-sandbox ... (8 actions, 6 running)
[11,382 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 23s remote-cache, processwrapper-sandbox ... (8 actions, 3 running)
[11,405 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 24s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,427 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 25s remote-cache, processwrapper-sandbox ... (8 actions, 4 running)
[11,443 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 26s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,459 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 27s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,469 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 28s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,492 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 29s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,516 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 30s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,531 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 32s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,548 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 33s remote-cache, processwrapper-sandbox ... (8 actions, 3 running)
[11,572 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 34s remote-cache, processwrapper-sandbox ... (8 actions, 3 running)
[11,598 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 35s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,613 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 36s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,631 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 37s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,641 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 38s remote-cache, processwrapper-sandbox ... (3 actions, 2 running)
[11,659 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 40s remote-cache, processwrapper-sandbox ... (8 actions, 2 running)
[11,678 / 11,754] Compiling systems/controllers/sampling_based_c3_controller.cc; 41s remote-cache, processwrapper-sandbox ... (8 actions, 3 running)
ERROR: /tmp/cirrus-ci-build/examples/sampling_c3/BUILD.bazel:22:10: Linking examples/sampling_c3/franka_sim failed: (Exit 1): gcc failed: error executing CppLink command (from target //examples/sampling_c3:franka_sim) /usr/bin/gcc @bazel-out/k8-opt/bin/examples/sampling_c3/franka_sim-0.params

Use --sandbox_debug to see verbose messages from the sandbox and retain the sandbox build root for debugging
/usr/bin/ld.gold: error: cannot find -lopenblas
collect2: error: ld returned 1 exit status
INFO: Elapsed time: 378.881s, Critical Path: 41.73s
INFO: 11691 processes: 4201 remote cache hit, 5659 internal, 1829 processwrapper-sandbox, 2 worker.
ERROR: Build did NOT complete successfully