📄 softplc.cpp
字号:
#include "stdio.h"
#include "string.h"
#include "ctype.h"
#include "stdlib.h"
#include "malloc.h"
#include "system.h"
#define OPEN 0
#define STOP 0
#define START 1
#define CLOSE 1
#define AddSpaceError 0x0001
#define SignalError 0x0002
#define AddrError 0x0003
#define InstructionError 0x0004
#define GetInfoErr 0x0005
#define PushError 0x0006
#define PopError 0x0007
#define iInstructionError 0x0008
char *DeleteLeftSpace(char *Chg_Str);
char *DeleteRightSpace(char *Chg_Str);
static void Push(void);
static void Pop(void);
static void RunALine(bool Fl_Pop);
static void ReportErr(int ErrCode);
static void ExcuteLD(void);
static char *strrev(char *str);
static int LetterCnt(const char *str,int letter);
static char *DeleteDoubleSpace(char *Chg_Str);
static void GetInfo(char *str);
static void SeparateALine(char *sOriginLine) ;
static void SeparateSeg(char *Str);
static void ExcuteLD(void);
static void ExcuteLDN(void);
static void ExcuteAND(bool Fl_Pop);
static void ExcuteANDN(bool Fl_Pop);
static void ExcuteOR(bool Fl_Pop);
static void ExcuteORN(bool Fl_Pop);
static void ExcuteXOR(bool Fl_Pop);
static void ExcuteXORN(bool Fl_Pop);
static void ExcuteST(void);
static void ExcuteSTN(void);
static void ExcuteS(void);
static void ExcuteR(void);
extern void ImageOut(void);
char Signal,DataWidth;
int iSignal=0,iInstruction=0,iFirstAddr=0,iSecondAddr=0,iThirdAddr=0;
int iTop=0,iLine=0,iColumn=0;
short int Stack[2][10]={{0,0,0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0,0,0}};
int bStack[100],bCR=0,Fl_Pop=0,Test[8];
bool In[8]={0,0,0,0,0,0,0,0},Out[8]={0,0,0,0,0,0,0,0},nOut[8]={1,1,1,1,1,1,1,1};
bool Addr[3][10][8]={{{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,1,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0}},
{{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0}},
{{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0},{0,0,0,0,0,0,0,0}}};
/**************
* 函数名：strrev
* 功 能: 翻转字符串，将字符串逆向排列
*
*************/
char *strrev(char *str)
{
char *original =str;
char *forward =str;
char temp;
while (*str)
str++;
while (forward < str)
{
temp=*(--str);
*str=*forward;
*forward++=temp;
}
return (original);
}
/**************
* 函数名：strrevLetterCnt
* 功 能: 计算字符串中字符出现的次数
*
**************/
int LetterCnt(const char *str,int letter)
{
int iLetterCnt=0;
while (*str)
{if (*str==letter)
iLetterCnt++;
str++;}
return iLetterCnt;
}
/**************
* 函数名：DeleteLeftSpace
* 功 能: 删除一行(S)的左空格，例如将" LD %I0.0"转化为"LD %I0.0"
*
**************/
char *DeleteLeftSpace(char *Chg_Str)
{
while (Chg_Str[0]==' ')
strcpy(Chg_Str,Chg_Str+1);
return (Chg_Str);
}
/**************
* 函数名：DeleteDoubleSpace
* 功 能: 删除两个以上的连续空格为一个空格
*
**************/
char *DeleteDoubleSpace(char *Chg_Str)
{ unsigned int iCnt,jChrLen;
for (jChrLen=0;jChrLen<strlen(Chg_Str);jChrLen++)
{ if (Chg_Str[jChrLen]==' ')
{ iCnt=jChrLen+1;
while (Chg_Str[iCnt]==' ')
strcpy(Chg_Str+iCnt,Chg_Str+iCnt+1);
}
}
return (Chg_Str);
}
/**************
* 函数名：DeleteRightSpace
* 功 能: 删除一行(S)的右空格
*
**************/
char *DeleteRightSpace(char *Chg_Str)
{
strrev(Chg_Str);
DeleteLeftSpace(Chg_Str);
strrev(Chg_Str);
return (Chg_Str);
}
/**************
* 函数名：GetInfo
* 功 能: 分解一个单元，得到{I,Q,M},{Addr},{Instruction}
*
**************/
void GetInfo(char *str)
{ int AddrCnt;
if (str[0]=='%')
{
strcpy(str,str+1); //右移一位
Signal= str[0];
switch (Signal)
{
case 'I': iSignal=0;break;
case 'Q': iSignal=1;break;
case 'M': iSignal=2;break;
default:ReportErr(SignalError);
}
/*************** 判断数据位宽度DataWidth
*************** 无--用0表示
***************/
strcpy(str,str+1); //右移一位
if (isdigit(str[0]))
DataWidth='0';
else
DataWidth= str[0];
strcpy(str,str+1);
/*************** 判断有几个"."
**************** 得出FirstAddr,SecondAddr
***************/
AddrCnt=1+LetterCnt(str,'.');
switch (AddrCnt)
{
case 1: iFirstAddr=atoi(str);break;
case 2: iFirstAddr=atoi(strtok(str,"."));iSecondAddr=atoi(strtok( NULL ,"."));break;
// case 3: FirstAddr=strtok(S,".");SecondAddr=strtok( NULL ,".");ThirdAddr=strtok( NULL ,".");break;
default: ReportErr(AddrError);
}
}
else if (isalpha(str[0]))
{
if (!strcmp(str,"LD")) iInstruction=0;
else if (!strcmp(str,"LDN")) iInstruction=1;
else if (!strcmp(str,"AND")) iInstruction=2;
else if (!strcmp(str,"ANDN")) iInstruction=3;
else if (!strcmp(str,"OR")) iInstruction=4;
else if (!strcmp(str,"ORN")) iInstruction=5;
else if (!strcmp(str,"XOR")) iInstruction=6;
else if (!strcmp(str,"XORN")) iInstruction=7;
else if (!strcmp(str,"ST")) iInstruction=8;
else if (!strcmp(str,"STN")) iInstruction=9;
else if (!strcmp(str,"S")) iInstruction=10;
else if (!strcmp(str,"R")) iInstruction=11;
else ReportErr(InstructionError);
}
else if (str[0]=='(')
{
Push();
}
else if (str[0]==')')
{
Pop();
}
else ReportErr(GetInfoErr);
}
/**************
* 函数名：SeparateALine
* 功 能: 分割一行，结果为sTemp[]
*
**************/
void SeparateALine(char *sOriginLine)
{
char *sTemp[100],*sCpyOfOrigin;
int i_sTemp=0,iLenOrigin;
sOriginLine=strupr(sOriginLine);//全部改为大写
DeleteLeftSpace(sOriginLine); //处理左空格
DeleteRightSpace(sOriginLine);
DeleteDoubleSpace(sOriginLine);
iLenOrigin=strlen(sOriginLine);
sCpyOfOrigin=(char *)malloc(iLenOrigin+1);
if (LetterCnt(sOriginLine,' ')==0)
{
sTemp[0]=sOriginLine;
strcpy(sCpyOfOrigin,sOriginLine);
GetInfo(sCpyOfOrigin);
}
else
{
do
{
sTemp[i_sTemp]=strtok(sOriginLine," ");//原来字符串取前段
strcpy(sCpyOfOrigin,sTemp[i_sTemp]);
GetInfo(sCpyOfOrigin);
strcpy(sOriginLine,sOriginLine+strlen(sTemp[i_sTemp])+1);//生成新的行
i_sTemp++;
if (LetterCnt(sOriginLine,' ')==0)
{ sTemp[i_sTemp]=strtok(sOriginLine," ");
strcpy(sCpyOfOrigin,sTemp[i_sTemp]);
GetInfo(sCpyOfOrigin);
break;}
}while ((strlen(sOriginLine))!=0);
}if (Fl_Pop==0) RunALine(0);Fl_Pop=0;
free(sCpyOfOrigin);
return;
}
/**************
* 函数名：SeparateSeg
* 功 能: 分割IL.TXT，结果为Line[]
*
**************/
void SeparateSeg(char *Str)
{ char *sLine[100],sTmp[100];
int iCnt,iLineCnt;
iLineCnt=LetterCnt(Str,'\n');
if (iLineCnt==0)
{
SeparateALine(Str);
iCnt=0;
}
else {
sLine[0]=strtok(Str,"\n");
for (iCnt=1;iCnt<iLineCnt;iCnt++)
sLine[iCnt]=strtok(NULL,"\n");
for (iCnt=0;iCnt<iLineCnt;iCnt++)
{
strcpy(sTmp,sLine[iCnt]);
SeparateALine(sTmp);
}
}
return;
}
/**************
* 函数名：Push
* 功 能: 入栈
*
**************/
void Push(void)
{
if (iTop==99) ReportErr(PushError);
Stack[0][iTop] = iInstruction;
Stack[1][iTop] = bCR;
iTop=iTop+1;
}
/**************
* 函数名：Pop
* 功 能: 出栈
*
**************/
void Pop(void)
{
if (iTop<1)
{
ReportErr(PopError);
}
else
{
iTop=iTop-1;
iInstruction = Stack[0][iTop];
Fl_Pop=1;
RunALine(1);
Stack[0][iTop] = 0;
Stack[1][iTop] = 0;
}
}
/**************
* 函数名：ExcuteLD
* 功 能: 执行LD指令
*
**************/
void ExcuteLD(void)
{
bCR=Addr[iSignal][iFirstAddr][iSecondAddr];
}
/**************
* 函数名：ExcuteLDN
* 功 能: 执行LDN指令
*
**************/
void ExcuteLDN(void)
{
bCR=!Addr[iSignal][iFirstAddr][iSecondAddr];
}
/**************
* 函数名：ExcuteAND
* 功 能: 执行AND指令
*
**************/
void ExcuteAND(bool Fl_Pop)
{ if (Fl_Pop==0)
bCR=bCR&&Addr[iSignal][iFirstAddr][iSecondAddr];
else bCR=bCR&&Stack[1][iTop];
}
/**************
* 函数名：ExcuteANDN
* 功 能: 执行ANDN指令
*
**************/
void ExcuteANDN(bool Fl_Pop)
{ if (Fl_Pop==0)
bCR=bCR&&!(Addr[iSignal][iFirstAddr][iSecondAddr]);
else bCR=Stack[1][iTop]&&bCR;
}
/**************
* 函数名：ExcuteOR
* 功 能: 执行OR指令
*
**************/
void ExcuteOR(bool Fl_Pop)
{ if (Fl_Pop==0)
bCR=bCR||Addr[iSignal][iFirstAddr][iSecondAddr];
else bCR=bCR||Stack[1][iTop];
}
/**************
* 函数名：ExcuteORN
* 功 能: 执行ORN指令
*
**************/
void ExcuteORN(bool Fl_Pop)
{ if (Fl_Pop==0)
bCR=bCR||!(Addr[iSignal][iFirstAddr][iSecondAddr]);
else bCR=Stack[1][iTop]||!bCR;
}
/**************
* 函数名：ExcuteORN
* 功 能: 执行ORN指令
*
**************/
void ExcuteXOR(bool Fl_Pop)
{ if (Fl_Pop==0)
bCR=(((!bCR)&&Addr[iSignal][iFirstAddr][iSecondAddr])||(bCR&&(!Addr[iSignal][iFirstAddr][iSecondAddr])));
else bCR=(((!bCR)&&Stack[1][iTop])||(bCR&&(!Stack[1][iTop])));
}
/**************
* 函数名：ExcuteXORN
* 功 能: 执行XORN指令
*
**************/
void ExcuteXORN(bool Fl_Pop)
{ if (Fl_Pop==0)
bCR=((bCR&&Addr[iSignal][iFirstAddr][iSecondAddr])||((!bCR)&&(!Addr[iSignal][iFirstAddr][iSecondAddr])));
else bCR=((bCR&&Stack[1][iTop])||((!bCR)&&(!Stack[1][iTop])));
}
/**************
* 函数名：ExcuteST
* 功 能: 执行ST指令
*
**************/
void ExcuteST(void)
{
Addr[iSignal][iFirstAddr][iSecondAddr]=bCR;
}
/**************
* 函数名：ExcuteSTN
* 功 能: 执行STN指令
*
**************/
void ExcuteSTN(void)
{
Addr[iSignal][iFirstAddr][iSecondAddr]=!bCR;
}
/**************
* 函数名：ExcuteS
* 功 能: 执行S指令
*
**************/
void ExcuteS(void)
{ if (bCR==1)
Addr[iSignal][iFirstAddr][iSecondAddr]=1;
}
/**************
* 函数名：ExcuteR
* 功 能: 执行R指令
*
**************/
void ExcuteR(void)
{ if (bCR==1)
Addr[iSignal][iFirstAddr][iSecondAddr]=0;
}
/**************
* 函数名：RunALine
* 功 能: 执行一行PLC语句
*
**************/
void RunALine(bool Flag_Pop)
{ switch (iInstruction)
{
case 0:ExcuteLD();break;
case 1:ExcuteLDN();break;
case 2:ExcuteAND(Flag_Pop);break;
case 3:ExcuteANDN(Flag_Pop);break;
case 4:ExcuteOR(Flag_Pop);break;
case 5:ExcuteORN(Flag_Pop);break;
case 6:ExcuteXOR(Flag_Pop);break;
case 7:ExcuteXORN(Flag_Pop);break;
case 8:ExcuteST();break;
case 9:ExcuteSTN();break;
case 10:ExcuteS();break;
case 11:ExcuteR();break;
default:ReportErr(iInstructionError);
}
}
/**************
* 函数名：ReportErr
* 功 能: 报错
*
**************/
void ReportErr(int ErrCode)
{
printf("\nERROR CODE = %d\n",ErrCode);
}
/**************
* 函数名：RunIL
* 功 能: 运行PLC（Segment）
*
**************/
int RunIL(char* IL,bool* InPoint,bool* OutPoint)
{ char *Sdup;
int len;
Addr[0][1][0]=*InPoint;
Addr[0][1][1]=*(InPoint+1);
Addr[0][1][2]=*(InPoint+2);
Addr[0][1][3]=*(InPoint+3);
Addr[0][1][4]=*(InPoint+4);
Addr[0][1][5]=*(InPoint+5);
Addr[0][2][0]=*(InPoint+6);
Addr[0][2][1]=*(InPoint+7);
Addr[1][1][0]=*OutPoint;
Addr[1][1][1]=*(OutPoint+1);
Addr[1][1][2]=*(OutPoint+2);
Addr[1][1][3]=*(OutPoint+3);
Addr[1][1][4]=*(OutPoint+4);
Addr[1][1][5]=*(OutPoint+5);
Addr[1][2][0]=*(OutPoint+6);
Addr[1][2][1]=*(OutPoint+7);
len=4096;
Sdup=(char *)malloc(len+1);
strcpy(Sdup,IL);
SeparateSeg(Sdup);
free(Sdup);
*InPoint=Addr[0][1][0];
*(InPoint+1)=Addr[0][1][1];
*(InPoint+2)=Addr[0][1][2];
*(InPoint+3)=Addr[0][1][3];
*(InPoint+4)=Addr[0][1][4];
*(InPoint+5)=Addr[0][1][5];
*(InPoint+6)=Addr[0][2][0];
*(InPoint+7)=Addr[0][2][1];
*OutPoint=Addr[1][1][0];
*(OutPoint+1)=Addr[1][1][1];
*(OutPoint+2)=Addr[1][1][2];
*(OutPoint+3)=Addr[1][1][3];
*(OutPoint+4)=Addr[1][1][4];
*(OutPoint+5)=Addr[1][1][5];
*(OutPoint+6)=Addr[1][2][0];
*(OutPoint+7)=Addr[1][2][1];
return 0;
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -