GSM.rar_GSM_Q2403A_WAVECOM gsm_系统状态监测_车载

#include <string.h> #include <stddef.h> #include <locale.h> #include <stdlib.h> #include "pdu.h" /** * 可打印字符串转换为字节数据 * 如："C8329BFD0E01" --> {0xC8, 0x32, 0x9B, 0xFD, 0x0E, 0x01} *@ pSrc - 源字符串指针 *@ nSrcLength - 源字符串长度 *@ pDst - 目标数据指针 *return: 目标数据长度 */ int string2bytes(const char* pSrc, unsigned char* pDst, int nSrcLength) { int i; for (i = 0; i < nSrcLength; i += 2) { /* 输出高4位*/ if ((*pSrc >= '0') && (*pSrc <= '9')) *pDst = (*pSrc - '0') << 4; else *pDst = (*pSrc - 'A' + 10) << 4; pSrc++; /* 输出低4位*/ if ((*pSrc>='0') && (*pSrc<='9')) *pDst |= *pSrc - '0'; else *pDst |= *pSrc - 'A' + 10; pSrc++; pDst++; } // 返回目标数据长度 return (nSrcLength/2); } /** *字节数据转换为可打印字符串 * 如：{0xC8, 0x32, 0x9B, 0xFD, 0x0E, 0x01} --> "C8329BFD0E01" *@ pSrc - 源数据指针 *@nSrcLength - 源数据长度 *@pDst - 目标字符串指针 *return -目标字符串长度 */ int bytes2string(const unsigned char* pSrc, char* pDst, int nSrcLength) { const char tab[]="0123456789ABCDEF"; /* 0x0-0xf的字符查找表*/ int i; for (i = 0; i < nSrcLength; i++) { *pDst++ = tab[*pSrc >> 4]; /* 输出高4位*/ *pDst++ = tab[*pSrc & 0x0f]; /* 输出低4位*/ pSrc++; } /* 输出字符串加个结束符*/ *pDst = '\0'; /* 返回目标字符串长度*/ return (nSrcLength * 2); } /** * 7bit编码 *@ pSrc - 源字符串指针 *@ nSrcLength - 源字符串长度 *@ pDst - 目标编码串指针 *return: 目标编码串长度 */ int encode_7bit(const char* pSrc, unsigned char* pDst, int nSrcLength) { int nSrc; /* 源字符串的计数值*/ int nDst; /* 目标编码串的计数值*/ int nChar; /* 当前正在处理的组内字符字节的序号，范围是0-7*/ unsigned char nLeft; /* 上一字节残余的数据*/ /* 计数值初始化*/ nSrc = 0; nDst = 0; /* *将源串每8个字节分为一组，压缩成7个字节 * 循环该处理过程，直至源串被处理完 * 如果分组不到8字节，也能正确处理 */ while (nSrc < nSrcLength) { /* 取源字符串的计数值的最低3位*/ nChar = nSrc & 7; /* 处理源串的每个字节*/ if(nChar == 0) { /* 组内第一个字节，只是保存起来， *待处理下一个字节时使用 */ nLeft = *pSrc; } else { /* 组内其它字节，将其右边部分与残余数据相加， *得到一个目标编码字节 */ *pDst = (*pSrc << (8-nChar)) | nLeft; /* 将该字节剩下的左边部分，作为残余数据保存起来*/ nLeft = *pSrc >> nChar; // 修改目标串的指针和计数值 pDst++; nDst++; } // 修改源串的指针和计数值 pSrc++; nSrc++; } // 返回目标串长度 return nDst; } // 7bit解码 // 输入: pSrc - 源编码串指针 // nSrcLength - 源编码串长度 // 输出: pDst - 目标字符串指针 // 返回: 目标字符串长度 int decode_7bit(const unsigned char* pSrc, char* pDst, int nSrcLength) { int nSrc; // 源字符串的计数值 int nDst; // 目标解码串的计数值 int nByte; // 当前正在处理的组内字节的序号，范围是0-6 unsigned char nLeft; // 上一字节残余的数据 // 计数值初始化 nSrc = 0; nDst = 0; // 组内字节序号和残余数据初始化 nByte = 0; nLeft = 0; // 将源数据每7个字节分为一组，解压缩成8个字节 // 循环该处理过程，直至源数据被处理完 // 如果分组不到7字节，也能正确处理 while(nSrc<nSrcLength) { // 将源字节右边部分与残余数据相加，去掉最高位，得到一个目标解码字节 *pDst = ((*pSrc << nByte) | nLeft) & 0x7f; // 将该字节剩下的左边部分，作为残余数据保存起来 nLeft = *pSrc >> (7-nByte); // 修改目标串的指针和计数值 pDst++; nDst++; // 修改字节计数值 nByte++; // 到了一组的最后一个字节 if(nByte == 7) { // 额外得到一个目标解码字节 *pDst = nLeft; // 修改目标串的指针和计数值 pDst++; nDst++; // 组内字节序号和残余数据初始化 nByte = 0; nLeft = 0; } // 修改源串的指针和计数值 pSrc++; nSrc++; } // 输出字符串加个结束符 *pDst = '\0'; // 返回目标串长度 return nDst; } // 8bit编码 // 输入: pSrc - 源字符串指针 // nSrcLength - 源字符串长度 // 输出: pDst - 目标编码串指针 // 返回: 目标编码串长度 int encode_8bit(const char* pSrc, unsigned char* pDst, int nSrcLength) { // 简单复制 memcpy(pDst, pSrc, nSrcLength); return nSrcLength; } // 8bit解码 // 输入: pSrc - 源编码串指针 // nSrcLength - 源编码串长度 // 输出: pDst - 目标字符串指针 // 返回: 目标字符串长度 int decode_8bit(const unsigned char* pSrc, char* pDst, int nSrcLength) { // 简单复制 memcpy(pDst, pSrc, nSrcLength); // 输出字符串加个结束符 *pDst = '\0'; return nSrcLength; } /** *@ desbuf - the buf to store the encoded string *@ srcbuf -the UTF-8 string you want to encode, its lenth <=255 *RETURN -the encoded length of desbuf */ int encode_UCS2(char *desbuf, const char *srcbuf) { int len,i,j=0; wchar_t wcbuf[255]; setlocale(LC_ALL,""); /* convert mutibytes string to wide charater string */ len = mbstowcs(wcbuf, srcbuf, 255); for (i=0;i<len;i++) { desbuf[j++] = wcbuf[i]>>8; /* height byte */ desbuf[j++] = wcbuf[i]&0xff; /* low byte */ } return len*2 ; } /** *@ srcbuf - source UCS-2 string you want to decode *@ desbuf - destination buf to store the decoded string *@ desbuflen - the lenth of desbuf, must <=255 *RETURN - the length of decoded string */ int decode_UCS2(char *desbuf, const char *srcbuf, int desbuflen) { wchar_t wcbuf[255]; int deslen; int i; setlocale(LC_ALL,""); for( i=0;i < desbuflen/2;i++ ) { wcbuf[i] = *srcbuf++ << 8; wcbuf[i] |= *srcbuf++; } /* convert wide charater string to mutibytes string */ deslen = wcstombs((char *)desbuf,wcbuf,desbuflen); desbuf[deslen] = '\0'; return deslen; } // 正常顺序的字符串转换为两两颠倒的字符串，若长度为奇数，补'F'凑成偶数 // 如："8613851872468" --> "683158812764F8" // 输入: pSrc - 源字符串指针 // nSrcLength - 源字符串长度 // 输出: pDst - 目标字符串指针 // 返回: 目标字符串长度 int invert_numbers(const char* pSrc, char* pDst, int nSrcLength) { int nDstLength; // 目标字符串长度 char ch; // 用于保存一个字符 // 复制串长度 nDstLength = nSrcLength; // 两两颠倒 int i; for(i=0; i<nSrcLength;i+=2) { ch = *pSrc++; // 保存先出现的字符 *pDst++ = *pSrc++; // 复制后出现的字符 *pDst++ = ch; // 复制先出现的字符 } // 源串长度是奇数吗？ if(nSrcLength & 1) { *(pDst-2) = 'F'; // 补'F' nDstLength++; // 目标串长度加1 } // 输出字符串加个结束符 *pDst = '\0'; // 返回目标字符串长度 return nDstLength; } // 两两颠倒的字符串转换为正常顺序的字符串 // 如："683158812764F8" --> "8613851872468" // 输入: pSrc - 源字符串指针 // nSrcLength - 源字符串长度 // 输出: pDst - 目标字符串指针 // 返回: 目标字符串长度 int serialize_numbers(const char* pSrc, char* pDst, int nSrcLength) { int nDstLength; // 目标字符串长度 char ch; // 用于保存一个字符 // 复制串长度 nDstLength = nSrcLength; // 两两颠倒 int i; for(i=0; i<nSrcLength;i+=2) { ch = *pSrc++; // 保存先出现的字符 *pDst++ = *pSrc++; // 复制后出现的字符 *pDst++ = ch; // 复制先出现的字符 } // 最后的字符是'F'吗？ if(*(pDst-1) == 'F') { pDst--; nDstLength--; // 目标字符串长度减1 } // 输出字符串加个结束符 *pDst = '\0'; // 返回目标字符串长度 return nDstLength; } // PDU编码，用于编制、发送短消息 // 输入: pSrc - 源PDU参数指针 // 输出: pDst - 目标PDU串指针 // 返回: 目标PDU串长度 int encode_PDU(const smsopt *pSrc, char *pDst) { int nLength; // 内部用的串长度 int nDstLength; // 目标PDU串长度 unsigned char buf[256]; // 内部用的缓冲区 // SMSC地址信息段 nLength = strlen(pSrc->SCA); // SMSC地址字符串的长度 buf[0] = (char)((nLength & 1) == 0 ? nLength : nLength + 1) / 2 + 1; // SMSC地址信息长度 buf[1] = 0x91; // 固定: 用国际格式号码 nDstLength = bytes2string(buf, pDst, 2); // 转换2个字节到目标PDU串 nDstLength += invert_numbers(pSrc->SCA, &pDst[nDstLength], nLength); // 转换SMSC号码到目标PDU串 // TPDU段基本参数、目标地址等 nLen