function.c

lpc2136芯片的硬件全部功能示例程序

/*************************************************************
		WPD800 通用函数
		修改历史    2007-10-9  zaken create version 1.0


*************************************************************/

#include "config.h"
#include "target.h"
#include "main.h"
#include "function.h"

//CRC-16 表
const WORD Lookup[256]={
  0x0000,0xC0C1,0xC181,0x0140,0xC301,0x03C0,0x0280,0xC241,
  0xC601,0x06C0,0x0780,0xC741,0x0500,0xC5C1,0xC481,0x0440,
  0xCC01,0x0CC0,0x0D80,0xCD41,0x0F00,0xCFC1,0xCE81,0x0E40,
  0x0A00,0xCAC1,0xCB81,0x0B40,0xC901,0x09C0,0x0880,0xC841,
  0xD801,0x18C0,0x1980,0xD941,0x1B00,0xDBC1,0xDA81,0x1A40,
  0x1E00,0xDEC1,0xDF81,0x1F40,0xDD01,0x1DC0,0x1C80,0xDC41,
  0x1400,0xD4C1,0xD581,0x1540,0xD701,0x17C0,0x1680,0xD641,
  0xD201,0x12C0,0x1380,0xD341,0x1100,0xD1C1,0xD081,0x1040,
  0xF001,0x30C0,0x3180,0xF141,0x3300,0xF3C1,0xF281,0x3240,
  0x3600,0xF6C1,0xF781,0x3740,0xF501,0x35C0,0x3480,0xF441,
  0x3C00,0xFCC1,0xFD81,0x3D40,0xFF01,0x3FC0,0x3E80,0xFE41,
  0xFA01,0x3AC0,0x3B80,0xFB41,0x3900,0xF9C1,0xF881,0x3840,
  0x2800,0xE8C1,0xE981,0x2940,0xEB01,0x2BC0,0x2A80,0xEA41,
  0xEE01,0x2EC0,0x2F80,0xEF41,0x2D00,0xEDC1,0xEC81,0x2C40,
  0xE401,0x24C0,0x2580,0xE541,0x2700,0xE7C1,0xE681,0x2640,
  0x2200,0xE2C1,0xE381,0x2340,0xE101,0x21C0,0x2080,0xE041,
  0xA001,0x60C0,0x6180,0xA141,0x6300,0xA3C1,0xA281,0x6240,
  0x6600,0xA6C1,0xA781,0x6740,0xA501,0x65C0,0x6480,0xA441,
  0x6C00,0xACC1,0xAD81,0x6D40,0xAF01,0x6FC0,0x6E80,0xAE41,
  0xAA01,0x6AC0,0x6B80,0xAB41,0x6900,0xA9C1,0xA881,0x6840,
  0x7800,0xB8C1,0xB981,0x7940,0xBB01,0x7BC0,0x7A80,0xBA41,
  0xBE01,0x7EC0,0x7F80,0xBF41,0x7D00,0xBDC1,0xBC81,0x7C40,
  0xB401,0x74C0,0x7580,0xB541,0x7700,0xB7C1,0xB681,0x7640,
  0x7200,0xB2C1,0xB381,0x7340,0xB101,0x71C0,0x7080,0xB041,
  0x5000,0x90C1,0x9181,0x5140,0x9301,0x53C0,0x5280,0x9241,
  0x9601,0x56C0,0x5780,0x9741,0x5500,0x95C1,0x9481,0x5440,
  0x9C01,0x5CC0,0x5D80,0x9D41,0x5F00,0x9FC1,0x9E81,0x5E40,
  0x5A00,0x9AC1,0x9B81,0x5B40,0x9901,0x59C0,0x5880,0x9841,
  0x8801,0x48C0,0x4980,0x8941,0x4B00,0x8BC1,0x8A81,0x4A40,
  0x4E00,0x8EC1,0x8F81,0x4F40,0x8D01,0x4DC0,0x4C80,0x8C41,
  0x4400,0x84C1,0x8581,0x4540,0x8701,0x47C0,0x4680,0x8641,
  0x8201,0x42C0,0x4380,0x8341,0x4100,0x81C1,0x8081,0x4040
};
//======================================================================

