small_water_meter_4g_src/Users/tdc_tof/tdc_ms1030.c

 #include "board.h"
#include "tdc_tof.h"

#define ANZ_FIRE 		12u//fire发送脉冲数
#define DIV_FIRE 		3u	//内部时钟产生脉冲的分频
#define DIV_CLKHS 	    0u	//高速时钟分频
#define START_CLKHS     2u	//高速启动后测量前晶振启动间隔时间,120us;0关闭，1持续开启，2延迟120us后开启
#define NEG_START  	    0u	//start通道边缘
#define NEG_STOP		0u	//stop通道边缘
#define HITIN			9u	//stop预期脉冲数
#define SEL_TIMO_MB	    3u	//测量范围溢出时间暂未确定数值
#define SEL_TSTO2		3u	//32khz //和MS1030不同
#define SEL_TSTO1		0u	//暂时不用这个引脚，配置为高速时钟输入模式
#define DFLT_WREG0   ((ANZ_FIRE<<25) | \
                      ( DIV_FIRE<<19) | \
                      ( DIV_CLKHS<<17) | \
                      ( START_CLKHS<<14) | \
                      ( NEG_START<<13) | \
                      ( NEG_STOP<<12) | \
                      ( HITIN<< 8) | \
                      ( SEL_TIMO_MB<< 4) | \
                      ( SEL_TSTO2<< 2) | \
                      ( SEL_TSTO1<< 0)) 
                      


#define EN_INT_TO       1  //TIMOUT中断触发位
#define EN_INT_HIT      0  //END HITS中断触发位
#define EN_INT_ALU      1  //alu中断触发位
#define RFEDGE          0  //stop通道边沿敏感性
#define UP_DELVAL1      200  //当EN_FIST_WAVE=1时,为第一波屏蔽窗口 BIT12~27  暂未设置
#define OFFSET          0	//当en_hc=1时, 62~-64mV   暂未设置
#define DFLT_WREG1   (( EN_INT_TO<<31)  | \
                      ( EN_INT_HIT<<30) | \
                      ( EN_INT_ALU<<29) | \
                      ( RFEDGE<<28)     | \
                      ( UP_DELVAL1<<12) | \
                      ( OFFSET<< 0))
                      

#define EN_FIRST_WAVE	    1u	//BIT31, 为1时后面的定义有效
#define EDGE_FW				0u	//第一波边缘敏感性
#define DELREL1				6u	//第1个stop接收第几个回波周期
#define DELREL2				8u	//第2个stop接收第几个回波周期
#define DELREL3				10u	//第3个stop接收第几个回波周期
#define DELREL4				12u	//第4个stop接收第几个回波周期
#define DELREL5				14u	//第5个stop接收第几个回波周期
#define DFLT_WREG2    ((EN_FIRST_WAVE<<31)| \
                      (EDGE_FW<<30) | \
                      (DELREL1<<24) | \
                      (DELREL2<<18) | \
                      (DELREL3<<12) | \
                      (DELREL4<< 6) | \
                      (DELREL5<< 0))



#define DELREL6				16u	//第3个stop接收第几个回波周期
#define DELREL7				18u	//第4个stop接收第几个回波周期
#define DELREL8				20u	//第5个stop接收第几个回波周期
//#define DIS_PW              0u	//关闭脉冲宽度测量功能,0=开启
//#define WAVE_OFFS           16u	//第一波比较器偏置电压：EN_HC = 0 -64mV~63mV,10mv
#define DFLT_WREG3   ((DELREL6<<26) | \
                      (DELREL7<<20) | \
                      (DELREL8<<14))
