aboutsummaryrefslogtreecommitdiff
path: root/libraries/Robot_Control/examples/explore/R01_Logo/R01_Logo.ino
diff options
context:
space:
mode:
authorCristian Maglie <c.maglie@bug.st>2013-06-01 23:16:02 +0200
committerCristian Maglie <c.maglie@bug.st>2013-06-01 23:16:02 +0200
commit177ad96f866714a4962be57f69cd3d5a6334cde1 (patch)
tree1072239986340d6a239adac924eddf2e1d1ca566 /libraries/Robot_Control/examples/explore/R01_Logo/R01_Logo.ino
parent6cff36ac5e85c74bcb45cc53491ad69d64520b36 (diff)
parentd90fcca5839d13d57ed527d4009b78d22dafbde7 (diff)
Merge branch 'merge-1.0.5' into ide-1.5.x-discovery
Diffstat (limited to 'libraries/Robot_Control/examples/explore/R01_Logo/R01_Logo.ino')
-rw-r--r--libraries/Robot_Control/examples/explore/R01_Logo/R01_Logo.ino134
1 files changed, 134 insertions, 0 deletions
diff --git a/libraries/Robot_Control/examples/explore/R01_Logo/R01_Logo.ino b/libraries/Robot_Control/examples/explore/R01_Logo/R01_Logo.ino
new file mode 100644
index 0000000..794479e
--- /dev/null
+++ b/libraries/Robot_Control/examples/explore/R01_Logo/R01_Logo.ino
@@ -0,0 +1,134 @@
+/* Robot Logo
+
+ This sketch demonstrates basic movement of the Robot.
+ When the sketch starts, press the on-board buttons to tell
+ the robot how to move. Pressing the middle button will
+ save the pattern, and the robot will follow accordingly.
+ You can record up to 20 commands. The robot will move for
+ one second per command.
+
+ This example uses images on an SD card. It looks for
+ files named "lg0.bmp" and "lg1.bmp" and draws them on the
+ screen.
+
+ Circuit:
+ * Arduino Robot
+
+ created 1 May 2013
+ by X. Yang
+ modified 12 May 2013
+ by D. Cuartielles
+
+ This example is in the public domain
+ */
+
+#include <ArduinoRobot.h> // include the robot library
+
+int commands[20]; // array for storing commands
+
+void setup() {
+ // initialize the Robot, SD card, and display
+ Robot.begin();
+ Robot.beginTFT();
+ Robot.beginSD();
+
+ // draw "lg0.bmp" and "lg1.bmp" on the screen
+ Robot.displayLogos();
+}
+
+void loop() {
+
+ Robot.drawBMP("intro.bmp", 0, 0); //display background image
+
+ iniCommands(); // remove commands from the array
+ addCommands(); // add commands to the array
+
+ delay(1000); // wait for a second
+
+ executeCommands(); // follow orders
+
+ Robot.stroke(0,0,0);
+ Robot.text("Done!", 5, 103); // write some text to the display
+ delay(1500); // wait for a moment
+}
+
+// empty the commands array
+void iniCommands() {
+ for(int i=0; i<20; i++)
+ commands[i]=-1;
+}
+
+// add commands to the array
+void addCommands() {
+ Robot.stroke(0,0,0);
+ // display text on the screen
+ Robot.text("1. Press buttons to\n add commands.\n\n 2. Middle to finish.", 5, 5);
+
+ // read the buttons' state
+ for(int i=0; i<20;) { //max 20 commands
+ int key = Robot.keyboardRead();
+ if(key == BUTTON_MIDDLE) { //finish input
+ break;
+ }else if(key == BUTTON_NONE) { //if no button is pressed
+ continue;
+ }
+ commands[i] = key; // save the button to the array
+ PrintCommandI(i, 46); // print the command on the screen
+ delay(100);
+ i++;
+ }
+}
+
+// run through the array and move the robot
+void executeCommands() {
+ // print status to the screen
+ Robot.text("Excuting...",5,70);
+
+ // read through the array and move accordingly
+ for(int i=0; i<20; i++) {
+ switch(commands[i]) {
+ case BUTTON_LEFT:
+ Robot.turn(-90);
+ break;
+ case BUTTON_RIGHT:
+ Robot.turn(90);
+ break;
+ case BUTTON_UP:
+ Robot.motorsWrite(255, 255);
+ break;
+ case BUTTON_DOWN:
+ Robot.motorsWrite(-255, -255);
+ break;
+ case BUTTON_NONE:
+ return;
+ }
+ // print the current command to the screen
+ Robot.stroke(255,0,0);
+ PrintCommandI(i, 86);
+ delay(1000);
+
+ // stop moving for a second
+ Robot.motorsStop();
+ delay(1000);
+ }
+}
+
+// convert the button press to a single character
+char keyToChar(int key) {
+ switch(key) {
+ case BUTTON_LEFT:
+ return '<';
+ case BUTTON_RIGHT:
+ return '>';
+ case BUTTON_UP:
+ return '^';
+ case BUTTON_DOWN:
+ return 'v';
+ }
+}
+
+// display a command
+void PrintCommandI(int i, int originY) {
+ Robot.text(keyToChar(commands[i]), i%14*8+5, i/14*10+originY);
+}
+