WangYongFei/400Vhuganqi
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
main
400Vhuganqi/082418vnlp6lnxpdjm5ldp/rn8209/RN8209D.c

1071 lines
28 KiB
C
Raw Permalink Normal View History

首次提交
2024-12-10 20:11:28 +08:00
#include "RN8209D.h"
#include "platform_config.h"
#include "delay.h"
#include "stm32f0xx_gpio.h"
#include "global.h"
#include <math.h> //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
#define USING_SOFT_SPI
#define RN8209D_CS_SET() GPIO_SetBits(GPIOB,GPIO_Pin_5)
#define RN8209D_CS_CLR() GPIO_ResetBits(GPIOB,GPIO_Pin_5)
#define RN8209D_SCK_SET() GPIO_SetBits(GPIOD,GPIO_Pin_2)
#define RN8209D_SCK_CLR() GPIO_ResetBits(GPIOD,GPIO_Pin_2)
#define RN8209D_Read_MISO() GPIO_ReadInputDataBit(GPIOB,GPIO_Pin_3)
#define RN8209D_MOSI_SET() GPIO_SetBits(GPIOB,GPIO_Pin_4)
#define RN8209D_MOSI_CLR() GPIO_ResetBits(GPIOB,GPIO_Pin_4)
#ifdef USE_SMARTACU110
#define RN8209D_RST_SET() GPIO_SetBits(GPIOC,GPIO_Pin_10)
#define RN8209D_RST_CLR() GPIO_ResetBits(GPIOC,GPIO_Pin_10)
#endif
#ifdef USE_SMARTACU120
#define RN8209D_RST_SET() GPIO_SetBits(GPIOC,GPIO_Pin_7)
#define RN8209D_RST_CLR() GPIO_ResetBits(GPIOC,GPIO_Pin_7)
#endif
#define RNDelay delay_us
#define RN_CLOCKWIDTH 30
StDef_RN8209DPara StDef_RN8209DPara_Reg;
void RN8209D_GetCheckSum(void);
void RN8209D_ReadRegNoCheck(uint8_t addr,uint8_t *regbuf,uint8_t regbuflen)
{
uint8_t ucI,ucK;
RN8209D_CS_CLR();
delay_us(10);
addr |= 0x00; //<2F><><EFBFBD>Ͷ<EFBFBD><CDB6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>(bit.7=0)
for(ucI=0;ucI<8;ucI++) //<2F><><EFBFBD>Ͷ<EFBFBD><CDB6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>,<2C>½<EFBFBD><C2BD>ؽ<EFBFBD><D8BD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>,<2C><>λ<EFBFBD><CEBB>ǰ<EFBFBD><C7B0><EFBFBD><EFBFBD>λ<EFBFBD>ں<EFBFBD>
{
if( addr & 0x80 )
RN8209D_MOSI_SET();
else
RN8209D_MOSI_CLR();
RN8209D_SCK_SET();
delay_us(RN_CLOCKWIDTH);
RN8209D_SCK_CLR(); //<2F><>ʱ<EFBFBD>ӵ<EFBFBD><D3B5>½<EFBFBD><C2BD><EFBFBD>д<EFBFBD><D0B4><EFBFBD><EFBFBD>
addr<<=1;
delay_us(RN_CLOCKWIDTH);
}
RN8209D_MOSI_CLR();
RN8209D_SCK_CLR();
delay_us(50);
for(ucK=0;ucK<regbuflen;ucK++)
{
regbuf[ucK]=0x00;
for(ucI=0;ucI<8;ucI++)
{
RN8209D_SCK_SET();
delay_us(RN_CLOCKWIDTH);
regbuf[ucK]<<=1;
RN8209D_SCK_CLR(); //<2F><>ʱ<EFBFBD>ӵ<EFBFBD><D3B5>½<EFBFBD><C2BD>ض<EFBFBD><D8B6><EFBFBD><EFBFBD><EFBFBD>
delay_us(RN_CLOCKWIDTH/2);
if(RN8209D_Read_MISO())
regbuf[ucK]=regbuf[ucK]|0x01;
delay_us(RN_CLOCKWIDTH/2);
}
}
RN8209D_CS_SET();
delay_us(10);
RN8209D_SCK_CLR();
delay_us(10);
}
uint8_t RN8209D_ReadReg(uint8_t addr,uint8_t *regbuf,uint8_t regbuflen)
{
uint8_t buf[4];
RN8209D_ReadRegNoCheck(addr,regbuf,regbuflen);
m_memset(buf,0x01,4);
RN8209D_ReadRegNoCheck(Reg_RData,buf,4);
if(regbuflen == 3){
if(m_memcmp(regbuf,buf+1,regbuflen) == 0)
return 0;
else
return 1;
}
else if(regbuflen == 4){
if(m_memcmp(regbuf,buf,regbuflen) == 0)
return 0;
else
return 1;
}
else if(regbuflen == 2){
if(m_memcmp(regbuf,buf+2,regbuflen) == 0)
return 0;
else
return 1;
}
else{
return 1;
}
}
void RN8209D_WriteRegNoCheck(uint8_t addr,uint8_t *regbuf,uint8_t regbuflen)
{
uint8_t ucI,ucK;
RN8209D_CS_CLR();
delay_us(100);
addr |= 0x80; //<2F><><EFBFBD><EFBFBD>д<EFBFBD><D0B4><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>(bit.7=1)
for(ucI=0;ucI<8;ucI++)
{
if( addr & 0x80 )
RN8209D_MOSI_SET();
else
RN8209D_MOSI_CLR(); ;
RN8209D_SCK_SET();
delay_us(RN_CLOCKWIDTH);
RN8209D_SCK_CLR(); //<2F><>ʱ<EFBFBD>ӵ<EFBFBD><D3B5>½<EFBFBD><C2BD><EFBFBD>д<EFBFBD><D0B4><EFBFBD><EFBFBD>
addr<<=1;
delay_us(RN_CLOCKWIDTH);
}
RN8209D_MOSI_CLR();
RN8209D_SCK_CLR();
delay_us(500);
for(ucK=0;ucK<regbuflen;ucK++)
{
for(ucI=0;ucI<8;ucI++)
{
if(regbuf[ucK] & 0x80 )
RN8209D_MOSI_SET();
else
RN8209D_MOSI_CLR();
RN8209D_SCK_SET();
delay_us(RN_CLOCKWIDTH);
RN8209D_SCK_CLR(); //<2F><>ʱ<EFBFBD>ӵ<EFBFBD><D3B5>½<EFBFBD><C2BD><EFBFBD>д<EFBFBD><D0B4><EFBFBD><EFBFBD>
regbuf[ucK]<<=1;
delay_us(RN_CLOCKWIDTH);
}
}
RN8209D_MOSI_CLR();
delay_us(100);
RN8209D_CS_SET();
delay_us(100);
RN8209D_SCK_CLR();
delay_us(100);
}
uint8_t RN8209D_WriteReg(uint8_t addr,uint8_t *regbuf,uint8_t regbuflen)
{
uint8_t buf[4];
RN8209D_WriteRegNoCheck(addr,regbuf,regbuflen);
m_memset(buf,0,4);
RN8209D_WriteRegNoCheck(Reg_WData,buf,regbuflen);
if(regbuflen == 3){
if(m_memcmp(regbuf,buf+1,regbuflen) == 0)
return 0;
else
return 1;
}
else if(regbuflen == 4){
if(m_memcmp(regbuf,buf,regbuflen) == 0)
return 0;
else
return 1;
}
else if(regbuflen == 2){
if(m_memcmp(regbuf,buf+2,regbuflen) == 0)
return 0;
else
return 1;
}
else{
return 1;
}
}
static void RN8209D_GPIOConfig(void)
{
GPIO_InitTypeDef GPIO_InitStructure;
RCC_AHBPeriphClockCmd(RCC_AHBPeriph_GPIOB|RCC_AHBPeriph_GPIOC|RCC_AHBPeriph_GPIOD,ENABLE);
/* SCLK */
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_2;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;//GPIO_OType_PP;
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;//GPIO_PuPd_NOPULL;//;
GPIO_Init(GPIOD, &GPIO_InitStructure);
/* CS MOSI */
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_4|GPIO_Pin_5;
GPIO_Init(GPIOB, &GPIO_InitStructure);
#ifdef USE_SMARTACU110
/* RST */
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10;
GPIO_SetBits(GPIOC,GPIO_Pin_10); //û<><C3BB><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>䣬<EFBFBD>ᵼ<EFBFBD>³<EFBFBD>ʼ<EFBFBD><CABC><EFBFBD><EFBFBD><EFBFBD>˿<EFBFBD><CBBF><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ƽΪ0
GPIO_Init(GPIOC, &GPIO_InitStructure);
#endif
#ifdef USE_SMARTACU120
/* RST */
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7;
GPIO_Init(GPIOC, &GPIO_InitStructure);
#endif
/* MISO */
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_3;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN;
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
GPIO_Init(GPIOB, &GPIO_InitStructure);
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>ȡ00H~17H<EFBFBD>Ĵ<EFBFBD><EFBFBD><EFBFBD>У<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
void RN8209D_GetCheckSum(void)
{
uint16_t regbuf[24],i;
//00H ϵͳ<CFB5><CDB3><EFBFBD>ƼĴ<C6BC><C4B4><EFBFBD>
regbuf[0] = 0x0051;
//01H <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[1] = 0x8003; //<2F><><EFBFBD>ܶ<EFBFBD><DCB6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
//02H дHFCONST
regbuf[2] = 0x357B;
//03H,04H<34><48><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[3] = 0x012D;
regbuf[4] = 0x012D;
//05H Aͨ<41><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>;
regbuf[5] = StDef_RN8209DPara_Reg.Cst_GPQA;
//06HBͨ<42><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[6] = StDef_RN8209DPara_Reg.Cst_GPQB;
//07H Aͨ<41><CDA8><EFBFBD><EFBFBD>λУ<CEBB><D0A3>
regbuf[7] = StDef_RN8209DPara_Reg.Cst_PhsA;
//08 Bͨ<42><CDA8><EFBFBD><EFBFBD>λУ<CEBB><D0A3>
regbuf[8] = StDef_RN8209DPara_Reg.Cst_PhsB;
//09 <20>޹<EFBFBD><DEB9><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
regbuf[9] = 0;
//0AH Aͨ<41><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[10] = StDef_RN8209DPara_Reg.Cst_APOSA;
//0BH Bͨ<42><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[11] = StDef_RN8209DPara_Reg.Cst_APOSB;
//0CH Aͨ<41><CDA8><EFBFBD>޹<EFBFBD><DEB9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[12] = StDef_RN8209DPara_Reg.Cst_RPOSA;
//0DH Bͨ<42><CDA8><EFBFBD>޹<EFBFBD><DEB9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[13] = StDef_RN8209DPara_Reg.Cst_RPOSB;
//0EH Aͨ<41><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[14] = StDef_RN8209DPara_Reg.Cst_IARMSOS;
//0FH Bͨ<42><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[15] = StDef_RN8209DPara_Reg.Cst_IBRMSOS;
//10H Bͨ<42><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[16] = StDef_RN8209DPara_Reg.Cst_IBGain;
//11H <20>޹<EFBFBD><DEB9><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
regbuf[17] = 0;
//12H <20>޹<EFBFBD><DEB9><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
regbuf[18] = 0;
//13H <20>޹<EFBFBD><DEB9><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
regbuf[19] = 0;
//14H <20>޹<EFBFBD><DEB9><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
regbuf[20] = 0;
//15H <20>޹<EFBFBD><DEB9><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
regbuf[21] = 0;
//16H <20>޹<EFBFBD><DEB9><EFBFBD>λ<EFBFBD><CEBB><EFBFBD><EFBFBD>
regbuf[22] = 0;
//17H <20><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2
regbuf[23] = 0x00B0;
StDef_RN8209DPara_Reg.cheskSum = 0;
for(i=0;i<24;i++){
StDef_RN8209DPara_Reg.cheskSum += regbuf[i];
}
StDef_RN8209DPara_Reg.cheskSum = ~StDef_RN8209DPara_Reg.cheskSum;
}
uint8_t RN8209D_Init(void)
{
uint8_t regbuf[4];
uint8_t status = 1;
RN8209D_GPIOConfig();
RN8209D_RST_CLR();
delay_ms(100);
RN8209D_RST_SET();
delay_ms(100);
//<2F><>ȡRN8209 DeviceID
if(RN8209D_ReadReg(Reg_DeviceID,regbuf,3) == 0)
{
if((regbuf[0]==0x82)&&(regbuf[1]==0x09)&&(regbuf[2]==0x00)){
status = 0;
}
else{
status = 1;
}
}
//Ĭ<>ϻ<EFBFBD><CFBB><EFBFBD>ϵ<EFBFBD><CFB5>
//StDef_RN8209DPara_Reg.Cst_Kia = 41938;
//StDef_RN8209DPara_Reg.Cst_Kib = 44529;
//StDef_RN8209DPara_Reg.Cst_Ku = 8711;
if(status == 0)
{
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//<2F><>λ
regbuf[0] = 0xFA;
RN8209D_WriteReg(WREN,regbuf,1);
delay_ms(20);
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//ϵͳ<CFB5><CDB3><EFBFBD>ƼĴ<C6BC><C4B4><EFBFBD>
regbuf[0] = 0x00;
regbuf[1] = 0x51; //<2F><><EFBFBD><EFBFBD>ͨ<EFBFBD><CDA8>B,A<><41>Bͨ<42><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2
RN8209D_WriteReg(Reg_SYSCON,regbuf,2);
m_memset(regbuf,0,2);
RN8209D_ReadReg(Reg_SYSCON,regbuf,2);
//дHFCONST
regbuf[0] = 0x35;
regbuf[1] = 0x7B;
RN8209D_WriteReg(Reg_HFCONST,regbuf,2);
m_memset(regbuf,0,2);
RN8209D_ReadReg(Reg_HFCONST,regbuf,2);
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[0] = 0x01;
regbuf[1] = 0x2D;
RN8209D_WriteReg(Reg_PStart,regbuf,2);
regbuf[0] = 0x01;
regbuf[1] = 0x2D;
RN8209D_WriteReg(Reg_DStart,regbuf,2);
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[0] = 0x80; //<2F><><EFBFBD>ܶ<EFBFBD><DCB6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[1] = 0x03;
RN8209D_WriteReg(Reg_EMUCON,regbuf,2);
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2
regbuf[0] = 0x00;
regbuf[1] = 0xB0;
RN8209D_WriteReg(Reg_EMUCON2,regbuf,2);
//Aͨ<41><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
//StDef_RN8209DPara_Reg.Cst_GPQA = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_GPQA/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_GPQA%256;
RN8209D_WriteReg(Reg_GPQA,regbuf,2);
//Bͨ<42><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
//StDef_RN8209DPara_Reg.Cst_GPQB = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_GPQB/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_GPQB%256;
RN8209D_WriteReg(Reg_GPQB,regbuf,2);
//Aͨ<41><CDA8><EFBFBD><EFBFBD>λУ<CEBB><D0A3>
//StDef_RN8209DPara_Reg.Cst_PhsA = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_PhsA;
RN8209D_WriteReg(Reg_PhsA,regbuf,1);
//Bͨ<42><CDA8><EFBFBD><EFBFBD>λУ<CEBB><D0A3>
//StDef_RN8209DPara_Reg.Cst_PhsB = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_PhsB;
RN8209D_WriteReg(Reg_PhsB,regbuf,1);
//Aͨ<41><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD>offset
//StDef_RN8209DPara_Reg.Cst_APOSA = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_APOSA/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_APOSA%256;
RN8209D_WriteReg(Reg_APOSA,regbuf,2);
//Bͨ<42><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD>offset
//StDef_RN8209DPara_Reg.Cst_APOSB = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_APOSB/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_APOSB%256;
RN8209D_WriteReg(Reg_APOSB,regbuf,2);
//Aͨ<41><CDA8><EFBFBD>޹<EFBFBD><DEB9><EFBFBD><EFBFBD><EFBFBD>offset
StDef_RN8209DPara_Reg.Cst_RPOSA = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_RPOSA/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_RPOSA%256;
RN8209D_WriteReg(Reg_RPOSA,regbuf,2);
//Bͨ<42><CDA8><EFBFBD>޹<EFBFBD><DEB9><EFBFBD><EFBFBD><EFBFBD>offset
StDef_RN8209DPara_Reg.Cst_RPOSB = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_RPOSB/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_RPOSB%256;
RN8209D_WriteReg(Reg_RPOSB,regbuf,2);
//Aͨ<41><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>offset
//StDef_RN8209DPara_Reg.Cst_IARMSOS = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_IARMSOS/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_IARMSOS%256;
RN8209D_WriteReg(Reg_IARMSOS,regbuf,2);
//Bͨ<42><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>offset
//StDef_RN8209DPara_Reg.Cst_IBRMSOS = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_IBRMSOS/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_IBRMSOS%256;
RN8209D_WriteReg(Reg_IBRMSOS,regbuf,2);
//Bͨ<42><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
StDef_RN8209DPara_Reg.Cst_IBGain = 0;
regbuf[0] = StDef_RN8209DPara_Reg.Cst_IBGain/256;
regbuf[1] = StDef_RN8209DPara_Reg.Cst_IBGain%256;
RN8209D_WriteReg(Reg_IBGain,regbuf,2);
//ֱ<><D6B1>ͨ<EFBFBD><CDA8>
regbuf[0]=0;regbuf[1]=0;
RN8209D_WriteReg(Reg_D2FPL,regbuf,2);
regbuf[0]=0;regbuf[1]=0;
RN8209D_WriteReg(Reg_D2FPH,regbuf,2);
regbuf[0]=0;regbuf[1]=0;
RN8209D_WriteReg(Reg_DCIAH,regbuf,2);
regbuf[0]=0;regbuf[1]=0;
RN8209D_WriteReg(Reg_DCIBH,regbuf,2);
regbuf[0]=0;regbuf[1]=0;
RN8209D_WriteReg(Reg_DCUH,regbuf,2);
regbuf[0]=0;regbuf[1]=0;
RN8209D_WriteReg(Reg_DCL,regbuf,2);
//д<><D0B4><EFBFBD><EFBFBD>
regbuf[0] = 0xDC;
RN8209D_WriteReg(WREN,regbuf,1);
//<2F><>ȡУ<C8A1><D0A3><EFBFBD>Ĵ<EFBFBD><C4B4><EFBFBD>У<EFBFBD><D0A3>ֵ
RN8209D_GetCheckSum();
}
return status;
}
void RN8209D_CalibrateInit(void)
{
uint8_t regbuf[4];
uint8_t status = 1;
//<2F><>ȡRN8209 DeviceID
if(RN8209D_ReadReg(Reg_DeviceID,regbuf,3) == 0){
if((regbuf[0]==0x82)&&(regbuf[1]==0x09)&&(regbuf[2]==0x00)){
status = 0;
}
else{
status = 1;
}
}
//Ĭ<>ϻ<EFBFBD><CFBB><EFBFBD>ϵ<EFBFBD><CFB5>
//StDef_RN8209DPara_Reg.Cst_Kia = 41938;
//StDef_RN8209DPara_Reg.Cst_Kib = 44529;
//StDef_RN8209DPara_Reg.Cst_Ku = 8711;
if(status == 0){
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//<2F><>λ
regbuf[0] = 0xFA;
RN8209D_WriteReg(WREN,regbuf,1);
delay_ms(20);
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//ϵͳ<CFB5><CDB3><EFBFBD>ƼĴ<C6BC><C4B4><EFBFBD>
regbuf[0] = 0x00;
regbuf[1] = 0x51; //<2F><><EFBFBD><EFBFBD>ͨ<EFBFBD><CDA8>B
RN8209D_WriteReg(Reg_SYSCON,regbuf,2);
m_memset(regbuf,0,2);
RN8209D_ReadReg(Reg_SYSCON,regbuf,2);
//дHFCONST
regbuf[0] = 0x35;
regbuf[1] = 0x7B;
RN8209D_WriteReg(Reg_HFCONST,regbuf,2);
m_memset(regbuf,0,2);
RN8209D_ReadReg(Reg_HFCONST,regbuf,2);
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[0] = 0x01;
regbuf[1] = 0x2D;
RN8209D_WriteReg(Reg_PStart,regbuf,2);
regbuf[0] = 0x01;
regbuf[1] = 0x2D;
RN8209D_WriteReg(Reg_DStart,regbuf,2);
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[0] = 0x80; //<2F><><EFBFBD>ܶ<EFBFBD><DCB6><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[1] = 0x03;
RN8209D_WriteReg(Reg_EMUCON,regbuf,2);
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>2
regbuf[0] = 0x00;
regbuf[1] = 0xB0; //<2F>Զ<EFBFBD><D4B6><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ܼĴ<DCBC><C4B4><EFBFBD>ΪBͨ<42><CDA8>
RN8209D_WriteReg(Reg_EMUCON2,regbuf,2);
//Bͨ<42><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_IBGain,regbuf,2);
//Aͨ<41><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_GPQA,regbuf,2);
//Bͨ<42><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_GPQB,regbuf,2);
//Aͨ<41><CDA8><EFBFBD><EFBFBD>λУ<CEBB><D0A3>
regbuf[0] = 0;
RN8209D_WriteReg(Reg_PhsA,regbuf,1);
//Bͨ<42><CDA8><EFBFBD><EFBFBD>λУ<CEBB><D0A3>
regbuf[0] = 0;
RN8209D_WriteReg(Reg_PhsB,regbuf,1);
//Aͨ<41><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_APOSA,regbuf,2);
//Bͨ<42><CDA8><EFBFBD>й<EFBFBD><D0B9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_APOSB,regbuf,2);
//Aͨ<41><CDA8><EFBFBD>޹<EFBFBD><DEB9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_RPOSA,regbuf,2);
//Bͨ<42><CDA8><EFBFBD>޹<EFBFBD><DEB9><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_RPOSB,regbuf,2);
//Aͨ<41><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_IARMSOS,regbuf,2);
//Bͨ<42><CDA8><EFBFBD><EFBFBD><EFBFBD><EFBFBD>offset
regbuf[0] = 0;
regbuf[1] = 0;
RN8209D_WriteReg(Reg_IBRMSOS,regbuf,2);
//У<><D0A3>ʱ<EFBFBD><CAB1>Ҫд<D2AA><D0B4><EFBFBD><EFBFBD>
}
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD>У׼<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
void RN8209D_CalibrateGPQxErr(uint8_t phase,int16_t err)
{
const uint16_t regGPx[]={Reg_GPQA,Reg_GPQB};
const uint16_t regArry[]={Reg_PowerPA,Reg_PowerPB};
uint8_t regbuf[5];
float k = 0;
uint16_t GPQx;
uint16_t tempValue;
//<2F>ж<EFBFBD><D0B6>Ƿ<EFBFBD><C7B7>Ǹ<EFBFBD><C7B8><EFBFBD>
if(err & 0x8000){
err &= 0x7fff;
err = -err;
}
k = (-err/10000.0)/(1+err/10000.0);
if(k > 0){
GPQx = (uint16_t)(k*32768);
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
regbuf[0] = GPQx/256;
regbuf[1] = GPQx%256;
RN8209D_WriteReg(regGPx[phase],regbuf,2);
}
else{
GPQx = (uint16_t)(k*32768+65536);
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//д<>Ĵ<EFBFBD><C4B4><EFBFBD>
regbuf[0] = GPQx/256;
regbuf[1] = GPQx%256;
RN8209D_WriteReg(regGPx[phase],regbuf,2);
m_memset(regbuf,0x00,2);
RN8209D_ReadReg(regGPx[phase],regbuf,2);
}
if(phase == phase_A){
StDef_RN8209DPara_Reg.Cst_GPQA = GPQx;
if(RN8209D_ReadReg(regArry[phase],regbuf,2)==0){
tempValue = regbuf[0]*256+regbuf[1];
//StDef_RN8209DPara_Reg.Cst_Kpa = tempValue / 1100;
}
}
else if(phase == phase_B){
StDef_RN8209DPara_Reg.Cst_GPQB = GPQx;
if(RN8209D_ReadReg(regArry[phase],regbuf,2)==0){
tempValue = regbuf[0]*256+regbuf[1];
//StDef_RN8209DPara_Reg.Cst_Kpb = tempValue / 1100;
}
}
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD>У׼<EFBFBD><EFBFBD>λ
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
void RN8209D_CalibratePhsXErr(uint8_t phase,int16_t err)
{
double k = 0;
uint8_t phsValue = 0;
const uint16_t regGPx[]={Reg_PhsA,Reg_PhsB};
uint8_t regbuf[5];
k = asin(-err/10000.0/1.732)*180/3.142;
if(k > 0){
phsValue = (uint8_t)(k/0.02);
}
else{
phsValue = (uint8_t)(k/0.02+512);
}
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//д<>Ĵ<EFBFBD><C4B4><EFBFBD>
regbuf[0] = phsValue;
RN8209D_WriteReg(regGPx[phase],regbuf,1);
if(phase == phase_A){
StDef_RN8209DPara_Reg.Cst_PhsA = phsValue;
}
else if(phase == phase_B){
StDef_RN8209DPara_Reg.Cst_PhsB = phsValue;
}
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>й<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>offset
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
//void RN8209D_CalibrateAPOSx(uint8_t phase)
//{
// uint8_t regbuf[5];
// uint32_t regtemp[12],regtotal=0;
// const uint16_t regArry[]={Reg_PowerPA,Reg_PowerPB};
// const uint16_t reg_APOSArry[]={Reg_APOSA,Reg_APOSB};
// uint8_t i = 0;
// uint16_t temp;
// for(i=0;i<12;i++){
// if(RN8209D_ReadReg(regArry[phase],regbuf,4)==0){
// regtemp[i] = (regbuf[0]<<24)+(regbuf[1]<<16)+(regbuf[2]<<8)+(regbuf[3]);
// //<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
// if(regtemp[i]&0x80000000){
// regtemp[i] = ~regtemp[i];
// regtemp[i] += 1;
// }
// }
// delay_ms(350);
// }
// //<2F><>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD>Ҫ
// for(i=1;i<12;i++){
// regtotal += regtemp[i];
// }
// regtotal /= 11;
// temp = (regtotal&0x0000FFFF);
// //дʹ<D0B4><CAB9>
// regbuf[0] = 0xE5;
// RN8209D_WriteReg(WREN,regbuf,1);
// //д<>Ĵ<EFBFBD><C4B4><EFBFBD>
// regbuf[0] = temp/256;regbuf[1] = temp%256;
// RN8209D_WriteReg(reg_APOSArry[phase],regbuf,2);
//}
void RN8209D_CalibrateAPOSx(uint8_t phase)
{
uint8_t regbuf[5];
uint32_t regtemp[12],regtotal=0;
const uint16_t regArry[]={Reg_PowerPA,Reg_PowerPB};
const uint16_t reg_APOSArry[]={Reg_APOSA,Reg_APOSB};
const uint16_t reg_GPQxArry[]={Reg_GPQA,Reg_GPQB};
uint8_t i = 0;
uint16_t temp;
float gGPQx = 0;
double k = 0;
for(i=0;i<12;i++){
if(RN8209D_ReadReg(regArry[phase],regbuf,4)==0){
regtemp[i] = (regbuf[0]<<24)+(regbuf[1]<<16)+(regbuf[2]<<8)+(regbuf[3]);
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
if(regtemp[i]&0x80000000){
regtemp[i] = ~regtemp[i];
regtemp[i] += 1;
}
}
delay_ms(350);
}
//<2F><>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD>Ҫ
for(i=1;i<12;i++){
regtotal += regtemp[i];
}
regtotal /= 11;
RN8209D_ReadReg(reg_GPQxArry[phase],regbuf,2);
temp = regbuf[0]*256+regbuf[1];
if(temp&0x8000)
{
gGPQx = (temp-65536)/32768.0;
}
else{
gGPQx = temp/32768.0;
}
k = (602299-regtotal)/(1+gGPQx);
if(k > 0){
temp = (uint16_t)k;
}
else{
temp = (uint16_t)(k+65536);
}
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//д<>Ĵ<EFBFBD><C4B4><EFBFBD>
regbuf[0] = temp/256;regbuf[1] = temp%256;
RN8209D_WriteReg(reg_APOSArry[phase],regbuf,2);
if(phase == phase_A){
StDef_RN8209DPara_Reg.Cst_APOSA = temp;
}
else if(phase == phase_B){
StDef_RN8209DPara_Reg.Cst_APOSB = temp;
}
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ͨ<EFBFBD><EFBFBD>offset
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
void RN8209D_CalibrateCurrentOffset(uint8_t phase)
{
uint8_t regbuf[5];
uint32_t regtemp[12],regtotal=0;
const uint16_t regArry[]={Reg_IARMS,Reg_IBRMS};
const uint16_t regIx_OS[]={Reg_IARMSOS,Reg_IBRMSOS};
uint8_t i = 0;
uint16_t temp;
for(i=0;i<12;i++)
{
if(RN8209D_ReadReg(regArry[phase],regbuf,3)==0){
regtemp[i] = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
}
delay_ms(350);
}
//<2F><>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD>Ҫ
for(i=1;i<12;i++){
regtotal += regtemp[i];
}
regtotal /= 11;
regtotal = regtotal * regtotal;
//<2F><><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
regtotal = ~regtotal;
temp = (regtotal>>8);
//<2F><><EFBFBD><EFBFBD>λ
if(regtotal & 0x80000000)
temp |= 0x8000;
//дʹ<D0B4><CAB9>
regbuf[0] = 0xE5;
RN8209D_WriteReg(WREN,regbuf,1);
//д<>Ĵ<EFBFBD><C4B4><EFBFBD>
regbuf[0] = temp/256;regbuf[1] = temp%256;
RN8209D_WriteReg(regIx_OS[phase],regbuf,2);
if(phase == phase_A){
StDef_RN8209DPara_Reg.Cst_IARMSOS = temp;
}
else if(phase == phase_B){
StDef_RN8209DPara_Reg.Cst_IBRMSOS = temp;
}
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ѹ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ʾת<EFBFBD><EFBFBD>ϵ<EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
void RN8209D_CalibrateKx(uint8_t phase)
{
uint8_t regbuf[3];
//uint32_t tempValue;
uint32_t regtemp[12],regtotal=0;
uint8_t i = 0;
if(phase == phase_A){
for(i=0;i<12;i++)
{
if(RN8209D_ReadReg(Reg_URMS,regbuf,3)==0){
regtemp[i] = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
}
delay_ms(350);
}
//<2F><>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD>Ҫ
for(i=1;i<12;i++){
regtotal += regtemp[i];
}
regtotal /= 11;
StDef_RN8209DPara_Reg.Cst_Ku = regtotal / 220;
regtotal = 0;
for(i=0;i<12;i++)
{
if(RN8209D_ReadReg(Reg_IARMS,regbuf,3)==0){
regtemp[i] = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
}
delay_ms(350);
}
//<2F><>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD>Ҫ
for(i=1;i<12;i++){
regtotal += regtemp[i];
}
regtotal /= 11;
StDef_RN8209DPara_Reg.Cst_Kia = regtotal / 5;
}
else if(phase == phase_B){
for(i=0;i<12;i++)
{
if(RN8209D_ReadReg(Reg_URMS,regbuf,3)==0){
regtemp[i] = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
}
delay_ms(350);
}
//<2F><>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD>Ҫ
for(i=1;i<12;i++){
regtotal += regtemp[i];
}
regtotal /= 11;
StDef_RN8209DPara_Reg.Cst_Ku = regtotal / 220;
regtotal = 0;
for(i=0;i<12;i++)
{
if(RN8209D_ReadReg(Reg_IBRMS,regbuf,3)==0){
regtemp[i] = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
}
delay_ms(350);
}
//<2F><>һ<EFBFBD><D2BB><EFBFBD><EFBFBD><EFBFBD>ݲ<EFBFBD>Ҫ
for(i=1;i<12;i++){
regtotal += regtemp[i];
}
regtotal /= 11;
StDef_RN8209DPara_Reg.Cst_Kib = regtotal / 5;
}
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD>10<EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
uint8_t RN8209D_ReadVoltage(uint16_t *vol)
{
uint8_t regbuf[3];
uint32_t tempValue;
if(RN8209D_ReadReg(Reg_URMS,regbuf,3)==0){
tempValue = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
if(tempValue & 0x800000){
tempValue = 0;
}
else{
*vol = (uint16_t)(tempValue*10.0/StDef_RN8209DPara_Reg.Cst_Ku);
}
return 0;
}
return 1;
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD>1000<EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
uint8_t RN8209D_ReadCurrent(uint8_t phase,uint16_t *current)
{
uint8_t regbuf[3];
uint32_t tempValue;
if(phase == phase_A){
if(RN8209D_ReadReg(Reg_IARMS,regbuf,3)==0){
tempValue = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
if(tempValue & 0x800000){
tempValue = 0;
}
else{
*current = (uint16_t)(tempValue*1000.0/StDef_RN8209DPara_Reg.Cst_Kia);
}
return 0;
}
}
else if(phase == phase_B){
if(RN8209D_ReadReg(Reg_IBRMS,regbuf,3)==0){
tempValue = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
if(tempValue & 0x800000){
tempValue = 0;
}
else{
*current = (uint16_t)(tempValue*1000.0/StDef_RN8209DPara_Reg.Cst_Kib);
}
return 0;
}
}
return 1;
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>ȡ<EFBFBD>й<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD>1000<EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
uint8_t RN8209D_ReadPower(uint8_t phase,uint32_t *p)
{
uint8_t regbuf[4];
uint32_t tempValue;
if(phase == phase_A){
if(RN8209D_ReadReg(Reg_PowerPA,regbuf,4)==0){
tempValue = (regbuf[0]<<24)+(regbuf[1]<<16)+(regbuf[2]<<8)+(regbuf[3]);
if(tempValue&0x80000000){
tempValue = ~tempValue;
tempValue += 1;
}
// if(tempValue>=21903393){
// *p = (uint32_t)(tempValue*0.0000457);
// }
// else if(tempValue<21903393 && tempValue>=2190339){
// *p = (uint32_t)(tempValue*10*0.0000457);
// }
// else if(tempValue<2190339 && tempValue>=219033){
// *p = (uint32_t)(tempValue*100*0.0000457);
// }
// else if(tempValue<219033){
// *p = (uint32_t)(tempValue*1000*0.0000457);
// }
*p = (uint32_t)(tempValue*0.000457);
return 0;
}
}
else if(phase == phase_B){
if(RN8209D_ReadReg(Reg_PowerPB,regbuf,4)==0){
tempValue = (regbuf[0]<<24)+(regbuf[1]<<16)+(regbuf[2]<<8)+(regbuf[3]);
if(tempValue&0x80000000){
tempValue = ~tempValue;
tempValue += 1;
}
*p = (uint32_t)(tempValue*0.0000457);
return 0;
}
}
return 1;
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>ȡ<EFBFBD>ۼƵ<EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD><EFBFBD><EFBFBD>100<EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
uint8_t RN8209D_ReadTotalE(uint8_t phase,uint32_t *p)
{
uint8_t regbuf[3];
uint32_t tempValue;
if(phase == phase_A){
if(RN8209D_ReadReg(Reg_EnergyP,regbuf,3)==0){
tempValue = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
//*p = (uint32_t)(tempValue*100.0/3200);
*p = tempValue;
return 0;
}
}
else if(phase == phase_B){
if(RN8209D_ReadReg(Reg_EnergyD,regbuf,3)==0){
tempValue = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
//*p = (uint32_t)(tempValue*100.0/3200);
*p = tempValue;
return 0;
}
}
return 1;
}
/********************************************************
<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>ȡУ<EFBFBD><EFBFBD><EFBFBD>Ĵ<EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD>˵<EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD>÷<EFBFBD>ʽ<EFBFBD><EFBFBD>
ȫ<EFBFBD>ֱ<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD>дʱ<EFBFBD>䣺
ע<EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>
<EFBFBD><EFBFBD><EFBFBD><EFBFBD> <EFBFBD><EFBFBD>
********************************************************/
uint8_t RN8209D_ReadCheckSum(uint32_t *p)
{
uint8_t regbuf[3];
uint32_t tempValue;
if(RN8209D_ReadReg(Reg_EMUStatus,regbuf,3)==0){
tempValue = (regbuf[0]<<16)+(regbuf[1]<<8)+(regbuf[2]);
*p = tempValue;
return 0;
}
return 1;
}
Reference in New Issue Copy Permalink