|
|
@@ -258,53 +258,15 @@ int equ_config_do_yd(void)
|
|
|
|
|
|
int equ_init_later(void)
|
|
|
{
|
|
|
- u32 i;
|
|
|
- int ui,index;
|
|
|
-
|
|
|
- //TODO:need to check g_brd_type_kz how to work
|
|
|
- g_brd_type_kz = g_board_info[EQU_SLOT_KZ].type - BOARD_TYPE_DFTU_KC00;
|
|
|
- if(g_brd_type_kz >= BOARD_TYPE_KZ_NUM)
|
|
|
- {
|
|
|
- rt_printf("控制板类型错误(g_brd_type_kz=%lu).\r\n",g_brd_type_kz);
|
|
|
- g_brd_type_kz = 0;
|
|
|
- return -1;
|
|
|
- }
|
|
|
+ int i,ui;
|
|
|
+ struct equ_config_di *ecd;
|
|
|
|
|
|
- //通道取反,重新初始化一下,在equ.c中初始化过,但由于g_brd_type_kz未初始化,取反是错误的
|
|
|
- memset(g_equ_adc_inv,0,sizeof(g_equ_adc_inv));
|
|
|
- g_equ_adc_inv_num=0;
|
|
|
- memset(g_equ_adc_config,0,sizeof(g_equ_adc_config)); //jack.liu20200917 g_equ_adc_config初始化
|
|
|
- for(i=0; i<g_equ_config->ac_num; i++)
|
|
|
- {
|
|
|
- u32 adc;
|
|
|
- adc = equ_get_ac_channel(g_equ_config_ac[i].slot,g_equ_config_ac[i].index);
|
|
|
- if (adc<CFG_ADC_CHANNEL)
|
|
|
- {
|
|
|
- // 是否配置
|
|
|
- if(g_equ_config_ac[i].type)
|
|
|
- {
|
|
|
- g_equ_adc_config[adc] = 1;
|
|
|
- }
|
|
|
-
|
|
|
- // 是否取反
|
|
|
- if (g_equ_config_ac[i].is_ct_inverse)
|
|
|
- {
|
|
|
- g_equ_adc_inv[g_equ_adc_inv_num++] = adc;
|
|
|
+ // 采样板起始槽位
|
|
|
+ g_ac_slot_begin = EQU_SLOT_AC_BEGIN;
|
|
|
|
|
|
- }
|
|
|
- }
|
|
|
- }
|
|
|
-
|
|
|
- // 获取频率所对应的UI通道
|
|
|
- // 频率采样对应ADC通道为1.
|
|
|
- for(index=0;index<EQU_SLOT_AC_CHN;index++)
|
|
|
- {
|
|
|
- if(g_ac_index[g_brd_type_kz][index] == 1) // 频率0对应通道为 1
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- g_ui_freq[0] = UI_NUM;
|
|
|
+ // 检查频率硬件通道对应的UI。
|
|
|
+ g_ui_freq[0] = UI_NUM;
|
|
|
+ g_ui_freq[1] = UI_NUM;
|
|
|
for(i=0; i< g_equ_config->ac_num; i++)
|
|
|
{
|
|
|
// 频率通道必须是配置了的公共电压类型
|
|
|
@@ -312,53 +274,39 @@ int equ_init_later(void)
|
|
|
{
|
|
|
continue;
|
|
|
}
|
|
|
- ui = g_equ_config_ac[i].type -1;
|
|
|
- if(ui >= PUB_AC_NUM)
|
|
|
- {
|
|
|
- continue;
|
|
|
- }
|
|
|
-
|
|
|
- if(g_equ_config_ac[i].slot == EQU_SLOT_KZ && g_equ_config_ac[i].index == index)
|
|
|
- {
|
|
|
- g_ui_freq[0] = ui;
|
|
|
- }
|
|
|
- }
|
|
|
|
|
|
- // 获取频率所对应的UI通道
|
|
|
- // 频率1采样对应ADC通道为12.
|
|
|
- for(index=0;index<EQU_SLOT_AC_CHN;index++)
|
|
|
- {
|
|
|
- if(g_ac_index[g_brd_type_kz][index] == 7) // 频率1对应通道为 7
|
|
|
- {
|
|
|
- break;
|
|
|
- }
|
|
|
- }
|
|
|
- g_ui_freq[1] = UI_NUM;
|
|
|
- for(i=0; i< g_equ_config->ac_num; i++)
|
|
|
- {
|
|
|
- // 频率通道必须是配置了的公共电压类型
|
|
|
- if(g_equ_config_ac[i].type == 0 || g_equ_config_ac[i].owner != 0)
|
|
|
- {
|
|
|
- continue;
|
|
|
- }
|
|
|
ui = g_equ_config_ac[i].type -1;
|
|
|
if(ui >= PUB_AC_NUM)
|
|
|
{
|
|
|
continue;
|
|
|
}
|
|
|
|
|
|
- if(g_equ_config_ac[i].slot == EQU_SLOT_KZ && g_equ_config_ac[i].index == index)
|
|
|
+ // 确定频率对应电压通道
|
|
|
+ if(ui < PUB_AC_NUM)
|
|
|
{
|
|
|
- g_ui_freq[1] = ui;
|
|
|
- }
|
|
|
- }
|
|
|
+ if(g_equ_config_ac[i].slot == 9 && g_equ_config_ac[i].index == 0)
|
|
|
+ {
|
|
|
+ g_ui_freq[0] = ui;
|
|
|
+ }
|
|
|
|
|
|
- // 采样板起始槽位
|
|
|
- g_ac_slot_begin = EQU_SLOT_AC_BEGIN;
|
|
|
+ if(g_equ_config_ac[i].slot == 10 && g_equ_config_ac[i].index == 0)
|
|
|
+ {
|
|
|
+ g_ui_freq[1] = ui;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ }
|
|
|
|
|
|
- // 初始化开入开出
|
|
|
- equ_config_do();
|
|
|
- equ_config_di();
|
|
|
+ // 初始化开入g_di_st结构
|
|
|
+ memset((unsigned char*)g_di_st,0,sizeof(g_di_st));
|
|
|
+
|
|
|
+ ecd = g_equ_config_di;
|
|
|
+ for(i=0;i<g_equ_config->di_num;i++)
|
|
|
+ {
|
|
|
+ g_di_st[ecd->slot][ecd->index].tm_filter = ecd->filter_time;
|
|
|
+ g_di_st[ecd->slot][ecd->index].owner = ecd->owner;
|
|
|
+ g_di_st[ecd->slot][ecd->index].type = ecd->type;
|
|
|
+ ecd++;
|
|
|
+ }
|
|
|
|
|
|
return 0;
|
|
|
}
|