glib.c

Linux的实时性如何得到改观

#include "GLib.h"

void Bcd_to_Ascii(unsigned char BCD_code,unsigned char *pASCII)
{
	unsigned char i;
	
	i = (BCD_code & 0xF0)>>4;
	pASCII[0] = i + '0';
	
	i = (BCD_code & 0x0F);
	pASCII[1] = i + '0';
}

void Hex_to_Ascii(unsigned char HEX_data,unsigned char *pASCII)
{
	unsigned char i;
	
	i = (HEX_data & 0xF0)>>4;
	if( i > 0x09  ){
		i = i - 0x0A + 'A';
	}else{
		i = i + '0';
	}	
	pASCII[0] = i;
	
	i = HEX_data & 0x0F;
	if( i > 0x09  ){
		i = i - 0x0A + 'A';
	}else{
		i = i + '0';
	}	
	pASCII[1] = i;	

}

void Mem_Cpy(void *Dst,const void *Src,unsigned int len)
{
	unsigned char *d,*s;
	
	d=(unsigned char *)Dst;
	s=(unsigned char *)Src;
	
	while(len--)
	{
		*d++=*s++;
	}
}

void Mem_Set(void *Dst, unsigned char c, unsigned int len)
{
	unsigned char *d;
	
	d=(unsigned char *)Dst;
	
	while(len--) 
	{
		*d++ =c;
	}
}

unsigned short Crc16(unsigned char *Dat, unsigned int Length)
{
	unsigned short Crc;
    int i;
      
    Crc =0;
    for(i=0; i<Length; i++)
    {
    	Crc  = (unsigned char)(Crc >> 8) | (Crc << 8);
        Crc ^= Dat[i];
        Crc ^= (unsigned char)(Crc & 0xff) >> 4;
        Crc ^= (Crc << 8) << 4;
        Crc ^= ((Crc & 0xff) << 4) << 1;
    }
    
    return Crc;
}