kapko

Untitled

Jun 8th, 2024
480
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. /**
  2.  * 1. (1 pkt) Zadeklaruj zmienną x o wartości 50.
  3.  */
  4. var x = 50;
  5.  
  6. /**
  7.  * 2. (1 pkt) Utwórz strukturę POS o polach x, y, z. Nadaj polom odpowiednie wartości 50 (x), 100 (y), 200 (z).
  8.  */
  9.  
  10. var POS = {x: 50, y: 100, z: 200};
  11.  
  12. /**
  13.  * 3. (1 pkt) Ustaw robota w pozycji domowej wykorzystując współrzędne złączowe: J1=0, J2=-90, J3=-90, J4=-90, J5=90, J6=0.
  14.  */
  15.  
  16. var JOINT_HOME = [0, -90, 90, -90, 90, 0]; // deklaracja pozycji domwej
  17. moveJoint(JOINT_HOME); // ruch
  18.  
  19. /**
  20.  * 4. (1 pkt) Obróć robota względem podstawy o 90 stopni zgodnie z ruchem wskazówek zegara.
  21.  */
  22.  
  23. JOINT_HOME[0] = -90; // zamiana pierwszej wspolrzednej w tablicy
  24. moveJoint(JOINT_HOME); // ruch z nowymi wspolrzednymi
  25.  
  26. /**
  27.  * 5. (1 pkt) Przesuń robota liniowo do pozycji domowej: POS = x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90;
  28.  */
  29.  
  30. var POSE_HOME = { x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90 };
  31. moveLinear('flange', POSE_HOME);
  32.  
  33. /**
  34.  * 6. (1 pkt) Zatocz z pozycji domowej dowolny okrąg o średnicy 100.
  35.  */
  36.  
  37. var diameter = 100;
  38. var radius = diameter/2;
  39.  
  40. var HOME = { x: 400, y: 100, z: 400, rx: -180, ry: 0, rz: -90 };
  41. var POSE_PASS = { x: HOME.x + radius, y: HOME.y - radius , z: HOME.z, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz };
  42. var POSE_TARGET = { x: HOME.x, y: HOME.y - 2*radius , z: HOME.z, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz };;
  43.  
  44. moveLinear('flange', HOME);
  45. moveCircle('flange', POSE_PASS, POSE_TARGET);
  46.  
  47. /**
  48.  * 7. (1 pkt) Zatocz z pozycji domowej dowolny łuk o mierze 135 stopni i promieniu 50.
  49.  */
  50.  
  51. var radius = 50;
  52. var degree = 135;
  53.  
  54. var x = 135 * (Math.PI/180)
  55.  
  56. var POSE_HOME = { x: 490, y: -170.5, z: 400, rx: -180, ry: 0, rz: -90 };
  57. var POSE_PASS = { x: 540, y: -120.5, z: 400, rx: -180, ry: 0, rz: -90 };
  58. var POSE_TARGET = { x: 575, y: -135, z: 400, rx: -180, ry: 0, rz: -90 };
  59.  
  60. moveLinear('flange', POSE_HOME);
  61. moveArc('flange', POSE_PASS, POSE_TARGET);
  62.  
  63. /**
  64.  * 8. (1 pkt) Wykonaj ruch z pozycji domowej po ścieżce w kształcie kwadratu o boku 100.
  65.  */
  66. var len = 100;
  67. var POSITION = { x: 490, y: -170.5, z: 400, rx: -180, ry: 0, rz: -90 };
  68. moveLinear('flange', POSITION);
  69. POSITION.x += len;
  70. moveLinear('flange', POSITION);
  71. POSITION.y += len;
  72. moveLinear('flange', POSITION);
  73. POSITION.x -= len;
  74. moveLinear('flange', POSITION);
  75. POSITION.y -= len;
  76. moveLinear('flange', POSITION);
  77.  
  78. /**
  79.  * 9. (2 pkt) Wykonaj ruch z pozycji domowej po ścieżce w kształcie półelipsy o półosiach 70 i 100. Podziel ścieżkę na 10 fragmentów liniowych.
  80.  */
  81. var HOME = { x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90 };
  82. moveLinear('flange', HOME);
  83.  
  84. var a = 70; // półoś x
  85. var b = 100; // półoś y
  86. var segments = 10;
  87. for (var i = segments; i >= 0; i--) {
  88.     var t = Math.PI * i / segments;
  89.     var posX = a + a * Math.cos(t);
  90.     var posY = b *Math.sin(t);
  91.     moveLinear("flange", { x: HOME.x+ posX, y: HOME.y + posY, z: HOME.z, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz });
  92. }
  93.  
  94. /**
  95.  * 10. (2 pkt) Wykonaj ruch z pozycji domowej po ścieżce w kształcie linii śrubowej o promieniu 40 i skoku 60. Wykonaj trzy pełne obroty. Pojedynczy obrót podziel na 30 fragmentów liniowych.
  96.  * NIEDZIALA
  97.  */
  98. var HOME = { x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90 };
  99.  
  100. var radius = 40;
  101. var pitch = 60;
  102. var turns = 3;
  103. var segmentsPerTurn = 30;
  104. var totalSegments = turns * segmentsPerTurn;
  105.  
  106. for (var i = 0; i <= totalSegments; i++) {
  107.     var t = 2 * Math.PI * i / segmentsPerTurn;
  108.     var posX = radius * Math.cos(t);
  109.     var posY = radius * Math.sin(t);
  110.     var posZ = 441.5 + (i * pitch / segmentsPerTurn);
  111.     moveLinear('flange', { x: HOME.x + posX, y: HOME.y + posY, z: HOME.z + posZ, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz });
  112. }
  113.  
Advertisement
Add Comment
Please, Sign In to add comment