How does this workkkkk?!?!?!?!?!
Dependencies: 4DGL-uLCD-SE PinDetect mbed-rtos mbed
main.cpp@0:973e6eca2102, 2016-10-29 (annotated)
- Committer:
- swilliams346
- Date:
- Sat Oct 29 22:10:24 2016 +0000
- Revision:
- 0:973e6eca2102
ERICK
Who changed what in which revision?
User | Revision | Line number | New 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 | } |