comdefine.c

用来pdu编解码

//**************************************************************************
//文件名: comdefine.C
//
//定义公共变量和函数
//**************************************************************************

//**************************************************************************
//函数：Verify
//功能: 计算串的校验和，自溢出
//输入：Data=数据串，Datalen=数据长度

//**************************************************************************
#include "comdefine.h"

unsigned char Verify( unsigned char *Data, int Datalen )
{
	int kk;
	unsigned char check = 0;
	
	for (kk = 0; kk < Datalen; kk++)
	{
		check += Data[kk];			
	}
	return check;	
}
//**************************************************************************
//从source的beginindex开始拷贝degits字节到dest
//输入：source＝源字符串；beginindex=起始位置(从0开始算)
//      dest=目标字符串； degits＝请求字节数
//返回：实际拷贝的字节数
//dest以'\0'结束
//**************************************************************************
int Mycopy(char *source , char *dest , int beginindex ,int degits)
{
	int n ;
	int len ;
	len = strlen(source) ;
	if (degits>=(len-beginindex))
	{
		for(n=beginindex;n<len;n++)
			*(dest++)=source[n];
		*dest='\0';
			
		return (len-beginindex) ;	
		
	}else
	{
		for(n=beginindex;n<(degits+beginindex);n++)
			*(dest++)=source[n];
		*dest='\0';
			
		return degits ;	
		
	}		
}
//***************************************************************************
//寻找字符c在PStr中第Num次出现的位置
//返回:	=-1 不存在
//		>-1 c在PStr中第Num次出现的位置
//**************************************************************************
int FindeCharInStr ( char* PStr , int nSrcLength ,int cNum , char c ) 
{
		int i ,FindeCharInStr = -1 ;
		for(i = 0 ; i<nSrcLength;i++ , PStr++)
		{
			if (*PStr==c)
			{
				cNum-- ;
				if (cNum < 1 )
				{
					FindeCharInStr = i ;
					break ;		
				}
			}	
		}
		return FindeCharInStr ;
}
void delay_s(int i)
{
	int ss ;
	
	if (i<=0)return ;
	for(ss=0;ss<i;ss++)
		delay_ms(8000);
}

void delay_ms(int i)
{
	int kk ,hh ;
	
	if (i<=0)return ;
	for(kk=0;kk<i;kk++)
		for(hh=0;hh<8000;hh++);
}