From ffd439d89a5393e2043ff30dd9904af23babdeb8 Mon Sep 17 00:00:00 2001
From: Richard Roberts <richard.jw.roberts@gmail.com>
Date: Tue, 7 Jan 2014 17:34:00 -0500
Subject: [PATCH] Added unit tests for Values::find, lower_bound, and
 upper_bound

---
 gtsam/nonlinear/tests/testValues.cpp | 28 ++++++++++++++++++++++++++++
 1 file changed, 28 insertions(+)

diff --git a/gtsam/nonlinear/tests/testValues.cpp b/gtsam/nonlinear/tests/testValues.cpp
index 636789652..ec386950d 100644
--- a/gtsam/nonlinear/tests/testValues.cpp
+++ b/gtsam/nonlinear/tests/testValues.cpp
@@ -149,6 +149,34 @@ TEST( Values, update_element )
   CHECK(assert_equal(v2, cfg.at<LieVector>(key1)));
 }
 
+/* ************************************************************************* */
+TEST(Values, basic_functions)
+{
+  Values values;
+  const Values& values_c = values;
+  values.insert(2, LieVector());
+  values.insert(4, LieVector());
+  values.insert(6, LieVector());
+  values.insert(8, LieVector());
+
+  // find
+  EXPECT_LONGS_EQUAL(4, values.find(4)->key);
+  EXPECT_LONGS_EQUAL(4, values_c.find(4)->key);
+
+  // lower_bound
+  EXPECT_LONGS_EQUAL(4, values.lower_bound(4)->key);
+  EXPECT_LONGS_EQUAL(4, values_c.lower_bound(4)->key);
+  EXPECT_LONGS_EQUAL(4, values.lower_bound(3)->key);
+  EXPECT_LONGS_EQUAL(4, values_c.lower_bound(3)->key);
+
+  // upper_bound
+  EXPECT_LONGS_EQUAL(6, values.upper_bound(4)->key);
+  EXPECT_LONGS_EQUAL(6, values_c.upper_bound(4)->key);
+  EXPECT_LONGS_EQUAL(4, values.upper_bound(3)->key);
+  EXPECT_LONGS_EQUAL(4, values_c.upper_bound(3)->key);
+
+}
+
 ///* ************************************************************************* */
 //TEST(Values, dim_zero)
 //{