probe()
{
 gvarset(8635,forward); //Jog forward
 timer=60000;
 do
  {
     timer--;
     if ((timer&0xff)==0)  {    gvarset(8635,forward);   };
     a=portget(sensor);
     if (a!=0) { timer=0;};
   }while(timer>0);

 gvarset(8634,((1<<24)|(speed/8))); //Jog speed for X
 gvarset(8634,((2<<24)|(speed/8))); //Jog speed for Y
 gvarset(8635,backward); //Jog backward

 timer=60000;
 do
  {
     timer--;
     if ((timer&0xff)==0)  {    gvarset(8635,backward);   };
     a=portget(sensor);
     if (a==0) { timer=0;};
   }while(timer>0);

  gvarset(8635, 0); //Jog Stop
  do{ a=gvarget(6060); }while(a!=0x4d);
}; 


probe_xy()
{
 dir1=forward1;
 dir2=forward2;
 gvarset(8635,dir1|dir2); //Jog forward
 timer=60000; 
 do
  { 
     timer--;
     if ((timer&0xff)==0)   {       gvarset(8635,dir1|dir2);    };
      if (dir1)
      {
       a=portget(sensor1);
       if (a!=0)
        {
          dir1=0;
          gvarset(8635,dir1|dir2); //Jog forward
        };
      };

      if (dir2)
      {
       a=portget(sensor2);
       if (a!=0)   
        {    
          dir2=0;
          gvarset(8635,dir1|dir2); //Jog forward
        };
      };
   }while(dir1|dir2);

dir1=backward1;
dir2=backward2;

 gvarset(8634,((1<<24)|(speed/8))); //Jog speed for X
 gvarset(8634,((2<<24)|(speed/8))); //Jog speed for Y
 gvarset(8635,dir1|dir2); //Jog backward

 timer=60000;
 do
  {
     timer--;
     if ((timer&0xff)==0)   {       gvarset(8635,dir1|dir2);    };
      if (dir1)
      {
       a=portget(sensor1);
       if (a==0)
        {
          dir1=0;
          gvarset(8635,dir1|dir2); //Jog forward
        };
      };

      if (dir2)
      {
       a=portget(sensor2);
       if (a==0)
        {
          dir2=0;
          gvarset(8635,dir1|dir2); //Jog forward
        };
      };
   }while(dir1|dir2);

  gvarset(8635, 0); //Jog Stop
  do{ a=gvarget(6060); }while(a!=0x4d);
};