//                      (DIS_PW<<13)  | \
//                      (WAVE_OFFS<<6))
                      
                            
#define CONF_FIRE			2		//脉冲触发器的输出设置，暂时设置为0 bit29~31
#define PHASE_FIREUP		0       //FIREUP反向设置
#define PHASE_FIREDOWN	    0       //FIREDOWN反向设置
#define SEL_START_FIRE	    1       //FIRE脉冲用作触发TDCSTART
#define EN_ANALOG			1       //模拟测量控制开关
#define HZ60				0       //顺流测量和逆流测量的时间单位
#define TCYCLE				1       //温度测量循环时间
#define ANZ_FAKE			0       //温度测量热身次数，0：两次热身，1：7次热身
#define SEL_ECLK_TMP		1       //选择温度测量内部参考时钟
#define TW2					5       //180us充电时间，与1030不同
#define EN_PEAK				0		//峰值检波使能关闭，1030不同
#define EN_DISCHARGE		0		//检波放电使能关闭，1030不同
#define CYCLE_TOF			0		//顺流逆流自动检测模式下,顺流逆流测量间隔时间,初步确定为3=20ms 1030不同
#define EN_ERR_VAL			1       //溢出时alu将全f写到结果寄存器
#define EN_DC				1		//stop端口充电模式 这里设置为直流  1030不同
#define FIRE0_DEF			1       //fire通道默认状态，fire通道默认电平
#define DOUBLE_RES			0       //双精度模式
#define QUAD_RES			1       //4精度模式
#define DFLT_WREG4   (( CONF_FIRE<<29) | \
                      ( PHASE_FIREUP<<28) | \
                      ( PHASE_FIREDOWN<<27) | \
                      ( SEL_START_FIRE<<26) | \
                      ( EN_ANALOG<<25) | \
                      ( HZ60<<24) | \
                      ( TCYCLE<<23) | \
                      ( ANZ_FAKE<<22) | \
                      ( SEL_ECLK_TMP<<21) | \
                      ( TW2<<17) | \
                      ( EN_PEAK<<16) | \
					  ( EN_DISCHARGE<<15) | \
					  ( CYCLE_TOF<<11) | \
                      ( EN_ERR_VAL<<10) | \
					  ( EN_DC<<9) | \
					  ( FIRE0_DEF<<8) | \
					  ( DOUBLE_RES<<7) | \
					  ( QUAD_RES<<6))


#define CYCLE_AUTOTOF	 (250<<20)	//自动测量循环时间 500ms
#define ANZ_AUTOTOF      (1<<16)	//循环次数 一直开启
#define AUTOTOF_MODE     (0<<15)	//顺逆顺逆
#define PHASE_FIRENUM    (3<<6)		//插入相位位置
#define ANZ_PHASE		 (8)		//插入周期数
#define DFLT_WREG5        0

#define DOWN_DELVAL1    (200<<12) //逆流屏蔽窗口
#define SEL_SRC_CLK		(0<<7)  //选择高速时钟输入源
#define EN_HC			(0<<6)  //比较器调节步长
#define CURR32K			(0<<5)  //32K晶振功耗设置
#define DIS_Vref		(1<<4)  //基准电压输出控制
#define ADJ_LDO_ROUGH	(0<<3)  //内部LDO输出粗调
#define ADJ_LDO_FINE	(0<<0)	//内部LDO输出细调
#define DFLT_WREG6 (DOWN_DELVAL1|SEL_SRC_CLK|EN_HC|CURR32K|DIS_Vref|ADJ_LDO_ROUGH|ADJ_LDO_FINE)
            

uint16_t tof_state = TOF_ST_INIT;
uint32_t tof_flag;





//uint16_t CntSync = 0;

