511 lines
15 KiB
C
511 lines
15 KiB
C
|
// 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
|
|||
|
|
*/
|
|||
|
|
//}*/
|
|||
|
|
|