dcfactor.c 8.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437
  1. /******************************************************************************
  2. 版权所有:
  3. 文件名称: dcfactor.c
  4. 文件版本: 01.01
  5. 创建作者: sunxi
  6. 创建日期: 2013-05-20
  7. 功能说明: 直流系数处理。
  8. 其它说明:
  9. 修改记录:
  10. */
  11. /*------------------------------- 头文件 --------------------------------------
  12. */
  13. #include "head.h"
  14. /*------------------------------- 宏定义 --------------------------------------
  15. */
  16. #define DCFACTOR_FILE_VERSION 0X01010101 //文件版本
  17. /*------------------------------ 类型结构 -------------------------------------
  18. */
  19. /*------------------------------ 全局变量 -------------------------------------
  20. */
  21. float g_dc_temp;
  22. struct dc_factor g_dcfactor[DC_NUM];
  23. struct dc_factor_save g_dcfactor_save[DC_NUM];
  24. u8 g_dcfactor_id[AUTH_ID_LEN];
  25. float dc_adjust[2];
  26. /*------------------------------ 函数声明 -------------------------------------
  27. */
  28. int dcfactor_init(void);
  29. int dcfactor_readfile(void);
  30. int dcfactor_update(void);
  31. /*------------------------------ 外部函数 -------------------------------------
  32. 外部函数供其它实体文件引用,必须仔细检查传入参数的合法性.
  33. */
  34. /******************************************************************************
  35. 函数名称: dcfactor_init
  36. 函数版本: 01.01
  37. 创建作者: xxxxxx
  38. 创建日期: 2015-10-23
  39. 函数说明: dcfactor初始化。
  40. 参数说明: 无
  41. 返回值: 成功返回0.
  42. 修改记录:
  43. */
  44. int dcfactor_init(void)
  45. {
  46. int i,ret;
  47. ret = dcfactor_readfile();
  48. if (ret != 0)
  49. {
  50. rt_err_set(ERR_CODE_DCFACTOR,0);
  51. rt_file_del("/app/data/dcfactor.bin");
  52. rt_printf("直流系数文件错误: %d\r\n", ret);
  53. for (i=0; i<DC_NUM; i++)
  54. {
  55. g_dcfactor_save[i].adjust_set = DC_DEFAULT;
  56. g_dcfactor_save[i].dc_h = 50;
  57. g_dcfactor_save[i].dc_l = 10;
  58. }
  59. g_dc_temp = 40.0;
  60. }
  61. _getdcfactorinf();
  62. dcfactor_update();
  63. return ret;
  64. }
  65. /******************************************************************************
  66. 函数名称: dcfactor_exit
  67. 函数版本: 01.01
  68. 创建作者: xxxxxx
  69. 创建日期: 2015-10-23
  70. 函数说明: dcfactor退出。
  71. 参数说明: 无
  72. 返回值: 成功返回0.
  73. 修改记录:
  74. */
  75. int dcfactor_exit(void)
  76. {
  77. return 0;
  78. }
  79. /******************************************************************************
  80. 函数名称: dcfactor_createfile
  81. 函数版本: 01.01
  82. 创建作者: xxxxxx
  83. 创建日期: 2015-10-23
  84. 函数说明: 创建直流系数文件
  85. 参数说明: 无
  86. 返回值: 成功返回0.
  87. 修改记录:
  88. */
  89. int dcfactor_createfile(u8 *id, u8 *factor)
  90. {
  91. unsigned int addr,file_length;
  92. u16 crc;
  93. char *p;
  94. loff_t pos;
  95. struct file * pfile;
  96. struct dcfactor_file_head_data dcfactor_file;
  97. // 写文件头
  98. memset(&dcfactor_file,0,sizeof(dcfactor_file));
  99. dcfactor_file.cfh.signature = SIG_DCFACTOR_FILE;
  100. dcfactor_file.cfh.version = DCFACTOR_FILE_VERSION;
  101. memcpy (&dcfactor_file.auth_id, id, 8);
  102. // 校正温度更新
  103. #if defined TMP_CHIP_DS18B20
  104. dcfactor_file.temp = ds18b20_get_temp();
  105. #elif defined TMP_CHIP_GX21M15
  106. dcfactor_file.temp = gx21m15_get_temp();
  107. #endif
  108. dcfactor_file.addr = FILE_ADDR_ALGIN(sizeof(dcfactor_file));
  109. dcfactor_file.num = DC_NUM;
  110. // 得到文件长度
  111. addr = dcfactor_file.addr + dcfactor_file.num * sizeof(struct dc_factor_save);
  112. file_length = addr;
  113. // 分配并初始化空间
  114. p = rt_malloc(file_length + 2);
  115. if(!p)
  116. {
  117. return -1;
  118. }
  119. memset(p, 0, file_length + 2);
  120. // 写入文件头
  121. memcpy(p, (char *)&dcfactor_file, sizeof(dcfactor_file));
  122. // 写直流系数
  123. memcpy(p+dcfactor_file.addr, factor, sizeof(struct dc_factor_save)*2);
  124. // 计算CRC
  125. crc = CrcStr(p, file_length);
  126. memcpy(p+file_length, &crc, 2);
  127. // 创建数据文件
  128. pfile = rt_file_open("/app/data/dcfactor.bin",O_CREAT|O_RDWR,0);
  129. if(IS_ERR(pfile))
  130. {
  131. rt_err_set(ERR_CODE_DCFACTOR,0);
  132. rt_free(p);
  133. return -2;
  134. }
  135. pos = 0;
  136. rt_file_write(pfile, p, file_length+2, &pos);
  137. rt_file_close(pfile,0);
  138. rt_free(p);
  139. memcpy(g_dcfactor_id, id, 8);
  140. memcpy(g_dcfactor_save, factor, sizeof(g_dcfactor_save));
  141. dcfactor_update();
  142. g_dc_temp = dcfactor_file.temp;
  143. //清除直流告警灯
  144. rt_err_clr(ERR_CODE_DCFACTOR,0);
  145. return 0;
  146. }
  147. /******************************************************************************
  148. 函数名称: dcfactor_readfile
  149. 函数版本: 01.01
  150. 创建作者: xxxxxx
  151. 创建日期: 2015-10-23
  152. 函数说明: 读取直流系数文件
  153. 参数说明: 无
  154. 返回值: 成功返回0.
  155. 修改记录:
  156. */
  157. int dcfactor_readfile(void)
  158. {
  159. u32 len,len2;
  160. u16 crc;
  161. u8 *buf;
  162. loff_t pos;
  163. struct file * pfile;
  164. struct dcfactor_file_head_data *brh;
  165. // 创建并打开文件
  166. pfile = rt_file_open("/app/data/dcfactor.bin",O_RDWR,0);
  167. if(IS_ERR(pfile))
  168. {
  169. return -1;
  170. }
  171. // 得到文件长度
  172. len = rt_file_getfile_size(pfile);
  173. if(len <= 0)
  174. {
  175. rt_file_close(pfile,0);
  176. return -11;
  177. }
  178. // 分配内存
  179. buf = rt_malloc(len);
  180. if((buf) == NULL)
  181. {
  182. rt_file_close(pfile,0);
  183. return -2;
  184. }
  185. // 读出内容
  186. pos = 0;
  187. if(rt_file_read(pfile,buf,len,&pos) != len)
  188. {
  189. rt_file_close(pfile,0);
  190. rt_free(buf);
  191. return -3;
  192. }
  193. // 关闭文件
  194. rt_file_close(pfile,0);
  195. // 检查CRC
  196. crc = CrcStr(buf,len-2);
  197. if(crc != *(u16*)(buf+len-2))
  198. {
  199. rt_free(buf);
  200. return -4;
  201. }
  202. // 检查文件签名
  203. brh = (struct dcfactor_file_head_data*)buf;
  204. if(brh->cfh.signature != SIG_DCFACTOR_FILE)
  205. {
  206. rt_free(buf);
  207. return -5;
  208. }
  209. //noted by sunxi: 20220413 暂进屏蔽
  210. #ifndef CPU_FUXI
  211. // 检查FLASH唯一ID号
  212. memcpy (&g_dcfactor_id, &brh->auth_id, 8);
  213. if (memcmp (&g_dcfactor_id, g_auth_id, 8) != 0)
  214. {
  215. rt_free(buf);
  216. return -6;
  217. }
  218. #endif
  219. // 检查文件长度
  220. len2 = FILE_ADDR_ALGIN(sizeof(*brh)) + brh->num*sizeof(struct dc_factor_save)+ 2;
  221. if(len != len2)
  222. {
  223. rt_printf("dcfactor_readfile:len=%d,len2=%d.\r\n",len,len2);
  224. rt_free(buf);
  225. return -7;
  226. }
  227. //取出文件中存储内容
  228. g_dc_temp = brh->temp;
  229. memcpy (&g_dcfactor_save, buf+brh->addr, sizeof(struct dc_factor_save)*2);
  230. rt_free(buf);
  231. return 0;
  232. }
  233. /******************************************************************************
  234. 函数名称: dcfactor_update
  235. 函数版本: 01.01
  236. 创建作者: xxxxxx
  237. 创建日期: 2015-10-23
  238. 函数说明: 更新程序实际的直流系数
  239. 参数说明: 无
  240. 返回值: 成功返回0.
  241. 修改记录:
  242. */
  243. int dcfactor_update(void)
  244. {
  245. int i;
  246. // 直流量校正系数
  247. for (i=0; i<DC_NUM; i++)
  248. {
  249. if (g_dcfactor_save[i].dc_h-g_dcfactor_save[i].dc_l == 0)
  250. {
  251. g_dcfactor[i].f_dc = 1;
  252. }
  253. else
  254. {
  255. g_dcfactor[i].f_dc = (dc_adjust[1] - dc_adjust[0])/(g_dcfactor_save[i].dc_h-g_dcfactor_save[i].dc_l);
  256. }
  257. g_dcfactor[i].f_dcL = g_dcfactor_save[i].dc_l;
  258. }
  259. return 0;
  260. }
  261. int dcfactor_restore_default(void)
  262. {
  263. int i;
  264. struct dc_factor_save factor[2];
  265. for(i=0; i<DC_NUM; i++)
  266. {
  267. factor[i].dc_l = dc_adjust[0];
  268. factor[i].dc_h = dc_adjust[1];
  269. factor[i].adjust_set = DC_DEFAULT;
  270. }
  271. return dcfactor_createfile(g_auth_id, (u8 *)&factor);
  272. }
  273. void _getdcfactorinf(void)
  274. {
  275. u32 i,file_length;
  276. struct file * pfile;
  277. u8 *filebuf;
  278. //u8 filestr[128],*pstr,strlenth;
  279. loff_t pos;
  280. // 打开文件
  281. pfile = rt_file_open("/app/data/pcolcfg.ini",O_RDONLY ,0);
  282. if(IS_ERR(pfile))
  283. {
  284. rt_printf("error! 无法打开 pcolcfg.ini\r\n");
  285. goto dc_err;
  286. }
  287. // 得到文件长度
  288. file_length = rt_file_getfile_size(pfile);
  289. if(file_length <= 0)
  290. {
  291. rt_file_close(pfile,0);
  292. goto dc_err;
  293. }
  294. if(file_length == 0)
  295. {
  296. rt_file_close(pfile,0);
  297. goto dc_err;
  298. }
  299. // 分配内存
  300. filebuf = rt_malloc(file_length);
  301. if((filebuf) == NULL)
  302. {
  303. rt_file_close(pfile,0);
  304. goto dc_err;
  305. }
  306. pos = 0;
  307. if(rt_file_read(pfile,filebuf,file_length,&pos) != file_length)
  308. {
  309. rt_file_close(pfile,0);
  310. rt_free(filebuf);
  311. goto dc_err;
  312. }
  313. for(i = 0; i < file_length; i++)
  314. {
  315. if(strncmp(&filebuf[i],"DC_AJUST_0", 10) == 0)
  316. {
  317. dc_adjust[0] = getstrval(&filebuf[i]);
  318. }
  319. else if(strncmp(&filebuf[i],"DC_AJUST_1", 10) == 0)
  320. {
  321. dc_adjust[1] = getstrval(&filebuf[i]);
  322. break;
  323. }
  324. }
  325. if(i >= file_length)
  326. {
  327. dc_adjust[0] = DC_AJUST_0;
  328. dc_adjust[1] = DC_AJUST_1;
  329. }
  330. rt_printf("dc_adjust[0] = %f\r\n", dc_adjust[0]);
  331. rt_printf("dc_adjust[1] = %f\r\n", dc_adjust[1]);
  332. rt_file_close(pfile,0); // 关闭文件
  333. rt_free(filebuf); // 释放内存
  334. return;
  335. dc_err:
  336. dc_adjust[0] = DC_AJUST_0;
  337. dc_adjust[1] = DC_AJUST_1;
  338. rt_printf("dc_adjust[0] = %f\r\n", dc_adjust[0]);
  339. rt_printf("dc_adjust[1] = %f\r\n", dc_adjust[1]);
  340. }
  341. /*------------------------------ 内部函数 -------------------------------------
  342. 内部函数以下划线‘_’开头,不需要检查参数的合法性.
  343. */
  344. /*------------------------------ 测试函数 -------------------------------------
  345. 一个实体文件必须带一个本模块的测试函数来进行单元测试,如果的确不方便在本模块中
  346. 进行单元测试,必须在此注明实际的测试位置(例如在哪个实体文件中使用哪个测试函数).
  347. */
  348. int dcfactor_printf(void)
  349. {
  350. int i;
  351. rt_printf("直流校正系数:\r\n");
  352. rt_printf("校正温度:%f.\r\n",g_dc_temp);
  353. rt_printf("%d,\t存储标志:%d,\tdc_h=%9f,\tdc_l=%9f \r\n",
  354. 0,
  355. g_dcfactor_save[0].adjust_set,
  356. g_dcfactor_save[0].dc_h,
  357. g_dcfactor_save[0].dc_l);
  358. rt_printf("%d,\t存储标志:%d,\tdc_h=%9f,\tdc_l=%9f \r\n",
  359. 1,
  360. g_dcfactor_save[1].adjust_set,
  361. g_dcfactor_save[1].dc_h,
  362. g_dcfactor_save[1].dc_l);
  363. rt_printf("存储ID号:0x");
  364. for (i=0; i<8; i++)
  365. {
  366. rt_printf("%02x ", g_dcfactor_id[i]);
  367. }
  368. rt_printf("\r\n实际ID号:0x");
  369. for (i=0; i<8; i++)
  370. {
  371. rt_printf("%02x ", g_auth_id[i]);
  372. }
  373. rt_printf("\r\n");
  374. return 0;
  375. }
  376. //========================== 本文件结束 =============================