void tdc_tof_init(void)
{
    //MUX ADDA : PA08; ADDB : PC09
    mux_init();

    // MS1030 RSTN : PD02
    GpioInit(PD02_AF0,   GPIO_DIG_OUT_WEAK_PUSH_NONEUP_NONEDOWN);
    GpioClrPins(GpioPortD, GpioBitMsk2);   // reset active low
    us_delay(10);       // 10us > tPH(30ns)
    GpioSetPins(GpioPortD, GpioBitMsk2);   // reset release
    us_delay(10);       // 10us > tRFS(30ns)

    tdc_spi_init();     // peripheral init

    PeriClk_MutEnable(PeriClk_Spi1);
    DMA_ReqClkOn();

    // TDC POR
    tdc_spi_wr_code(0x50);
    us_delay(1000);     // 1000us > specification(500us)

     tdc_spi_wr_d32(0x80, DFLT_WREG0);
     uint32_t read_a0=tdc_spi_rd_d32(0xA0);
     read_a0=read_a0&0xFFu;
     
#if 1    
    tof_flag = TOF_FLAG_UNALGND_CHOP;
    if (read_a0!=(DFLT_WREG0&0xFFu)){
        tof_flag |= TOF_FLAG_TDC_FAULT;
    } else {
        // write_reg0
        tdc_spi_wr_d32(0x80, DFLT_WREG0);                     
        // write_reg1
        tdc_spi_wr_d32(0x81, DFLT_WREG1);
        // write_reg2
        tdc_spi_wr_d32(0x82, DFLT_WREG2);
        // write_reg3
        tdc_spi_wr_d32(0x83, DFLT_WREG3);
        // write_reg4
        tdc_spi_wr_d32(0x84, DFLT_WREG4);       
        // write_reg5
	    tdc_spi_wr_d32(0x85, DFLT_WREG5);
        // write_reg6
		tdc_spi_wr_d32(0x86, DFLT_WREG6);
				
        tdc_spi_wr_d32(0x87,0x20000000);//!!!!!!!!do not delete!!!!!!!!!
        
        tdc_spi_wr_code(0x70);
        tdc_spi_wr_code(0x06);

//        // not 'INTN' but 'us_delay' to avoid dead loop when INTN fault
        us_delay(2000); // > 480 + 600 + 16 + 70
        tdc_read_cal(0x0u);
//            tof_flag ^= TOF_FLAG_UNALGND_CHOP;
//            // start a single ToF to align MS1030 internal calibration order(1 CAL every 24 ToF)
//            // must be sure that CAL not in the middle of UP Tof and DOWN Tof
//            tdc_start_tof(TDC_CFG_DO_WREG | TDC_CFG_FIRE_UP);
//
//            // not 'INTN' but 'us_delay' to avoid dead loop when INTN fault
//            us_delay(2000); // > 480 + 600 + 16 + 70
//
//            tdc_read_tof(TDC_CFG_FIRE_UP);  // read data and clear interrupt
    }
#endif 
DMA_ReqClkOff();
PeriClk_MutDisable(PeriClk_Spi1);

    // MS1030 INTN : PD03 falling edge trigger
    GpioInit(PD03_AF0, GPIO_DIG_IN_PULLUP_NONEDOWN);
    GpioEventInit(PD03_AF0, GPIO_EVENT_FALL);

    // enable interrupt at NVIC side
    IRQMutEnable(PORTD_F_IRQn, NVIC_PRIO_1);
}

void tdc_start_tof(uint32_t cfg)
{
	//rt_enter_critical();
    uint32_t u32tmp;

    if (cfg & TDC_CFG_DO_CKENA){
        PeriClk_MutEnable(PeriClk_Spi1);
        DMA_ReqClkOn();
    }

    if (cfg & TDC_CFG_DO_WREG){

        
     u32tmp = (DFLT_WREG3 & ~(1u << 13)) | (TdcFwOfst << 6);
                    // measure FW pulse width, 0:on; 1:off
                   // FW wave_offs, 0:0mv; 1~63:2~126mV; 64~127:-128~-2mV;
        if (tof_state&TOF_ST_VOID){
            u32tmp |= (1u<<13);     // disable FW pulse width to save power
        }
        tdc_spi_wr_d32(0x83, u32tmp);
    }

    // Initial TDC status regs
    tdc_spi_wr_code(0x70);

    // start single-direction measure
    tdc_spi_wr_code(0x03);

    if (cfg & TDC_CFG_DO_CKDIS){
        DMA_ReqClkOff();
        PeriClk_MutDisable(PeriClk_Spi1);
    }
//rt_exit_critical();
}

uint16_t TdcStatus;

uint16_t TdcUPwFw;
uint16_t TdcUPwHw;
uint32_t TdcUToF[9];

uint16_t TdcDPwFw;
uint16_t TdcDPwHw;
uint32_t TdcDToF[9];

uint32_t TdcCal;
//float TdcScale = 250.0f/65536;
float TdcScale = 0.00381147861f;

