1 // Ceres Solver - A fast non-linear least squares minimizer
2 // Copyright 2010, 2011, 2012 Google Inc. All rights reserved.
3 // http://code.google.com/p/ceres-solver/
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: keir@google.com (Keir Mierle)
30 //
31 // Originally by Anton Carver
32
33 #ifndef CERES_INTERNAL_MAP_UTIL_H_
34 #define CERES_INTERNAL_MAP_UTIL_H_
35
36 #include <utility>
37 #include "ceres/internal/port.h"
38 #include "glog/logging.h"
39
40 namespace ceres {
41
42 // Perform a lookup in a map or hash_map, assuming that the key exists.
43 // Crash if it does not.
44 //
45 // This is intended as a replacement for operator[] as an rvalue (for reading)
46 // when the key is guaranteed to exist.
47 //
48 // operator[] is discouraged for several reasons:
49 // * It has a side-effect of inserting missing keys
50 // * It is not thread-safe (even when it is not inserting, it can still
51 // choose to resize the underlying storage)
52 // * It invalidates iterators (when it chooses to resize)
53 // * It default constructs a value object even if it doesn't need to
54 //
55 // This version assumes the key is printable, and includes it in the fatal log
56 // message.
57 template <class Collection>
58 const typename Collection::value_type::second_type&
FindOrDie(const Collection & collection,const typename Collection::value_type::first_type & key)59 FindOrDie(const Collection& collection,
60 const typename Collection::value_type::first_type& key) {
61 typename Collection::const_iterator it = collection.find(key);
62 CHECK(it != collection.end()) << "Map key not found: " << key;
63 return it->second;
64 }
65
66 // Perform a lookup in a map or hash_map.
67 // If the key is present in the map then the value associated with that
68 // key is returned, otherwise the value passed as a default is returned.
69 template <class Collection>
70 const typename Collection::value_type::second_type&
FindWithDefault(const Collection & collection,const typename Collection::value_type::first_type & key,const typename Collection::value_type::second_type & value)71 FindWithDefault(const Collection& collection,
72 const typename Collection::value_type::first_type& key,
73 const typename Collection::value_type::second_type& value) {
74 typename Collection::const_iterator it = collection.find(key);
75 if (it == collection.end()) {
76 return value;
77 }
78 return it->second;
79 }
80
81 // Insert a new key and value into a map or hash_map.
82 // If the key is not present in the map the key and value are
83 // inserted, otherwise nothing happens. True indicates that an insert
84 // took place, false indicates the key was already present.
85 template <class Collection>
InsertIfNotPresent(Collection * const collection,const typename Collection::value_type::first_type & key,const typename Collection::value_type::second_type & value)86 bool InsertIfNotPresent(
87 Collection * const collection,
88 const typename Collection::value_type::first_type& key,
89 const typename Collection::value_type::second_type& value) {
90 pair<typename Collection::iterator, bool> ret =
91 collection->insert(typename Collection::value_type(key, value));
92 return ret.second;
93 }
94
95 // Perform a lookup in a map or hash_map.
96 // Same as above but the returned pointer is not const and can be used to change
97 // the stored value.
98 template <class Collection>
99 typename Collection::value_type::second_type*
FindOrNull(Collection & collection,const typename Collection::value_type::first_type & key)100 FindOrNull(Collection& collection, // NOLINT
101 const typename Collection::value_type::first_type& key) {
102 typename Collection::iterator it = collection.find(key);
103 if (it == collection.end()) {
104 return 0;
105 }
106 return &it->second;
107 }
108
109 // Test to see if a set, map, hash_set or hash_map contains a particular key.
110 // Returns true if the key is in the collection.
111 template <class Collection, class Key>
ContainsKey(const Collection & collection,const Key & key)112 bool ContainsKey(const Collection& collection, const Key& key) {
113 typename Collection::const_iterator it = collection.find(key);
114 return it != collection.end();
115 }
116
117 // Inserts a new key/value into a map or hash_map.
118 // Dies if the key is already present.
119 template<class Collection>
InsertOrDie(Collection * const collection,const typename Collection::value_type::first_type & key,const typename Collection::value_type::second_type & data)120 void InsertOrDie(Collection* const collection,
121 const typename Collection::value_type::first_type& key,
122 const typename Collection::value_type::second_type& data) {
123 typedef typename Collection::value_type value_type;
124 CHECK(collection->insert(value_type(key, data)).second)
125 << "duplicate key: " << key;
126 }
127
128 } // namespace ceres
129
130 #endif // CERES_INTERNAL_MAP_UTIL_H_
131