paraschhabra96

Untitled

Feb 11th, 2016
26
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.14 KB | None | 0 0
  1. int rotated = 0;
  2. void pick(char side, char color)
  3. {
  4. if (side == 'l')
  5. {
  6. if (gripper2 == 'e')
  7. {
  8. forward_mm(50);
  9. pick2();
  10. gripper2 = color;
  11. }
  12. else if (gripper3 == 'e')
  13. {
  14. forward_mm(100);
  15. pick3();
  16. gripper3 = color;
  17. }
  18. else
  19. {
  20. left_degrees(180);
  21. if (gripper4 == 'e')
  22. {
  23. backward_mm(50);
  24. pick4();
  25. gripper4 = color;
  26. }
  27. else if (gripper1 == 'e')
  28. {
  29. backward_mm(50);
  30. pick1();
  31. gripper1 = color;
  32. }
  33. rotated = 1;
  34. }
  35. }
  36. else if (side == 'r')
  37. {
  38. if (gripper1 == 'e')
  39. {
  40. forward_mm(50);
  41. pick1();
  42. gripper1 = color;
  43. }
  44. else if (gripper4 == 'e')
  45. {
  46. forward_mm(100);
  47. pick4();
  48. gripper4 = color;
  49. }
  50. else
  51. {
  52. left_degrees(180);
  53. if (gripper3 == 'e')
  54. {
  55. backward_mm(50);
  56. pick3();
  57. gripper3 = color;
  58. }
  59. else if (gripper2 == 'e')
  60. {
  61. backward_mm(50);
  62. pick2();
  63. gripper2 = color;
  64. }
  65. rotated = 1;
  66. }
  67. }
  68. }
Add Comment
Please, Sign In to add comment