uint32_t TdcPT[4];
float TdcResist = 5000;     // OhmX10
//modified by yuewei 20260520
//float WaterPrmt[2] = {25.0f, 1496.6f};
float WaterPrmt[2] = {25.0f, 1497.1484f};

void tdc_read_tof(uint32_t cfg)
{
//    uint16_t i;
    if (cfg & TDC_CFG_DO_CKENA){
        PeriClk_MutEnable(PeriClk_Spi1);
        DMA_ReqClkOn();
    }

    TdcStatus = tdc_spi_rd_d16(0xd0);   // 读取状态寄存器
    if ((TdcStatus&0x0300)==0x0000u){
        tof_flag ^= TOF_FLAG_UNALGND_CHOP;

    }

    if ((TdcStatus&0x03F0)!=0x0090u){
        tof_flag |= TOF_FLAG_BLANK_PIPE;
        tdc_spi_wr_code(0x70);
        tdc_spi_wr_d32(0x80, DFLT_WREG0 & ~(0x07 << 14));   //一旦为空管马上关闭高速晶振，降低功耗
    } 
    else 
     {
       
            TdcUPwFw = tdc_spi_rd_d16(0xd3);    // First wave pulse width
            TdcUPwHw = tdc_spi_rd_d16(0xd4);    // 1st Hit wave pulse width
            TdcDPwFw = tdc_spi_rd_d16(0xd3);   
            TdcDPwHw = tdc_spi_rd_d16(0xd4);  

            // TOF_UP_HITs
            TdcUToF[0] = tdc_spi_rd_d32(0xb8)*(1.0f/8);  // average of all
            // TOF_DOWN_HITs
            TdcDToF[0] = tdc_spi_rd_d32(0xc8)*(1.0f/8);  // average of all
//            for(i=0; i<8; i++){
//                TdcDToF[i+1] = tdc_spi_rd_d32(0xb0 + i);
//            };
        
    }

    if (cfg & TDC_CFG_DO_CKDIS){
        DMA_ReqClkOff();
        PeriClk_MutDisable(PeriClk_Spi1);
    }
}

void tdc_start_cal(uint32_t cfg)
{
//rt_enter_critical();
    if (cfg & TDC_CFG_DO_CKENA){
        PeriClk_MutEnable(PeriClk_Spi1);
        DMA_ReqClkOn();
    }

    // 8*T_32k = 244.140625us
    if (cfg & TDC_CFG_DO_WREG){
        // write_reg0
//        tdc_spi_wr_d32(0x80, DFLT_WREG0 |
//                              ( 2u<< 4)     // SEL_TIMO_MB, 0:64us; 1:128us; 2:256us; ~ 6:4096us;
//                      );

        // write_reg3
        tdc_spi_wr_d32(0x83, DFLT_WREG3 |
                              ( 1u<<13)         // measure FW pulse width, 0:on; 1:off
                      );
    }

    tdc_spi_wr_code(0x70);
    tdc_spi_wr_code(0x06);

    if (cfg & TDC_CFG_DO_CKDIS){
        DMA_ReqClkOff();
        PeriClk_MutDisable(PeriClk_Spi1);
    }
//rt_exit_critical();
}

void tdc_read_cal(uint32_t cfg)
{
	//rt_enter_critical();
    if (cfg & TDC_CFG_DO_CKENA){
        PeriClk_MutEnable(PeriClk_Spi1);
        DMA_ReqClkOn();
    }

    TdcStatus = tdc_spi_rd_d16(0xd0);   // status
    if ((TdcStatus&0x0300)==0x0000u){
        tof_flag ^= TOF_FLAG_UNALGND_CHOP;

        TdcCal = tdc_spi_rd_d32(0xd5);

//        TdcScale = 244140.625f/TdcCal;
        TdcScale += (244140.625f/TdcCal - TdcScale)*(1.0f/2);
				//LOG("----------TdcScale=%.6f\n",TdcScale);
    } else {
//        tdc_spi_wr_code(0x70);
    }

    if (cfg & TDC_CFG_DO_CKDIS){
        DMA_ReqClkOff();
        PeriClk_MutDisable(PeriClk_Spi1);
    }
//rt_exit_critical();
}

