equ_ftu.c 13 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533
  1. /******************************************************************************
  2. 版权所有:
  3. 文件名称: equ.c
  4. 文件版本: 01.01
  5. 创建作者: sunxi
  6. 创建日期: 2013-03-25
  7. 功能说明: 装置信息管理维护
  8. 其它说明:
  9. 修改记录:
  10. */
  11. /*------------------------------- 头文件 --------------------------------------
  12. */
  13. #include "head.h"
  14. /*------------------------------- 宏定义 --------------------------------------
  15. */
  16. #define EQU_SLOT_CHECK_TIMEOUT 4 // 子板检查超时,以秒为单位,不能小于4s
  17. /*------------------------------ 类型结构 -------------------------------------
  18. */
  19. //子板信息帧结构
  20. struct board_info_frame
  21. {
  22. u8 type; // 子板类型
  23. u8 status :4; // 子板状态
  24. u8 errcode:4; // 子板错误代码
  25. u16 crc; // 子板CRC
  26. u32 version; // 子板版本
  27. };
  28. /*------------------------------ 全局变量 -------------------------------------
  29. */
  30. // 控制板类型
  31. u32 g_brd_type_kz;
  32. // 模拟量对应关系
  33. static const s8 g_ac_index[BOARD_TYPE_KZ_NUM][EQU_SLOT_AC_CHN] =
  34. {
  35. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X04,0X0A,0X0E,0X02,0X08,0X0C,0X00,0X06,0X0F}, // KC00
  36. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X0F,0x0E,0x04,0x02,0x08,0x0C,0x00,0x06,0x0A}, // KC08
  37. {0X0C,0X0E,0X01,0X03,0X00,0X02,0X04,0X06,0X08,0X0A,0X05,0X07,0X09,0X0B,0X0D,0X0F}, // KC10,10AC
  38. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X04,0X0A,0X0E,0X02,0X08,0X0C,0X00,0X06,0X0F}, // 一体式分布式DTU控制板
  39. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X0F,0x0E,0x04,0x02,0x08,0x0C,0x00,0x06,0x0A}, // 后拔插分布式DTU控制板 FB_V3_22_12
  40. {0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00}, // 18 老版本分布式主板类型,不起作用
  41. {0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00,0X00}, // 19 老版本分布式主板类型,不起作用
  42. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X0F,0x0E,0x04,0x02,0x08,0x0C,0x00,0x06,0x0A}, // 类型 20 FB_V4_24_12
  43. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X0F,0x08,0x0A,0x0C,0x0E,0x06,0x04,0x02,0x00}, //类型 21 FB_V4.1_24_12
  44. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X0F,0x08,0x0A,0x0C,0x0E,0x06,0x04,0x02,0x00}, //类型 22 FB_V3.1_22_12
  45. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X0F,0x0E,0x04,0x02,0x08,0x0C,0x00,0x06,0x0A}, //类型 23 FB_V3D_1_22_12
  46. {0X01,0X03,0X05,0X07,0X09,0X0B,0X0D,0X0F,0x0E,0x04,0x02,0x08,0x0C,0x00,0x06,0x0A}, //类型 24 V4_D_30_12
  47. };
  48. //遥信转换表
  49. s8 g_change_di_index[BOARD_TYPE_KZ_NUM][EQU_DB_YX_NUM] =
  50. {
  51. { 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31,32},//13
  52. { 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31,32},//14 FB_V3_22_8 21,20,19,22,23,24,25,26,27,28,29,30,31,32}
  53. { 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31,32},//15
  54. { 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15,16,17,18,19,00,00,00,00,00,00,00,00,00,00,00,00,00},//16 FBV1_19_6
  55. { 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31,32},//17 FB_V3_22_12
  56. { 1, 2, 3, 5, 7, 9,11,13,15,19,21,23,24,18,17, 4, 6, 8,10,12,14,16,20,22,00,00,00,00,00,00,00,00},//18 null
  57. { 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15,16,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31,32},//19 null
  58. { 1, 2, 3, 5, 7, 9,11,13,15,19,21,23,24,18,17, 4, 6, 8,10,12,14,16,20,22,00,00,00,00,00,00,00,00},//20 FB_V4_24_12
  59. { 1, 2, 3, 5, 7, 9,11,13,15,19,21,23,24,18,17, 4, 6, 8,10,12,14,16,20,22,00,00,00,00,00,00,00,00},//21 FB_V4.1_24_12
  60. { 1, 2, 3, 4, 5, 6, 7, 8, 9,10,11,12,13,14,15,16,17,18,19,20,24,23,21,22,25,26,27,28,29,30,31,32},//22 FB_V3.1_22_12
  61. { 2, 4, 6, 8,10,12,14,15,16, 1, 3, 5, 7, 9,11,13,17,18,19,20,21,22,23,24,25,26,27,28,29,30,31,32},//23 FB_V3D_122_12
  62. { 1, 3, 5, 7, 9,11,13,15,19,21,25,27,29, 2, 4, 6, 8,10,12,14,16,20,22,26,28,30,17,18,23,24,00,00},//24 V4_D_30_12
  63. };
  64. // 开出对应关系
  65. static const s8 g_do_index[BOARD_TYPE_KZ_NUM][DO_NUM] =
  66. {
  67. {-1,-1,-1,-1-1,-1,-1,-1-1,-1,-1,-1},
  68. {DO_OUT8,DO_OUT0,DO_OUT1,DO_OUT6,DO_OUT5,DO_OUT2,DO_OUT3,DO_OUT4,DO_OUT7,-1}, //14
  69. {DO_OUT9,DO_OUT0,DO_OUT2,DO_OUT4,DO_OUT6,DO_OUT1,DO_OUT3,DO_OUT5,DO_OUT7,-1}, //15
  70. {-1,-1,-1,-1-1,-1,-1,-1-1,-1,-1,-1}, // 18 老版本分布式主板类型,不起作用
  71. {-1,-1,-1,-1-1,-1,-1,-1-1,-1,-1,-1}, // 19 老版本分布式主板类型,不起作用
  72. // {DO_PWM2,DO_PWM1,DO_OUT7,DO_OUT6,DO_OUT3,DO_OUT2,DO_PWM0,DO_PWM3,DO_OUT0,DO_OUT1,DO_OUT5,-1}, //20 V4 类型20
  73. // {DO_PWM2,DO_PWM1,DO_OUT7,DO_OUT6,DO_OUT3,DO_OUT2,DO_PWM0,DO_PWM3,DO_OUT0,DO_OUT1,DO_OUT5,-1}, //21 V4.1 类型20
  74. // {DO_PWM0,DO_PWM3,DO_OUT0,DO_OUT1,DO_OUT6,DO_OUT5,DO_OUT2,DO_OUT3,DO_OUT4,DO_OUT7,DO_PWM1,-1}, //22 FB_V3.1_22_12
  75. // {DO_PWM0,DO_PWM3,DO_OUT0,DO_OUT1,DO_OUT6,DO_OUT5,DO_OUT2,DO_OUT3,DO_OUT4,DO_OUT7,DO_PWM1,-1}, //23 FB_V3D1_22_12
  76. // {DO_OUT2,DO_OUT3,DO_PWM2,DO_PWM0,DO_PWM3,DO_OUT0,DO_OUT1,DO_OUT6,DO_OUT5,DO_OUT7,DO_PWM1,-1},//24 V4_D_30_12
  77. };
  78. // 采样板索引和插槽的对应关系
  79. const int g_ac_index_to_slot[EQU_SLOT_AC_NUM] = {1};
  80. // 采样板起始槽位,每种机箱不一样。
  81. u32 g_ac_slot_begin;
  82. // 记录频率对应ui通道的索引值
  83. int g_ui_freq[CFG_FREQ_NUM];
  84. /*------------------------------ 函数声明 -------------------------------------
  85. */
  86. int equ_slot_config_di(int slot);
  87. int equ_slot_config_do(int slot);
  88. unsigned int chDi;
  89. unsigned int change_di_ch(unsigned int di)
  90. {
  91. register int i,rts=0;
  92. #if 0
  93. static int di_bak;
  94. if(di_bak!=di)
  95. {
  96. rt_printf_time("change_di_ch di=%x \r\n",di);
  97. di_bak=di;
  98. }
  99. #endif
  100. for(i=0;i<EQU_DB_YX_NUM;i++)
  101. {
  102. if(g_change_di_index[g_brd_type_kz][i]!=0 && g_change_di_index[g_brd_type_kz][i]<=EQU_DB_YX_NUM)
  103. {
  104. if(di>>(g_change_di_index[g_brd_type_kz][i]-1)&0x01)
  105. rts|= (1<<i);
  106. }
  107. }
  108. //rt_printf("%d %d 。。",rts,g_brd_type_kz);
  109. return rts;
  110. }
  111. /*------------------------------ 外部函数 -------------------------------------
  112. 外部函数供其它实体文件引用,必须仔细检查传入参数的合法性.
  113. */
  114. int equ_config_di(void)
  115. {
  116. u32 i;
  117. struct equ_config_di *ecd;
  118. memset(&g_di_st,0,sizeof(g_di_st));
  119. // 用户配置的保持时间、拥有者、类型
  120. ecd = g_equ_config_di;
  121. for(i=0;i<g_equ_config->di_num;i++)
  122. {
  123. // 开入扫描在156us中断,通过以下算法,得出对应不同防抖延时的最佳动态转换系数,理论误差为156us左右
  124. //g_di_st[ecd->slot][ecd->index].tm_filter = ecd->filter_time * 1000 / 156;
  125. if(ecd->filter_time>=10000)
  126. {
  127. g_di_st[ecd->slot][ecd->index].tm_filter = ecd->filter_time * 3200 / 500;
  128. g_di_st[ecd->slot][ecd->index].tm_filter -= (g_di_st[ecd->slot][ecd->index].tm_filter/10000);
  129. }
  130. else
  131. {
  132. g_di_st[ecd->slot][ecd->index].tm_filter = ecd->filter_time * 3200 / 500;
  133. }
  134. //rt_printf("filter_time[%d]=%d\r\n",i,ecd->filter_time);
  135. g_di_st[ecd->slot][ecd->index].owner = ecd->owner;
  136. g_di_st[ecd->slot][ecd->index].type = ecd->type;
  137. ecd++;
  138. }
  139. return 0;
  140. }
  141. int equ_config_do(void)
  142. {
  143. u32 i,index;
  144. struct equ_config_do *ecd;
  145. memset(&g_do_st,0,sizeof(struct do_struct)*14);
  146. // 用户配置的保持时间
  147. ecd = g_equ_config_do;
  148. for(i=0;i<g_equ_config->do_num;i++)
  149. {
  150. if(ecd->slot == EQU_SLOT_KZ)
  151. {
  152. index = equ_get_do_channel(ecd->index);
  153. g_do_st[index].us_keep = (u32)ecd->time_pulse;
  154. g_do_st[index].us_keep *= 1000; //ms转换为us
  155. }
  156. ecd++;
  157. }
  158. return 0;
  159. }
  160. int equ_config_di_yd(void)
  161. {
  162. u32 i;
  163. struct equ_config_di *ecd;
  164. // 用户配置的保持时间、拥有者、类型
  165. ecd = g_equ_config_di;
  166. for(i=0;i<g_equ_config->di_num;i++)
  167. {
  168. // 开入扫描在156us中断,通过以下算法,得出对应不同防抖延时的最佳动态转换系数,理论误差为156us左右
  169. g_di_st[ecd->slot][ecd->index].tm_filter = (u32)tRunPara.wYXFD * 1000 / 156;
  170. ecd++;
  171. }
  172. return 0;
  173. }
  174. int equ_config_do_yd(void)
  175. {
  176. #if 0
  177. int i,index;
  178. struct equ_config_do *ecd;
  179. // 用户配置的保持时间
  180. ecd = g_equ_config_do;
  181. for(i=0;i<g_equ_config->do_num;i++)
  182. {
  183. u32 dotime=(u32)ecd->time_pulse;
  184. if(ecd->slot == EQU_SLOT_KZ)
  185. {
  186. // 如果定值参数中设置了分闸时间,覆盖
  187. if(ecd->owner&&((ecd->type == (SW_DO_FZ+1))||(ecd->type == (SW_DO_BHT+1))||(ecd->type == (SW_DO_YKT+1))))
  188. {
  189. if(pRunSet->bTT_RmtPara)
  190. {
  191. dotime=tRunPara.wFZMC;
  192. }
  193. }
  194. // 如果定值参数中设置了合闸时间,覆盖
  195. if(ecd->owner&&((ecd->type == (SW_DO_HZ+1))||(ecd->type == (SW_DO_BHH+1))||(ecd->type == (SW_DO_YKH+1))))
  196. {
  197. if(pRunSet->bTT_RmtPara)
  198. {
  199. dotime=tRunPara.wHZMC;
  200. }
  201. }
  202. index = equ_get_do_channel(ecd->index);
  203. g_do_st[index].us_keep = (u32)dotime;
  204. g_do_st[index].us_keep *= 1000; //ms转换为us
  205. }
  206. ecd++;
  207. }
  208. #endif
  209. return 0;
  210. }
  211. int equ_init_later(void)
  212. {
  213. int i,ui;
  214. struct equ_config_di *ecd;
  215. // 采样板起始槽位
  216. g_ac_slot_begin = EQU_SLOT_AC_BEGIN;
  217. // 检查频率硬件通道对应的UI。
  218. g_ui_freq[0] = UI_NUM;
  219. g_ui_freq[1] = UI_NUM;
  220. for(i=0; i< g_equ_config->ac_num; i++)
  221. {
  222. // 频率通道必须是配置了的公共电压类型
  223. if(g_equ_config_ac[i].type == 0 || g_equ_config_ac[i].owner != 0)
  224. {
  225. continue;
  226. }
  227. ui = g_equ_config_ac[i].type -1;
  228. if(ui >= PUB_AC_NUM)
  229. {
  230. continue;
  231. }
  232. // 确定频率对应电压通道
  233. if(ui < PUB_AC_NUM)
  234. {
  235. if(g_equ_config_ac[i].slot == 9 && g_equ_config_ac[i].index == 0)
  236. {
  237. g_ui_freq[0] = ui;
  238. }
  239. if(g_equ_config_ac[i].slot == 10 && g_equ_config_ac[i].index == 0)
  240. {
  241. g_ui_freq[1] = ui;
  242. }
  243. }
  244. }
  245. // 初始化开入g_di_st结构
  246. memset((unsigned char*)g_di_st,0,sizeof(g_di_st));
  247. ecd = g_equ_config_di;
  248. for(i=0;i<g_equ_config->di_num;i++)
  249. {
  250. g_di_st[ecd->slot][ecd->index].tm_filter = ecd->filter_time;
  251. g_di_st[ecd->slot][ecd->index].owner = ecd->owner;
  252. g_di_st[ecd->slot][ecd->index].type = ecd->type;
  253. ecd++;
  254. }
  255. return 0;
  256. }
  257. /******************************************************************************
  258. 函数名称: equ_board_info_update
  259. 函数版本: 01.01
  260. 创建作者: sunxi
  261. 创建日期: 2013-08-08
  262. 函数说明: 接收到子板的对时应答帧后,更新子板信息
  263. 参数说明:
  264. can_bus 从哪条can总线接收到的帧。
  265. frame 接收帧的buf指针
  266. 返回值:
  267. 0: 成功
  268. 其它: 失败
  269. 修改记录:
  270. */
  271. int equ_board_info_update(int can_bus,u8 * frame)
  272. {
  273. struct can_frame_head *cfh;
  274. struct board_info_frame *bif;
  275. struct board_info *bi;
  276. // 检查帧内容
  277. cfh = (struct can_frame_head *)frame;
  278. #ifdef CAN_SLAVE_BOARD
  279. if(cfh->src >= (EQU_SLOT_NUM_MAX+CAN_BOARD_NUM))
  280. #else
  281. if(cfh->src >= EQU_SLOT_NUM_MAX)
  282. #endif
  283. {
  284. return -1;
  285. }
  286. if(cfh->len != 8)
  287. {
  288. return -2;
  289. }
  290. // 比较子板类型
  291. bi = &g_board_info[cfh->src];
  292. bif = (struct board_info_frame *)(frame + sizeof(cfh));
  293. if(bif->type != bi->type)
  294. {
  295. // rt_printf("board type error(no=%d,bi_type=%d,gbi_type=%d)\r\n",cfh->src,bif->type,bi->type);
  296. // print_mem("frame",frame,16);
  297. return -3;
  298. }
  299. // 得到子板信息
  300. bi->status = bif->status;
  301. bi->errcode = bif->errcode;
  302. bi->crc = bif->crc;
  303. bi->version = bif->version;
  304. //rt_printf("%02d\t%02d\t%02d\t%04x\t%08x\t",bi->type,bi->status,bi->errcode,bi->crc,bi->version);
  305. // 得到子板时间
  306. clk_time_get(&bi->update_time);
  307. bi->us0 = ustimer_get_origin();
  308. bi->is_ok = 1;
  309. bi->can_bus = can_bus;
  310. return 0;
  311. }
  312. /******************************************************************************
  313. 函数名称: equ_ac_channel_is_ok
  314. 函数版本: 01.01
  315. 创建作者: sunxi
  316. 创建日期: 2013-08-08
  317. 函数说明: 得到插槽中子板的模拟量通道对应的ADC采样通道。
  318. 参数说明:
  319. slot 插槽索引号
  320. index 子板上模拟量通道索引号
  321. 返回值: ADC采样通道索引号
  322. 修改记录:
  323. */
  324. int equ_ac_channel_is_ok(u32 index)
  325. {
  326. // 检查参数
  327. if(index >= CFG_ADC_CHANNEL)
  328. {
  329. return 0;
  330. }
  331. // 板卡不能插拔,直接返回ok
  332. return 1;
  333. // return g_ac_slot_is_ok[index/EQU_SLOT_AC_CHN];
  334. }
  335. /******************************************************************************
  336. 函数名称: equ_get_ac_channel
  337. 函数版本: 01.01
  338. 创建作者: sunxi
  339. 创建日期: 2013-08-08
  340. 函数说明: 得到插槽中子板的模拟量通道对应的ADC采样通道。
  341. 参数说明:
  342. slot 插槽索引号
  343. index 子板上模拟量通道索引号
  344. 返回值: ADC采样通道索引号
  345. 修改记录:
  346. */
  347. int equ_get_ac_channel(u32 slot,u32 index)
  348. {
  349. // 检查参数
  350. if(slot != EQU_SLOT_KZ)
  351. {
  352. return -1;
  353. }
  354. if(index >= 16)
  355. {
  356. return -2;
  357. }
  358. return g_ac_index[g_brd_type_kz][index];
  359. }
  360. /******************************************************************************
  361. 函数名称: equ_get_ac_slot
  362. 函数版本: 01.01
  363. 创建作者: xxxxxx
  364. 创建日期: 2014-10-09
  365. 函数说明: 得到采样通道对应的板卡
  366. 参数说明:
  367. owner 归属公共、开关
  368. type 采样类型
  369. 返回值: ADC采样通道索引号
  370. 修改记录:
  371. */
  372. int equ_get_ac_slot(u32 owner, u32 type)
  373. {
  374. u32 no;
  375. if (owner)
  376. {
  377. no = g_sw[owner].ac_cfg_index[type];
  378. }
  379. else
  380. {
  381. no = g_sw_pub.ac_cfg_index[type];
  382. }
  383. return g_equ_config_ac[no].slot;
  384. }
  385. /******************************************************************************
  386. 函数名称: equ_ac_index_to_slot
  387. 函数版本: 01.01
  388. 创建作者: sunxi
  389. 创建日期: 2013-08-08
  390. 函数说明: 将采样板索引号(和ADC通道号对应)转换为插槽号。
  391. 参数说明:
  392. ac_index 采样板索引号
  393. 返回值: 插槽号
  394. 修改记录:
  395. */
  396. int equ_ac_index_to_slot(int ac_index)
  397. {
  398. if((u32)ac_index >= EQU_SLOT_AC_NUM)
  399. {
  400. return 0;
  401. }
  402. return g_ac_index_to_slot[ac_index];
  403. }
  404. /******************************************************************************
  405. 函数名称: equ_slot_config_do
  406. 函数版本: 01.01
  407. 创建作者: sunxi
  408. 创建日期: 2013-08-08
  409. 函数说明: 配置子板上的开出资源
  410. 参数说明:
  411. slot 插槽索引号
  412. 返回值: 插槽号
  413. 0: 成功
  414. 其它: 失败
  415. 修改记录:
  416. */
  417. int equ_get_do_channel(u32 index)
  418. {
  419. return g_do_index[g_brd_type_kz][index];
  420. }
  421. /******************************************************************************
  422. 函数名称: equ_slot_config_di
  423. 函数版本: 01.01
  424. 创建作者: xxxxxx
  425. 创建日期: 2014-04-08
  426. 函数说明: 配置子板上的开入资源
  427. 参数说明:
  428. slot 插槽索引号
  429. 返回值: 插槽号
  430. 0: 成功
  431. 其它: 失败
  432. 修改记录:
  433. */
  434. /*------------------------------ 内部函数 -------------------------------------
  435. 内部函数以下划线‘_’开头,不需要检查参数的合法性.
  436. */
  437. /*------------------------------ 测试函数 -------------------------------------
  438. 一个实体文件必须带一个本模块的测试函数来进行单元测试,如果的确不方便在本模块中
  439. 进行单元测试,必须在此注明实际的测试位置(例如在哪个实体文件中使用哪个测试函数).
  440. */
  441. /*------------------------------ 文件结束 -------------------------------------
  442. */