Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- #include <Servo.h>
- typedef struct{
- int basePos;
- int armPos;
- int wristPos;
- byte knot;
- byte cross;
- }
- cell;
- cell ticTac[2][2];//goes ROW -> COLCUMN
- //Servos
- Servo base;
- Servo arm;
- Servo wrist;
- //Prototypes
- void scan();
- void select(int row, int col);//row and col are the indicies of ticTac
- void setup(){
- int i, j;
- ticTac[0][0].basePos = 120;
- ticTac[0][0].armPos = 124;
- ticTac[0][0].wristPos = 47;
- ticTac[0][1].basePos = 105;
- ticTac[0][1].armPos = 132;
- ticTac[0][1].wristPos = 71;
- ticTac[0][2].basePos = 95;
- ticTac[0][2].armPos = 148;
- ticTac[0][2].wristPos = 105;
- ticTac[1][0].basePos = 100;
- ticTac[1][0].armPos = 116;
- ticTac[1][0].wristPos = 36;
- ticTac[1][1].basePos = 85;
- ticTac[1][1].armPos = 132;
- ticTac[1][1].wristPos = 67;
- ticTac[1][2].basePos = 85;
- ticTac[1][2].armPos = 142;
- ticTac[1][2].wristPos = 94;
- ticTac[2][0].basePos = 65;
- ticTac[2][0].armPos = 126;
- ticTac[2][0].wristPos = 47;
- ticTac[2][1].basePos = 65;
- ticTac[2][1].armPos = 131;
- ticTac[2][1].wristPos = 68;
- ticTac[2][2].basePos = 65;
- ticTac[2][2].armPos = 148;
- ticTac[2][2].wristPos = 105;
- for(i = 0; i <= 2; i++){
- for(j = 0; j <= 2; j++){
- ticTac[j][i].knot = 0;
- ticTac[j][i].cross = 0;
- }
- }
- base.attach(10);
- arm.attach(9);
- wrist.attach(8);
- Serial.begin(9600);
- }
- void scan();
- void select(int row, int col);
- void loop(){
- base.write(ticTac[0][0].basePos);
- arm.write(ticTac[0][0].armPos);
- wrist.write(ticTac[0][0].wristPos);
- }
- void scan(){
- int i, j;
- for(i = 0; i = 2; i++){
- for(j = 0; j = 2; j++){
- select(j, i);
- }
- }
- }
- void select(int row, int col){
- base.write(ticTac[row][col].basePos);
- delay(500);
- arm.write(ticTac[row][col].armPos);
- delay(500);
- wrist.write(ticTac[row][col].wristPos);
- delay(500);
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement