cnc-club.ru

// поиск НОМЕ по Z
//этап 1 - поиск датчика, до его включения (порт 138)
ch2->LimitSwitchOptions=0x100; // отключение обработки концевого датчика на оси Z, чтобы не блокировалась ось
Jog(2,2500); // перемещение оси Z в положительном направлении на скорости 2500 имп/сек
while (!ReadBit(138)) ; // ожидание срабатывания датчика по Z пин 138 - появление сигнала
Zero(2); // обнуление координаты оси Z
Jog(2,0); // остановка оси Z
//этап 2 - отъезд от датчика, до его отключения (порт 138)
Jog(2,-2500); // перемещение оси Z в отрицательном направлении на скорости 2500 имп/сек
while (ReadBit(138)) ; // ожидание срабатывания датчика по Z пин 138 - пропадание сигнала
Zero(2); // обнуление координаты оси Z
Jog(2,0); // остановка оси Z
Jog(2,-2500); // перемещение оси Z в отрицательном направлении на скорости 2500 имп/сек
//этап 3 -Движение от датчика до включения индексных меток (порт 38)
while (!ReadBit(38)) ; // ожидание срабатывания индексной метки по Z- пин 38 - появление сигнала
Zero(2); // обнуление координаты оси Z
Jog(2,0); // остановка оси Z
//этап 4 - отъезд от датчика на 5мм
MoveAtVel(2,2000,-2500 ); // перемещение оси Z с датчика в позицию 2000 имп (5мм) на скорости 2500имп/сек
while (!CheckDone(2)) ;
ch2->LimitSwitchOptions=0x123;// включение обработки концевого датчика на оси Z

#include "KMotionDef.h"

int SimpleZprobeFunction(int axis, // axis number to Probe
float speed, // speed to move toward probe
float speed_slow, // slow speed to move toward probe
int dir, // direction to move toward probe (+1 or -1)
int probezbit, // limit bit number to watch for probe
int probezlimitpolarity, // limit polarity to wait for (1 or 0)
float Zup1, // move up for slow motion
float Zup2) // move up after all done
{



// probe z- jog until it sees the limit

Jog(axis,dir*speed); // jog slowly
while (ReadBit(probezbit)!=probezlimitpolarity) // loop until Limit bit goes to specified polarity
Jog(axis,0); // stop


while (!CheckDone(axis)) // loop until motion completes

if (!chan[axis].Enable) return 1; // abort/exit if disabled

Move(axis,-dir * Zup1); // move up for Zup1
while (!CheckDone(axis)) // loop until motion completes
if (!chan[axis].Enable) return 1; // abort/exit if disabled


// test if probe still active
if (ReadBit(probezbit)==probezlimitpolarity) // probez bit specified?
{
Move(axis,-dir * Zup1); // move up for some mm
//while (!CheckDone(axis)) // loop until motion completes
//if (!chan[axis].Enable) return 1; // abort/exit if disabled
}


if (ReadBit(probezbit)!=probezlimitpolarity) //
{

Jog(axis,speed_slow*dir); // repeat jog slowly
while (ReadBit(probezbit)!=probezlimitpolarity) // loop until Limit bit goes to specified polarity
Jog(axis,0); // stop
while (!CheckDone(axis)) // loop until motion completes
if (!chan[axis].Enable) return 1; // abort/exit if disabled
Zero(axis); // Zero the position
printf ("Axis Z probe DONE!!!");

if (!chan[axis].Enable) return 1; // abort/exit if disabled

}

Move(axis,-dir * Zup2); // move some amount
while (!CheckDone(axis)) ; // loop until motion completes
if (!chan[axis].Enable) return 1; // abort/exit if disabled

//chan[axis].LimitSwitchOptions = SaveLimits; // restore limit settings
return 0;
}



int DoPC(int cmd);
int DoPCInt(int cmd, int i);
#define GATH_OFF 0 // define the offset into the Gather buffer where strings are passed

main()
{
SimpleZprobeFunction(2, // axis number to home
500, // speed to move toward probe
800, // slow speed to move toward probe
-1, // direction to move toward home (+1 or -1)
139, // limit bit number to watch for probe
0, // limit polarity to wait for (1 or 0)
1200, // move up for slow motion 3mm
6000); // move up after all done 15mm
}