// trs55d.c
#include "system/includes.h"
#include "app_config.h"
#include "app_action.h"
#include "app_main.h"
#include "update.h"
#include "update_loader_download.h"
#include "app_charge.h"
#include "app_power_manage.h"
#include "asm/charge.h"
#include "app_temperature.h"
#include "typedef.h"

#include "le_common.h"
#include "cpu.h"
#include "timer.h"
#include "os/os_api.h"
#include "system/includes.h"

#include "gatt_common/le_gatt_common.h"
#include "examples/trans_data/ble_trans_profile.h"

#include "asm/iic_soft.h"
#include "trs55d.h"

#define IIC_CHANNEL_1   0
const struct soft_iic_config soft_iic_cfg[] = {
    //iic0 data
    {
        .scl = IO_PORTA_07, //IIC CLK脚
        .sda = IO_PORTA_08, //IIC DAT脚
        .delay = 50,        //软件IIC延时参数，影响通讯时钟频率
        .io_pu = 1,         //是否打开上拉电阻，如果外部电路没有焊接上拉电阻需要置1
    },
};



#if 1
//如果无reg_addr:reg_addr=NULL,reg_len=0
//return: <0:error,  =read_len:ok
int soft_i2c_master_read_nbytes_from_device_reg(soft_iic_dev iic, //iic索引
        unsigned char dev_addr, //设备地址
        int reg_addr, unsigned char reg_len,//设备寄存器地址，长度
        unsigned char *read_buf, int read_len)//缓存buf，读取长度
{
	  u8 ack;
    int ret = 0;
    
    // 发送起始条件
    soft_iic_start(iic);
    
    // 1. 发送设备地址（写模式）
    ack = soft_iic_tx_byte(iic, dev_addr & 0xFE);
    if (!ack) {
        printf("dev_addr no ack!\n");
        ret = -1;
        goto exit;
    }
    
    // 2. 发送寄存器地址（支持多字节地址）
    if (reg_len > 0) {
        // 处理多字节地址（高位在前）
        uint8_t addr_buf[4];
        for (int i = reg_len - 1; i >= 0; i--) {
            addr_buf[i] = (reg_addr >> (8 * (reg_len - 1 - i))) & 0xFF;
        }
        
        for (u8 i = 0; i < reg_len; i++) {
            ack = soft_iic_tx_byte(iic, addr_buf[i]);
            if (!ack) {
                printf("reg_addr no ack at byte %d!\n", i);
                ret = -1;
                goto exit;
            }
        }
    }
    
    // 3. 发送重复起始条件
    soft_iic_start(iic);
    
    // 4. 发送设备地址（读模式）
    ack = soft_iic_tx_byte(iic, dev_addr | 0x01);
    if (!ack) {
        printf("dev_addr (read) no ack!\n");
        ret = -1;
        goto exit;
    }
    
    // 5. 读取数据
    ret = soft_iic_read_buf(iic, read_buf, read_len);
    
exit:
    // 发送停止条件
    soft_iic_stop(iic);
    return ret;
	/*
    u8 ack;
    int ret = 0;
    //local_irq_disable();
    //if (soft_iic_check_busy(iic) == IIC_ERROR_BUSY) { //busy
    //    ret = IIC_ERROR_BUSY; //busy
    //    goto _read_exit2;
    //}

    if ((reg_addr != 0) && (reg_len != 0)) {
        soft_iic_start(iic);
        ack = soft_iic_tx_byte(iic, dev_addr);
        if (ack == 0) {
            printf("dev_addr no ack!");
            //ret = IIC_ERROR_DEV_ADDR_ACK_ERROR; //无应答
			ret = -1;
            goto _read_exit1;
        }

        for (u8 i = 0; i < reg_len; i++) {
            ack = soft_iic_tx_byte(iic, reg_addr);
            if (ack == 0) {
                printf("reg_addr no ack!");
                //ret = IIC_ERROR_REG_ADDR_ACK_ERROR; //无应答
				ret = -1;
                goto _read_exit1;
            }
        }
    }

    soft_iic_start(iic);
    ack = soft_iic_tx_byte(iic, dev_addr | BIT(0));
    if (ack == 0) {
        printf("dev_addr no ack!");
        //ret = IIC_ERROR_DEV_ADDR_ACK_ERROR; //无应答
        goto _read_exit1;
    }

    ret = soft_iic_read_buf(iic, read_buf, read_len);
_read_exit1:
    soft_iic_stop(iic);

    return ret;*/
}


//如果无reg_addr:reg_addr=NULL,reg_len=0
//return: =write_len:ok, other:error
int soft_i2c_master_write_nbytes_to_device_reg(soft_iic_dev iic,
        unsigned char dev_addr, //设备地址
        int reg_addr, unsigned char reg_len,//设备寄存器地址，长度
        unsigned char *write_buf, int write_len)//数据buf, 写入长度
{
    int res;
    u8 ack;
    //local_irq_disable();//软件iic不可被中断
    //if (soft_iic_check_busy(iic) == IIC_ERROR_BUSY) { //busy
    //    res = IIC_ERROR_BUSY; //busy
    //    goto _write_exit2;
    //}

    soft_iic_start(iic);
    ack = soft_iic_tx_byte(iic, dev_addr);
    if (ack == 0) {
        printf("dev_addr no ack!");
        //res = IIC_ERROR_DEV_ADDR_ACK_ERROR; //无应答
		res = -1; //无应答
        goto _write_exit1;
    }

    if ((reg_addr !=0 ) && (reg_len != 0)) {
        for (u8 i = 0; i < reg_len; i++) {
            ack = soft_iic_tx_byte(iic, reg_addr);
            if (ack == 0) {
                printf("reg_addr no ack!");
                //res = IIC_ERROR_REG_ADDR_ACK_ERROR; //无应答
				res = -1;
                goto _write_exit1;
            }
        }
    }

    for (res = 0; res < write_len; res++) {
        if (0 == soft_iic_tx_byte(iic, write_buf[res])) {
            printf("write data no ack!");
            goto _write_exit1;
        }
    }
_write_exit1:
    soft_iic_stop(iic);

    return res;
}
#endif

static void udelay(u32 usec)
{
    /* if (set_to_close_timer0_delay) { */
    /*     JL_MCPWM->MCPWM_CON0 &= ~BIT(8 + 3); */
    /*     JL_MCPWM->TMR3_CNT = 0; */
    /*     JL_MCPWM->TMR3_PR = clk_get("lsb") / 1000000 * usec; */
    /*     JL_MCPWM->TMR3_CON = BIT(10) | BIT(0); */
    /*     JL_MCPWM->MCPWM_CON0 |= BIT(8 + 3); */
    /*     while (!(JL_MCPWM->TMR3_CON & BIT(12))); */
    /*     JL_MCPWM->TMR3_CON = BIT(10); */
    /*     JL_MCPWM->MCPWM_CON0 &= ~BIT(8 + 3); */
    /* } else { */
    JL_TIMER0->CON = BIT(14);
    JL_TIMER0->CNT = 0;
    JL_TIMER0->PRD = 16 * 1000000L / 1000000L  * usec; //1us
    JL_TIMER0->CON = BIT(0); //sys clk
    while ((JL_TIMER0->CON & BIT(15)) == 0);
    JL_TIMER0->CON = BIT(14);
    /* } */
}

