How does this workkkkk?!?!?!?!?!

Dependencies:   4DGL-uLCD-SE PinDetect mbed-rtos mbed

Committer:
swilliams346
Date:
Sat Oct 29 22:10:24 2016 +0000
Revision:
0:973e6eca2102
ERICK

Who changed what in which revision?

UserRevisionLine numberNew contents of line
swilliams346 0:973e6eca2102 1 #include "mbed.h"
swilliams346 0:973e6eca2102 2 #include "uLCD_4DGL.h"
swilliams346 0:973e6eca2102 3 #include "rtos.h"
swilliams346 0:973e6eca2102 4 uLCD_4DGL uLCD(p28, p27, p30);
swilliams346 0:973e6eca2102 5 #include "Robot.h"
swilliams346 0:973e6eca2102 6 #include "Nav_Switch.h"
swilliams346 0:973e6eca2102 7 BusOut mbedleds(LED1,LED2,LED3,LED4);
swilliams346 0:973e6eca2102 8 Robot myRobot;
swilliams346 0:973e6eca2102 9 Nav_Switch myNav( p21, p22, p23, p24, p25);
swilliams346 0:973e6eca2102 10
swilliams346 0:973e6eca2102 11 int i = 11;
swilliams346 0:973e6eca2102 12 int j = 11;
swilliams346 0:973e6eca2102 13 int C1 = 11;
swilliams346 0:973e6eca2102 14 int C2 = 32;
swilliams346 0:973e6eca2102 15 int C3 = 53;
swilliams346 0:973e6eca2102 16 int C4 = 74;
swilliams346 0:973e6eca2102 17 int C5 = 95;
swilliams346 0:973e6eca2102 18 int C6 = 116;
swilliams346 0:973e6eca2102 19
swilliams346 0:973e6eca2102 20 int main()
swilliams346 0:973e6eca2102 21 {
swilliams346 0:973e6eca2102 22 //Initialize Background
swilliams346 0:973e6eca2102 23 uLCD.filled_rectangle(0, 0 , 127, 127, RED);
swilliams346 0:973e6eca2102 24 myRobot.drawOutline();
swilliams346 0:973e6eca2102 25 while(i <= 116){
swilliams346 0:973e6eca2102 26 while(j <= 116){
swilliams346 0:973e6eca2102 27 myRobot.drawHelper(i,j);
swilliams346 0:973e6eca2102 28 j = j + 21;
swilliams346 0:973e6eca2102 29 }
swilliams346 0:973e6eca2102 30 j = 11;
swilliams346 0:973e6eca2102 31 i = i + 21;
swilliams346 0:973e6eca2102 32 }
swilliams346 0:973e6eca2102 33 myRobot.drawFrog();
swilliams346 0:973e6eca2102 34
swilliams346 0:973e6eca2102 35 //Auto-pilot Testing
swilliams346 0:973e6eca2102 36 wait(1);
swilliams346 0:973e6eca2102 37 myRobot.drawEraser();
swilliams346 0:973e6eca2102 38 myRobot.moveForward();
swilliams346 0:973e6eca2102 39 myRobot.drawFrog();
swilliams346 0:973e6eca2102 40 wait(1);
swilliams346 0:973e6eca2102 41 myRobot.drawEraser();
swilliams346 0:973e6eca2102 42 myRobot.moveForward();
swilliams346 0:973e6eca2102 43 myRobot.drawFrog();
swilliams346 0:973e6eca2102 44 wait(1);
swilliams346 0:973e6eca2102 45 myRobot.drawEraser();
swilliams346 0:973e6eca2102 46 myRobot.moveLeft();
swilliams346 0:973e6eca2102 47 myRobot.drawFrog();
swilliams346 0:973e6eca2102 48 wait(1);
swilliams346 0:973e6eca2102 49 myRobot.drawEraser();
swilliams346 0:973e6eca2102 50 myRobot.moveBackward();
swilliams346 0:973e6eca2102 51 myRobot.drawFrog();
swilliams346 0:973e6eca2102 52
swilliams346 0:973e6eca2102 53 //Begin Processes
swilliams346 0:973e6eca2102 54 while(1) {
swilliams346 0:973e6eca2102 55 mbedleds = ~(myNav & 0x0F); //update leds with nav switch direction inputs
swilliams346 0:973e6eca2102 56 if(myNav.fire()) mbedleds = 0x0F;
swilliams346 0:973e6eca2102 57 wait(0.02);
swilliams346 0:973e6eca2102 58 }
swilliams346 0:973e6eca2102 59 }