void tdc_start_temp(uint32_t cfg)
{
//rt_enter_critical();
    if (cfg & TDC_CFG_DO_CKENA){
        PeriClk_MutEnable(PeriClk_Spi1);
        DMA_ReqClkOn();
    }

    if (cfg & TDC_CFG_DO_WREG){
       
              
//        tdc_spi_wr_d32(0x80, DFLT_WREG0 |
//                              ( 3u<< 6)     // SEL_TIMO_MB, 0:64us; 1:128us; 2:256us; 3:512us; ~ 6:4096us;
//                      );

//        // write_reg1
//        tdc_spi_wr_d32(0x81, DFLT_WREG1 |
//                              ( 0u<< 12)   // DELVAL1=0us, format:16.5, time unit:Tref;
//                      );

        // write_reg3
        tdc_spi_wr_d32(0x83, DFLT_WREG3 |
                              ( 1u<<13)         // measure FW pulse width, 0:on; 1:off
                      );
    }

    tdc_spi_wr_code(0x70);
    tdc_spi_wr_code(0x04);

    if (cfg & TDC_CFG_DO_CKDIS){
        DMA_ReqClkOff();
        PeriClk_MutDisable(PeriClk_Spi1);
    }
//rt_exit_critical();
}
uint8_t temp_error_flag=0;
void tdc_read_temp(uint32_t cfg)
{

    if (cfg & TDC_CFG_DO_CKENA){
        PeriClk_MutEnable(PeriClk_Spi1);
        DMA_ReqClkOn();
    }

    TdcStatus = tdc_spi_rd_d16(0xd0);   // status
    
    TdcPT[0] = tdc_spi_rd_d32(0xd1);  // REF 5K +/- 5
    TdcPT[1] = tdc_spi_rd_d32(0xd2);  // U7

    if(TdcPT[0]==0xffffffff || TdcPT[1]==0xffffffff || TdcPT[0] ==0x00000000 || TdcPT[1]==0x00000000)
    {
        temp_error_flag=1;
    }
    else
    {
     temp_error_flag=0;   
     TdcResist = 2500.0f*TdcPT[1]/TdcPT[0];  // ohmX10
     Ohm2Dgr2USSpd(TdcResist, WaterPrmt);        // [0]:Temperature; [1]:ultrasonic speed @Temp
    }    

    if (cfg & TDC_CFG_DO_CKDIS){
        DMA_ReqClkOff();
        PeriClk_MutDisable(PeriClk_Spi1);
    }

}

void MS1031_DisableHighSpeedOsc(void)
{
   PeriClk_MutEnable(PeriClk_Spi1);
   DMA_ReqClkOn();
    
   tdc_spi_wr_d32(0x80, DFLT_WREG0 & ~(0x07 << 14));   //一旦为空管马上关闭高速晶振，降低功耗
    
   DMA_ReqClkOff();
   PeriClk_MutDisable(PeriClk_Spi1);

}

void MS1031_EnableHighSpeedOsc(void)
{
  PeriClk_MutEnable(PeriClk_Spi1);
  DMA_ReqClkOn();
    
    GpioClrPins(GpioPortD, GpioBitMsk2);   
    us_delay(10);      
    GpioSetPins(GpioPortD, GpioBitMsk2);   
    us_delay(10);       
        
    tdc_spi_wr_d32(0x80,DFLT_WREG0);
    tdc_spi_wr_d32(0x81,DFLT_WREG1);
    tdc_spi_wr_d32(0x82,DFLT_WREG2);
    tdc_spi_wr_d32(0x83,DFLT_WREG3);
    tdc_spi_wr_d32(0x84,DFLT_WREG4);
    tdc_spi_wr_d32(0x85,DFLT_WREG5);
    tdc_spi_wr_d32(0x86,DFLT_WREG6);
    tdc_spi_wr_d32(0x87,0x20000000);//!!!!!!!!do not delete!!!!!!!!!

    
 DMA_ReqClkOff();
 PeriClk_MutDisable(PeriClk_Spi1);
    
}