void TRS55D_Init(){
    #if 0
	//LCD VDD3.3
	pmu_set_aldo_voltage(PMU_ALDO_MODE_NORMAL,PMU_ALDO_VOL_3_3);
	//LCD RESET
    system_set_port_mux(GPIO_PORT_A,GPIO_BIT_4,PORTA4_FUNC_A4);
    gpio_set_dir(GPIO_PORT_A, GPIO_BIT_4, GPIO_DIR_OUT);
    gpio_set_pin_value(GPIO_PORT_A,GPIO_BIT_4,1);
    co_delay_100us(1000);
	system_set_port_mux(GPIO_PORT_A, GPIO_BIT_6, PORTA6_FUNC_I2C1_CLK);//Pa6
    system_set_port_mux(GPIO_PORT_A, GPIO_BIT_7, PORTA7_FUNC_I2C1_DAT);//Pa7
    system_set_port_pull( (GPIO_PA6|GPIO_PA7), true);
   //IIC0, 1M hz. slave addr: 0xd6
    iic_init(IIC_CHANNEL_1,100,TRS_ADDR_AD);
    soft_iic_init(0);
    #endif

	//打开电源
    gpio_set_direction(IO_PORTA_02,0);
    gpio_direction_output(IO_PORTA_02, 1);
	//初始化IIC
    soft_iic_init(IIC_CHANNEL_1);
}
 uint8_t TRS55D_IIC_Read(uint8_t addr_dev, uint8_t addr_reg, uint8_t *buf, uint16_t count)
{

    #if 0
        uint8_t ret;
		 uint8_t ackflag;
		 uint16_t i = 0;
	    /*
		 drv_i2c_start();
		 drv_i2c_select_dev(addr_dev,DRV_I2C_OPWR);
		 drv_i2c_writebyte(addr_reg);
		 drv_i2c_start();
		 drv_i2c_select_dev(addr_dev,DRV_I2C_OPRD);
		 for(i = 0; i < count; i ++) {
				ackflag = (i < (count-1)) ? 1:0; buf[i] = drv_i2c_readbyte(ackflag);
		 }
		 drv_i2c_stop();
		 */

		 iic_read_bytes(IIC_CHANNEL_1, addr_dev, addr_reg, buf, count);

		 return ret;
         #endif
    //soft_iic_read_buf(IIC_CHANNEL_1, buf, count);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,
        addr_dev, //设备地址
        addr_reg, 1,//设备寄存器地址，长度
        buf, count);//数据buf, 写入长度

    return 1;
}

void TRS55D_IIC_Write(uint8_t addr_dev, uint8_t addr_reg, uint8_t *buf, uint16_t count)
 {
		 uint16_t i = 0;
	 /*
		 drv_i2c_start();
		 drv_i2c_select_dev(addr_dev,DRV_I2C_OPWR);
		 drv_i2c_writebyte(addr_reg);
		 for (i = 0; i < count; i ++)
		 {
			 drv_i2c_writebyte(buf[i]);
		 }
		 drv_i2c_stop();
		 */
		// iic_write_bytes(IIC_CHANNEL_1,addr_dev,addr_reg,buf,count);

        //soft_iic_write_buf(IIC_CHANNEL_1, buf, count);

		soft_i2c_master_write_nbytes_to_device_reg(IIC_CHANNEL_1,
        addr_dev, //设备地址
        addr_reg, 1,//设备寄存器地址，长度
        buf, count);//数据buf, 写入长度
 }


static char buffer[264];
uu32_t  obj,tmp_3, vtp_cor;
float tamb_temp ,vtp_cor_uv ,Tobj_temp ;

