Advertisement
Guest User

Untitled

a guest
Jul 4th, 2012
55
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.86 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. typedef struct{
  4. int basePos;
  5. int armPos;
  6. int wristPos;
  7. byte knot;
  8. byte cross;
  9. }
  10. cell;
  11. cell ticTac[2][2];//goes ROW -> COLCUMN
  12.  
  13. //Servos
  14. Servo base;
  15. Servo arm;
  16. Servo wrist;
  17.  
  18. //Prototypes
  19. void scan();
  20. void select(int row, int col);//row and col are the indicies of ticTac
  21.  
  22. void setup(){
  23.  
  24. int i, j;
  25. ticTac[0][0].basePos = 120;
  26. ticTac[0][0].armPos = 124;
  27. ticTac[0][0].wristPos = 47;
  28. ticTac[0][1].basePos = 105;
  29. ticTac[0][1].armPos = 132;
  30. ticTac[0][1].wristPos = 71;
  31. ticTac[0][2].basePos = 95;
  32. ticTac[0][2].armPos = 148;
  33. ticTac[0][2].wristPos = 105;
  34. ticTac[1][0].basePos = 100;
  35. ticTac[1][0].armPos = 116;
  36. ticTac[1][0].wristPos = 36;
  37. ticTac[1][1].basePos = 85;
  38. ticTac[1][1].armPos = 132;
  39. ticTac[1][1].wristPos = 67;
  40. ticTac[1][2].basePos = 85;
  41. ticTac[1][2].armPos = 142;
  42. ticTac[1][2].wristPos = 94;
  43. ticTac[2][0].basePos = 65;
  44. ticTac[2][0].armPos = 126;
  45. ticTac[2][0].wristPos = 47;
  46. ticTac[2][1].basePos = 65;
  47. ticTac[2][1].armPos = 131;
  48. ticTac[2][1].wristPos = 68;
  49. ticTac[2][2].basePos = 65;
  50. ticTac[2][2].armPos = 148;
  51. ticTac[2][2].wristPos = 105;
  52.  
  53. for(i = 0; i <= 2; i++){
  54. for(j = 0; j <= 2; j++){
  55. ticTac[j][i].knot = 0;
  56. ticTac[j][i].cross = 0;
  57. }
  58. }
  59.  
  60. base.attach(10);
  61. arm.attach(9);
  62. wrist.attach(8);
  63. Serial.begin(9600);
  64.  
  65. }
  66.  
  67. void scan();
  68. void select(int row, int col);
  69.  
  70. void loop(){
  71. base.write(ticTac[0][0].basePos);
  72. arm.write(ticTac[0][0].armPos);
  73. wrist.write(ticTac[0][0].wristPos);
  74. }
  75.  
  76. void scan(){
  77. int i, j;
  78. for(i = 0; i = 2; i++){
  79. for(j = 0; j = 2; j++){
  80. select(j, i);
  81. }
  82. }
  83. }
  84.  
  85. void select(int row, int col){
  86. base.write(ticTac[row][col].basePos);
  87. delay(500);
  88. arm.write(ticTac[row][col].armPos);
  89. delay(500);
  90. wrist.write(ticTac[row][col].wristPos);
  91. delay(500);
  92. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement