Files
checker_slave/source/elec_det/driver/history/EWDriver.c

1563 lines
35 KiB
C
Raw Normal View History

2023-10-31 18:12:21 +08:00
#include "EWDriver.h"
#include "base/delay.h"
#include "base/utility.h"
#include "hardware/gpio_cfg.h"
#include "base/utility.h"
#include "hardware/adc_cfg.h"
#include "hardware/power.h"
#include "ewdriver.h"
#include "hardware/timer_cfg.h"
#include "debug.h"
static volatile EWBus_Mod_en bus_mod = OFF_MOD;
static volatile CurrentSample_Range_eu buscurrent_range = Current_Max;
#define FB_Read_AD_Sample_C 30
#if FIREBUS_ADC_BUF_LEN < FB_Read_AD_Sample_C
#error "EWDriver ADC define error"
#endif
#define SMod_Read_Idle_Filter 90
#define DMod_Read_Idle_Filter 50
volatile uint16_t* EW_Read_AD_V = FireBus_ADC_Buf;
static volatile uint16_t SMod_Read_Idle_C;
static uint16_t firebus_idle_diff = SMod_Read_Idle_Filter;
const static uint16_t data2bit_signal[]={200,234,275,323,380,446};
volatile static uint16_t datapulus[6][2];
//发送起始信号
#define SMod_Begin_Plus() SMod_2Bit_Plus(4)
//发送结束信号
#define SMod_End_Plus() SMod_2Bit_Plus(5)
volatile uint8_t EW_CommBuf[EW_DMODE_FRAME_SIZE];
volatile uint16_t EW_DMOD_Peroid = 300;
volatile uint16_t EW_DMOD_READ_Timeout = 6000;
//发送唤醒信号
static void SMod_Wake_Plus(void)
{
EW_SINGLE_MOD_M;
delay_us(200);
EW_SINGLE_MOD_H;
delay_us(600);
}
//发送2Bit数据信号
static void SMod_2Bit_Plus(uint8_t data)
{
if(data > 5)
return;
EW_SINGLE_MOD_M;
delay_us(datapulus[data][0]);
EW_SINGLE_MOD_H;
delay_us(datapulus[data][1]);
}
//读取1bit数据
static uint8_t SMod_ReadBit(uint16_t wait_us)
{
uint32_t ul_temp = 0;
ADC_CurChnnelSet(AN_MAL_CH,ADC_SPEED_MIDLE);
EW_SINGLE_MOD_M;
delay_us(wait_us);
while(ul_temp < FB_Read_AD_Sample_C)
{
EW_Read_AD_V[ul_temp++] = ADC_GetCurADCFast();
}
EW_SINGLE_MOD_H;
Bubble_Sort_u16((uint16_t*)EW_Read_AD_V,FB_Read_AD_Sample_C);
ul_temp = EW_Read_AD_V[FB_Read_AD_Sample_C - 6];
ul_temp += EW_Read_AD_V[FB_Read_AD_Sample_C - 7];
ul_temp += EW_Read_AD_V[FB_Read_AD_Sample_C - 8];
ul_temp += EW_Read_AD_V[FB_Read_AD_Sample_C - 9];
ul_temp >>= 2;
if(ul_temp > SMod_Read_Idle_C)
{
LED1_Out_On;
return 1;
}
LED1_Out_Off;
return 0;
}
static uint8_t DMod_ReadBit(uint16_t wait_us)
{
uint32_t ul_temp = 0;
ADC_CurChnnelSet(AN_MAL_CH,ADC_SPEED_MIDLE);
EW_DIFF_MOD_M;
delay_us(wait_us);
while(ul_temp < FB_Read_AD_Sample_C)
{
EW_Read_AD_V[ul_temp++] = ADC_GetCurADCFast();
}
EW_DIFF_MOD_L;
Bubble_Sort_u16((uint16_t*)EW_Read_AD_V,FB_Read_AD_Sample_C);
ul_temp = EW_Read_AD_V[FB_Read_AD_Sample_C - 6];
ul_temp += EW_Read_AD_V[FB_Read_AD_Sample_C - 7];
ul_temp += EW_Read_AD_V[FB_Read_AD_Sample_C - 8];
ul_temp += EW_Read_AD_V[FB_Read_AD_Sample_C - 9];
ul_temp >>= 2;
if(ul_temp > SMod_Read_Idle_C)
{
LED1_Out_On ;
return 1;
}
LED1_Out_Off;
return 0;
}
/*
@brief ACK
@param 0.1ms
*/
static uint8_t DMod_ReadAck(uint16_t time_out)
{
uint32_t ul_temp = 0;
uint32_t ul_temp2 = 0;
uint16_t us_count = 0;
ul_temp = time_out*10;
ADC_CurChnnelSet(AN_MAL_CH,ADC_SPEED_MIDLE);
EW_DIFF_MOD_M;
Get10usCount();
while((ul_temp2 < ul_temp) && (us_count < 10))
{
if(ADC_GetCurADCFast() > SMod_Read_Idle_C)
{
us_count++;
}else{
us_count = 0;
}
ul_temp2 += Get10usCount();
}
if(us_count < 10)
{
EW_DIFF_MOD_H;
return 0;
}
delay_ms(20);
EW_DIFF_MOD_H
return 1;
}
//从AD采样缓存总计算空闲电流
static uint16_t FireBus_UpdataIdeV(void)
{
SMod_Read_Idle_C = 0;
SMod_Read_Idle_C = (uint32_t)(EW_Read_AD_V[FB_Read_AD_Sample_C - 6]);
SMod_Read_Idle_C += (uint32_t)(EW_Read_AD_V[FB_Read_AD_Sample_C - 7]*3);
SMod_Read_Idle_C += (uint32_t)(EW_Read_AD_V[FB_Read_AD_Sample_C - 8]*4);
SMod_Read_Idle_C += (uint32_t)(EW_Read_AD_V[FB_Read_AD_Sample_C - 9]*2);
SMod_Read_Idle_C /= 10;
SMod_Read_Idle_C += firebus_idle_diff;
return SMod_Read_Idle_C;
}
//采集空闲电流
static uint16_t SMod_GetIdleV(void)
{
firebus_idle_diff = SMod_Read_Idle_Filter;
SMod_ReadBit(80);//获取采样电流
return FireBus_UpdataIdeV();
}
static uint16_t DMod_GetIdleV(void)
{
firebus_idle_diff = DMod_Read_Idle_Filter;
DMod_ReadBit(300);//获取采样电流
return FireBus_UpdataIdeV();
}
static uint16_t SMod_GetIdle2V(void)
{
uint32_t ul_temp = 0;
firebus_idle_diff = SMod_Read_Idle_Filter;
while(ul_temp < FB_Read_AD_Sample_C)
{
EW_Read_AD_V[ul_temp++] = ADC_GetCurADCFast();
}
return FireBus_UpdataIdeV();
}
static uint16_t DMod_GetIdle2V(void)
{
uint32_t ul_temp = 0;
firebus_idle_diff = DMod_Read_Idle_Filter;
while(ul_temp < FB_Read_AD_Sample_C)
{
EW_Read_AD_V[ul_temp++] = ADC_GetCurADCFast();
}
return FireBus_UpdataIdeV();
}
//采集到应答信号返0 否则返1
static uint8_t SMod_WaitAck(uint16_t time_out)
{
while(time_out > 0)
{
time_out--;
if(SMod_ReadBit(80) > 0)
{
delay_us(350);
return 0;
}
delay_us(350);
}
return 1;
}
void EW_BusDef_Init(void)
{
uint16_t us_temp = 80;
uint8_t count = 0;
for(count = 0; count < 6;count++)
{
datapulus[count][0] = us_temp;
datapulus[count][1] = data2bit_signal[count] - us_temp-12;//-4为延时偏移实测。
}
}
/*
@brief 4Bytes
@param *buf 4
@param type
@param bg_count
@param end_count
*/
void SMod_FireBusSend4BytesFrame(uint8_t* buf,EW_SINGLE_FRAME_TYPE_en type ,uint8_t bg_count,uint8_t end_count)
{
uint8_t uc_plus_type[17];
uint8_t uc_data;
uint32_t ul_count1 = 0;
uint32_t ul_count2 = 0;
uc_plus_type[ul_count1++] = (uint8_t)type;
while(ul_count1 < 17)
{
ul_count2 = 0;
uc_data = *buf;
while(ul_count2 < 4)
{
uc_plus_type[ul_count1++] = (uc_data & 0xC0)>>6;
uc_data <<= 2;
ul_count2++;
}
buf++;
}
SMod_Wake_Plus();
/******************/
while(bg_count > 0)
{
bg_count --;
SMod_Begin_Plus();
}
for(ul_count1 = 0; ul_count1 < 17; ul_count1++)
{
SMod_2Bit_Plus(uc_plus_type[ul_count1]);
}
while(end_count > 0)
{
end_count --;
SMod_End_Plus();
}
}
/*
@brief
@param *buf
@param bg_count
@param end_count
*/
uint8_t SMod_SendData(uint8_t* buf, uint16_t len,uint8_t bg_count,uint8_t end_count)
{
uint16_t us_count = 0;
uint8_t* databuf = (uint8_t*)rt_malloc(len+4);
uint8_t crc = 0;
if(databuf == RT_NULL)
{
return 1;
}
len--;
rt_memcpy(databuf,buf,len);
while((len % 4) != 3)
{
databuf[len++] = 0;
}
databuf[len] = CheckXOR_8(databuf,len);
len++;
if(len == 4)
{
SMod_FireBusSend4BytesFrame(databuf,COMPLETE_FRAME,bg_count,end_count);
goto SMod_Data_Send_End;
}
SMod_FireBusSend4BytesFrame(databuf,BEGIN_FRAME,bg_count,end_count);
us_count += 4;
while(us_count < (len-4))
{
delay_ms(40);
SMod_FireBusSend4BytesFrame(databuf+us_count,DATA_FRAME,bg_count,end_count);
us_count += 4;
}
delay_ms(40);
SMod_FireBusSend4BytesFrame(databuf+us_count,END_FRAME,bg_count,end_count);
SMod_Data_Send_End:
rt_free(databuf);
return 0;
}
/*
@brief
@param *buf
@param len
@param time_out
*/
uint8_t SMod_FireBusReadDatas(uint8_t* buf, uint8_t len, uint16_t time_out)
{
uint32_t ul_temp = 0;
uint8_t uc_data;
CurrentSample_Range_eu range = buscurrent_range;//档位保存
Power_SetSampleCurrentRange(R10_2mA_30mA_MC);
ADC_CurChnnelSet(AN_MAL_CH,ADC_SPEED_MIDLE);
delay_ms(1);
//采集空闲电流
SMod_GetIdleV();
delay_us(350);
SMod_GetIdleV();
delay_us(350);
if(SMod_WaitAck(time_out) > 0)
{
Power_SetSampleCurrentRange(range);
return 1;
}
while(len > 0)
{
ul_temp = 0;
uc_data = 0;
len--;
while(ul_temp < 8)
{
uc_data <<= 1;
uc_data += SMod_ReadBit(80);
delay_us(500);
ul_temp++;
}
*buf = uc_data;
buf++;
}
Power_SetSampleCurrentRange(range);
return 0;
}
/*
@brief
@param count
@param buf
@rtv
*/
void FireBus_ReadInspect_Data(uint16_t count,uint8_t* buf)
{
uint16_t index;
uint8_t data;
CurrentSample_Range_eu range = buscurrent_range;//档位保存
Power_SetSampleCurrentRange(R10_2mA_30mA_MC);//采样电阻全开,快速放电
ADC_CurChnnelSet(AN_MAL_CH,ADC_SPEED_MIDLE);
//delay_us(500);
//总线跳转到中电平
EW_SINGLE_MOD_M;
//延时等待电流稳定
//COM_PH2_Out = 0;
delay_us(240);
//获取中电平电流
SMod_GetIdle2V();
EW_SINGLE_MOD_H
delay_us(700);
rt_memset(buf,0,((count+7 ) >> 3));
index = 0;
while(index < count)
{
data = *(buf+(index >> 3));
if( SMod_ReadBit(80) > 0)
{
data |= (0x01 << (index & 0x07));
};
EW_SINGLE_MOD_H
delay_us(800);
*(buf+(index >> 3)) = data;
index++;
}
Power_SetSampleCurrentRange(range);
}
/*************************************************************/
#define DMOD_READ_AD_FILTER_COUNT 4
static uint8_t SMod_FireBusReadPlus(uint16_t* plus_h, uint16_t* plus_t,uint16_t time_out,uint16_t ad_line,uint16_t* max_ad)
{
uint32_t ul_ad_sample;
uint32_t ul_index = 0;
uint16_t us_adc_buf[DMOD_READ_AD_FILTER_COUNT+1];
uint32_t ul_count = 0;
uint32_t uc_step = 0;
uint32_t ul_h_count = 0,ul_l_count = 0;
*max_ad = 0;
for(ul_count =0; ul_count < DMOD_READ_AD_FILTER_COUNT; ul_count++)
{
us_adc_buf[ul_count++] = ADC_GetCurADCFast();
}
//数据发送时,以高脉冲在先,然后是低电平,
do{
time_out--;
ul_ad_sample = ADC_GetCurADCFast();
if(ul_ad_sample > *max_ad)
*max_ad = ul_ad_sample;
// if(ul_ad_sample > ad_line)
// {
// PBout(I2IC_SCL_Pin_Nu) = 1 ;
// }else{
// PBout(I2IC_SCL_Pin_Nu) = 0;
// }
us_adc_buf[ul_count++] = ul_ad_sample;
ul_count %= DMOD_READ_AD_FILTER_COUNT;
ul_h_count = 0;
ul_l_count = 0;
for(ul_index =0; ul_index < DMOD_READ_AD_FILTER_COUNT; ul_index++)
{
if(us_adc_buf[ul_index] > ad_line)
{
ul_h_count++;
}else{
ul_l_count++;
}
}
if(uc_step == 0 && ul_h_count >(DMOD_READ_AD_FILTER_COUNT-1))//启动周期计数
{
(*plus_h)++;
(*plus_t)++;
uc_step = 1;
}else if(uc_step == 0){
continue;//未启动
}
if(uc_step == 1)
{
if(ul_h_count > (DMOD_READ_AD_FILTER_COUNT-1))
{
PBout(I2IC_SCL_Pin_Nu) = 1 ;
(*plus_h)++;
uc_step = 1;
}else if(ul_l_count > (DMOD_READ_AD_FILTER_COUNT-1)) //由高变低
{
PBout(I2IC_SCL_Pin_Nu) = 0;
uc_step = 2;
}
}
else if(uc_step == 2 && ul_h_count > (DMOD_READ_AD_FILTER_COUNT-1))//由低变高
{
PBout(I2IC_SCL_Pin_Nu) = 1 ;
break;
}
(*plus_t)++;
}while(time_out > 0);
if(time_out < 1)//等待起始信号超时
{
return 1;
}
return 0;
}
/*
@brief
@param *buf
@param len
@param time_out 1bit数据时间
@rtv 0
*/
static uint16_t us_plus_H,us_plus_H2;//高电平采用次数
static uint16_t us_plus_T,us_plus_T2;//采样周期
uint16_t idle_line = 0;
typedef struct{
uint16_t cur_idle;
uint16_t cur_idle_ad;
uint16_t cur_high_value;
uint16_t cur_idle_line;
uint16_t cur_max;
}firebus_def;
uint8_t DMod_FireBusReadDatasV2(uint8_t* buf, uint8_t len, uint32_t time_out)
{
uint32_t ul_ad_sample;
uint32_t ul_check_falg; //奇校验
uint32_t us_time_out = time_out;
uint32_t ul_data = 0;
uint32_t us_dataT_Or;//数据周期
uint32_t us_temp1,us_temp2;
uint16_t ad_max = 0,ad_max_temp = 0;
firebus_def fire_dat={0};
uint8_t ret=0;
CurrentSample_Range_eu range = buscurrent_range;//档位保存
Power_SetSampleCurrentRange(R10_2mA_30mA_MC);
ADC_CurChnnelSet(AN_MAL_CH,ADC_SPEED_HFAST);
delay_us(2000);
//总线跳转到中电平
EW_DIFF_MOD_M;
//延时等待电流稳定
delay_us(800);
//COM_PH2_Out = 0;
PBout(I2IC_SCL_Pin_Nu) = 0;
delay_us(200);
//获取中电平电流
PBout(I2IC_SCL_Pin_Nu) = 1 ;
DMod_GetIdle2V();
fire_dat.cur_idle=SMod_Read_Idle_C;
fire_dat.cur_idle_ad=ADC_GetCurADCFast();
PBout(I2IC_SCL_Pin_Nu) = 0 ;
//读取指定长度数据
//读取单字节数据
ul_data = 0;
//等待起始信号唤醒信号
us_plus_H = 0;
us_plus_T = 0;
us_time_out = 2000 + time_out;
do{
ul_ad_sample = ADC_GetCurADCFast();
if(ad_max < ul_ad_sample)
ad_max = ul_ad_sample;
if(ul_ad_sample > SMod_Read_Idle_C)
{
if(ul_ad_sample-SMod_Read_Idle_C>50){
us_plus_H++;
fire_dat.cur_high_value=fire_dat.cur_high_value/2+ul_ad_sample/2;
}else{
SMod_Read_Idle_C=ul_ad_sample;
}
}else{
us_plus_H = 0;
fire_dat.cur_high_value=0;
}
delay_us(2);
us_time_out--;
}
while((us_plus_H < 4) && (us_time_out > 0));
fire_dat.cur_max=ad_max;
if(us_time_out < 1)//等待起始信号超时
{
ret=1;
goto end;
}
// 空闲判线以最高电平为基准
SMod_Read_Idle_C=(SMod_Read_Idle_C+fire_dat.cur_high_value)/2;
fire_dat.cur_idle_line=SMod_Read_Idle_C;
while(len > 0)
{
//等待数据帧起始信号
us_time_out = 10;
us_plus_T2 = 0xFFFF;
us_plus_H2 = 0;
while(us_time_out > 0)
{
us_plus_H = 0;
us_plus_T = 0;
idle_line = SMod_Read_Idle_C;
// idle_line = ad_max - SMod_Read_Idle_C;
// idle_line = (idle_line>>1)+ (idle_line>>4)+ SMod_Read_Idle_C;
if(SMod_FireBusReadPlus(&us_plus_H,&us_plus_T,time_out,idle_line,&ad_max_temp ) > 0)
{
ret=2;
goto end;
}
if(us_plus_H2 > (us_plus_T2- us_plus_H2))
{
us_temp1 = us_plus_T << 1; //2倍
us_temp2 = us_plus_T + (us_plus_T >> 1);//1.5倍
if((us_plus_T2 > us_temp2) && (us_plus_T2 < us_temp1))
{
break;
}
}
us_plus_T2 = us_plus_T;
us_plus_H2 = us_plus_H;
us_time_out--;
}
//采集8bit数据+1位校验
ul_data = 0;
ul_check_falg = 0;
us_time_out = 0;
us_plus_T2 = 0;
us_dataT_Or = us_plus_T;//保存数据周期
do{
ul_data <<= 1;
if(us_plus_H > (us_plus_T- us_plus_H)) //高电平时间大于低电平 1
{
ul_data |= 0x01;
ul_check_falg ^= 0x01;
}else{//检测是否是结束信号 0
us_temp1 = us_plus_T2 << 1; //2倍
us_temp2 = us_plus_T2 + (us_plus_T2 >> 1);//1.5倍
if((us_plus_T > us_temp2) && (us_plus_T < us_temp1))
{
break;
}
}
//约束数据周期范围
// if(((us_dataT_Or+4) < us_plus_T)
// || ((us_dataT_Or - 4) > us_plus_T))
// {
// SetSampleCurrentRange(range);
// EW_SINGLE_MOD_H;
// return 3;
// }
us_plus_T2 = us_plus_T;
us_plus_H2 = us_plus_H;
us_plus_H = 0;
us_plus_T = 0;
//idle_line = ad_max - SMod_Read_Idle_C;
//idle_line = (idle_line>>1)+ (idle_line>>4)+ SMod_Read_Idle_C;
idle_line = SMod_Read_Idle_C;
if(SMod_FireBusReadPlus(&us_plus_H,&us_plus_T,time_out,idle_line,&ad_max_temp ) > 0)
{
ret=4;
goto end;
}
ad_max = (uint16_t)(ad_max * 0.7f + ad_max_temp*0.3f);
us_time_out++;
}while(us_time_out < 13);
if(ul_check_falg == 0)
{
ret=5;
goto end;
}
if(us_time_out != 9)
{
ret=6;
goto end;
}
ul_data >>= 2;
*buf = (uint8_t)ul_data;
buf++;
len--;
}
//delay_us(time_out >> 1);
end:
EW_DIFF_MOD_H;
Power_SetSampleCurrentRange(range);
if(ret){
DBG_LOG("cur_idle=%d,high_value=%d,idle_line=%d.",fire_dat.cur_idle, fire_dat.cur_high_value,fire_dat.cur_idle_line);
DBG_LOG("cur_max=%d,cur_idle_ad=%d",fire_dat.cur_max,fire_dat.cur_idle_ad);
}
return ret;
}
/*
@brief
@param buf
@param len
@param pre
*/
static void DMod_SendBytesSelf(uint8_t* buf, uint8_t len, uint16_t pre,uint8_t rw_flag,
uint8_t (*crc_fun)(uint8_t *,uint16_t))
{
uint16_t us_count = 0;
uint8_t uc_checkc_flag = 0;
uint8_t uc_datatemp = 0;
uint16_t beg_send_pre,beg_H_plus,end_H_plus,data1_H_plus,data0_H_plus;
beg_send_pre = pre+(pre >> 1)+(pre >> 2);//1.75倍数据周期
beg_H_plus = (uint16_t)(beg_send_pre * 0.65f)+1;
end_H_plus = (uint16_t)(beg_send_pre * 0.35f)+1;
data1_H_plus = (uint16_t)(pre * 0.65f);
data0_H_plus = (uint16_t)(pre * 0.35f);
//buf[len] = CheckCRC_8(buf,len);
buf[len] = crc_fun(buf,len);
len++;
/*
1.3
2.
2-1 1
2-2 8bit数据信号
2-3 1bit校验信号
2-4 1
2-5 2-1退
3
*/
//发送唤醒脉冲
__disable_irq();
while(us_count < 3)
{
EW_DIFF_MOD_L;
delay_us( beg_send_pre - end_H_plus);
EW_DIFF_MOD_H;
delay_us(end_H_plus);
us_count++;
}
while(len > 0)
{
us_count = 0;
uc_checkc_flag = 0;
len--;
//发送起始信号
EW_DIFF_MOD_L;
delay_us(beg_H_plus);
EW_DIFF_MOD_H;
delay_us( beg_send_pre - beg_H_plus);
uc_datatemp = *buf;
//8bit数据信号+1bit校验
while(us_count < 9)
{
if((uc_datatemp & 0x80) > 0)
{
EW_DIFF_MOD_L;
delay_us(data1_H_plus);
EW_DIFF_MOD_H;
delay_us( pre - data1_H_plus);
uc_checkc_flag ^= 0x01;
}else{
EW_DIFF_MOD_L;
delay_us(data0_H_plus);
EW_DIFF_MOD_H;
delay_us( pre - data0_H_plus);
}
uc_datatemp <<= 1;
us_count++;
if(us_count == 8)
{
uc_checkc_flag ^= 0x01;
uc_datatemp &= 0x7F;
uc_datatemp |= (uc_checkc_flag << 7);
}
}
buf++;
//发结束始信号
EW_DIFF_MOD_L;
delay_us(end_H_plus);
EW_DIFF_MOD_H;
delay_us( beg_send_pre - end_H_plus);
}
//补发结束信号
EW_DIFF_MOD_L;
delay_us(end_H_plus);
EW_DIFF_MOD_H;
delay_us( beg_send_pre - end_H_plus);
if(rw_flag > 0)
{
EW_DIFF_MOD_L;
}
__enable_irq();
delay_ms(5);//保障芯片总线空闲监听退出
}
void DMod_SendBytes(uint8_t* buf, uint8_t len, uint16_t pre,uint8_t rw_flag)
{
DMod_SendBytesSelf(buf,len,pre,rw_flag,CheckCRC_8);
}
/*
* buf[len]
* buf的实际长度要求至少比len长1
*/
void DMod_SendBytesXor(uint8_t* buf, uint8_t len, uint8_t rw_flag)
{
//DMod_SendBytesSelf(buf,len,EW_DMOD_Peroid,rw_flag,CheckXOR_8);
DMod_SendBytesSelf(buf,len,200,rw_flag,CheckXOR_8);
}
uint8_t DMod_ReadBytesXor(uint8_t* buf, uint8_t len,uint16_t retry_times)
{
uint8_t ret;
// for(int i=0;i<retry_times;i++){
ret=DMod_FireBusReadDatasV2(buf,len,500*1000/2);
// if(ret==0) break;
// delay_ms(10);
// }
if(ret==0)
{
if(buf[len-1]==CheckXOR_8(buf,len-1))
return 0;
else
return 2;
}
return ret;
}
/*
@brief
@param count
@param
*/
void DMod_ReadInspect_Data(uint16_t count,uint8_t* buf)
{
uint16_t index;
uint8_t data;
CurrentSample_Range_eu range = buscurrent_range;//档位保存
Power_SetSampleCurrentRange(R10_2mA_30mA_MC);//采样电阻全开,快速放电
ADC_CurChnnelSet(AN_MAL_CH,ADC_SPEED_MIDLE);
//delay_us(500);
//总线跳转到中电平
EW_DIFF_MOD_M;
//延时等待电流稳定
//COM_PH2_Out = 0;
delay_us(500);
//获取中电平电流
SMod_GetIdle2V();
EW_DIFF_MOD_L
delay_us(700);
rt_memset(buf,0,((count+7 ) >> 3));
index = 0;
while(index < count)
{
data = *(buf+(index >> 3));
if( DMod_ReadBit(400) > 0)
{
data |= (0x01 << (index & 0x07));
}
delay_us(1200);
*(buf+(index >> 3)) = data;
index++;
}
Power_SetSampleCurrentRange(range);
delay_ms(1);
EW_DIFF_MOD_H;
}
/***********************************************************/
volatile uint8_t EW_Trim_Flag = 0;
static void EW_TrimPlusCallback(uint8_t flag)
{
if(flag == 1)
{
EW_DIFF_MOD_L;
}else if(flag > 1){
EW_DIFF_MOD_H;
}
EW_Trim_Flag = flag;
}
/*
@brief
@param cycle
@param duty 线
@param count
*/
void EW_SendTrimSquare(uint16_t cycle,uint16_t duty, uint32_t count)
{
FireBus_ClkAmend(cycle,duty,count,EW_TrimPlusCallback);
EW_Trim_Flag = 0;
while(EW_Trim_Flag != 3)
{
delay_ms(20);
}
delay_ms(1);
EW_DIFF_MOD_H
}
/*
@breif
*/
uint8_t EW_CommTest(uint8_t* buf,uint16_t len,uint16_t cycle)
{
uint8_t auc_buf[16];
uint16_t us_head = 1;
us_head = (us_head << 6)& 0xFFC0;
us_head += EW_COMM_TEST;
auc_buf[0] = us_head & 0xFF;
auc_buf[1] = (us_head >> 8) & 0xFF;
if(len > 13)
{
len = 13;
}
memcpy(auc_buf+2,buf,len);
len += 2;
DMod_SendBytes(auc_buf,len,cycle,1);
memset(buf,0,len);
delay_ms(2);
return DMod_FireBusReadDatasV2(buf,len+1,500);
}
/*
@brief 使MTP写
@param addr
@param 使
@rtv
*/
uint8_t EW_EnWriteMTP(uint16_t addr ,uint8_t en_flag)
{
uint8_t uc_ack = 0;
uint8_t uc_readflag = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 40;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = en_flag;
DMod_SendBytes((uint8_t*)EW_CommBuf,3,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 0;
}
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf+2,2,EW_DMOD_READ_Timeout);
if(EW_CommBuf[0] != EW_CommBuf[2] || EW_CommBuf[1] != EW_CommBuf[3])
{
return 1;
}
return uc_ack;
}
/*
@brief MTP
@param addr
@param mtpaddr MTP地址/4
@param buf
@param len
*/
uint8_t EW_WriteMTP(uint16_t addr,uint8_t mtpaddr,uint8_t* buf,uint8_t len)
{
uint8_t uc_ack = 0;
uint8_t uc_readflag = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 63;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = mtpaddr;
if(len > 10)
{
len = 10;
}
EW_CommBuf[3] = len;
memcpy((void*)(EW_CommBuf+4),buf,len);
DMod_SendBytes((uint8_t*)EW_CommBuf,len+4,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 0;
}
len = (len>>2)*8+4;
delay_ms(len);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)(EW_CommBuf+2),2,EW_DMOD_READ_Timeout);
if(EW_CommBuf[0] != EW_CommBuf[2] || EW_CommBuf[1] != EW_CommBuf[3])
{
return 1;
}
return uc_ack;
}
/*
@brief MTP
@param addr
@param mtpaddr MTP地址/4
@param buf
@param len
*/
uint8_t EW_ReadMTP(uint16_t addr,uint8_t mtpaddr,uint8_t* buf,uint8_t len)
{
uint8_t uc_ack = 0;
uint8_t uc_readflag = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 62;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = mtpaddr;
if(len > 10)
{
len = 10;
}
EW_CommBuf[3] = len;
memcpy((void*)(EW_CommBuf+4),buf,len);
DMod_SendBytes((uint8_t*)EW_CommBuf,len+4,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 1;
}
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)buf,len+1,EW_DMOD_READ_Timeout);
if(buf[len] != CheckCRC_8(buf,len))
{
return 1;
}
return uc_ack;
}
/*
@brief BootLoader程序
@param addr
@param reboot 1
@rtv 0
*/
uint8_t EW_RunBootLoader(uint16_t addr,uint8_t reboot)
{
uint32_t ul_bootflag = 0x55AA6699;
addr<<=6;
addr = (addr & 0xFFC0) | 61;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
if(reboot == 1)
{
ul_bootflag = 0x9966AA55;
}
memcpy((void*)(EW_CommBuf+2),&ul_bootflag,4);
DMod_SendBytes((uint8_t*)EW_CommBuf,6,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief MTP中
@param addr
@param runcfg
@rtv
*/
uint8_t EW_WriteRunCfg(uint16_t addr,RunCfg_un* runcfg)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 20;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((void*)(EW_CommBuf+2),&runcfg,3);
DMod_SendBytes((uint8_t*)EW_CommBuf,6,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 0;
}
delay_ms(4);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf+2,2,EW_DMOD_READ_Timeout);
if(EW_CommBuf[0] != EW_CommBuf[2] || EW_CommBuf[1] != EW_CommBuf[3])
{
return 1;
}
return uc_ack;
}
/*
@brief
@param
@param UID
@param uid_len UID长度
@param ack_data 2bytes延时和2bytes状态
@rtv
*/
uint8_t EW_SetAddrByUID(uint16_t addr,uint8_t* uid,uint8_t uid_len,uint8_t* ack_data)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 21;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((void*)(EW_CommBuf+2),uid,uid_len);
DMod_SendBytes((uint8_t*)EW_CommBuf,uid_len+2,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 0;
}
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf+2,2,EW_DMOD_READ_Timeout);
if(EW_CommBuf[0] != EW_CommBuf[2] || EW_CommBuf[1] != EW_CommBuf[3])
{
return 1;
}
return uc_ack;
}
/*
@brief
@param
@param
@param UID
@param UID长度
@param 2bytes延时和2bytes状态
@rtv
*/
uint8_t EW_FastSetByUID(uint16_t addr,uint16_t delay, uint8_t pwd_flag,uint8_t* uid,uint8_t uid_len,uint8_t* ack_data)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 22;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = pwd_flag;
memcpy((void*)(EW_CommBuf+3),&delay,2);
memcpy((void*)(EW_CommBuf+5),uid,uid_len);
uid_len +=5;
DMod_SendBytes(((uint8_t*)(EW_CommBuf)),uid_len,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 0;
}
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2(ack_data,5,EW_DMOD_READ_Timeout);
if(ack_data[4] != CheckCRC_8(ack_data,4))
{
return 1;
}
return uc_ack;
}
/*
@brief
@param addr
@param
@rtv
*/
uint8_t EW_SetDelay(uint16_t addr,uint16_t delay)
{
uint8_t uc_ack;
addr<<=6;
addr = (addr & 0xFFC0) | 23;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((void*)(EW_CommBuf+2),&delay,2);
DMod_SendBytes((uint8_t*)EW_CommBuf,4,EW_DMOD_Peroid,0);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf+2,2,EW_DMOD_READ_Timeout);
if(EW_CommBuf[0] != EW_CommBuf[2] || EW_CommBuf[1] != EW_CommBuf[3])
{
return 1;
}
return uc_ack;
}
/*
@brief
@param addr
@param
@param
@rtv
*/
uint8_t EW_VerfyPWD(uint16_t addr,uint8_t* pwd,uint8_t pwd_len)
{
addr<<=6;
addr = (addr & 0xFFC0) | 24;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((void*)(EW_CommBuf+2),pwd,pwd_len);
pwd_len += 2;
DMod_SendBytes((uint8_t*)EW_CommBuf,pwd_len,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief
@param addr
@param *50ms
@rtv
*/
uint8_t EW_Boom(uint16_t addr,uint8_t delay_count)
{
addr<<=6;
addr = (addr & 0xFFC0) | 25;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = delay_count;
DMod_SendBytes((uint8_t*)EW_CommBuf,3,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief
@param addr
@param 0 1 16V 2:20V 32.5V
@param addr = group*4 addr的可以充电
@rtv
*/
uint8_t EW_Charge(uint16_t addr,uint8_t chg_class,uint8_t group)
{
addr<<=6;
addr = (addr & 0xFFC0) | 26;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = chg_class;
EW_CommBuf[3] = group;
DMod_SendBytes((uint8_t*)EW_CommBuf,4,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief
@param addr
*/
uint8_t EW_DisCharge(uint16_t addr)
{
addr<<=6;
addr = (addr & 0xFFC0) | 27;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief
@param addr
@param *state
@param len
*/
uint8_t EW_ReadState(uint16_t addr,uint8_t* state)
{
uint8_t uc_ack = 0;
uint8_t uc_readflag = 0;
if(addr == 0)
{
return 1;
}
uc_readflag = 1;
addr<<=6;
addr = (addr & 0xFFC0) | 28;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 1;
}
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf,5,EW_DMOD_READ_Timeout);
if(EW_CommBuf[5] != CheckCRC_8((uint8_t*)EW_CommBuf,5))
{
return 1;
}else{
memcpy(state,((uint8_t*)EW_CommBuf),4);
}
return uc_ack;
}
/*
@brief
@param addr
@param cycle us
@param plus_count
*/
uint8_t EW_ClkAmend(uint16_t addr ,uint16_t cycle,uint16_t plus_count)
{
addr<<=6;
addr = (addr & 0xFFC0) | 29;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,0);
delay_ms(5);
EW_SendTrimSquare(cycle,cycle>>1,plus_count);
return 0;
}
/*
@brief
@param addr
@param cycle us
@param plus_count
*/
uint8_t EW_Inspect(uint16_t bgaddr ,uint16_t endaddr,uint16_t state,uint8_t* buf)
{
uint16_t addr = 0;
addr<<=6;
addr = (addr & 0xFFC0) | 30;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((uint8_t*)&EW_CommBuf[2],&bgaddr,2);
memcpy((uint8_t*)&EW_CommBuf[4],&endaddr,2);
memcpy((uint8_t*)&EW_CommBuf[6],&state,2);
DMod_SendBytes((uint8_t*)EW_CommBuf,8,EW_DMOD_Peroid,1);
delay_ms(5);
DMod_ReadInspect_Data(endaddr-bgaddr,buf);
return 0;
}
/*
@brief
@param addr
@param cfg_mask
@param (EW_Cfg & cfg_mask) == cfg_state
@param 0 1
@param
*/
uint8_t EW_CheckRunCfg(uint16_t addr,uint32_t cfg_mask ,uint32_t cfg_state,uint8_t* rtv)
{
addr<<=6;
addr = (addr & 0xFFC0) | 31;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((uint8_t*)&EW_CommBuf[2],&cfg_mask,3);
memcpy((uint8_t*)&EW_CommBuf[5],&cfg_state,3);
EW_CommBuf[8] = *rtv;
DMod_SendBytes((uint8_t*)EW_CommBuf,9,EW_DMOD_Peroid,1);
delay_ms(5);
*rtv = DMod_ReadAck(50);
return 0;
}
/*
@brief
@param addr
@param check_class 0 1 2 4
@param *buf
*/
uint8_t EW_ChecSelf(uint16_t addr,uint8_t check_class,uint8_t* buf)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(check_class == 4)
{
uc_readflag = 1;
}
if(buf == NULL && check_class ==4)
{
return 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 32;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = check_class;
DMod_SendBytes((uint8_t*)EW_CommBuf,9,EW_DMOD_Peroid,uc_readflag);
if( uc_readflag == 0)
{
return 0;
}
delay_ms(5);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf,5,EW_DMOD_READ_Timeout);
if(EW_CommBuf[4] == CheckCRC_8((uint8_t*)EW_CommBuf,4))
{
memcpy(buf,(uint8_t*)EW_CommBuf,4);
}else{
uc_ack = 1;
}
return uc_ack;
}
/*
@brief 使
*/
uint8_t EW_SaveFireInfo(uint16_t addr)
{
addr<<=6;
addr = (addr & 0xFFC0) | 33;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief
@param addr
@param delay
*/
uint8_t EW_ReadDelay(uint16_t addr,uint16_t* delay)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 34;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,uc_readflag);
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf,3,EW_DMOD_READ_Timeout);
if(EW_CommBuf[2] == CheckCRC_8((uint8_t*)EW_CommBuf,2))
{
memcpy(delay,(uint8_t*)EW_CommBuf,2);
}else{
uc_ack = 1;
}
return uc_ack;
}
/*
@brief
@param addr
@param speed 0:10K 1:7K 2:5K 3:4.5K 4: 4K 4+n:4-0.5*n
@param cur 01mA 1:2mA 2:4mA 3:8mA
*/
uint8_t EW_SetReportCfg(uint8_t speed,uint8_t cur)
{
uint16_t addr = 0;
addr<<=6;
addr = (addr & 0xFFC0) | 35;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
EW_CommBuf[2] = speed;
EW_CommBuf[3] = cur;
DMod_SendBytes((uint8_t*)EW_CommBuf,4,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief
@param addr
@param new_addr
*/
uint8_t EW_UpdateCommAddr(uint8_t addr,uint16_t new_addr)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 36;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((void*)(EW_CommBuf+2),&new_addr,2);
DMod_SendBytes((uint8_t*)EW_CommBuf,4,EW_DMOD_Peroid,uc_readflag);
if(uc_readflag == 0)
{
return 0;
}
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf+2,2,EW_DMOD_READ_Timeout);
if(EW_CommBuf[0] != EW_CommBuf[2] || EW_CommBuf[1] != EW_CommBuf[3])
{
return 1;
}
return uc_ack;
}
/*
@brief
@param addr
@param clk_amend
*/
uint8_t EW_ReadClkAmend(uint16_t addr,uint32_t* clk_amend)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 37;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,uc_readflag);
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf,5,EW_DMOD_READ_Timeout);
if(EW_CommBuf[4] == CheckCRC_8((uint8_t*)EW_CommBuf,4))
{
memcpy(clk_amend,(uint8_t*)EW_CommBuf,4);
}else{
uc_ack = 1;
}
return uc_ack;
}
/*
@brief
@param addr
@param clk_amend
*/
uint8_t EW_ReadRunCfgVersion(uint16_t addr,uint8_t* run_cfg,uint16_t* version)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 38;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,uc_readflag);
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf,6,EW_DMOD_READ_Timeout);
if(EW_CommBuf[5] == CheckCRC_8((uint8_t*)EW_CommBuf,5))
{
memcpy(run_cfg,(uint8_t*)EW_CommBuf,3);
memcpy(version,(uint8_t*)EW_CommBuf+3,2);
}else{
uc_ack = 1;
}
return uc_ack;
}
/*
@brief
@param max_addr
@param fac_addr
*/
uint8_t EW_AutoSetAddr(uint16_t max_addr,uint16_t fac_addr)
{
uint16_t addr = 0;
addr<<=6;
addr = (addr & 0xFFC0) | 39;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
memcpy((uint8_t*)EW_CommBuf+2,&max_addr,2);
memcpy((uint8_t*)EW_CommBuf+4,&max_addr,2);
DMod_SendBytes((uint8_t*)EW_CommBuf,6,EW_DMOD_Peroid,0);
return 0;
}
/*
@brief
@param addr
@param UID数据
*/
uint8_t EW_ReadUID(uint16_t addr,uint8_t* uid,uint8_t uid_len)
{
uint8_t uc_readflag = 0;
uint8_t uc_ack = 0;
if(addr > 0)
{
uc_readflag = 1;
}
addr<<=6;
addr = (addr & 0xFFC0) | 41;
EW_CommBuf[0] = addr&0xFF;
EW_CommBuf[1] = (addr >> 8)&0xFF;
DMod_SendBytes((uint8_t*)EW_CommBuf,2,EW_DMOD_Peroid,uc_readflag);
delay_ms(2);
uc_ack = DMod_FireBusReadDatasV2((uint8_t*)EW_CommBuf,uid_len+1,EW_DMOD_READ_Timeout);
if(EW_CommBuf[uid_len] == CheckCRC_8((uint8_t*)EW_CommBuf,uid_len))
{
memcpy(uid,(uint8_t*)EW_CommBuf,uid_len);
}else{
uc_ack = 1;
}
return uc_ack;
}