robot code
|
|
|
|
|
|
|
|
|
|
Search for red beacon
|
| |
| |
| |
| |
YES
|
|
|
|
|
|
|
|
|
Go to beacon and make contact with limit switch
| NO
|
Keep moving to beacon
|
| |
| |
| |
YES
|
|
|
|
|
|
|
|
|
Move arm down to turn off beacon
| NO
|
Lift arm up and try again
|
| |
| |
| |
YES
|
|
|
|
|
|
|
|
|
Search for green beacon and make contact
|
| |
| |
| |
| |
YES
|
|
|
|
|
|
|
|
|
Bring green beacon to starting line
|
| |
| |
| |
| |
|
|
|
|
|
|
|
|
|
|
| |
| |
| |
| |
|
|
|
|
|
|
|
|
|
|
| |
| |
| |
| |
|
|
|
|
|
|
|
|
|