IRC5 WorldZone. Setup and test.

  • Hello,


    I want to setup two woldzones. When robot is inside the specified cube then output comes ON.
    Procedure says: Specify two corners of the cube and setup output.


    Here is a code from routine which runs on the Power_On event:

    ! NPC Zone 1
    WZBoxDef\Inside,volNPC1,NPC1_pos1,NPC1_pos2;
    WZDOSet\Stat,NPC_zone1\Inside,volNPC1,DO_NPCZone1,1;
    ! NPC Zone 2
    WZBoxDef\Inside,volNPC2,NPC2_pos1,NPC2_pos2;
    WZDOSet\Stat,NPC_zone2\Inside,volNPC2,DO_NPCZone2,1;


    Where


    VAR shapedata volNPC1;
    VAR wzstationary NPC_zone1:=[0];
    PERS pos NPC1_pos1:=[-1200,850,150];
    PERS pos NPC1_pos2:=[-840,1500,655];


    VAR shapedata volNPC2;
    VAR wzstationary NPC_zone2:=[0];
    PERS pos NPC2_pos1:=[-280,1346,150];
    PERS pos NPC2_pos2:=[-70,1820,655];


    After all modifications applied I did warm start on the controller.


    Now, I am testing outputs when robot is inside the cube and nothing comes out.


    Below is the actual robot position:
    X: -206.3mm
    Y: 1401.3mm
    Z: 437.5mm


    According to geometry they are inside the specified volNPC2 cube. But output is not ON.


    Any suggestions?
    Thanks

    Edited once, last by boldive ().

Advertising from our partners