Advertisement
Guest User

Untitled

a guest
Oct 30th, 2014
169
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
Robots 4.66 KB | None | 0 0
  1. MODULE MainModule
  2.     CONST robtarget Target_50:=[[298.36,100.97,250.58],[0.000000269,0.707107,0.707107,-0.000000268],[0,-1,0,0],[9E9,9E9,9E9,9E9,9E9,9E9]];
  3.     CONST robtarget Target_10:=[[0,0,0],[0,0.707106781,0.707106781,0],[-1,0,-1,0],[9E9,9E9,9E9,9E9,9E9,9E9]];
  4.     CONST robtarget Target_20:=[[300,0,0],[0,0.707106781,0.707106781,0],[0,-1,0,0],[9E9,9E9,9E9,9E9,9E9,9E9]];
  5.     CONST robtarget Target_30:=[[300,150,0],[0,0.707106781,0.707106781,0],[0,-1,0,0],[9E9,9E9,9E9,9E9,9E9,9E9]];
  6.     CONST robtarget Target_40:=[[0,150,0],[0,0.707106781,0.707106781,0],[-1,0,-1,0],[9E9,9E9,9E9,9E9,9E9,9E9]];
  7.     TASK PERS wobjdata Workobject_1_m:=[FALSE,TRUE,"",[[500.1848,227.1942,115.53],[0.707106781,0,0,-0.707106781]],[[0,0,0],[1,0,0,0]]];
  8.     PERS tooldata t3Jaw_RobStudio_m:=[TRUE,[[0,0,158],[1,0,0,0]],[1,[0,0,130],[1,0,0,0],0,0,0]];
  9.     CONST robtarget Target_50_m:=[[298.36,-100.97,250.58],[2.69E-07,-0.707107,0.707107,2.68E-07],[-1,0,-1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  10.     CONST robtarget Target_10_m:=[[0,0,0],[0,-0.707106781,0.707106781,0],[0,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  11.     CONST robtarget Target_20_m:=[[300,0,0],[0,-0.707106781,0.707106781,0],[-1,0,-1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  12.     CONST robtarget Target_30_m:=[[300,-150,0],[0,-0.707106781,0.707106781,0],[-1,0,-1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  13.     CONST robtarget Target_40_m:=[[0,-150,0],[0,-0.707106781,0.707106781,0],[0,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  14.     CONST robtarget Target_50_m0:=[[298.3607,100.9702,-250.5806],[0.70710721881225,0.000963507654349458,-0.00096350944356938,0.707108531696115],[0,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  15.     CONST robtarget Target_10_m0:=[[0,0,0],[0.707107218812979,0.000786533135736088,0.000786534108887692,0.707108093695183],[-1,0,-1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  16.     CONST robtarget Target_20_m0:=[[300.0007,0,0],[0.707107218812979,0.000786533135736088,0.000786534108887692,0.707108093695183],[0,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  17.     CONST robtarget Target_30_m0:=[[300.0007,150.0004,0],[0.707107218812979,0.000786533135736088,0.000786534108887692,0.707108093695183],[0,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  18.     CONST robtarget Target_40_m0:=[[0,150.0004,0],[0.707107218812979,0.000786533135736088,0.000786534108887692,0.707108093695183],[-1,0,-1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
  19.     PROC main()
  20.         ConfL\Off;
  21.         TPErase;
  22.         TPReadNum reg1, "wpisz numer procedury do wykonania ";
  23.         IF reg1 = 0 THEN
  24.             TPWrite "Viola_Michal1";
  25.             Viola_Michal1;
  26.         ENDIF
  27.         IF reg1 = 1 THEN
  28.             TPWrite "Viola_Michal1_Copy";
  29.             Viola_Michal1Copy;
  30.         ENDIF
  31.         IF reg1 = 2 THEN
  32.             TPWrite "Viola_Michal1_mirror_base";
  33.             Viola_Michal1_mirror_base;
  34.         ENDIF
  35.         IF reg1 = 3 THEN
  36.             TPWrite "Viola_Michal1_mirrorx";
  37.             Viola_Michal1_mirrorx;
  38.         ENDIF
  39.     ENDPROC
  40.     PROC Viola_Michal1()
  41.         MoveL Target_50, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  42.         MoveL Target_10, v300, z0, t3Jaw_RobStudio\WObj:=Workobject_1;
  43.         MoveL Target_20, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  44.         MoveL Target_30, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  45.         MoveL Target_40, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  46.         MoveL Target_10, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  47.     ENDPROC
  48.     PROC Viola_Michal1_mirrorx()
  49.         MoveL Target_50_m0, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  50.         MoveL Target_10_m0, v300, z0, t3Jaw_RobStudio\WObj:=Workobject_1;
  51.         MoveL Target_20_m0, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  52.         MoveL Target_30_m0, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  53.         MoveL Target_40_m0, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  54.         MoveL Target_10_m0, v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  55.     ENDPROC
  56.     PROC Viola_Michal1_mirror_base()
  57.         MoveL Target_50_m, v300, fine, t3Jaw_RobStudio_m\WObj:=Workobject_1_m;
  58.         MoveL Target_10_m, v300, z0, t3Jaw_RobStudio_m\WObj:=Workobject_1_m;
  59.         MoveL Target_20_m, v300, fine, t3Jaw_RobStudio_m\WObj:=Workobject_1_m;
  60.         MoveL Target_30_m, v300, fine, t3Jaw_RobStudio_m\WObj:=Workobject_1_m;
  61.         MoveL Target_40_m, v300, fine, t3Jaw_RobStudio_m\WObj:=Workobject_1_m;
  62.         MoveL Target_10_m, v300, fine, t3Jaw_RobStudio_m\WObj:=Workobject_1_m;
  63.     ENDPROC
  64.     PROC Viola_Michal1Copy()
  65.         MoveL Offs(Target_50,0,0,10), v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  66.         MoveL Offs(Target_10,0,0,10), v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  67.         MoveL Offs(Target_20,0,0,10), v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  68.         MoveL Offs(Target_30,0,0,10), v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  69.         MoveL Offs(Target_40,0,0,10), v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  70.         MoveL Offs(Target_10,0,0,10), v300, fine, t3Jaw_RobStudio\WObj:=Workobject_1;
  71.     ENDPROC
  72. ENDMODULE
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement