func.c 6.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252
  1. /*************************************************************************
  2. * 版权所有:
  3. * 文件版本: V1.00
  4. * 文件名称: fun.c
  5. * 生成日期: 2004年6月7日
  6. * 作 者: 保护部
  7. *
  8. * 功能描述: 通用子函数实现
  9. * CrcStr: 计算一个数组的CRC-16
  10. *更新信息:
  11. *更新日志1:
  12. *日期:
  13. *修改者:
  14. *修改内容:
  15. *修改原因:
  16. *更新日志2:
  17. **************************************************************************/
  18. #include "head.h"
  19. //-------------------------------------------------------------------------------
  20. //CRC-16 表
  21. const WORD Lookup[256]=
  22. {
  23. 0x0000,0xC0C1,0xC181,0x0140,0xC301,0x03C0,0x0280,0xC241,
  24. 0xC601,0x06C0,0x0780,0xC741,0x0500,0xC5C1,0xC481,0x0440,
  25. 0xCC01,0x0CC0,0x0D80,0xCD41,0x0F00,0xCFC1,0xCE81,0x0E40,
  26. 0x0A00,0xCAC1,0xCB81,0x0B40,0xC901,0x09C0,0x0880,0xC841,
  27. 0xD801,0x18C0,0x1980,0xD941,0x1B00,0xDBC1,0xDA81,0x1A40,
  28. 0x1E00,0xDEC1,0xDF81,0x1F40,0xDD01,0x1DC0,0x1C80,0xDC41,
  29. 0x1400,0xD4C1,0xD581,0x1540,0xD701,0x17C0,0x1680,0xD641,
  30. 0xD201,0x12C0,0x1380,0xD341,0x1100,0xD1C1,0xD081,0x1040,
  31. 0xF001,0x30C0,0x3180,0xF141,0x3300,0xF3C1,0xF281,0x3240,
  32. 0x3600,0xF6C1,0xF781,0x3740,0xF501,0x35C0,0x3480,0xF441,
  33. 0x3C00,0xFCC1,0xFD81,0x3D40,0xFF01,0x3FC0,0x3E80,0xFE41,
  34. 0xFA01,0x3AC0,0x3B80,0xFB41,0x3900,0xF9C1,0xF881,0x3840,
  35. 0x2800,0xE8C1,0xE981,0x2940,0xEB01,0x2BC0,0x2A80,0xEA41,
  36. 0xEE01,0x2EC0,0x2F80,0xEF41,0x2D00,0xEDC1,0xEC81,0x2C40,
  37. 0xE401,0x24C0,0x2580,0xE541,0x2700,0xE7C1,0xE681,0x2640,
  38. 0x2200,0xE2C1,0xE381,0x2340,0xE101,0x21C0,0x2080,0xE041,
  39. 0xA001,0x60C0,0x6180,0xA141,0x6300,0xA3C1,0xA281,0x6240,
  40. 0x6600,0xA6C1,0xA781,0x6740,0xA501,0x65C0,0x6480,0xA441,
  41. 0x6C00,0xACC1,0xAD81,0x6D40,0xAF01,0x6FC0,0x6E80,0xAE41,
  42. 0xAA01,0x6AC0,0x6B80,0xAB41,0x6900,0xA9C1,0xA881,0x6840,
  43. 0x7800,0xB8C1,0xB981,0x7940,0xBB01,0x7BC0,0x7A80,0xBA41,
  44. 0xBE01,0x7EC0,0x7F80,0xBF41,0x7D00,0xBDC1,0xBC81,0x7C40,
  45. 0xB401,0x74C0,0x7580,0xB541,0x7700,0xB7C1,0xB681,0x7640,
  46. 0x7200,0xB2C1,0xB381,0x7340,0xB101,0x71C0,0x7080,0xB041,
  47. 0x5000,0x90C1,0x9181,0x5140,0x9301,0x53C0,0x5280,0x9241,
  48. 0x9601,0x56C0,0x5780,0x9741,0x5500,0x95C1,0x9481,0x5440,
  49. 0x9C01,0x5CC0,0x5D80,0x9D41,0x5F00,0x9FC1,0x9E81,0x5E40,
  50. 0x5A00,0x9AC1,0x9B81,0x5B40,0x9901,0x59C0,0x5880,0x9841,
  51. 0x8801,0x48C0,0x4980,0x8941,0x4B00,0x8BC1,0x8A81,0x4A40,
  52. 0x4E00,0x8EC1,0x8F81,0x4F40,0x8D01,0x4DC0,0x4C80,0x8C41,
  53. 0x4400,0x84C1,0x8581,0x4540,0x8701,0x47C0,0x4680,0x8641,
  54. 0x8201,0x42C0,0x4380,0x8341,0x4100,0x81C1,0x8081,0x4040
  55. };
  56. /**************************************************************************
  57. 函数名称:CrcStr
  58. 函数版本:1.00
  59. 作者:
  60. 创建日期:2005.4.13
  61. 函数功能说明:计算1个字节数组的CRC-16
  62. 输入参数: p =数组的开始地址
  63. len =数组长度
  64. 返回值: crc =计算后的CRC-16结果
  65. 更新信息:
  66. 更新日志1:
  67. 日期:
  68. 修改者:
  69. 修改内容:
  70. 修改原因:
  71. ***************************************************************************/
  72. WORD CrcStr(BYTE *p,int len)
  73. {
  74. WORD crc=0;
  75. bool bZero=true;
  76. while(len-->0)
  77. {
  78. if(*p!=0)bZero=false;
  79. crc=Lookup[(crc&0xff)^(*p++)]^(crc>>8);
  80. }
  81. if(bZero)crc=0x5678; //若全为0,crc返回就不要为零
  82. return crc;
  83. }
  84. /**************************************************************************
  85. 函数名称:MaxDWORD
  86. 函数版本:1.00
  87. 作者:
  88. 创建日期:2005.4.13
  89. 函数功能说明:从三个长字中返回最大的一个
  90. 输入参数:
  91. 返回值:
  92. 更新信息:
  93. 更新日志1:
  94. 日期:
  95. 修改者:
  96. 修改内容:
  97. 修改原因:
  98. ***************************************************************************/
  99. //从三个长字中返回最大的一个
  100. #if 0
  101. static DWORD MaxDWORD(DWORD d1,DWORD d2,DWORD d3)
  102. {
  103. DWORD ret;
  104. ret=(d1>d2)?d1:d2;
  105. if(ret<d3)
  106. {
  107. ret=d3;
  108. }
  109. return ret;
  110. }
  111. #endif
  112. /**************************************************************************
  113. 函数名称:Buffer2Zero
  114. 函数版本:1.00
  115. 作者:
  116. 创建日期:2005.4.13
  117. 函数功能说明:缓冲区清零
  118. 输入参数:
  119. 返回值:
  120. 更新信息:
  121. 更新日志1:
  122. 日期:
  123. 修改者:
  124. 修改内容:
  125. 修改原因:
  126. ***************************************************************************/
  127. //缓冲区清零
  128. #if 0
  129. static void Buffer2Zero(char *pnt, int nLen)
  130. {
  131. int nCnt;
  132. for(nCnt=0;nCnt<nLen;nCnt++)
  133. {
  134. *pnt++=0;
  135. }
  136. }
  137. #endif
  138. /**************************************************************************
  139. 函数名称:CheckFloatSet
  140. 函数版本:1.00
  141. 作者:
  142. 创建日期:2005.4.13
  143. 函数功能说明:检查浮点数的有效性
  144. 输入参数:
  145. 返回值:
  146. 更新信息:
  147. 更新日志1:
  148. 日期:
  149. 修改者:
  150. 修改内容:
  151. 修改原因:
  152. ***************************************************************************/
  153. int CheckFloatSet(void *pf,float fMax,float fMin)
  154. {
  155. if(isnan_f(pf)>0)return 1;
  156. else
  157. {
  158. float ff=*(float*)pf;
  159. if(ff>(fMax+0.00005))return 1; // 浮点数大于大值
  160. if((ff+0.00005)<fMin)return 1; //小于小值
  161. }
  162. return 0;
  163. }
  164. /**************************************************************************
  165. 函数名称:FUC_Get_LongValue_String
  166. 函数版本:1.00
  167. 作者:
  168. 创建日期:2005.4.13
  169. 函数功能说明:将long型数值转为可显示的字符串
  170. 输入参数:
  171. 返回值:
  172. 更新信息:
  173. 更新日志1:
  174. 日期:
  175. 修改者:
  176. 修改内容:
  177. 修改原因:
  178. ***************************************************************************/
  179. void FUC_Get_LongValue_String(long templong,char *tempstr)
  180. {
  181. long temp1,temp2;
  182. bool tbl=false;
  183. if(templong<0)
  184. {
  185. templong=-templong;
  186. tbl=true;
  187. }
  188. temp1=templong/65536;
  189. if((temp1>=0)&&(temp1<=60000))//显示一次值,增加变比造成数值变大 30000-》60000
  190. {
  191. temp2=(templong-temp1*65536)*1000/65536;
  192. if(tbl)
  193. {
  194. sprintf(tempstr,"-%d.%-3.3d",(int)temp1,(int)temp2);
  195. }
  196. else
  197. {
  198. sprintf(tempstr,"%d.%-3.3d",(int)temp1,(int)temp2);
  199. }
  200. }
  201. else //无效值
  202. {
  203. sprintf(tempstr,"%s","-----");
  204. }
  205. }
  206. /**************************************************************************
  207. 函数名称:FUC_Get_LongLongValue_String
  208. 函数版本:1.00
  209. 作者:
  210. 创建日期:2005.4.13
  211. 函数功能说明:将long long型数值转为可显示的字符串
  212. 输入参数:
  213. 返回值:
  214. 更新信息:
  215. 更新日志1:
  216. 日期:
  217. 修改者:
  218. 修改内容:
  219. 修改原因:
  220. ***************************************************************************/
  221. void FUC_Get_LongLongValue_String(long long templong,char *tempstr)
  222. {
  223. long temp1,temp2;
  224. bool tbl=false;
  225. if(templong<0)
  226. {
  227. templong=-templong;
  228. tbl=true;
  229. }
  230. temp1=(long)(templong/65536);
  231. if(temp1<30000)return;
  232. temp2=(long)(templong-(long long)temp1*65536)*1000/65536;
  233. if(tbl)
  234. {
  235. sprintf(tempstr,"-%d.%-1.1d",(int)temp1,(int)temp2);
  236. }
  237. else
  238. {
  239. sprintf(tempstr,"%d.%-1.1d",(int)temp1,(int)temp2);
  240. }
  241. }
  242. //========================== 本文件结束 =============================