Visual Servoing Platform  version 3.3.0
vpMomentAreaNormalized.cpp
1 /****************************************************************************
2  *
3  * ViSP, open source Visual Servoing Platform software.
4  * Copyright (C) 2005 - 2019 by Inria. All rights reserved.
5  *
6  * This software is free software; you can redistribute it and/or modify
7  * it under the terms of the GNU General Public License as published by
8  * the Free Software Foundation; either version 2 of the License, or
9  * (at your option) any later version.
10  * See the file LICENSE.txt at the root directory of this source
11  * distribution for additional information about the GNU GPL.
12  *
13  * For using ViSP with software that can not be combined with the GNU
14  * GPL, please contact Inria about acquiring a ViSP Professional
15  * Edition License.
16  *
17  * See http://visp.inria.fr for more information.
18  *
19  * This software was developed at:
20  * Inria Rennes - Bretagne Atlantique
21  * Campus Universitaire de Beaulieu
22  * 35042 Rennes Cedex
23  * France
24  *
25  * If you have questions regarding the use of this file, please contact
26  * Inria at visp@inria.fr
27  *
28  * This file is provided AS IS with NO WARRANTY OF ANY KIND, INCLUDING THE
29  * WARRANTY OF DESIGN, MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
30  *
31  * Description:
32  * 2D normalized surface moment descriptor (usually described as An)
33  *
34  * Authors:
35  * Filip Novotny
36  *
37  *****************************************************************************/
38 #include <cmath>
39 #include <visp3/core/vpMomentAreaNormalized.h>
40 #include <visp3/core/vpMomentCentered.h>
41 #include <visp3/core/vpMomentDatabase.h>
42 #include <visp3/core/vpMomentObject.h>
43 
49 {
50  bool found_moment_centered;
51 
52  /* getMoments() returns a reference to a vpMomentDatabase. (a protected
53  member inherited from vpMoment)
54  .get() is a member function of vpMomentDatabase that returns
55  a specific moment which is linked to it*/
56  const vpMomentCentered &momentCentered =
57  static_cast<const vpMomentCentered &>(getMoments().get("vpMomentCentered", found_moment_centered));
58 
59  if (!found_moment_centered)
60  throw vpException(vpException::notInitialized, "vpMomentCentered not found");
61 
62  double a;
63  /* getObject() returns a reference to the vpMomentObject from which
64  * the moment values are calculated. (public member of vpMoment)*/
65  if (getObject().getType() == vpMomentObject::DISCRETE)
66  a = momentCentered.get(2, 0) + momentCentered.get(0, 2);
67  else
68  a = getObject().get(0, 0);
69 
70  values[0] = desiredDepth * sqrt(desiredSurface / a);
71 }
72 
79  : vpMoment(), desiredSurface(a_star), desiredDepth(Z_star)
80 {
81  values.resize(1);
82 }
83 
87 VISP_EXPORT std::ostream &operator<<(std::ostream &os, const vpMomentAreaNormalized &m)
88 {
89  os << (__FILE__) << std::endl;
90  os << "An = " << m.values[0] << std::endl;
91  return os;
92 }
93 
102 void vpMomentAreaNormalized::printDependencies(std::ostream &os) const
103 {
104  os << (__FILE__) << std::endl;
105  os << "Desired depth Z* = " << desiredDepth << std::endl;
106  os << "Desired area m00* = " << desiredSurface << std::endl;
107 
108  bool found_moment_centered;
109  const vpMomentCentered &momentCentered =
110  static_cast<const vpMomentCentered &>(getMoments().get("vpMomentCentered", found_moment_centered));
111  if (!found_moment_centered)
112  throw vpException(vpException::notInitialized, "vpMomentCentered not found");
113 
114  double a;
115  if (getObject().getType() == vpMomentObject::DISCRETE)
116  a = momentCentered.get(2, 0) + momentCentered.get(0, 2);
117  else
118  a = getObject().get(0, 0);
119  os << "a = " << a << std::endl;
120 }
vpMoment::getMoments
vpMomentDatabase & getMoments() const
Definition: vpMoment.h:123
vpMoment
This class defines shared methods/attributes for 2D moments.
Definition: vpMoment.h:111
vpMomentCentered
This class defines the double-indexed centered moment descriptor .
Definition: vpMomentCentered.h:80
vpMomentAreaNormalized::printDependencies
void printDependencies(std::ostream &os) const
Definition: vpMomentAreaNormalized.cpp:102
vpMomentAreaNormalized::compute
void compute()
Definition: vpMomentAreaNormalized.cpp:48
vpMomentAreaNormalized
Class handling the normalized surface moment that is invariant in scale and used to estimate depth.
Definition: vpMomentAreaNormalized.h:139
vpMomentCentered::get
double get(unsigned int i, unsigned int j) const
Definition: vpMomentCentered.cpp:103
vpException::notInitialized
@ notInitialized
Used to indicate that a parameter is not initialized.
Definition: vpException.h:98
vpMoment::getObject
const vpMomentObject & getObject() const
Definition: vpMoment.h:150
vpMomentObject::DISCRETE
@ DISCRETE
Definition: vpMomentObject.h:231
vpMomentDatabase::get
const vpMoment & get(const char *type, bool &found) const
Definition: vpMomentDatabase.cpp:64
vpMomentObject::get
const std::vector< double > & get() const
Definition: vpMomentObject.cpp:532
vpMomentAreaNormalized::vpMomentAreaNormalized
vpMomentAreaNormalized(double a_star, double Z_star)
Definition: vpMomentAreaNormalized.cpp:78
vpException
error that can be emited by ViSP classes.
Definition: vpException.h:72
vpMoment::values
std::vector< double > values
Definition: vpMoment.h:118
vpArray2D::operator<<
friend std::ostream & operator<<(std::ostream &s, const vpArray2D< Type > &A)
Definition: vpArray2D.h:494