int main(int argc, char **argv) {
int i, a, adrPos;
int len, number, blockCont, localPPI, plcPPI;
#ifdef UNIX_STYLE
int fd, res;
#endif
#ifdef WIN_STYLE
HANDLE fd;
unsigned long res;
#endif
int blockNumber, rawLen, netLen;
unsigned int maxPBlockLen;
char blockType;
daveInterface * di;
daveConnection * dc;
_daveOSserialType fds;
PDU p,p2;
uc pup[]= { // Load request
0x1A,
0,1,0,0,0,0,0,9,
0x5F,0x30,0x42,0x30,0x30,0x30,0x30,0x34,0x50, // block type code and number
// _ 0 B 0 0 0 0 4 P
// SDB
0x0D,
0x31,0x30,0x30,0x30,0x32,0x30,0x38,0x30,0x30,0x30,0x31,0x31,0x30, // file length and netto length
// 1 0 0 0 2 0 8 0 0 0 1 1 0
0 //extra byte
};
uc pablock[]= { // parameters for parts of a block
0x1B,0
};
uc progBlock[1260]= {
0, 0, 0, 0xFB, // This seems to be a fix prefix for program blocks
};
uc paInsert[]= { // sended after transmission of a complete block,
// I this makes the CPU link the block into a program
0x28,0x00,0x00,0x00,
0x00,0x00,0x00,0xFD,
0x00,0x0A,0x01,0x00,
0x30,0x42,0x30,0x30,0x30,0x30,0x34,0x50, // block type code and number
0x05,'_','I','N','S','E',
};
adrPos=1;
localPPI=0;
plcPPI=2;
if (argc<3) {
usage();
exit(-1);
}
while (argv[adrPos][0]=='-') {
if (strcmp(argv[adrPos],"-d")==0) {
daveSetDebug(daveDebugAll);
} else if (strncmp(argv[adrPos],"--local=",8)==0) {
localPPI=atol(argv[adrPos]+8);
printf("setting local PPI address to:%d\n",localPPI);
} else if (strncmp(argv[adrPos],"--mpi=",6)==0) {
plcPPI=atol(argv[adrPos]+6);
printf("setting PPI address of PLC to:%d\n",plcPPI);
} else if (strncmp(argv[adrPos],"--ppi=",6)==0) {
plcPPI=atol(argv[adrPos]+6);
printf("setting PPI address of PLC to:%d\n",plcPPI);
}
adrPos++;
if (argc<=adrPos+1) {
usage();
exit(-1);
}
}
fds.rfd=setPort(argv[adrPos],"9600",'E');
fds.wfd=fds.rfd;
if (fds.rfd>0) {
di =daveNewInterface(fds,"IF1", localPPI, daveProtoPPI, daveSpeed9k);
daveSetTimeout(di, 30000000);
dc =daveNewConnection(di, plcPPI, 0, 0); // insert your PPI address here
daveConnectPLC(dc);
maxPBlockLen=dc->maxPDUlength-22;
// maxPBlockLen=90;
progBlock[1]=maxPBlockLen;
printf("Trying to read 64 bytes (32 words) from data block 1.\n This V memory of the 200.\n");
wait();
res=daveReadBytes(dc,daveDB,1,0,64,NULL);
if (res==0) {
a=daveGetU16(dc);
printf("VW0: %d\n",a);
a=daveGetU16(dc);
printf("VW2: %d\n...\n",a);
}
printf("About to open: %s\n",argv[adrPos+1]);
#ifdef UNIX_STYLE
fd=open(argv[adrPos+1],O_RDONLY);
read(fd, progBlock+4, maxPBlockLen);
close(fd);
#endif
#ifdef WIN_STYLE
// fd=openFile(argv[adrPos+1],O_RDONLY);
fd = CreateFile(argv[adrPos+1],
GENERIC_READ,
0,
0,
OPEN_EXISTING,
FILE_FLAG_WRITE_THROUGH,
0);
printf("fd is: %d. About to read.\n",fd);
ReadFile(fd, progBlock+4, maxPBlockLen, &res, NULL);
printf("Read result: %d\n",res);
CloseHandle(fd);
#endif
blockNumber=daveGetU16from(progBlock+10);
blockType=progBlock[9];
rawLen=daveGetU16from(progBlock+14);
netLen=daveGetU16from(progBlock+38);
printf("Block number: %d\n",blockNumber);
printf("Block type: %0X\n",blockType);
printf("Size 1: %d\n",rawLen);
printf("Size 2: %d\n",netLen);
printf("1%06d%06d\n",rawLen,netLen);
printf("0%X%05d\n",blockType,blockNumber);
sprintf((char*)pup+10,"0%X%05d",blockType,blockNumber);
sprintf((char*)paInsert+12,"0%X%05d",blockType,blockNumber);
pup[17]='P';
paInsert[19]='P';
sprintf((char*)pup+19,"1%06d%06d",rawLen,netLen);
if (daveGetDebug() & daveDebugPDU) {
_daveDump("pup:",pup,sizeof(pup)-1);
}
p.header=dc->msgOut+dc->PDUstartO;
_daveInitPDUheader(&p, 1);
_daveAddParam(&p, pup, sizeof(pup)-1);
res=_daveExchange(dc, &p);
// res=
_daveSetupReceivedPDU(dc, &p2);
printf("res1: %04X\n",res);
if (res==daveResOK) {
res=_daveSetupReceivedPDU(dc, &p2);
if (daveGetDebug() & daveDebugPDU) {
_daveDumpPDU(&p2);
}
res=daveGetPDUerror(&p2);
printf("load request:%04X\n",res);
_daveSendRequestData(dc, 1);
#ifdef UNIX_STYLE
fd=open(argv[adrPos+1],O_RDONLY);
#endif
#ifdef WIN_STYLE
fd = CreateFile(argv[adrPos+1],
GENERIC_READ,
0,
0,
OPEN_EXISTING,
FILE_FLAG_WRITE_THROUGH,
0);
printf("fd is: %d\n",fd);
#endif
// res=_daveGetResponsePPI(dc);
// res=_daveSetupReceivedPDU(dc, &p2);
blockCont=1;
do {
res=_daveGetResponsePPI(dc);
if (res==0) {
res=_daveSetupReceivedPDU(dc, &p2);
if (daveGetDebug() & daveDebugPDU) {
_daveDumpPDU(&p2);
}
number=((PDUHeader*)p2.header)->number;
if (p2.param[0]==0x1B) {
if (daveGetDebug() & daveDebugPDU) {
printf("Beginning block transmission\n");
}
#ifdef UNIX_STYLE
res=read(fd, progBlock+4, maxPBlockLen);
#endif
#ifdef WIN_STYLE
ReadFile(fd, progBlock+4, maxPBlockLen, &res, NULL);
printf("Read result: %d\n",res);
#endif
p.header=dc->msgOut+dc->PDUstartO;
_daveInitPDUheader(&p, 3);
if ((unsigned int)res==maxPBlockLen) pablock[1]=1; //more blocks
else {
pablock[1]=0; //last block
blockCont=0;
}
progBlock[1]=res;
_daveAddParam(&p, pablock, sizeof(pablock));
_daveAddData(&p, progBlock, res+4 /*sizeof(progBlock)*/);
if (daveGetDebug() & daveDebugPDU) {
_daveDumpPDU(&p);
}
((PDUHeader*)p.header)->number=number;
// _daveSendRequestData(dc, 1);
// _daveExchange(dc,&p);
dc->msgOut[0]=dc->MPIAdr; //address ?
dc->msgOut[1]=dc->iface->localMPI;
// dc->msgOut[2]=108;
dc->msgOut[2]=0x5C;
len=3+p.hlen+p.plen+p.dlen; // The 3 fix bytes + all parts of PDU
_daveSendLength(dc->iface, len);
_daveSendIt(dc->iface, dc->msgOut, len);
printf("Block sended\n");
res=0;
// i = _daveReadChars(dc->iface, dc->msgIn+res, 2000000, daveMaxRawLen);
i = _daveReadChars2(dc->iface, dc->msgIn+res, daveMaxRawLen);
if ((daveGetDebug() & daveDebugByte)!=0) {
LOG3("i:%d res:%d\n",i,res);
}
_daveSendRequestData(dc, 1);
printf("Your turn sended\n");
}
}
} while (blockCont);
#ifdef UNIX_STYLE
close(fd);
#endif
#ifdef WIN_STYLE
CloseHandle(fd);
#endif
res=_daveGetResponsePPI(dc);
if (res==0) {
res=_daveSetupReceivedPDU(dc, &p2);
if (daveGetDebug() & daveDebugPDU) {
_daveDumpPDU(&p2);
}
number=((PDUHeader*)p2.header)->number;
if (p2.param[0]==0x1C) {
printf("Got end of block transmission\n");
p.header=dc->msgOut+dc->PDUstartO;
printf("1\n");
_daveInitPDUheader(&p, 3);
printf("2\n");
_daveAddParam(&p, p2.param,1);
printf("3\n");
if (daveGetDebug() & daveDebugPDU) {
_daveDumpPDU(&p);
}
printf("4\n");
((PDUHeader*)p.header)->number=number;
printf("5\n");
dc->msgOut[0]=dc->MPIAdr; //address ?
printf("6\n");
dc->msgOut[1]=dc->iface->localMPI;
dc->msgOut[2]=0x5C;
len=3+p.hlen+p.plen+p.dlen; // The 3 fix bytes + all parts of PDU
_daveSendLength(dc->iface, len);
_daveSendIt(dc->iface, dc->msgOut, len);
printf("ACK for end sended\n");
res=0;
// i = _daveReadChars(dc->iface, dc->msgIn+res, 2000000, daveMaxRawLen);
i = _daveReadChars2(dc->iface, dc->msgIn+res, daveMaxRawLen);
if ((daveGetDebug() & daveDebugByte)!=0) {
LOG3("i:%d res:%d\n",i,res);
}
p.header=dc->msgOut+dc->PDUstartO;
_daveInitPDUheader(&p, 1);
_daveAddParam(&p, paInsert, sizeof(paInsert));
res=_daveExchange(dc, &p);
res=_daveSetupReceivedPDU(dc, &p2);
res=daveGetPDUerror(&p2);
printf("block insert:%04X\n",res);
}
}
}
} else
printf("Couldn't open serial port %s\n",argv[adrPos]);
return 0;
}
int main(int argc, char **argv) {
int i, adrPos,
initSuccess,
useProto, speed, localMPI, plcMPI;
int number, blockCont;
#ifdef UNIX_STYLE
int fd, res;
#endif
#ifdef WIN_STYLE
HANDLE fd;
unsigned long res;
#endif
int blockNumber,rawLen,netLen;
char blockType;
daveInterface * di;
daveConnection * dc;
_daveOSserialType fds;
PDU p,p2;
uc pup[]= { // Load request
0x1A,
0,1,0,0,0,0,0,9,
0x5F,0x30,0x42,0x30,0x30,0x30,0x30,0x34,0x50, // block type code and number
// _ 0 B 0 0 0 0 4 P
// SDB
0x0D,
0x31,0x30,0x30,0x30,0x32,0x30,0x38,0x30,0x30,0x30,0x31,0x31,0x30, // file length and netto length
// 1 0 0 0 2 0 8 0 0 0 1 1 0
0 //extra byte
};
uc pablock[]= { // parameters for parts of a block
0x1B,0
};
uc progBlock[1260]= {
0,maxPBlockLen,0,0xFB, // This seems to be a fix prefix for program blocks
};
uc paInsert[]= { // sended after transmission of a complete block,
// I this makes the CPU link the block into a program
0x28,0x00,0x00,0x00,
0x00,0x00,0x00,0xFD,
0x00,0x0A,0x01,0x00,
0x30,0x42,0x30,0x30,0x30,0x30,0x34,0x50, // block type code and number
0x05,'_','I','N','S','E',
};
adrPos=1;
daveDebug=daveDebugPrintErrors;
useProto=daveProtoMPI_IBH;
speed=daveSpeed187k;
localMPI=0;
plcMPI=2;
if (argc<3) {
usage();
exit(-1);
}
while (argv[adrPos][0]=='-') {
if (strcmp(argv[adrPos],"-d")==0) {
daveDebug=daveDebugAll;
} else if (strncmp(argv[adrPos],"--local=",8)==0) {
localMPI=atol(argv[adrPos]+8);
printf("setting local MPI address to:%d\n",localMPI);
} else if (strncmp(argv[adrPos],"--mpi=",6)==0) {
plcMPI=atol(argv[adrPos]+6);
printf("setting MPI address of PLC to:%d\n",plcMPI);
} else if (strcmp(argv[adrPos],"-2")==0) {
useProto=daveProtoMPI2;
} else if (strcmp(argv[adrPos],"-9")==0) {
speed=daveSpeed9k;
} else if (strcmp(argv[adrPos],"-19")==0) {
speed=daveSpeed19k;
} else if (strcmp(argv[adrPos],"-45")==0) {
speed=daveSpeed45k;
} else if (strcmp(argv[adrPos],"-93")==0) {
speed=daveSpeed93k;
} else if (strcmp(argv[adrPos],"-500")==0) {
speed=daveSpeed500k;
} else if (strcmp(argv[adrPos],"-1500")==0) {
speed=daveSpeed1500k;
}
adrPos++;
if (argc<=adrPos+1) {
usage();
exit(-1);
}
}
initSuccess=0;
// fds.rfd=setPort(argv[adrPos],"38400",'O');
fds.rfd=openSocket(1099, argv[adrPos]);
fds.wfd=fds.rfd;
if (fds.rfd>0) {
di =daveNewInterface(fds,"IF1", localMPI, useProto, speed);
for(i=0;i<=3;i++){
if(0==daveInitAdapter(di)) {
initSuccess=1;
break;
} else daveDisconnectAdapter(di);
}
if (!initSuccess) {
printf("Couldn't connect to Adapter!.\n Please try again. You may also try the option -2 for some adapters.\n");
return -3;
}
initSuccess=0;
dc =daveNewConnection(di,plcMPI,0,0); // insert your MPI address here
for(i=0;i<=3;i++){
if (0==daveConnectPLC(dc)) {
initSuccess=1;
break;
} else daveDisconnectPLC(dc);
}
if (initSuccess) {
printf("About to open: %s\n",argv[adrPos+1]);
#ifdef UNIX_STYLE
fd=open(argv[adrPos+1],O_RDONLY);
read(fd, progBlock+4, maxPBlockLen);
close(fd);
#endif
#ifdef WIN_STYLE
// fd=openFile(argv[adrPos+1],O_RDONLY);
fd = CreateFile(argv[adrPos+1],
GENERIC_READ,
0,
0,
OPEN_EXISTING,
FILE_FLAG_WRITE_THROUGH,
0);
printf("fd is: %d. About to read.\n",fd);
ReadFile(fd, progBlock+4, maxPBlockLen, &res, NULL);
printf("Read result: %d\n",res);
CloseHandle(fd);
#endif
blockNumber=daveGetU16from(progBlock+10);
blockType=progBlock[9];
rawLen=daveGetU16from(progBlock+14);
netLen=daveGetU16from(progBlock+38);
// if (daveDebug & daveDebugPDU) {
printf("Block number: %d\n",blockNumber);
printf("Block type: %0X\n",blockType);
printf("Size 1: %d\n",rawLen);
printf("Size 2: %d\n",netLen);
printf("1%06d%06d\n",rawLen,netLen);
printf("0%X%05d\n",blockType,blockNumber);
// }
sprintf(pup+10,"0%X%05d",blockType,blockNumber);
sprintf(paInsert+12,"0%X%05d",blockType,blockNumber);
pup[17]='P';
paInsert[19]='P';
sprintf(pup+19,"1%06d%06d",rawLen,netLen);
if (daveDebug & daveDebugPDU) {
_daveDump("pup:",pup,sizeof(pup)-1);
}
p.header=dc->msgOut+dc->PDUstartO;
_daveInitPDUheader(&p, 1);
_daveAddParam(&p, pup, sizeof(pup)-1);
if (daveDebug & daveDebugPDU) {
_daveDumpPDU(&p);
}
res=_daveExchange(dc, &p);
if (res==daveResOK) {
res=_daveSetupReceivedPDU(dc, &p2);
if (daveDebug & daveDebugPDU) {
_daveDumpPDU(&p2);
}
res=daveGetPDUerror(&p2);
printf("load request:%04X\n",res);
if (res==0) {
#ifdef UNIX_STYLE
fd=open(argv[adrPos+1],O_RDONLY);
#endif
#ifdef WIN_STYLE
fd = CreateFile(argv[adrPos+1],
GENERIC_READ,
0,
0,
OPEN_EXISTING,
FILE_FLAG_WRITE_THROUGH,
0);
printf("fd is: %d\n",fd);
#endif
blockCont=1;
res=daveGetResponse(dc);
res=_daveSetupReceivedPDU(dc, &p2);
do {
res=_daveSetupReceivedPDU(dc, &p2);
if (daveDebug & daveDebugPDU) {
_daveDumpPDU(&p2);
}
number=((PDUHeader*)p2.header)->number;
if (p2.param[0]==0x1B) {
if (daveDebug & daveDebugPDU) {
printf("Beginning block transmission\n");
}
#ifdef UNIX_STYLE
res=read(fd, progBlock+4, maxPBlockLen);
#endif
#ifdef WIN_STYLE
ReadFile(fd, progBlock+4, maxPBlockLen, &res, NULL);
printf("Read result: %d\n",res);
#endif
// p.header=dc->msgOut+dc->PDUstartO+2;
p.header=dc->msgOut+dc->PDUstartO;
_daveInitPDUheader(&p, 3);
if (res==maxPBlockLen) pablock[1]=1; //more blocks
else {
pablock[1]=0; //last block
blockCont=0;
}
progBlock[1]=res;
_daveAddParam(&p, pablock, sizeof(pablock));
_daveAddData(&p, progBlock, res+4 /*sizeof(progBlock)*/);
if (daveDebug & daveDebugPDU) {
_daveDumpPDU(&p);
}
((PDUHeader*)p.header)->number=number;
_daveExchange(dc,&p);
// daveSendMessage(dc,&p);
// daveGetResponse(dc);
// if (daveDebug & daveDebugPDU) {
printf("Block sent.\n");
// }
}
} while (blockCont);
#ifdef UNIX_STYLE
close(fd);
#endif
#ifdef WIN_STYLE
CloseHandle(fd);
#endif
res=_daveSetupReceivedPDU(dc, &p2);
if (daveDebug & daveDebugPDU) {
_daveDumpPDU(&p2);
}
number=((PDUHeader*)p2.header)->number;
if (p2.param[0]==0x1C) {
printf("Got end of block transmission\n");
p.header=dc->msgOut+dc->PDUstartO;
// printf("1\n");
_daveInitPDUheader(&p, 3);
// printf("2\n");
_daveAddParam(&p, p2.param,1);
// printf("3\n");
if (daveDebug & daveDebugPDU) {
_daveDumpPDU(&p);
}
// printf("4\n");
((PDUHeader*)p.header)->number=number;
_daveExchange(dc,&p);
// daveSendMessage(dc,&p);
printf("Answer to block end sended.\n");
p.header=dc->msgOut+dc->PDUstartO;
_daveInitPDUheader(&p, 1);
_daveAddParam(&p, paInsert, sizeof(paInsert));
res=_daveExchange(dc, &p);
res=_daveSetupReceivedPDU(dc, &p2);
res=daveGetPDUerror(&p2);
printf("block insert:%04X\n",res);
}
} else {
printf("CPU doesn't accept load request:%04X\n",res);
}
}
/*
Just to test whether connection to PLC is still ok:
*/
/*
printf("Trying to read 64 bytes (32 words) from flags.\n");
wait();
res=daveReadBytes(dc,daveFlags,0,0,64,NULL);
if (res==0) {
a=daveGetWORD(dc);
printf("FW0: %d\n",a);
a=daveGetWORD(dc);
printf("FW2: %d\n...\n",a);
}
*/
daveDisconnectPLC(dc);
} else {
printf("Couldn't connect to PLC\n");
}
daveDisconnectAdapter(di);
} else
printf("Couldn't open serial port %s\n",argv[adrPos]);
return 0;
