From bd35c8b7da809e2788937dbf426faaec980ae8e6 Mon Sep 17 00:00:00 2001
From: Richard Roberts <richard.jw.roberts@gmail.com>
Date: Fri, 6 Jan 2012 16:52:06 +0000
Subject: [PATCH] Added print function to Permuted<>

---
 gtsam/inference/Permutation.h | 8 ++++++++
 1 file changed, 8 insertions(+)

diff --git a/gtsam/inference/Permutation.h b/gtsam/inference/Permutation.h
index 99d717681..b2d9c2d11 100644
--- a/gtsam/inference/Permutation.h
+++ b/gtsam/inference/Permutation.h
@@ -19,6 +19,7 @@
 
 #include <vector>
 #include <string>
+#include <iostream>
 #include <boost/shared_ptr.hpp>
 
 #include <gtsam/base/types.h>
@@ -168,6 +169,13 @@ public:
    */
   Permuted(CONTAINER& container) : permutation_(Permutation::Identity(container.size())), container_(container) {}
 
+  /** Print */
+  void print(const std::string& str = "") const {
+    std::cout << str;
+    permutation_.print("  permutation: ");
+    container_.print("  container: ");
+  }
+
   /** Access the container through the permutation */
   value_type& operator[](size_t index) { return container_[permutation_[index]]; }