Issue with WZDOSet

Hello everybody,

I have a problem with the execution of the WZDOSet instruction here under.

The routine is an event routine linked with POWERON

So the WZDOSet is define at the start of the controller.

At the beginning of my program I checked the position of the doSafeZoneHome status, to be sure that the robot is in a safe pHome positon.

The problem is that at the tart of my program, the PLC send me the MotorOn and PPtoMainAndStart commands. After this, even if the robot is @ the pHome position, the Output doSafeZoneHome is still at 0.

If I move the robot manually and put it @ , doSafeZoneHome change to 1.

If I move to Auto, MotorOn and PPtoMainAndStart, the robot doesn't move from pHome and doSafeZoneHome change to 0.

    PERS wzstationary wzstatSafeZoneHome:=[1];

    PROC SafeHome()

        VAR shapedata SphereSafeHome;
        CONST pos pPoseHome:=[pHome.trans.x,pHome.trans.y,pHome.trans.z];
        CONST num nRadius:=50;
        !*************************************
        WZSphDef\Inside,SphereSafeHome,pPoseHome,nRadius;
        WZDOSet\Stat,wzstatSafeZoneHome\Inside,SphereSafeHome,doSafeZoneHome,1;
        !*************************************
    ENDPROC

Any idea ?

Thanks