//#include "FW_TRS_CAL.h"
uint16_t t_objx10_u16;
int16_t Tambx10_u16;
uint16_t Trs_Read(uint16_t *t_body, uint16_t *t_ntc)
{

	uint8_t rbuf[4];
	uint8_t raddr, rdat;
	uint8_t waddr = 0x0, wdat = 0x0;
	int timeout = 0;

	waddr = 0x30;									// CMD
	wdat = 0x09;									// 0x0000 1 FSM  001 单通道连续转换
	TRS55D_IIC_Write(TRS_ADDR_AD, waddr, &wdat, 1); // start conversion 模式使能
	udelay(100);
	raddr = 0x03; // 原始数据地址
	do
	{
		TRS55D_IIC_Read(TRS_ADDR_AD, raddr, &rdat, 1);
	} while (((rdat == 0xFF) || (!(rdat & 0x30))) && timeout++ < 100); // 全真为真
																	   // flag置1 结果为真 取反为假跳出循环
	raddr = 0x02; // 经过校准后的数据地址
	do
	{
		TRS55D_IIC_Read(TRS_ADDR_AD, raddr, &rdat, 1);
	} while (((rdat == 0xFF) || (!(rdat & 0x0B))) && timeout++ < 200);
	// flag置1 结果为真 取反为假跳出循环
	udelay(500);

	// raddr = NORMAL_DATA1_MSB_R;//0x19 通道1校准后adc数据


	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x19, &rbuf[0]);
	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x1A, &rbuf[1]);
	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x1B, &rbuf[2]);

	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x19, 1,&rbuf[0], 1);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x1A, 1,&rbuf[1], 1);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x1B, 1,&rbuf[2], 1);


	//printf("0x19:%02X   0x1A:%02X    0x1B:%02X \r\n", rbuf[0], rbuf[1], rbuf[2]);

	vtp_cor.un.u8b2 = rbuf[0];
	vtp_cor.un.u8b1 = rbuf[1];
	vtp_cor.un.u8b0 = rbuf[2];
	if (vtp_cor.un.u8b2 & 0x80)
	{
		vtp_cor.un.u8b3 = 0xFF;
	}
	else
	{
		vtp_cor.un.u8b3 = 0x00;
	}
	float vt_cor = 524288;
	vtp_cor_uv = (float)vtp_cor.i32 / vt_cor; // vtp_cor_uv=DATA1/2^19（±16mV）=vtp_cor.i32/vt_cor
	vtp_cor_uv *= 1000.0;

	// raddr = NORMAL_TEMP_MSB_R;//0x16环境校准后温度
	// TRS55D_IIC_Read (TRS_ADDR_AD, raddr, &rbuf[0],3);
	// uint8_t iic_read_byte(enum iic_channel_t channel, uint8_t slave_addr, uint8_t reg_addr, uint8_t *buffer)

	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x16, &rbuf[0]);
	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x17, &rbuf[1]);
	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x18, &rbuf[2]);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x16, 1,&rbuf[0], 1);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x17, 1,&rbuf[1], 1);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x18, 1,&rbuf[2], 1);

	//printf("0x16:%02X   0x17:%02X    0x18:%02X \r\n", rbuf[0], rbuf[1], rbuf[2]);

	tmp_3.un.u8b2 = rbuf[0];
	tmp_3.un.u8b1 = rbuf[1];
	tmp_3.un.u8b0 = rbuf[2];
	if (tmp_3.un.u8b2 & 0x80)
	{
		tmp_3.un.u8b3 = 0xFF;
	}
	else
	{
		tmp_3.un.u8b3 = 0x00;
	}

	// raddr = NORMAL_Tobj_MSB_R;//0x10 dsp处理数据据
	// TRS55D_IIC_Read (TRS_ADDR_AD, raddr, &rbuf[0],3);

	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x10, &rbuf[0]);
	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x11, &rbuf[1]);
	//iic_read_byte(IIC_CHANNEL_1, TRS_ADDR_AD, 0x12, &rbuf[2]);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x10, 1,&rbuf[0], 1);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x11, 1,&rbuf[1], 1);
	soft_i2c_master_read_nbytes_from_device_reg(IIC_CHANNEL_1,TRS_ADDR_AD,0x12, 1,&rbuf[2], 1);

	//printf("0x10:%02X   0x11:%02X    0x12:%02X \r\n", rbuf[0], rbuf[1], rbuf[2]);

	obj.un.u8b2 = rbuf[0];
	obj.un.u8b1 = rbuf[1];
	obj.un.u8b0 = rbuf[2];
	if (obj.un.u8b2 & 0x80)
	{
		obj.un.u8b3 = 0xFF;
	}
	else
	{
		obj.un.u8b3 = 0x00;
	}
	// co_printf("NORMAL_Tobj_MSB_R :%02X %02X %02X\r\n",rbuf[0],rbuf[1],rbuf[2]);

	//printf("tmp_3.i32:  %d   obj.i32:  %d \r\n", tmp_3.i32, obj.i32);

	Cal_get_temp(tmp_3.i32, 1000, obj.i32, 1000, &Tambx10_u16, &t_objx10_u16);
	Tobj_temp = (float)t_objx10_u16 / 10;
	tamb_temp = (float)Tambx10_u16 / 10;



	*t_body = (uint16_t)(Tobj_temp * 100);
	*t_ntc = (uint16_t)(tamb_temp * 100);


	return 1;
}

 /*
 static char buffer[264];
 uu32_t tobj, tamb_cal;
 uu32_t vtp_cor;
 float vtp_uv_f = 0.0;
 float vtp_cor_f = 0.0;
 float tambf = 0.0;
 float tobjf = 0.0;
 float tbdyf = 0.0;

 void TRS55D_read(void){

	 co_printf("TRS55D_read !! \r\n");
	 uint8_t rbuf[4];
	 uint8_t raddr,rdat;
	 uint8_t waddr = 0x0, wdat = 0x0;
	 int timeout=0;

	 iic_read_byte(IIC_CHANNEL_1, ADDR_TRS55D, 0x97, &rdat);
	 co_printf("read raddr :%02X  rdat %02X\r\n",0x97,rdat);
	 co_delay_100us(1000);
	 waddr = 0x30; wdat = 0x09;
	 TRS55D_IIC_Write(ADDR_TRS55D, waddr, &wdat,1); //start conversion
	 //delay_ms(100);
	 co_delay_100us(1000);
	 // waite for conversion over
	 // co_printf("waite for conversion over !! \r\n");
   raddr = 0x03;
	 do {
		 TRS55D_IIC_Read (ADDR_TRS55D, raddr, &rdat,1);
		  co_printf("read raddr :%02X  rdat %02X\r\n",raddr,rdat);
	 } while(((rdat == 0xFF) || (!(rdat & 0x30))) && timeout++ < 200);
	 raddr = 0x02;
	 do {
		 TRS55D_IIC_Read (ADDR_TRS55D, raddr, &rdat,1);
		  co_printf("read raddr :%02X  rdat %02X\r\n",raddr,rdat);
	 } while(((rdat == 0xFF) || (!(rdat & 0x0B))) && timeout++ < 200);
	 // voltage value after calibration
	 raddr = TRS55D_NORMAL_DATA1_MSB_R;
	 TRS55D_IIC_Read (ADDR_TRS55D, raddr,&rbuf[0],3);

	 co_printf("NORMAL_DATA1_MSB_R :%02X %02X %02X\r\n",rbuf[0],rbuf[1],rbuf[2]);
	 vtp_cor.un.u8b2 = rbuf[0];
	 vtp_cor.un.u8b1 = rbuf[1];
	 vtp_cor.un.u8b0 =rbuf[2];
	 if (vtp_cor.un.u8b2 & 0x80)
	 {
			vtp_cor.un.u8b3 = 0xFF;
	 }else {
			vtp_cor.un.u8b3 = 0x00;// vtp after corrected
	 }
	 vtp_cor_f = (float)vtp_cor.i32/524288.0;
	 vtp_cor_f *= 1000;
	 // ambient temperature value after calibration
	 raddr = TRS55D_NORMAL_TEMP_MSB_R;
	 TRS55D_IIC_Read (ADDR_TRS55D,raddr,&rbuf[0],3);
	 co_printf("NORMAL_TEMP_MSB_R :%02X %02X %02X\r\n",rbuf[0],rbuf[1],rbuf[2]);
	 tamb_cal.un.u8b2 = rbuf[0];
	 tamb_cal.un.u8b1 =rbuf[1];
	 tamb_cal.un.u8b0 =rbuf[2];
	 tambf = (float)tamb_cal.i32 / 16384.0;
	 // ambient temperature
	 // object(surface) temperature after calibration
	 raddr = TRS55D_NORMAL_Tobj_MSB_R;
	 TRS55D_IIC_Read (ADDR_TRS55D,raddr,&rbuf[0],3);
	 tobj.un.u8b2 = rbuf[0];
	 tobj.un.u8b1 = rbuf[1];
	 tobj.un.u8b0 =rbuf[2];

	 tobjf = (float)tobj.i32 / 16384.0;
	 sprintf(buffer, "tambf = %.2f, vtp_cor = %.2f, tobj = %.2f, tbdy = %.2f\r\n",tambf,vtp_cor_f,tobjf,tbdyf);
	 co_printf("%s \r\n",buffer);

	 //co_printf("tambf:%.2f  vtp_cor_f:%.2f  tobjf:%.2f \r\n",tambf,vtp_cor_f,tobjf);
	 // object(surface) temperature
	 // get bodytemp
	 //tbdyf = get_body_temp(tambf,tobjf);
	 // get bodytemp
	 // display on uart
	// sprintf(buffer, "tamb = %.2f, vtp_cor = %.2f, tobj = %.2f, tbdy = %.2f\r\n",\tambf,vtp_cor_f,tobjf,tbdyf);
	 //uartSendString(buffer);
	 // display on oled
	 /*
	 float vals[4] = {tambf, vtp_cor_f, tobjf, tbdyf+0.05};
	 OLED_ShowBNum(64, 0, vals[0], 4, 16, 1); // Tamb
	 OLED_ShowBNum(48, 16, vals[1], 6, 16, 1); // vtp
	 OLED_ShowString(112,16,"uv",16, 1);
	 OLED_ShowBNum(64, 32, vals[2], 4, 16, 1); // Tobj
	 OLED_ShowBNum(64, 48, vals[3], 4, 16, 1); // Tbdy
	 */
//}*/