fake_bundle_adjustment_jacobian.h 3.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778
  1. // Ceres Solver - A fast non-linear least squares minimizer
  2. // Copyright 2015 Google Inc. All rights reserved.
  3. // http://ceres-solver.org/
  4. //
  5. // Redistribution and use in source and binary forms, with or without
  6. // modification, are permitted provided that the following conditions are met:
  7. //
  8. // * Redistributions of source code must retain the above copyright notice,
  9. // this list of conditions and the following disclaimer.
  10. // * Redistributions in binary form must reproduce the above copyright notice,
  11. // this list of conditions and the following disclaimer in the documentation
  12. // and/or other materials provided with the distribution.
  13. // * Neither the name of Google Inc. nor the names of its contributors may be
  14. // used to endorse or promote products derived from this software without
  15. // specific prior written permission.
  16. //
  17. // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  18. // AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19. // IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20. // ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
  21. // LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  22. // CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  23. // SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  24. // INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  25. // CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  26. // ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  27. // POSSIBILITY OF SUCH DAMAGE.
  28. //
  29. // Author: sameeragarwal@google.com (Sameer Agarwal)
  30. #ifndef CERES_INTERNAL_FAKE_BUNDLE_ADJUSTMENT_JACOBIAN
  31. #define CERES_INTERNAL_FAKE_BUNDLE_ADJUSTMENT_JACOBIAN
  32. #include <memory>
  33. #include <random>
  34. #include "ceres/block_sparse_matrix.h"
  35. #include "ceres/partitioned_matrix_view.h"
  36. namespace ceres::internal {
  37. std::unique_ptr<BlockSparseMatrix> CreateFakeBundleAdjustmentJacobian(
  38. int num_cameras,
  39. int num_points,
  40. int camera_size,
  41. int point_size,
  42. double visibility,
  43. std::mt19937& prng);
  44. template <int kEBlockSize = 3, int kFBlockSize = 6>
  45. std::pair<std::unique_ptr<PartitionedMatrixView<2, kEBlockSize, kFBlockSize>>,
  46. std::unique_ptr<BlockSparseMatrix>>
  47. CreateFakeBundleAdjustmentPartitionedJacobian(int num_cameras,
  48. int num_points,
  49. double visibility,
  50. std::mt19937& rng) {
  51. using PartitionedView = PartitionedMatrixView<2, kEBlockSize, kFBlockSize>;
  52. auto block_sparse_matrix = CreateFakeBundleAdjustmentJacobian(
  53. num_cameras, num_points, kFBlockSize, kEBlockSize, visibility, rng);
  54. auto partitioned_view =
  55. std::make_unique<PartitionedView>(*block_sparse_matrix, num_points);
  56. return std::make_pair(std::move(partitioned_view),
  57. std::move(block_sparse_matrix));
  58. }
  59. std::pair<
  60. std::unique_ptr<PartitionedMatrixView<2, Eigen::Dynamic, Eigen::Dynamic>>,
  61. std::unique_ptr<BlockSparseMatrix>>
  62. CreateFakeBundleAdjustmentPartitionedJacobian(int num_cameras,
  63. int num_points,
  64. int camera_size,
  65. int landmark_size,
  66. double visibility,
  67. std::mt19937& rng);
  68. } // namespace ceres::internal
  69. #endif // CERES_INTERNAL_FAKE_BUNDLE_ADJUSTMENT_JACOBIAN