abplc5_nameconv5.c

在LINUX环境下

#include "libabplc5.h"
#include <sys/types.h>
#include <sys/socket.h>
#include <stdio.h>
#include <sys/un.h>
#include <unistd.h>
#include <ctype.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <time.h>
#include <stdlib.h>
#include <string.h>
#include <netdb.h>

int x,l,junk,try;

//char dataaddr[32];

struct namedata nameconv5(char *dataaddr, int plctype, int debug)
{
	struct namedata name;
	int start,type,bitdata;
	byte tempname[3];

	bzero (&name, sizeof(name)); 
	bitdata=-1;
	name.mask=0; 
	name.module=-1; 
	name.area=-1; 
	name.subarea=-1; 
	name.section=-1; 
	name.bit=-1;
	name.file=-1; 
	name.element=-1;
	name.subelement=-1; 
	name.floatdata=FALSE;
	bzero (&tempname, sizeof(tempname));

	switch (plctype)
	{
	case PLC5:
		if (debug==TRUE)
			printf ("Encoding %s for PLC5.\n",dataaddr);
		start=1;
		type = -1;
		tempname[0]=dataaddr[0];
		if (isalpha(dataaddr[1]))
			{
			if (debug==TRUE)
				printf ("Saw second character as alpha.\n");
			start=2;
			tempname[1]=dataaddr[1];
			}
		for (x=0;x<addrtypescount;x++)
			{
			if (debug==TRUE)
				printf ("Comparing %s to %s.  ",tempname,addrtypes[x]);
			try = strncasecmp(tempname,addrtypes[x],start);
			if (debug==TRUE)
				printf ("Results %d\n",try);
			if (try==0)
				{
				type = x;
				if (debug==TRUE)
					printf ("type = %d\n",type);
				x = addrtypescount;
				}
			}
		if (type == -1)
			return name;
		switch (type)
			{
			case 0:		// Output
				name.section = 0;
				name.file = 0;
				name.type = 1;
				name.typelen = 2;
				break;
			case 1:		// Input
				name.section = 0;
				name.file = 1;
				name.type = 1;
				name.typelen = 2;
				break;
			case 2:		// System Registers
				name.section = 0;
				name.file = 2;
				name.type = 4;
				name.typelen = 2;
				break;
			case 3:		// Binary Registers
				name.section = 0;
				name.type = 1;
				name.typelen = 2;
				break;
			case 4:		// Timers
				name.section = 0;
				name.type = 5;
				name.typelen = 2;
				break;
			case 5:		// Counters
				name.section = 0;
				name.type = 6;
				name.typelen = 2;
				break;
			case 6:		// Control Registers
				name.section = 0;
				name.type = 7;
				name.typelen = 2;
				break;
			case 7:		// Integer Registers
				name.section = 0;
				name.type = 4;
				name.typelen = 2;
				break;
			case 8:		// IEEE Floating Point Registers
				name.section = 0;
				name.floatdata = TRUE;
				name.type = 8;
				name.typelen = 4;
				break;
			case 9:		// ASCII Data
				name.section = 0;
				name.type = 3;
				name.typelen = 1;
				break;
			case 10:	// BCD Data
				name.section = 0;
				name.type = 16;
				name.typelen = 2;
				break;
			case 11:	// Block Transfer Data
				name.section = 0;
				name.type = 7;
				name.typelen = 2;
				break;
			case 12:	// Long Integers
				name.section = 0;
				name.type = 4;
				name.typelen = 4;
				break;
			case 13:	// Message Control
				name.section = 0;
				name.type = 7;
				name.typelen = 2;
				break;
			case 14:	// PID Control
				name.section = 0;
				name.type = 7;
				name.typelen = 2;
				break;
			case 15:	// SC - ??
				name.section = 0;
				name.type = 4;
				name.typelen = 4;
				break;
			case 16:	// String data
				name.section = 0;
				name.type = 3;
				name.typelen = 1;
				break;
			case 17:	// PLC Program name
				name.section = 1;
				name.type = 3;
				name.typelen = 1;
				break;
			case 18:	// Rung data
				name.section = 1;
				name.type = 0x0d;
				break;
			case 19:	// Force table Outputs
				name.section = 2;
				name.file=0;
				name.type = 1;
				name.typelen = 2;
				break;
			case 20:	// Force Table Inputs
				name.section = 2;
				name.file=1;
				name.type = 1;
				name.typelen = 2;
				break;
			case 21:	// Section 3 data
				name.section = 3;
				name.type = 4;
				name.typelen = 2;
				break;
			case 22:	// Section 4 data
				name.section = 4;
				name.type = 4;
				name.typelen = 2;
				break;
			case 23:	// Section 5 data
				name.section = 5;
				name.type = 4;
				name.typelen = 2;
				break;
			case 24:	// Section 6 data
				name.section = 6;
				name.type = 4;
				name.typelen = 2;
				break;
			case 25:	// Force table as a whole
				name.section = 2;
				name.type = 1;
				name.typelen = 1;
				break;
			}
			
		if (debug==TRUE)
			printf ("Data Section = %d, type = %d\n",name.section, name.type);
			
		if (isdigit(dataaddr[start]))
			{
			name.file = atoi(&dataaddr[start]);
			if (debug==TRUE)
				printf ("File is %d\n",name.file);
			}			
		if (debug == TRUE)
			{
			printf ("Start = %d, strlen = %d\n",start,strlen(dataaddr));
			}
						
		for (x=start;x<strlen(dataaddr);x++)
			{
			if (debug== TRUE)
				printf ("x = %d\n",x);
			switch (dataaddr[x])
				{
				case ':':
				case ';':
					x++;
					if (isdigit(dataaddr[x]))
						name.element = atoi(&dataaddr[x]);
						
					break;
				case '.':
				case '/':
					x++;
					if (isdigit(dataaddr[x]))
						{
						if (name.element == -1)
							name.element = 0;
						bitdata = atoi(&dataaddr[x]);
						name.bit = bitdata % 16;
						name.element += (bitdata/16);
						}
		
					if ((debug == TRUE) && ( bitdata == -1))
						printf ("SubElement Found.\n");
					if (bitdata == -1)
						{
						name.subelement=0;
						l=strlen(dataaddr) - x;
						if (strncasecmp (&dataaddr[x],"acc",l) == 0 )
							name.subelement = 2;
						if (strncasecmp (&dataaddr[x],"pre",l) == 0 )
							name.subelement = 1;
						if (strncasecmp (&dataaddr[x],"len",l) == 0 )
							name.subelement = 1;
						if (strncasecmp (&dataaddr[x],"pos",l) == 0 )
							name.subelement = 2;
						if (strncasecmp (&dataaddr[x],"en",l) == 0 )
							name.bit = 13;
						if (strncasecmp (&dataaddr[x],"tt",l) == 0 )
							name.bit = 14;
						if (strncasecmp (&dataaddr[x],"dn",l) == 0 )
							name.bit = 15;
						x = strlen(dataaddr)-1;
						}
					}
			}
	
			if (debug==TRUE)
				{
				printf ("Element is now %d\n",name.element);
				printf ("Element changed to %d\n",name.element);
				printf ("Bit is %d\n",name.bit);
				printf ("Extracted bit data was %d\n",bitdata);
				}

		name.len = 1;
		if (name.section != -1)
			{
			name.data[name.len++] = name.section;
			name.data[0] = name.data[0] | 1;
			}
		if (name.file != -1)
			{
			name.data[0] = name.data[0] | 2;
			if (name.file >= 255)
				{
				name.data[name.len++] = 0xff;
				name.data[name.len++] = (name.file & 255);
				name.data[name.len++] = (name.file / 256);
				}
			if (name.file < 255)
				{
				name.data[name.len++] = name.file;
				}
			}
		if (name.element != -1)
			{
			name.data[0] = name.data[0] | 4;
			if (name.element >= 255)
				{
				name.data[name.len++] = 0xff;
				name.data[name.len++] = (name.element & 255);
				name.data[name.len++] = (name.element / 256);
				}
			if (name.element < 255)
				{
				name.data[name.len++] = name.element;
				}
			}
		if (name.subelement != -1)
			{
			name.data[0] = name.data[0] | 8;
			name.data[name.len++] = name.subelement;
			}
		return name;

// -------------------------------PLC5/250 Decoding----------------------
	
	case PLC5250:
		start=0;
		if (isdigit(dataaddr[0]))
			{
			name.module = atoi(&dataaddr[0]);
			if (name.module > 0)
				name.module = name.module + 30;
			start=1;
			name.area = 2; // identifies data section
			name.subarea = 0;
			}
			
		for (x=start;x<strlen(dataaddr);x++)
			{
			junk = toupper(dataaddr[x]);
			switch (junk)
				{
				case 'O':
					name.module = 1;
					name.type = 4;
					name.area = 0;
					break;
				case 'I':
					name.module = 1;
					name.area = 1;
					name.type = 4;
					break;
				case 'B':
					name.section=0;
					name.type = 1;
					x++;
					name.file = atoi(&dataaddr[x]);
					break;
				case 'N':
					name.section=1;
					name.type = 4;
					x++;
					name.file = atoi(&dataaddr[x]);
					break;
				case 'F':
					name.section=4;
					name.type = 8;
					x++;
					name.floatdata=TRUE;
					name.file = atoi(&dataaddr[x]);
					break;
				case 'T':
					name.section=5;
					name.type = 5;
					x++;
					name.file = atoi(&dataaddr[x]);
					break;
				case 'C':
					name.section=6;
					name.type = 6;
					x++;
					name.file = atoi(&dataaddr[x]);
					break;
				case 'R':
					name.section=7;
					name.type = 7;
					x++;
					name.file = atoi(&dataaddr[x]);
					break;
				case ':':
				case ';':
					if (name.module == 1)
						name.subarea = atoi(&dataaddr[++x]);
					if (name.module != 1)
						name.element = atoi(&dataaddr[++x]);
					break;
				case '.':
				case '/':
					x++;
					l=strlen(dataaddr) - x;
					if (strncasecmp (&dataaddr[x],"en",l) == 0 )
						name.subelement=0;
					if (strncasecmp (&dataaddr[x],"tt",l) == 0)
						name.subelement=1;
					if (strncasecmp (&dataaddr[x],"dn",l) == 0)
						name.subelement=2;
					if (strncasecmp (&dataaddr[x],"pre",l) == 0)
						{
						if (name.section == 5)
							name.subelement=3;
						if (name.section == 6)
							name.subelement=5;
						}
					if (strncasecmp (&dataaddr[x],"acc",l) == 0)
						{
						if (name.section == 5)
							name.subelement=4;
						if (name.section == 6)
							name.subelement=6;
						}
					if (strncasecmp (&dataaddr[x],"cu",l) == 0)
						name.subelement=0;
					if (strncasecmp (&dataaddr[x],"cd",l) == 0)
						name.subelement=1;
					if (strncasecmp (&dataaddr[x],"dn",l) == 0)
						name.subelement=2;
					if (strncasecmp (&dataaddr[x],"ov",l) == 0)
						name.subelement=3;
					if (strncasecmp (&dataaddr[x],"un",l) == 0)
						name.subelement=4;
					x = strlen(dataaddr) -1;
											
				}
			}
		if (name.subelement != -1)
			name.type = 4;

		if (debug == TRUE)
			{
			printf ("module = %d\n",name.module);
			printf ("area = %d\n",name.area);
			printf ("subarea = %d\n",name.subarea);
			printf ("section = %d\n",name.section);
			printf ("file = %d\n",name.file);
			printf ("element = %d\n",name.element);
			printf ("subelement = %d\n",name.subelement);
			}
			
		name.len = 1;

		if ((name.module != -1) && (name.module != 0))
			{
			if (debug==TRUE)
				printf ("Adding Module\n");
			name.data[name.len++]=name.module;
			name.data[0] = name.data[0] | 1;
			}
		if ((name.area != -1) && (name.area != 0))
			{
			if(debug==TRUE)
				printf ("Adding Area\n");
			name.data[name.len++]=name.area;
			name.data[0] = name.data[0] | 2;
			}
		if ((name.subarea != -1) && (name.subarea != 0))
			{
			if(debug==TRUE)
				printf ("Adding Subarea\n");
			name.data[name.len++]=name.subarea;
			name.data[0] = name.data[0] | 4;
			}
		if ((name.section != -1) && (name.section != 0))
			{
			if(debug==TRUE)
				printf ("Adding Section\n");
			name.data[name.len++]=name.section;
			name.data[0] = name.data[0] | 8;
			}
		if ((name.file != -1) && (name.file != 0))
			{
			if(debug==TRUE)
				printf ("Adding File\n");
			name.data[0] = name.data[0] | 16;
			if (name.file >= 255)
				{
				name.data[name.len++] = 0xff;
				name.data[name.len++] = (name.file & 255);
				name.data[name.len++] = (name.file / 256);
				}
			if (name.file < 255)
				{
				name.data[name.len++] = name.file;
				}
			}

		if (name.element != -1)
			{
			if(debug==TRUE)
				printf ("Adding Element\n");
			name.data[0] = name.data[0] | 32;
			if (name.element >= 255)
				{
				name.data[name.len++] = 0xff;
				name.data[name.len++] = (name.element & 255);
				name.data[name.len++] = (name.element / 256);
				}
			if (name.element < 255)
				{
				name.data[name.len++] = name.element;
				}
			}
			
		if (name.subelement != -1)
			{
			if(debug==TRUE)
				printf ("Adding Subelement\n");
			name.data[0] = name.data[0] | 64;
			name.data[name.len++] = name.subelement;
			}

		if(debug==TRUE)
			{
			printf ("name.len = %d\n",name.len);
			for (x=0;x<name.len;x++)
				printf ("%02X  ",name.data[x]);
			printf ("\n");
			}

		return name;

//------------------------- SLC 5/05 Encoding ----------------------

	case SLC:
		name.file=0;
		name.element=0;
		name.subelement=0;
		name.section=0;
		
		
		for (x=0;x<strlen(dataaddr);x++)
		{
			junk = toupper(dataaddr[x]);
			switch (junk)
			{
				case 'O':
					name.type = 0x8b;
					name.file = 0;
					name.typelen = 2;
					break;
				case 'I':
					name.type = 0x8c;
					name.file = 1;
					name.typelen = 2;
					break;
				case 'S':
					x++;
					name.type = 0x84;
					name.file = atoi(&dataaddr[x]);
					name.typelen = 2;
					break;
				case 'B':
					x++;
					name.type = 0x85;
					name.file = atoi(&dataaddr[x]);
					name.typelen = 2;
					break;
				case 'T':
					x++;
					name.type = 0x86;
					name.file = atoi(&dataaddr[x]);
					name.typelen = 2;
					break;
				case 'C':
					x++;
					name.type = 0x87;
					name.file = atoi(&dataaddr[x]);
					name.typelen = 2;
					break;
				case 'R':
					x++;
					name.type = 0x88;
					name.file = atoi(&dataaddr[x]);
					name.typelen = 2;
					break;
				case 'N':
					x++;
					name.type = 0x89;
					name.file = atoi(&dataaddr[x]);
					name.typelen=2;
					break;
				case 'F':
					x++;
					name.type = 0x8a;
					name.file = atoi(&dataaddr[x]);
					name.floatdata=TRUE;
					name.typelen = 4;
					break;
				case 'A':
					x++;
					name.type = 0x8e;
					name.file = atoi(&dataaddr[x]);
					name.typelen = 1;
					break;
				case 'D':
					x++;
					name.type = 0x8f;
					name.file = atoi(&dataaddr[x]);
					name.typelen = 2;
					break;
				
				case ':':
				case ';':
					name.element = atoi(&dataaddr[++x]);
					break;
				case 'P':   //special case to read program name from PLC.
					name.section  = 1;
					name.file = 7;
					name.element = 0;
					break;
				case '.':
				case '/':
					x++;
					l=strlen(dataaddr) - x;
					if (strncasecmp (&dataaddr[x],"acc",l) == 0 )
						name.subelement = 2;
					if (strncasecmp (&dataaddr[x],"pre",l) == 0 )
						name.subelement = 1;
					if (strncasecmp (&dataaddr[x],"len",l) == 0 )
						name.subelement = 1;
					if (strncasecmp (&dataaddr[x],"pos",l) == 0 )
						name.subelement = 2;
					x = strlen(dataaddr)-1;
			}
		}
	
		name.len = 1;
		if (name.file != -1)
		{
			name.data[0] = name.data[0] | 2;
			name.data[name.len++] = name.file;
		}
		if (name.section != -1)
		{
			name.data[name.len++] = name.section;
			name.data[0] = name.data[0] | 1;
		}
		if (name.element != -1)
		{
			name.data[0] = name.data[0] | 4;
			name.data[name.len++] = name.element;
		}
		if (name.subelement != -1)
		{
			name.data[0] = name.data[0] | 8;
			name.data[name.len++] = name.subelement;
		}
		return name;
		
	}
	return name;
}