//压缩BCD测试
bool IsBcdb(BYTE b)
{
  if(((b&0xf)<0x0a)&&((b&0xf0)<0xa0))return TRUE;
  return FALSE;
}
//压缩BCD测试
bool IsBcdw(WORD w)
{
  if(((w&0x000f)<0x0a)&&((w&0x00f0)<0xa0) &&((w&0x0f00)<0xa00)&&((w&0xf000)<0xa000))return TRUE;
  return FALSE;
}
//BCD与16进制的转换函数
WORD BcdHex(WORD b)
{
  WORD h;
  h=(b&0xf)+(b&0xf0)/0x10*10;
  h+=(b&0xf00)/0x100*100+(b&0xf000)/0x1000*1000;
  return h;
}

WORD HexBcd(WORD h)
{
  WORD b,t;
  if(h>9999)return 0x9999;
  t=h;
  b=t/1000*0x1000,t%=1000;
  b+=t/100*0x100,t%=100;
  b+=t/10*0x10+t%10;
  return b;
}

//BCD小数与16进制小数的转换函数
WORD FraHex(WORD f)
{
  return (WORD)(((DWORD)BcdHex(f)*0x10000L+5000)/10000);
}

WORD HexFra(WORD h)
{
  return HexBcd((WORD)(((DWORD)h*10000+0x08000L)/0x10000L));
}

//BCD定点数与16进制定点数的转换函数
DWORD FixHex(DWORD f)
{
  WORD t1,t2;
  t1=(WORD)(f>>16),t2=(WORD)f;
  return (((DWORD)BcdHex(t1)<<16)+FraHex(t2));
}

DWORD HexFix(DWORD h)
{
  WORD t1,t2;
  t1=(WORD)(h>>16),t2=(WORD)h;
  return (((DWORD)HexBcd(t1)<<16)+HexFra(t2));
}

//Crc-16 转换函数
void CrcCh(BYTE ch,WORD *crc)
{
  *crc=Lookup[(*crc&0xff)^ch]^(*crc>>8);
}

//Crc 码放在数据区末尾
bool CrcStr(BYTE *p)
{
  WORD crc,cnt;
  cnt=(WORD)*p;
  if(cnt==0)return FALSE;
  *p+=2,p++;
  for(crc=0;cnt>0;cnt--)crc=Lookup[(crc&0xff)^(*p++)]^(crc>>8);
  *p++=(BYTE)crc;
  *p++=(BYTE)(crc>>8);
  return TRUE;
}

//Crc 校验函数
// lSize 不包括两个字节的校验码长度
bool CrcOk( BYTE* pSrc, long lSize )
{
	WORD wTemp;
	WORD crc;

	crc= CrcCalc( pSrc, lSize );

	wTemp=pSrc[lSize];
	wTemp+=((WORD)pSrc[lSize+1])*256;
	return (wTemp == crc);
}

//Crc 码计算函数
//lSize 不包括两个字节的校验码长度
WORD CrcCalc( BYTE* pSrc, long lSize )
{
	WORD crc=0;
	long i;

	for( i=0; i<lSize ; i++ )
	{
	   CrcCh(*pSrc++,&crc);
	}
	return crc;
}

//Crc 码生成函数
//lSize 不包括两个字节的校验码长度
//Crc 码放置在数据区末尾
void CrcMake( BYTE* pSrc, long lSize )
{
	WORD crc;

	crc= CrcCalc( pSrc, lSize );

	pSrc[lSize]= (BYTE)crc;
	pSrc[lSize+1]= (BYTE) ( crc>>8 );
}



//将1个字COPY到缓冲区中,低字节在前,高字节在后
void sprintw(BYTE * sBuf,WORD w)
{
  *sBuf++=(BYTE)w;
  *sBuf++=(BYTE)(w>>8);
}

//将1个双字COPY到缓冲区中,低字节在前,高字节在后
void sprintdw(BYTE * sBuf,DWORD dw)
{
  *sBuf++=(BYTE)dw;
  *sBuf++=(BYTE)(dw>>8);
  *sBuf++=(BYTE)(dw>>16);
  *sBuf++=(BYTE)(dw>>24);
}

//产生一个小延时
void SmallDelay(int delay)
{
  int i,j;
  j=delay;
  if(j>200)j=200;
  for(i=0;i<j;i++);
}