cnc-club.ru

Код: Выделить всё

#include src/common.const.h
#include src/pins.h

#define command var00
#define parameter var01

tool_new=eparam>>16;	//L-parameter

timer=0;

if (tool_new==0)
{
message=PLCCMD_REPLY_TO_MYCNC;
command=PLC_MESSAGE_USER;
parameter=703;
texit=timer+20; do{ timer++;}while(timer<texit); //pause to push the message

message=PLCCMD_MOTION_BREAK;
exit(99);
};

if (tool_new>8)
{
message=PLCCMD_REPLY_TO_MYCNC;
command=PLC_MESSAGE_USER;
parameter=703;
texit=timer+20; do{ timer++;}while(timer<texit); //pause to push the message

message=PLCCMD_MOTION_BREAK;
exit(99);
};



tool_read=0;

//35, 37, 36
if (portget(35)==0) {   tool_read+=1; };
if (portget(37)==0) {   tool_read+=2; };
if (portget(36)==0) {   tool_read+=4; };

if (portget(53)==0) {   tool_read+=8; };

if (tool_new==tool_read)
{
    exit(99);
};

delta=tool_new-tool_read;
if (delta>4) 
{
    delta-=8;
};

km4=0-4;
if (delta<km4)
{
    delta+=8;
};


//message=PLCCMD_MOTION_CONTINUE;
texit=timer+2; do{ timer++;}while(timer<texit); //pause to push the message


if (delta>0)
{
    portset(13);
    portclr(12);
};

if (delta<0)
{
    portset(12);
    portclr(13);
};


texit=timer+4000;
ready__=0;

do{
timer++;

tool_read=0;
//35, 37, 36, 53
if (portget(35)==0) {     tool_read+=1; };
if (portget(37)==0) {     tool_read+=2; };
if (portget(36)==0) {     tool_read+=4; };
if (portget(53)==0) {     tool_read+=8; };

if (portget(50)!=0)
{
if (tool_read==tool_new)
{
    timer=texit;
    ready__=1;
};
};

}while(timer<texit);



portclr(12);
portclr(13);

if (ready__==0)
{
//Error!!!!
message=PLCCMD_REPLY_TO_MYCNC;
command=PLC_MESSAGE_USER;
parameter=702;
texit=timer+20; do{ timer++;}while(timer<texit); //pause to push the message

message=PLCCMD_MOTION_BREAK;
exit(99);
};



texit=timer+10;
do{timer++;}while(timer<texit);

tool_read=0;
parity=0;
//35, 37, 36, 53
if (portget(35)==0) {     tool_read+=1;     parity=parity^1; };
if (portget(37)==0) {     tool_read+=2;     parity=parity^1; };
if (portget(36)==0) {     tool_read+=4;     parity=parity^1; };
if (portget(53)==0) {     tool_read+=8;     parity=parity^1; };

a=(portget(54)==0);

if (a!=parity)
{

    message=PLCCMD_REPLY_TO_MYCNC;
    command=PLC_MESSAGE_USER;
    parameter=704;
    texit=timer+20; do{ timer++;}while(timer<texit); //pause to push the message

    message=PLCCMD_MOTION_BREAK;
    exit(99);
};


if (portget(50)!=0)
{
if (tool_read==tool_new)
{
    exit(99);
};
};

//Error2
message=PLCCMD_REPLY_TO_MYCNC;
command=PLC_MESSAGE_USER;
parameter=701;
texit=timer+20; do{ timer++;}while(timer<texit); //pause to push the message

message=PLCCMD_MOTION_BREAK;
exit(99);