/****************************************************************************** 版权所有： 文件名称： dido.c 文件版本： 01.01 创建作者: sunxi 创建日期： 2013-02-28 功能说明： 开入开出 其它说明： // 启动继电器 1、启动继电器可以重复多次启动，每次启动都将重新计算超时时间。 2、启动继电器有2种关闭方式: 1) 超时自动关闭，超时时间为装置参数的遥控超时时间。 2) 通过函数调用关闭。 3、有保护启动标志时，选择继电器不允许关闭。 4、需提供启动继电器的超时设置函数. 5、只所以采用超时自动关闭，是因为以前的程序关闭方式存在问题，可能由于资源竞争的关系， 导致不该关闭时却关闭了，虽然概率很小，但理论上存在。 修改记录： */ /*------------------------------- 头文件 -------------------------------------- */ #include "head.h" #include "gpio.h" #include "ad7616.h" /*------------------------------- 宏定义 -------------------------------------- */ #define DO_PWM_SW_HZ 0 #define DO_PWM_SW_QD 1 #define DO_PWM_SW_NULL 2 #define DO_PWM_SW_FZ 3 #define DO_QD_KC DO_OUT4 /*------------------------------ 类型结构 ------------------------------------- */ /*------------------------------ 全局变量 ------------------------------------- */ struct di g_di[EQU_SLOT_NUM_MAX]; struct _do g_do[EQU_SLOT_NUM_MAX]; struct di_struct g_di_st[EQU_SLOT_NUM_MAX][DIDO_MAX_DI_PER_SLOT]; struct do_struct g_do_st[DO_NUM]; u16 g_do_status; // 开出状态，因为仅主板有开出 u32 g_do_start_time; int g_do_flag; extern u32 g_brd_type_kz; struct rt_stat g_stat_di_delay; struct rt_stat g_stat_do_delay; static u32 di_error_count = 0; static u32 error_count = 0; struct do_time g_do_time[EQU_SLOT_NUM_MAX]; /*------------------------------ 函数声明 ------------------------------------- */ static int _dido_do(u32 slot, u16 v, int is_on); static int _get_di(int slot, u16 di_num, u32 di, struct timespec ts); static inline void _io_do_status_update(int on, unsigned int i); unsigned int change_di_ch(unsigned int di); /*------------------------------ 外部函数 ------------------------------------- 外部函数供其它实体文件引用，必须仔细检查传入参数的合法性. */ /****************************************************************************** 函数名称： dido_init 函数版本： 01.01 创建作者： 创建日期： 2013-03-13 函数说明： 开入开出初始化 参数说明： 无 返回值： 无 修改记录： */ void dido_init_di(void) { u32 i, slot; u32 di0, di, di_num; di0 = gpio_get_di(); // 主板 slot = EQU_SLOT_KZ; di = (di0 & 0x7FFFF); g_di[slot].value[0] = di ^ g_di[slot].inv[0]; di_num = equ_get_di_num(slot); for (i = 0; i < di_num; i++) { if (di & (1 << i)) { g_di_st[slot][i].b_on = 1; } else { g_di_st[slot][i].b_on = 0; } if (g_di[slot].value[0] & (1 << i)) { sw_di_set(g_di_st[slot][i].owner, g_di_st[slot][i].type, SW_DI_TYPE_ON); g_di[slot].ts_v[i][g_di[slot].ts_i[i].n] = 1; } g_di[slot].ts_t[i][g_di[slot].ts_i[i].n] = 0; g_di[slot].ts_i[i].n++; } } int dido_init(void) { u32 i; // 检查装置配置 if (equ_config_null()) { return -1; } // 初始化取反标志 for (i = 0; i < g_equ_config->di_num; i++) { if (g_equ_config_di[i].is_Inverse == 0) { continue; } if (g_equ_config_di[i].slot < EQU_SLOT_NUM_MAX && g_equ_config_di[i].index < DIDO_MAX_DI_PER_SLOT) { if (g_equ_config_di[i].index < 32) { g_di[g_equ_config_di[i].slot].inv[0] |= 1 << g_equ_config_di[i].index; } else { g_di[g_equ_config_di[i].slot].inv[1] |= 1 << (g_equ_config_di[i].index - 32); } } } dido_init_di(); dido_stat_reset(); return 0; } // 只有分合闸有选择启动继电器 int dido_do_have_select(u32 slot, u32 index) { int i = 0; i = equ_get_do_channel(index); if (i == DO_OUT0 || i == DO_OUT1 || i == DO_OUT5 || i == DO_OUT6) { return 1; } return 0; } /****************************************************************************** 函数名称： dido_do 函数版本： 01.01 创建作者： 创建日期： 2013-03-13 函数说明： 板卡开出动作 参数说明： 无 返回值： 修改记录： */ int dido_do(u32 slot, u16 v, int is_on) { // unsigned long flags; // 检查DO资源 if (equ_get_do_num(slot) == 0) { return -2; } // 保存输出值，在5ms中断中输出 rt_irq_save(flags); g_do_flag = 1; if (is_on) { g_do[slot].on |= v; } else { g_do[slot].off |= v; } rt_irq_restore(flags); return 0; } /****************************************************************************** 函数名称： do_kout_check 函数版本： 创建作者： 创建日期： 2013-03-13 函数说明： 开出反校。 参数说明： 无 返回值： 结果 修改记录： */ void io_do_check(void) { u16 now, fj; u32 us; #ifdef DO_KOUT_CHECK u8 index; // 取返校值，必须在下面时间点检查之 index = g_equ_config_di[g_sw[0].di_cfg_index[SW_DI_KOCHK]].index; fj = gpio_di_fj(index) & 0x01; // 0x02; // 返回值只判断启动、分闸、合闸 now = 0; if (g_do_status & (1 << DO_QD_KC)) // 预置反校DO_PWM_SW_QD { now |= 0x01; } // if(g_do_status &((1< g_do_st[i].us_keep) && (g_do_st[i].us_keep > 0)) { dido_do_kz(0, i); } } } } /****************************************************************************** 函数名称： dido_do_poll 函数版本： 01.01 创建作者： 创建日期： 2013-03-13 函数说明： 是否开出巡检 参数说明： 无 返回值： 无 修改记录： */ void dido_do_poll(void) { #if 1 int i; // 真正开出 if (g_do_flag) { g_do_flag = 0; for (i = 0; i < EQU_SLOT_NUM_MAX; i++) { if (g_do[i].on) { _dido_do(i, g_do[i].on, 1); g_do[i].on = 0; } if (g_do[i].off) { _dido_do(i, g_do[i].off, 0); g_do[i].off = 0; } } } // 开出返回 io_do_return(); // 开出返校 if (g_board_info[EQU_SLOT_KZ].do_num != 0) { #ifdef DO_KOUT_CHECK if ((short)g_sw[0].di_cfg_index[SW_DI_KOCHK] != INDEX_INVALLID) { io_do_check(); } #else // io_do_check(); #endif } return; #endif } /****************************************************************************** 函数名称： dido_qd_set_keeptime 函数版本： 01.01 创建作者: sunxi 创建日期： 2013-06-10 函数说明： 设置启动继电器的保持时间 参数说明： 无 返回值： 无 修改记录： */ void dido_qd_set_keeptime(u32 us) { g_do_st[DO_QD_KC].us_keep = us; } /****************************************************************************** 函数名称： get_di 函数版本： 01.01 创建作者： 创建日期： 2013-03-13 函数说明： 开入防抖处理 参数说明： 无 返回值： 无 修改记录： */ // unsigned int di_val; void dido_di_poll(SHM_SAMPLE_T *sample_data) { u32 di, di_num, slot; u64 us0; // 如果交流延时失电信号有，闭锁遥信 if (pRunSet->dSDYX_T && g_run_stu.dcjlsd_t) { return; } us0 = ustimer_get_origin(); // 主板,19个遥信 slot = EQU_SLOT_KZ; di_num = equ_get_di_num(slot); // di = gpio_get_di(); di = change_di_ch(~sample_data->yx_buf[0]); rt_printf("gpio_get_di:yx_buf[0]=%x di=%x\r\n", sample_data->yx_buf[0], di); _get_di(slot, di_num, di, sample_data->ts); rt_stat_other_in(6, ustimer_get_duration(us0)); } /****************************************************************************** 函数名称： dido_di_is_on 函数版本： 01.01 创建作者： 创建日期： 2013-03-13 函数说明： 开入状态 参数说明： 无 返回值： 1:有开入，0:无开入 修改记录： */ int dido_di_is_on(u8 slot, u8 index) { if (slot >= EQU_SLOT_NUM_MAX || index >= 64) { return 0; } if (index < 32) { if (g_di[slot].value[0] & (1 << index)) { return 1; } } else { index -= 32; if (g_di[slot].value[1] & (1 << index)) { return 1; } } return 0; } // 查看某个时间点下的开入值 int dido_di_is_on_ts(u8 slot, u8 index, u32 ts) { int i, r; struct ts_index ts_i; if (slot >= EQU_SLOT_NUM_MAX || index >= 32) { return 0; } #if 0 { static int cnt = 0; if(cnt++ < 16) rt_printf("slot=%d,index=%d,ts=%d.\r\n",slot,index,ts); } #endif ts_i.n = g_di[slot].ts_i[index].n - 1; // ts_i下是无值的，所以应该减1 for (i = 0; i < DIDO_TS_NUM; i++) { r = (int)(ts - g_di[slot].ts_t[index][ts_i.n]); if (r >= 0) { return g_di[slot].ts_v[index][ts_i.n]; } ts_i.n--; } if (g_di[slot].value[0] & (1 << index)) { return 1; } return 0; } int dido_do_kz(int on, unsigned int i) { if (on) // 开出，需启动启动继电器打开电源 { if (i == DO_OUT0 || i == DO_OUT1 || i == DO_OUT5 || i == DO_OUT6) { gpio_kout_do(on, DO_QD_KC - DO_OUT0); // 对应X4端子的DO0~DO7 _io_do_status_update(1, DO_QD_KC); } } // if(i<=DO_PWM3) // { // gpio_pwm_do(on, i); // 对应X3端子的OUT3,分闸 // _io_do_status_update(on,i); // } // else if (i == DO_QD_KC) // 启动继电器出口 { if (!on) { if (g_tRelay[0].zqd) // 如果保护启动，禁止关闭启动继电器 { return -2; } if (g_do_status & (~(1 << DO_QD_KC))) // 有其他开出，不收启动继电器 { return -3; } } gpio_kout_do(on, i - DO_OUT0); // 对应X4端子的DO0~DO7 _io_do_status_update(on, i); } else if ((i >= DO_OUT0) && (i <= DO_OUT7)) { gpio_kout_do(on, i - DO_OUT0); // 对应X4端子的DO0~DO7 _io_do_status_update(on, i); } else { rt_printf("dido_do_kz err(on=%d,i=%d).\r\n", on, i); } return 0; } /*------------------------------ 内部函数 ------------------------------------- 内部函数以下划线‘_’开头，不需要检查参数的合法性. */ static inline void _io_do_status_update(int on, unsigned int i) { if (on) { g_do_status |= (1 << i); g_do_st[i].us_on = ustimer_get_origin(); } else { g_do_status &= ~(1 << i); } // 更新返校检查时间 g_do_start_time = ustimer_get_origin(); } static int _dido_do(u32 slot, u16 v, int is_on) { int i; // 循环检查开出位 for (i = 0; i < g_board_info[slot].do_num; i++) { // 如果对应开出位有效，开出。 if (((v >> i) & 0x1)) { dido_do_kz(is_on, equ_get_do_channel(i)); } } if (((v >> g_board_info[slot].do_num) & 0x1)) // 启动继电器 { dido_do_kz(is_on, DO_QD_KC); } return 0; } /****************************************************************************** 函数名称： _get_di 函数版本： 01.01 创建作者： 创建日期： 2013-03-13 函数说明： 开入防抖处理 参数说明： 无 返回值： 修改记录： */ #ifdef CN_AREA_GUANGXI // 遥信全部为0 u32 kktime_0 = 0; #endif static int _get_di(int slot, u16 di_num, u32 di, struct timespec ts) { int i, b_on; struct rtc_time_t ct; uint32 diff_nsec; // struct timespec ts; #if 0 // #ifdef CN_AREA_GUANGXI//遥信全部为0,则关闭屏幕或者关机 if(di==0) { kktime_0++; if(kktime_0 > 10) { #if 1 g_run_stu.yxError=true; //遥信错误，关闭屏幕 #else char *argv[] = {"poweroff", NULL}; char *envp[] = { NULL }; call_usermodehelper(argv[0], argv, envp, UMH_WAIT_PROC);//关机 #endif return 0; } } else { g_run_stu.yxError=0; kktime_0=0; } #endif // 获取遥信值，并记录时间戳。 // 用秒的低8位和纳秒的高24位合成32位时间戳 // clk_time_get(&ts); // 循环处理每一个遥信 for (i = 0; i < di_num; i++) { struct di_struct *pt = &g_di_st[slot][i]; // 处理当前变位遥信。 b_on = (di & (1 << i)) ? 1 : 0; if (b_on ^ pt->b_on) { if (!pt->b_first_change) { pt->b_first_change = true; pt->tm_back = 0; pt->tm_keep = 0; // 记录变位的起始时刻点 pt->ts_di = ts; pt->dt = g_adc_dots_data_count; #ifdef DIDO_TS_MODE pt->ts_tmp = ts; #endif } else { // 累计保持时间 #ifdef DIDO_TS_MODE if (ts.tv_nsec >= pt->ts_tmp.tv_nsec) { diff_nsec = ts.tv_nsec - pt->ts_tmp.tv_nsec; } else { diff_nsec = 1000000000ul - pt->ts_tmp.tv_nsec + ts.tv_nsec; } if (diff_nsec > 312500ul) { diff_nsec = 156250ul; } pt->acc_nsec += diff_nsec; while (pt->acc_nsec >= 156250ul) { pt->tm_keep++; pt->acc_nsec -= 156250ul; } pt->ts_tmp = ts; // rt_printf("diff_nsec:%d, pt->tm_keep:%d\r\n", diff_nsec, pt->tm_keep); #else pt->tm_keep++; #endif pt->tm_back = 0; // 现在返回门限是0.5us，所有必须在此清零。 // 保持时间到，处理变位 if (pt->tm_keep > pt->tm_filter) { // 记录遥信状态 #if defined CN_AREA_GUANGXI || defined YX_DI_ERROR // 广西遥信异常后，遥信屏蔽不保存，不上报 if (g_run_stu.yxEnable == 0 && b_on == 0) { pt->type = SOE_TYPE_TST; pt->b_first_change = false; pt->tm_back = 0; pt->tm_keep = 0; return 0; } #endif pt->b_on = b_on; if (g_di[slot].inv[0] & (1 << i)) { b_on = !b_on; } if (b_on) { g_di[slot].value[0] |= (1 << i); } else { g_di[slot].value[0] &= ~(1 << i); } // 记录SOE soe_record_yx((WORD)(i + (slot << 8)), b_on, &pt->ts_di); timespec_to_rtc(ts, &ct, 1); rt_printf("di=%x value[0]=%x\r\n", di, g_di[slot].value[0]); // 更新逻辑模型中的值 sw_di_set(g_di_st[slot][i].owner, g_di_st[slot][i].type, b_on ? SW_DI_TYPE_ON : SW_DI_TYPE_OFF); // 更新记录 g_di[slot].ts_t[i][g_di[slot].ts_i[i].n] = pt->dt; g_di[slot].ts_v[i][g_di[slot].ts_i[i].n] = b_on; g_di[slot].ts_i[i].n++; // 滤波处理数据复位 pt->b_first_change = false; pt->tm_back = 0; pt->tm_keep = 0; } } } else if (pt->b_first_change) { // 变位返回处理 pt->tm_back++; // 屏蔽下一行， // 最新逻辑，有效电平不连续可计数累加； // 无效电平连续超0.5ms复归，且不连续累加。 // pt->tm_keep=0; // if(pt->tm_back > pt->tm_filter) if (pt->tm_back > 4) // 针对高频振荡波测试优化，返回门限设置为500us附件(4*156=624us)。 { pt->tm_back = 0; pt->tm_keep = 0; pt->b_first_change = false; } } } return 0; } #if (0) /* TODO 获取开入量 */ int dido_di_update(uint32_t _value_new, uint8_t _index, struct timespec *ts) { static uint8_t init_flag = 0; uint32_t dt; int i, j, is_on; if (init_flag == 0) { init_flag = 1; // DI数量未超32个，只用第一个元素就够了 g_di[g_di_slot].value[0] = _value_new; // 更新逻辑模型中的值 for (i = 0; i < DIDO_MAX_DI_PER_SLOT; i++) { is_on = (g_di[g_di_slot].value[0] & (1 << i)) ? 1 : 0; sw_di_set(g_di_st[g_di_slot][i].owner, g_di_st[g_di_slot][i].type, is_on ? SW_DI_TYPE_ON : SW_DI_TYPE_OFF); // 双点的值也需要重新初始化 plc_db_init_value(g_di_slot, i, is_on); // 遥信时标 g_di[g_di_slot].ts_t[i][g_di[g_di_slot].ts_i[i].n] = 0; g_di[g_di_slot].ts_v[i][g_di[g_di_slot].ts_i[i].n] = is_on; g_di[g_di_slot].ts_i[i].n++; } g_di[g_di_slot].bInited = RT_TRUE; return 0; } if (_value_new == 1) g_di[g_di_slot].value[0] |= _value_new << _index; else g_di[g_di_slot].value[0] &= ~((_value_new ^ 1) << _index); // clock_gettime(CLOCK_REALTIME, &ts); // 记录遥信变位 is_on = (g_di[g_di_slot].value[0] & (1 << _index)) ? 1 : 0; soe_record_yx(_index + (g_di_slot << 8), is_on, ts); // 更新逻辑模型中的值 sw_di_set(g_di_st[g_di_slot][_index].owner, g_di_st[g_di_slot][_index].type, (is_on) ? SW_DI_TYPE_ON : SW_DI_TYPE_OFF); // 更新记录 // TODO:原DTU此处更新采样点会关中断更新，但考虑到频繁关中断会影响采样，此处不关中断先观察 dt = g_adc_dots_count; g_di[g_di_slot].ts_t[_index][g_di[g_di_slot].ts_i[_index].n] = dt; g_di[g_di_slot].ts_v[_index][g_di[g_di_slot].ts_i[_index].n] = is_on; g_di[g_di_slot].ts_i[_index].n++; // rt_kprintf("板卡：%d,di[%d]:%d\r\n",g_di_slot,_index,is_on); //test_use } /** * @brief Get the shm didata object * @author lch (lch_work@foxmail.com) * @version 1.0 * @date 20251219 * @return * int * @retval none * * @warning none * @note none */ int get_shm_didata(void) { int l_read_ret = 0, l_cnt = 0; struct t_shmdata_di shm_data_di = {0}; l_read_ret = shm_packet_read_v2(SHM_ADDR_W_DI, sizeof(shm_data_di), (uint8_t *)&shm_data_di, sizeof(shm_data_di)); while (l_read_ret > 0) { if (++l_cnt > 5) break; usleep(300); } } #endif /*------------------------------ 测试函数 ------------------------------------- 一个实体文件必须带一个本模块的测试函数来进行单元测试，如果的确不方便在本模块中 进行单元测试，必须在此注明实际的测试位置（例如在哪个实体文件中使用哪个测试函数）. */ // SOE信号发生器控制全局变量 extern int g_soe_gen_state; // 状态，0停止，1初始化，2运行 extern int g_soe_gen_on_us; // 导通时间 extern int g_soe_gen_off_us; // 断开时间 extern int g_soe_gen_seq_us; // 通道序列间隔时间 #define SOE_GEN_NUM 8 u32 g_soe_gen_count; u32 g_soe_gen_us0[SOE_GEN_NUM]; u8 g_soe_gen_on[SOE_GEN_NUM]; void dido_soe_gen(void) { int i; if (g_soe_gen_state == 0) { return; } else if (g_soe_gen_state == 1) { pit_156us_period_set(78.125); g_soe_gen_count = 0; for (i = 0; i < SOE_GEN_NUM; i++) { g_soe_gen_us0[i] = g_soe_gen_seq_us * (i); g_soe_gen_on[i] = 0; g_soe_gen_state = 2; } } else if (dido_di_is_on(1, 0)) { for (i = 0; i < SOE_GEN_NUM; i++) { if (g_soe_gen_on[i] == 0) { if ((int)(g_soe_gen_count - g_soe_gen_us0[i]) >= g_soe_gen_off_us) { g_soe_gen_on[i] = 1; gpio_kout_do(1, i); g_soe_gen_us0[i] = g_soe_gen_count; } } else { if ((int)(g_soe_gen_count - g_soe_gen_us0[i]) >= g_soe_gen_on_us) { g_soe_gen_on[i] = 0; gpio_kout_do(0, i); g_soe_gen_us0[i] = g_soe_gen_count; } } } } else { g_soe_gen_count = 0; for (i = 0; i < SOE_GEN_NUM; i++) { g_soe_gen_us0[i] = g_soe_gen_seq_us * (i); g_soe_gen_on[i] = 0; g_soe_gen_state = 2; } } g_soe_gen_count++; } int dido_printf(void) { int i, slot, index; struct ts_index ts_i; rt_printf("槽号\t值\r\n"); for (i = 0; i < EQU_SLOT_NUM_MAX; i++) // xj 2015-5-4 { rt_printf("%02d:\tvalue=0x%08lx_%08lx,inv=0x%08lx_%08lx\r\n", i, g_di[i].value[1], g_di[i].value[0], g_di[i].inv[1], g_di[i].inv[0]); } rt_printf("\r\n"); slot = EQU_SLOT_MAIN; index = 1; ts_i.n = g_di[slot].ts_i[index].n; rt_printf("开入时间戳记录:slot=%d,index=%d,ts_i=%d.\r\n", slot, index, ts_i.n); rt_printf("序号\t值\t时间戳\r\n"); ts_i.n = 0; for (i = 0; i < DIDO_TS_NUM; i++) { rt_printf("%02d\t%d\t%08lu\r\n", ts_i.n, g_di[slot].ts_v[index][ts_i.n], g_di[slot].ts_t[index][ts_i.n]); ts_i.n++; } rt_printf("开出状态:0x%04x\r\n\r\n", g_do_status); rt_stat_printf(&g_stat_di_delay); rt_stat_printf(&g_stat_do_delay); return 0; } int dido_stat_reset(void) { rt_stat_init(&g_stat_di_delay, "di_delay"); rt_stat_init(&g_stat_do_delay, "do_delay"); return 0; } int dido_single_test(u8 slot, u8 point) { dido_do(slot, (1 << point), 1); ustimer_delay(250 * USTIMER_MS); dido_do(slot, (1 << point), 0); return 0; } int dido_test(void) { static unsigned long us0 = 0; static char dido_test_pair[3][2] = { {1, 3}, {2, 4}, {5, 5}, }; static char dido_test_di[32] = { 0, 1, 2, 3, 0, 1, 2, 3, 4, 5, 6, 7, 4, 5, 6, 7, 8, 9, 10, 11, 8, 9, 10, 11, 12, 13, 10, 11, 12, 13, 12, 13}; int i, j, k, err_once, di_num; u32 slot_di, slot_do; if (g_test_on == 0) { return 0; } // 5秒处理一次 if (ustimer_delay_origin2(&us0, 10 * USTIMER_SEC) != 1) { return 0; } rt_printf("dido_test begin...\r\n"); ustimer_delay(1 * USTIMER_SEC); #if 1 // 测试开出板、开入板 // 开出板逐一开出 rt_printf("dido_test single.\r\n"); err_once = 0; for (i = 0; i < 3; i++) { slot_do = dido_test_pair[i][0]; slot_di = dido_test_pair[i][1]; for (j = 0; j < equ_get_do_num(slot_do); j++) { dido_do(slot_do, (1 << j), 1); ustimer_delay(250 * USTIMER_MS); di_num = equ_get_di_num(slot_di); if (slot_di == equ_get_slot_by_type(BOARD_TYPE_AUX)) { di_num -= 1; } for (k = 0; k < di_num; k++) { // 是否对应的开出点 if (dido_test_di[k] == j) { if ((g_di[slot_di].value[0] & (1 << k)) == 0) { err_once++; error_count++; rt_printf("dido_test on err(err=%d):i=%d,j=%d,k=%d,di=0x%08lx.\r\n", err_once, i, j, k, g_di[slot_di].value[0]); } } else { if ((g_di[slot_di].value[0] & (1 << k)) != 0) { err_once++; error_count++; rt_printf("dido_test off err(err=%d):i=%d,j=%d,k=%d,di=0x%08lx.\r\n", err_once, i, j, k, g_di[slot_di].value[0]); } } } dido_do(slot_do, (1 << j), 0); ustimer_delay(20 * USTIMER_MS); watchdog_feed_mainloop(); } } #endif rt_printf("\r\n开入变位时间超出次数:%lu\r\n", di_error_count); rt_printf("name\t\t\tmin\tmax\tavg\tsum\t\tcnt\n"); rt_stat_printf(&g_stat_di_delay); rt_printf("\r\n"); for (i = 0; i < EQU_SLOT_NUM_MAX; i++) { if (g_do_time[i].slot != 0) { rt_printf("do_time[%d]:diff_max=%lu,diff_out_count=%lu\r\n", g_do_time[i].slot, g_do_time[i].diff_max, g_do_time[i].diff_out_count); } } rt_printf("\r\n"); rt_printf("dido_test end:err_once=%d,error_count=%lu!\r\n\r\n\r\n", err_once, error_count); return 0; } bool check_board_di_valid(u8 slot, u8 index) { u32 i; // 初始化取反标志 index -= 1; for (i = 0; i < g_equ_config->di_num; i++) { if ((g_equ_config_di[i].slot == 1) && (g_equ_config_di[i].index == index)) { if (g_equ_config_di[i].type == 0) return true; } } return false; } bool check_board_kc6_close(u8 slot, u8 index) { u32 i; // 初始化取反标志 index -= 1; for (i = 0; i < g_equ_config->do_num; i++) { if ((g_equ_config_do[i].slot == slot) && (g_equ_config_do[i].index == index)) { if (g_equ_config_do[i].type != 0) return true; } } return false; } #define DIGROUP 4 #define V3_OUT_NUM 5 int dido_auto_test_for_v3(char *buf, int num) { // 12个开入,用5个开出进行测试 static char test_di[6][DIGROUP] = { {1, 6, 11, 0}, {2, 7, 12, 0}, {3, 8, 13, 0}, {4, 9, 14, 0}, {16, 0, 0, 0}, {5, 10, 15, 0}, }; int i, j, k, err_once, flag, flag1, di_num, do_num; u32 slot_di, slot_do, di_result; u8 tmp[5], tmp_data[5]; u8 di_ok[4] = {0}; u8 do_errflag = 0; char dido_test_pair[num][2]; unsigned long us_begin = 0; bool bkc6close = false; slot_do = 0; bkc6close = check_board_kc6_close(1, 6); dido_stat_reset(); if (bkc6close) { dido_do(slot_do, (1 << 5), 1); // 开出6若焊接为常闭输出，先开出，打开节点 ustimer_delay(100 * USTIMER_MS); } // 取出板卡槽位 for (i = 0; i < (num * 2);) { for (j = 0; j < 2; j++) { dido_test_pair[i / 2][j] = buf[i]; i++; } } flag = 0; flag1 = 0; memset(tmp, 0, sizeof(tmp)); memset(tmp_data, 0, sizeof(tmp_data)); memset(dido_buf, 0, sizeof(dido_buf)); rt_printf("dido_test begin...\r\n"); err_once = 0; // 以组为循环 for (i = 0; i < num; i++) { slot_do = dido_test_pair[i][0]; slot_di = dido_test_pair[i][1]; // 槽位暂存 dido_buf[i + i * 13] = slot_do; dido_buf[i + i * 13 + 5] = slot_di; // 取出对应槽位的板卡中DI和DO的数量 di_num = equ_get_di_num(slot_di); do_num = equ_get_do_num(slot_do); // dido_do(slot_do,(1<<5),1); //磁保持继电器 // 启动记时 us_begin = ustimer_get_origin(); // 逐一输出开出点 for (j = 0; j < V3_OUT_NUM; j++) { dido_do(slot_do, (1 << j), 1); if (j == 5 && bkc6close) { dido_do(slot_do, (1 << 5), 0); // 开出6若焊接为常闭输出，反操作为闭合 } ustimer_delay(150 * USTIMER_MS); memset(di_ok, 0, sizeof(di_ok)); do_errflag = DIGROUP; for (k = 0; k < 4; k++) { bool bIgnore = false; di_result = (g_di[slot_di].value[0] ^ g_di[slot_di].inv[0]); k += i * 2; if (test_di[j][k] == 17) { bIgnore = check_board_di_valid(slot_di, 17); } if (test_di[j][k] == 18) { bIgnore = check_board_di_valid(slot_di, 18); } if (!test_di[j][k] || bIgnore) { do_errflag--; } else { if (!(di_result & (1 << (test_di[j][k] - 1)))) // 对应开入无值 { do_errflag--; di_ok[k] = test_di[j][k]; } } } if (!do_errflag) // 开出对应的所有开入都没有值，即代表该开出有问题 { if (j < 8) { dido_buf[i + i * 13 + 1] |= (1 << j); // 开出错误标志 } else if (j < 16) { dido_buf[i + i * 13 + 2] |= (1 << (j - 8)); // 开出错误标志 } rt_printf("dido_test do err:i=%d,j=%d,di=%d,di_l=0x%04lx,di_h=0x%04lx.\r\n", i, j, di_ok[0], g_di[slot_di].value[0], g_di[slot_di].value[1]); } else { for (k = 0; k < 4; k++) { if (!di_ok[k]) continue; if ((di_ok[k] - 1) < 8) { dido_buf[i + i * 13 + 6] |= (1 << (di_ok[k] - 1)); } else if ((di_ok[k] - 1) < 16) { dido_buf[i + i * 13 + 7] |= (1 << (di_ok[k] - 1 - 8)); } else if ((di_ok[k] - 1) < 24) { dido_buf[i + i * 13 + 8] |= (1 << (di_ok[k] - 1 - 16)); } else if ((di_ok[k] - 1) < 32) { dido_buf[i + i * 13 + 9] |= (1 << (di_ok[k] - 1 - 24)); } else if ((di_ok[k] - 1) < 40) { dido_buf[i + i * 13 + 10] |= (1 << (di_ok[k] - 1 - 32)); } else if ((di_ok[k] - 1) < 48) { dido_buf[i + i * 13 + 11] |= (1 << (di_ok[k] - 1 - 40)); } else if ((di_ok[k] - 1) < 56) { dido_buf[i + i * 13 + 12] |= (1 << (di_ok[k] - 1 - 48)); } else if ((di_ok[k] - 1) < 64) { dido_buf[i + i * 13 + 13] |= (1 << (di_ok[k] - 1 - 56)); } rt_printf("dido_test di err:i=%d,j=%d,di=%d,di_l=0x%04lx,di_h=0x%04lx.\r\n", i, j, di_ok[k], g_di[slot_di].value[0], g_di[slot_di].value[1]); } } dido_do(slot_do, (1 << j), 0); if (j == 5 && bkc6close) { dido_do(slot_do, (1 << 5), 1); // 开出6若焊接为常闭输出，反操作为闭合 } // if(j==4) //{ // dido_do(slot_do,(1<<5),1); //磁保持继电器 //} ustimer_delay(20 * USTIMER_MS); watchdog_feed_mainloop(); } } for (i = 0; i < EQU_SLOT_NUM_MAX; i++) { if (g_do_time[i].slot != 0) { rt_printf("do_time[%d]:diff_max=%lu,diff_out_count=%lu\r\n", g_do_time[i].slot, g_do_time[i].diff_max, g_do_time[i].diff_out_count); } } rt_printf("dido_test end:err_once=%d,error_count=%lu!\r\n\r\n\r\n", err_once, error_count); return 0; } int dido_auto_test(char *buf, int num) { #define KC_COUNT 11 // 12个开入,用5个开出进行测试 #if 0 static char test_di[6][DIGROUP] = { {1, 6, 11,0}, {2, 7, 12,0}, {3, 8, 13,0}, {4, 9, 14,0}, {16, 0, 0,0}, {5, 10, 15,0}, }; #endif static char test_di[KC_COUNT][DIGROUP] = { {1, 12, 23, 0}, {2, 13, 24, 0}, {3, 14, 0, 0}, {4, 15, 0, 0}, {5, 16, 0, 0}, {6, 17, 0, 0}, {7, 18, 0, 0}, {8, 19, 0, 0}, {9, 20, 0, 0}, {10, 21, 0, 0}, {11, 22, 0, 0}, // { 0, 0, 0,0} }; u8 brd_v3[] = {22, 23}; int i, j, k, err_once, flag, flag1, di_num, do_num; u32 slot_di, slot_do, di_result; u8 tmp[5], tmp_data[5]; u8 di_ok[4] = {0}; u8 do_errflag = 0; char dido_test_pair[num][2]; unsigned long us_begin = 0; bool bkc6close = false; rt_printf("g_brd_type_kz = %lu\r\n ", g_brd_type_kz); rt_printf("g_equ_config->do_num = %lu\r\n ", g_equ_config->do_num); for (i = 0; i < (int)sizeof(brd_v3); i++) { if (g_brd_type_kz + BOARD_TYPE_DFTU_KC00 == brd_v3[i]) // { rt_printf("auto_test_for_v3\r\n "); return (dido_auto_test_for_v3(buf, num)); } } rt_printf("auto_test_for_v4\r\n "); // bkc6close=check_board_kc6_close(1,6); dido_stat_reset(); if (bkc6close) { dido_do(1, (1 << 5), 1); // 开出6若焊接为常闭输出，先开出，打开节点 ustimer_delay(100 * USTIMER_MS); } // 取出板卡槽位 for (i = 0; i < (num * 2);) { for (j = 0; j < 2; j++) { dido_test_pair[i / 2][j] = buf[i]; i++; } } flag = 0; flag1 = 0; memset(tmp, 0, sizeof(tmp)); memset(tmp_data, 0, sizeof(tmp_data)); memset(dido_buf, 0, sizeof(dido_buf)); rt_printf("dido_test begin...\r\n"); err_once = 0; // 以组为循环 for (i = 0; i < num; i++) { slot_do = dido_test_pair[i][0]; slot_di = dido_test_pair[i][1]; // 槽位暂存 dido_buf[i + i * 13] = slot_do; dido_buf[i + i * 13 + 5] = slot_di; // 取出对应槽位的板卡中DI和DO的数量 di_num = equ_get_di_num(slot_di); do_num = equ_get_do_num(slot_do); // dido_do(slot_do,(1<<5),1); //磁保持继电器 // 启动记时 us_begin = ustimer_get_origin(); // 逐一输出开出点 for (j = 0; j < KC_COUNT; j++) { dido_do(slot_do, (1 << j), 1); if (j == 5 && bkc6close) { dido_do(slot_do, (1 << 5), 0); // 开出6若焊接为常闭输出，反操作为闭合 } ustimer_delay(150 * USTIMER_MS); memset(di_ok, 0, sizeof(di_ok)); do_errflag = DIGROUP; for (k = 0; k < 4; k++) { bool bIgnore = false; di_result = (g_di[slot_di].value[0] ^ g_di[slot_di].inv[0]); k += i * 2; if (test_di[j][k] == 17) { bIgnore = check_board_di_valid(slot_di, 17); } if (test_di[j][k] == 18) { bIgnore = check_board_di_valid(slot_di, 18); } if (!test_di[j][k] || bIgnore) { do_errflag--; } else { if (!(di_result & (1 << (test_di[j][k] - 1)))) // 对应开入无值 { do_errflag--; di_ok[k] = test_di[j][k]; } } } if (!do_errflag) // 开出对应的所有开入都没有值，即代表该开出有问题 { if (j < 8) { dido_buf[i + i * 13 + 1] |= (1 << j); // 开出错误标志 } else if (j < 16) { dido_buf[i + i * 13 + 2] |= (1 << (j - 8)); // 开出错误标志 } rt_printf("dido_test do err:i=%d,j=%d,di=%d,di_l=0x%04lx,di_h=0x%04lx.\r\n", i, j, di_ok[0], g_di[slot_di].value[0], g_di[slot_di].value[1]); } else { for (k = 0; k < 4; k++) { if (!di_ok[k]) continue; if ((di_ok[k] - 1) < 8) { dido_buf[i + i * 13 + 6] |= (1 << (di_ok[k] - 1)); } else if ((di_ok[k] - 1) < 16) { dido_buf[i + i * 13 + 7] |= (1 << (di_ok[k] - 1 - 8)); } else if ((di_ok[k] - 1) < 24) { dido_buf[i + i * 13 + 8] |= (1 << (di_ok[k] - 1 - 16)); } else if ((di_ok[k] - 1) < 32) { dido_buf[i + i * 13 + 9] |= (1 << (di_ok[k] - 1 - 24)); } else if ((di_ok[k] - 1) < 40) { dido_buf[i + i * 13 + 10] |= (1 << (di_ok[k] - 1 - 32)); } else if ((di_ok[k] - 1) < 48) { dido_buf[i + i * 13 + 11] |= (1 << (di_ok[k] - 1 - 40)); } else if ((di_ok[k] - 1) < 56) { dido_buf[i + i * 13 + 12] |= (1 << (di_ok[k] - 1 - 48)); } else if ((di_ok[k] - 1) < 64) { dido_buf[i + i * 13 + 13] |= (1 << (di_ok[k] - 1 - 56)); } rt_printf("dido_test di err:i=%d,j=%d,di=%d,di_l=0x%04lx,di_h=0x%04lx.\r\n", i, j, di_ok[k], g_di[slot_di].value[0], g_di[slot_di].value[1]); } } dido_do(slot_do, (1 << j), 0); if (j == 5 && bkc6close) { dido_do(slot_do, (1 << 5), 1); // 开出6若焊接为常闭输出，反操作为闭合 } // if(j==4) //{ // dido_do(slot_do,(1<<5),1); //磁保持继电器 //} ustimer_delay(20 * USTIMER_MS); watchdog_feed_mainloop(); } } for (i = 0; i < EQU_SLOT_NUM_MAX; i++) { if (g_do_time[i].slot != 0) { rt_printf("do_time[%d]:diff_max=%lu,diff_out_count=%lu\r\n", g_do_time[i].slot, g_do_time[i].diff_max, g_do_time[i].diff_out_count); } } rt_printf("dido_test end:err_once=%d,error_count=%lu!\r\n\r\n\r\n", err_once, error_count); return 0; } /*------------------------------ 文件结束 ------------------------------------- */