Update examples

More concise and focusing on individual features:

* Battery level
* Bumpers
* Drive circle
* LEDs
* Serial packets
* Play song
* Wheeldrop

examples/bumpers.cpp

@@ -0,0 +1,126 @@
+/**
+Software License Agreement (BSD)
+
+\file      bumpers.cpp
+\authors   Jacob Perron <jperron@sfu.ca>
+\copyright Copyright (c) 2018, Autonomy Lab (Simon Fraser University), All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions are met:
+ * Redistributions of source code must retain the above copyright notice,
+   this list of conditions and the following disclaimer.
+ * Redistributions in binary form must reproduce the above copyright notice,
+   this list of conditions and the following disclaimer in the
+   documentation and/or other materials provided with the distribution.
+ * Neither the name of Autonomy Lab nor the names of its contributors may
+   be used to endorse or promote products derived from this software without
+   specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
+LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+POSSIBILITY OF SUCH DAMAGE.
+*/
+#include "create/create.h"
+
+#include <iostream>
+
+int main(int argc, char** argv) {
+  // Select robot. Assume Create 2 unless argument says otherwise
+  create::RobotModel model = create::RobotModel::CREATE_2;
+  std::string port = "/dev/ttyUSB0";
+  int baud = 115200;
+  if (argc > 1 && std::string(argv[1]) == "create1") {
+    model = create::RobotModel::CREATE_1;
+    baud = 57600;
+    std::cout << "Running driver for Create 1" << std::endl;
+  }
+  else {
+    std::cout << "Running driver for Create 2" << std::endl;
+  }
+
+  // Construct robot object
+  create::Create* robot = new create::Create(model);
+
+  // Connect to robot
+  if (robot->connect(port, baud))
+    std::cout << "Connected to robot" << std::endl;
+  else {
+    std::cout << "Failed to connect to robot on port " << port.c_str() << std::endl;
+    return 1;
+  }
+
+  // Switch to Full mode
+  robot->setMode(create::MODE_FULL);
+
+  std::cout << std::endl << "Press center 'Clean' button to disconnect and end program" << std::endl;
+
+  uint16_t light_signals[6];
+  bool light_bumpers[6];
+  bool contact_bumpers[2];
+
+  while (!robot->isCleanButtonPressed()) {
+    // Get light sensor data (only available for Create 2 or later robots)
+    if (model == create::RobotModel::CREATE_2) {
+      // Get raw light signal values
+      light_signals[0] = robot->getLightSignalLeft();
+      light_signals[1] = robot->getLightSignalFrontLeft();
+      light_signals[2] = robot->getLightSignalCenterLeft();
+      light_signals[3] = robot->getLightSignalCenterRight();
+      light_signals[4] = robot->getLightSignalFrontRight();
+      light_signals[5] = robot->getLightSignalRight();
+
+      // Get obstacle data from light sensors (true/false)
+      light_bumpers[0] = robot->isLightBumperLeft();
+      light_bumpers[1] = robot->isLightBumperFrontLeft();
+      light_bumpers[2] = robot->isLightBumperCenterLeft();
+      light_bumpers[3] = robot->isLightBumperCenterRight();
+      light_bumpers[4] = robot->isLightBumperFrontRight();
+      light_bumpers[5] = robot->isLightBumperRight();
+    }
+
+    // Get state of bumpers
+    contact_bumpers[0] = robot->isLeftBumper();
+    contact_bumpers[1] = robot->isRightBumper();
+
+    // Print signals from left to right
+    std::cout << "[ " << light_signals[0] << " , "
+                      << light_signals[1] << " , "
+                      << light_signals[2] << " , "
+                      << light_signals[3] << " , "
+                      << light_signals[4] << " , "
+                      << light_signals[5]
+              << " ]" << std::endl;
+    std::cout << "[ " << light_bumpers[0] << " , "
+                      << light_bumpers[1] << " , "
+                      << light_bumpers[2] << " , "
+                      << light_bumpers[3] << " , "
+                      << light_bumpers[4] << " , "
+                      << light_bumpers[5]
+              << " ]" << std::endl;
+    std::cout << "[ " << contact_bumpers[0] << " , "
+                      << contact_bumpers[1]
+              << " ]" << std::endl;
+    std::cout << std::endl;
+
+    usleep(100000);  // 10 Hz
+  }
+
+  std::cout << std::endl;
+
+  // Call disconnect to avoid leaving robot in Full mode
+  robot->disconnect();
+
+  // Clean up
+  delete robot;
+
+  std::cout << "Bye!" << std::endl;
+  return 0;
+}