dcfactor.c 8.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435
  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. dp_err_n_c_rt("直流系数文件错误: %d", 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_AHT20
  104. dcfactor_file.temp = aht20_get_temp();
  105. #endif
  106. dcfactor_file.addr = FILE_ADDR_ALGIN(sizeof(dcfactor_file));
  107. dcfactor_file.num = DC_NUM;
  108. // 得到文件长度
  109. addr = dcfactor_file.addr + dcfactor_file.num * sizeof(struct dc_factor_save);
  110. file_length = addr;
  111. // 分配并初始化空间
  112. p = rt_malloc(file_length + 2);
  113. if(!p)
  114. {
  115. return -1;
  116. }
  117. memset(p, 0, file_length + 2);
  118. // 写入文件头
  119. memcpy(p, (char *)&dcfactor_file, sizeof(dcfactor_file));
  120. // 写直流系数
  121. memcpy(p+dcfactor_file.addr, factor, sizeof(struct dc_factor_save)*2);
  122. // 计算CRC
  123. crc = CrcStr(p, file_length);
  124. memcpy(p+file_length, &crc, 2);
  125. // 创建数据文件
  126. pfile = rt_file_open("/app/data/dcfactor.bin",O_CREAT|O_RDWR,0);
  127. if(IS_ERR(pfile))
  128. {
  129. rt_err_set(ERR_CODE_DCFACTOR,0);
  130. rt_free(p);
  131. return -2;
  132. }
  133. pos = 0;
  134. rt_file_write(pfile, p, file_length+2, &pos);
  135. rt_file_close(pfile,0);
  136. rt_free(p);
  137. memcpy(g_dcfactor_id, id, 8);
  138. memcpy(g_dcfactor_save, factor, sizeof(g_dcfactor_save));
  139. dcfactor_update();
  140. g_dc_temp = dcfactor_file.temp;
  141. //清除直流告警灯
  142. rt_err_clr(ERR_CODE_DCFACTOR,0);
  143. return 0;
  144. }
  145. /******************************************************************************
  146. 函数名称: dcfactor_readfile
  147. 函数版本: 01.01
  148. 创建作者: xxxxxx
  149. 创建日期: 2015-10-23
  150. 函数说明: 读取直流系数文件
  151. 参数说明: 无
  152. 返回值: 成功返回0.
  153. 修改记录:
  154. */
  155. int dcfactor_readfile(void)
  156. {
  157. u32 len,len2;
  158. u16 crc;
  159. u8 *buf;
  160. loff_t pos;
  161. struct file * pfile;
  162. struct dcfactor_file_head_data *brh;
  163. // 创建并打开文件
  164. pfile = rt_file_open("/app/data/dcfactor.bin",O_RDWR,0);
  165. if(IS_ERR(pfile))
  166. {
  167. return -1;
  168. }
  169. // 得到文件长度
  170. len = rt_file_getfile_size(pfile);
  171. if(len <= 0)
  172. {
  173. rt_file_close(pfile,0);
  174. return -11;
  175. }
  176. // 分配内存
  177. buf = rt_malloc(len);
  178. if((buf) == NULL)
  179. {
  180. rt_file_close(pfile,0);
  181. return -2;
  182. }
  183. // 读出内容
  184. pos = 0;
  185. if(rt_file_read(pfile,buf,len,&pos) != len)
  186. {
  187. rt_file_close(pfile,0);
  188. rt_free(buf);
  189. return -3;
  190. }
  191. // 关闭文件
  192. rt_file_close(pfile,0);
  193. // 检查CRC
  194. crc = CrcStr(buf,len-2);
  195. if(crc != *(u16*)(buf+len-2))
  196. {
  197. rt_free(buf);
  198. return -4;
  199. }
  200. // 检查文件签名
  201. brh = (struct dcfactor_file_head_data*)buf;
  202. if(brh->cfh.signature != SIG_DCFACTOR_FILE)
  203. {
  204. rt_free(buf);
  205. return -5;
  206. }
  207. //noted by sunxi: 20220413 暂进屏蔽
  208. #ifndef CPU_FUXI
  209. // 检查FLASH唯一ID号
  210. memcpy (&g_dcfactor_id, &brh->auth_id, 8);
  211. if (memcmp (&g_dcfactor_id, g_auth_id, 8) != 0)
  212. {
  213. rt_free(buf);
  214. return -6;
  215. }
  216. #endif
  217. // 检查文件长度
  218. len2 = FILE_ADDR_ALGIN(sizeof(*brh)) + brh->num*sizeof(struct dc_factor_save)+ 2;
  219. if(len != len2)
  220. {
  221. rt_printf("dcfactor_readfile:len=%d,len2=%d.\r\n",len,len2);
  222. rt_free(buf);
  223. return -7;
  224. }
  225. //取出文件中存储内容
  226. g_dc_temp = brh->temp;
  227. memcpy (&g_dcfactor_save, buf+brh->addr, sizeof(struct dc_factor_save)*2);
  228. rt_free(buf);
  229. return 0;
  230. }
  231. /******************************************************************************
  232. 函数名称: dcfactor_update
  233. 函数版本: 01.01
  234. 创建作者: xxxxxx
  235. 创建日期: 2015-10-23
  236. 函数说明: 更新程序实际的直流系数
  237. 参数说明: 无
  238. 返回值: 成功返回0.
  239. 修改记录:
  240. */
  241. int dcfactor_update(void)
  242. {
  243. int i;
  244. // 直流量校正系数
  245. for (i=0; i<DC_NUM; i++)
  246. {
  247. if (g_dcfactor_save[i].dc_h-g_dcfactor_save[i].dc_l == 0)
  248. {
  249. g_dcfactor[i].f_dc = 1;
  250. }
  251. else
  252. {
  253. g_dcfactor[i].f_dc = (dc_adjust[1] - dc_adjust[0])/(g_dcfactor_save[i].dc_h-g_dcfactor_save[i].dc_l);
  254. }
  255. g_dcfactor[i].f_dcL = g_dcfactor_save[i].dc_l;
  256. }
  257. return 0;
  258. }
  259. int dcfactor_restore_default(void)
  260. {
  261. int i;
  262. struct dc_factor_save factor[2];
  263. for(i=0; i<DC_NUM; i++)
  264. {
  265. factor[i].dc_l = dc_adjust[0];
  266. factor[i].dc_h = dc_adjust[1];
  267. factor[i].adjust_set = DC_DEFAULT;
  268. }
  269. return dcfactor_createfile(g_auth_id, (u8 *)&factor);
  270. }
  271. void _getdcfactorinf(void)
  272. {
  273. u32 i,file_length;
  274. struct file * pfile;
  275. u8 *filebuf;
  276. //u8 filestr[128],*pstr,strlenth;
  277. loff_t pos;
  278. // 打开文件
  279. pfile = rt_file_open("/app/data/pcolcfg.ini",O_RDONLY ,0);
  280. if(IS_ERR(pfile))
  281. {
  282. dp_err_n_c_rt("error! 无法打开 pcolcfg.ini");
  283. goto dc_err;
  284. }
  285. // 得到文件长度
  286. file_length = rt_file_getfile_size(pfile);
  287. if(file_length <= 0)
  288. {
  289. rt_file_close(pfile,0);
  290. goto dc_err;
  291. }
  292. if(file_length == 0)
  293. {
  294. rt_file_close(pfile,0);
  295. goto dc_err;
  296. }
  297. // 分配内存
  298. filebuf = rt_malloc(file_length);
  299. if((filebuf) == NULL)
  300. {
  301. rt_file_close(pfile,0);
  302. goto dc_err;
  303. }
  304. pos = 0;
  305. if(rt_file_read(pfile,filebuf,file_length,&pos) != file_length)
  306. {
  307. rt_file_close(pfile,0);
  308. rt_free(filebuf);
  309. goto dc_err;
  310. }
  311. for(i = 0; i < file_length; i++)
  312. {
  313. if(strncmp(&filebuf[i],"DC_AJUST_0", 10) == 0)
  314. {
  315. dc_adjust[0] = getstrval(&filebuf[i]);
  316. }
  317. else if(strncmp(&filebuf[i],"DC_AJUST_1", 10) == 0)
  318. {
  319. dc_adjust[1] = getstrval(&filebuf[i]);
  320. break;
  321. }
  322. }
  323. if(i >= file_length)
  324. {
  325. dc_adjust[0] = DC_AJUST_0;
  326. dc_adjust[1] = DC_AJUST_1;
  327. }
  328. rt_printf("dc_adjust[0] = %f\r\n", dc_adjust[0]);
  329. rt_printf("dc_adjust[1] = %f\r\n", dc_adjust[1]);
  330. rt_file_close(pfile,0); // 关闭文件
  331. rt_free(filebuf); // 释放内存
  332. return;
  333. dc_err:
  334. dc_adjust[0] = DC_AJUST_0;
  335. dc_adjust[1] = DC_AJUST_1;
  336. rt_printf("dc_adjust[0] = %f\r\n", dc_adjust[0]);
  337. rt_printf("dc_adjust[1] = %f\r\n", dc_adjust[1]);
  338. }
  339. /*------------------------------ 内部函数 -------------------------------------
  340. 内部函数以下划线‘_’开头,不需要检查参数的合法性.
  341. */
  342. /*------------------------------ 测试函数 -------------------------------------
  343. 一个实体文件必须带一个本模块的测试函数来进行单元测试,如果的确不方便在本模块中
  344. 进行单元测试,必须在此注明实际的测试位置(例如在哪个实体文件中使用哪个测试函数).
  345. */
  346. int dcfactor_printf(void)
  347. {
  348. int i;
  349. rt_printf("直流校正系数:\r\n");
  350. rt_printf("校正温度:%f.\r\n",g_dc_temp);
  351. rt_printf("%d,\t存储标志:%d,\tdc_h=%9f,\tdc_l=%9f \r\n",
  352. 0,
  353. g_dcfactor_save[0].adjust_set,
  354. g_dcfactor_save[0].dc_h,
  355. g_dcfactor_save[0].dc_l);
  356. rt_printf("%d,\t存储标志:%d,\tdc_h=%9f,\tdc_l=%9f \r\n",
  357. 1,
  358. g_dcfactor_save[1].adjust_set,
  359. g_dcfactor_save[1].dc_h,
  360. g_dcfactor_save[1].dc_l);
  361. rt_printf("存储ID号:0x");
  362. for (i=0; i<8; i++)
  363. {
  364. rt_printf("%02x ", g_dcfactor_id[i]);
  365. }
  366. rt_printf("\r\n实际ID号:0x");
  367. for (i=0; i<8; i++)
  368. {
  369. rt_printf("%02x ", g_auth_id[i]);
  370. }
  371. rt_printf("\r\n");
  372. return 0;
  373. }
  374. //========================== 本文件结束 =============================