Implemented Create reset method

CMakeLists.txt

@@ -84,7 +84,7 @@ endforeach()
 # Configuration #
 #################
 
-set(CMAKE_INSTALL_PREFIX "/usr/")
+# set(CMAKE_INSTALL_PREFIX "/usr/") // complib needs  this, riplib doesn't
 
 # Install directories layout:
 #   * <prefix>/lib/

include/create/create.h

@@ -135,6 +135,11 @@ namespace create {
        */
       ~Create();
 
+      /**
+       * \brief Resets the create as if the battery was removed and reinserted.
+       */
+      void reset();
+
       /**
        * \brief Make a serial connection to Create.
        *

src/create.cpp

@@ -67,6 +67,15 @@ namespace create {
     disconnect();
   }
 
+  void Create::reset() {
+    if (!connected()) {
+      CERR("[create::Serial] ", "send failed, not connected.");
+      return;
+    }
+    serial->sendOpcode(OC_START);
+    serial->sendOpcode(OC_RESET);
+  }
+
   Create::Matrix Create::addMatrices(const Matrix &A, const Matrix &B) const {
     size_t rows = A.size1();
     size_t cols = A.size2();