Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- /**
- * 1. (1 pkt) Zadeklaruj zmienną x o wartości 50.
- */
- var x = 50;
- /**
- * 2. (1 pkt) Utwórz strukturę POS o polach x, y, z. Nadaj polom odpowiednie wartości 50 (x), 100 (y), 200 (z).
- */
- var POS = {x: 50, y: 100, z: 200};
- /**
- * 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.
- */
- var JOINT_HOME = [0, -90, 90, -90, 90, 0]; // deklaracja pozycji domwej
- moveJoint(JOINT_HOME); // ruch
- /**
- * 4. (1 pkt) Obróć robota względem podstawy o 90 stopni zgodnie z ruchem wskazówek zegara.
- */
- JOINT_HOME[0] = -90; // zamiana pierwszej wspolrzednej w tablicy
- moveJoint(JOINT_HOME); // ruch z nowymi wspolrzednymi
- /**
- * 5. (1 pkt) Przesuń robota liniowo do pozycji domowej: POS = x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90;
- */
- var POSE_HOME = { x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90 };
- moveLinear('flange', POSE_HOME);
- /**
- * 6. (1 pkt) Zatocz z pozycji domowej dowolny okrąg o średnicy 100.
- */
- var diameter = 100;
- var radius = diameter/2;
- var HOME = { x: 400, y: 100, z: 400, rx: -180, ry: 0, rz: -90 };
- var POSE_PASS = { x: HOME.x + radius, y: HOME.y - radius , z: HOME.z, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz };
- var POSE_TARGET = { x: HOME.x, y: HOME.y - 2*radius , z: HOME.z, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz };;
- moveLinear('flange', HOME);
- moveCircle('flange', POSE_PASS, POSE_TARGET);
- /**
- * 7. (1 pkt) Zatocz z pozycji domowej dowolny łuk o mierze 135 stopni i promieniu 50.
- */
- var radius = 50;
- var degree = 135;
- var x = 135 * (Math.PI/180)
- var POSE_HOME = { x: 490, y: -170.5, z: 400, rx: -180, ry: 0, rz: -90 };
- var POSE_PASS = { x: 540, y: -120.5, z: 400, rx: -180, ry: 0, rz: -90 };
- var POSE_TARGET = { x: 575, y: -135, z: 400, rx: -180, ry: 0, rz: -90 };
- moveLinear('flange', POSE_HOME);
- moveArc('flange', POSE_PASS, POSE_TARGET);
- /**
- * 8. (1 pkt) Wykonaj ruch z pozycji domowej po ścieżce w kształcie kwadratu o boku 100.
- */
- var len = 100;
- var POSITION = { x: 490, y: -170.5, z: 400, rx: -180, ry: 0, rz: -90 };
- moveLinear('flange', POSITION);
- POSITION.x += len;
- moveLinear('flange', POSITION);
- POSITION.y += len;
- moveLinear('flange', POSITION);
- POSITION.x -= len;
- moveLinear('flange', POSITION);
- POSITION.y -= len;
- moveLinear('flange', POSITION);
- /**
- * 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.
- */
- var HOME = { x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90 };
- moveLinear('flange', HOME);
- var a = 70; // półoś x
- var b = 100; // półoś y
- var segments = 10;
- for (var i = segments; i >= 0; i--) {
- var t = Math.PI * i / segments;
- var posX = a + a * Math.cos(t);
- var posY = b *Math.sin(t);
- moveLinear("flange", { x: HOME.x+ posX, y: HOME.y + posY, z: HOME.z, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz });
- }
- /**
- * 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.
- * NIEDZIALA
- */
- var HOME = { x: 490, y: -170.5, z: 441.5, rx: -180, ry: 0, rz: -90 };
- var radius = 40;
- var pitch = 60;
- var turns = 3;
- var segmentsPerTurn = 30;
- var totalSegments = turns * segmentsPerTurn;
- for (var i = 0; i <= totalSegments; i++) {
- var t = 2 * Math.PI * i / segmentsPerTurn;
- var posX = radius * Math.cos(t);
- var posY = radius * Math.sin(t);
- var posZ = 441.5 + (i * pitch / segmentsPerTurn);
- moveLinear('flange', { x: HOME.x + posX, y: HOME.y + posY, z: HOME.z + posZ, rx: HOME.rx, ry: HOME.ry, rz: HOME.rz });
- }
Advertisement
Add Comment
Please, Sign In to add comment