ground_truth.h 3.3 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798
  1. /***********************************************************************
  2. * Software License Agreement (BSD License)
  3. *
  4. * Copyright 2008-2009 Marius Muja (mariusm@cs.ubc.ca). All rights reserved.
  5. * Copyright 2008-2009 David G. Lowe (lowe@cs.ubc.ca). All rights reserved.
  6. *
  7. * THE BSD LICENSE
  8. *
  9. * Redistribution and use in source and binary forms, with or without
  10. * modification, are permitted provided that the following conditions
  11. * are met:
  12. *
  13. * 1. Redistributions of source code must retain the above copyright
  14. * notice, this list of conditions and the following disclaimer.
  15. * 2. Redistributions in binary form must reproduce the above copyright
  16. * notice, this list of conditions and the following disclaimer in the
  17. * documentation and/or other materials provided with the distribution.
  18. *
  19. * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  20. * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  21. * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  22. * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  23. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  24. * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  25. * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  26. * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  27. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  28. * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  29. *************************************************************************/
  30. #ifndef OPENCV_FLANN_GROUND_TRUTH_H_
  31. #define OPENCV_FLANN_GROUND_TRUTH_H_
  32. //! @cond IGNORED
  33. #include "dist.h"
  34. #include "matrix.h"
  35. namespace cvflann
  36. {
  37. template <typename Distance>
  38. void find_nearest(const Matrix<typename Distance::ElementType>& dataset, typename Distance::ElementType* query, int* matches, int nn,
  39. int skip = 0, Distance distance = Distance())
  40. {
  41. typedef typename Distance::ResultType DistanceType;
  42. int n = nn + skip;
  43. std::vector<int> match(n);
  44. std::vector<DistanceType> dists(n);
  45. dists[0] = distance(dataset[0], query, dataset.cols);
  46. match[0] = 0;
  47. int dcnt = 1;
  48. for (size_t i=1; i<dataset.rows; ++i) {
  49. DistanceType tmp = distance(dataset[i], query, dataset.cols);
  50. if (dcnt<n) {
  51. match[dcnt] = (int)i;
  52. dists[dcnt++] = tmp;
  53. }
  54. else if (tmp < dists[dcnt-1]) {
  55. dists[dcnt-1] = tmp;
  56. match[dcnt-1] = (int)i;
  57. }
  58. int j = dcnt-1;
  59. // bubble up
  60. while (j>=1 && dists[j]<dists[j-1]) {
  61. std::swap(dists[j],dists[j-1]);
  62. std::swap(match[j],match[j-1]);
  63. j--;
  64. }
  65. }
  66. for (int i=0; i<nn; ++i) {
  67. matches[i] = match[i+skip];
  68. }
  69. }
  70. template <typename Distance>
  71. void compute_ground_truth(const Matrix<typename Distance::ElementType>& dataset, const Matrix<typename Distance::ElementType>& testset, Matrix<int>& matches,
  72. int skip=0, Distance d = Distance())
  73. {
  74. for (size_t i=0; i<testset.rows; ++i) {
  75. find_nearest<Distance>(dataset, testset[i], matches[i], (int)matches.cols, skip, d);
  76. }
  77. }
  78. }
  79. //! @endcond
  80. #endif //OPENCV_FLANN_GROUND_TRUTH_H_