252 lines
9.3 KiB
C
252 lines
9.3 KiB
C
//
|
|
// Created by ilya on 20.06.24.
|
|
//
|
|
#include <string.h>
|
|
#include "Amplifier_AW87579.h"
|
|
#include "SystemDelayInterface.h"
|
|
|
|
#define IfNotOkRet(FUN) if(FUN == false){return false;}
|
|
|
|
bool xAmplifierAW87579_SetSistemControl(tI2cIO *i2c, tAW87579_SYSCTR values){
|
|
uint8_t I2C_Out[2] = {0};
|
|
I2C_Out[0] = AW87579_REG_SYSCTRL;
|
|
I2C_Out[1] = 0x00|
|
|
((values.EN_SW & 0b1) << 6)|
|
|
(0b1<<5)|
|
|
((values.EN_BOOST & 0b1) << 4)|
|
|
((values.EN_PA & 0b1) << 3)|
|
|
((values.RCV_MODE & 0b1) << 2)|
|
|
(values.EN_HVBAT & 0b1) << 0;
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetBatterySafeguard(tI2cIO *i2c, tAW87579_BATSAFE values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_BATSAFE;
|
|
I2C_Out[1] = 0x00|
|
|
((values.BAT_SFGD_DEGLITCH & 0b11) << 5)|
|
|
((values.BAT_SFGD_VTH & 0b11) << 3)|
|
|
((values.EN_BAT_SFGD & 0b1) << 2)|
|
|
(values.BAT_SFGD_LEVEL & 0b11) << 0;
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetBoostOutputVoltage(tI2cIO *i2c, tAW87579_BSTVOUT values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_BSTOVR;
|
|
I2C_Out[1] = 0x00|
|
|
((values.BST_VOUT & 0b11111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetBoostControl(tI2cIO *i2c, tAW87579_BSTCPR2 values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_BSTCPR2;
|
|
I2C_Out[1] = 0x00|
|
|
((values.BST_IPEAK & 0b1111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetGainControl(tI2cIO *i2c, tAW87579_PAGR values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_PAGR;
|
|
I2C_Out[1] = 0x00|
|
|
((values.PA_GAIN & 0b11111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetAGC3OutputPower(tI2cIO *i2c, tAW87579_PAGC3OPR values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_PAGC3OPR;
|
|
I2C_Out[1] = 0x00|
|
|
(0b010 << 5)|
|
|
((values.PD_AGC3 & 0b1) << 4)|
|
|
((values.AGC3_OUTPUT_POWER & 0b1111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetAGC3Parameter(tI2cIO *i2c, tAW87579_PAGC3PR values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_PAGC3PR;
|
|
I2C_Out[1] = 0x00|
|
|
((values.AGC3_REL_TIME & 0b111) << 5)|
|
|
((values.AGC3_ATT_TIME & 0b111) << 2)|
|
|
(0b10 << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetAG2OutputPower(tI2cIO *i2c, tAW87579_PAGC2OPR values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_PAGC2OPR;
|
|
I2C_Out[1] = 0x00|
|
|
((values.AGC2_OUTPUT_POWER & 0b1111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetAGC2Parameter(tI2cIO *i2c, tAW87579_PAGC2PR values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_PAGC2PR;
|
|
I2C_Out[1] = 0x00|
|
|
((values.AGC2_ATT_TIME & 0b111) << 2);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetAGC1Parameter(tI2cIO *i2c, tAW87579_PAGC1PR values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_PAGC1PR;
|
|
I2C_Out[1] = 0x00|
|
|
(0b01001 << 3)|
|
|
((values.AGC1_ATT_TIME & 0b11) << 1)|
|
|
((values.PD_AGC1 & 0b1) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetADPMode(tI2cIO *i2c, tAW87579_ADP_MODE values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_ADP_MODE;
|
|
I2C_Out[1] = 0x00|
|
|
((values.AGC1_ATT_TIMEA & 0b1) << 3)|
|
|
((values.ADPBOOST_MODE & 0b111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetADPBoost(tI2cIO *i2c, tAW87579_ADPBST_TIME1 values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_ADPBST_TIME1;
|
|
I2C_Out[1] = 0x00|
|
|
((values.ADP_BST_TIME2 & 0b1111) << 4)|
|
|
((values.ADP_BST_TIME1 & 0b1111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
bool xAmplifierAW87579_SetADPBoostVTH(tI2cIO *i2c, tAW87579_ADPBST_VTH values){
|
|
uint8_t I2C_Out[3] = {0};
|
|
I2C_Out[0] = AW87579_REG_ADPBST_VTH;
|
|
I2C_Out[1] = 0x00|
|
|
((values.ADP_LOW_STEP & 0b11) << 6)|
|
|
((values.SET_BOOST_VTH2 & 0b111) << 3)|
|
|
((values.SET_BOOST_VTH1 & 0b111) << 0);
|
|
bool res = I2cWrite(i2c,AW87579_Addres_Write,I2C_Out,2,AW87579_IO_TIMEOUT);
|
|
SystemDelayMs(10);
|
|
return res;
|
|
}
|
|
|
|
|
|
|
|
void xAmplifierAW87579_GetGainControlReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_PAGR;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
}
|
|
|
|
void xAmplifierAW87579_GetBoostOutputVoltageReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg=AW87579_REG_BSTOVR;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_BSTOVR;
|
|
}
|
|
|
|
void xAmplifierAW87579_GetBoostControlReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_BSTCPR2;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_BSTCPR2;
|
|
}
|
|
|
|
void xAmplifierAW87579_GetADPBoostVthReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_ADPBST_VTH;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_ADPBST_VTH;
|
|
}
|
|
|
|
void xAmplifierAW87579_GetADPBoostModeReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_ADP_MODE;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_ADP_MODE;
|
|
}
|
|
|
|
void xAmplifierAW87579_GetADG1ModeReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_PAGC1PR;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_PAGC1PR;
|
|
}
|
|
|
|
void xAmplifierAW87579_GetADG3ModeOpReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_PAGC3OPR;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_PAGC3OPR;
|
|
}
|
|
|
|
void xAmplifierAW87579_GetADG3ModeReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_PAGC3PR;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_PAGC3PR;
|
|
}
|
|
|
|
void XfcProtMethod_GetAGC2OprParamModeReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_PAGC2OPR;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_PAGC2OPR;
|
|
}
|
|
|
|
void XfcProtMethod_GetEnBoostReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_SYSCTRL;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_SYSCTRL;
|
|
}
|
|
|
|
void XfcProtMethod_GetAGC2ParamModeReg(tI2cIO *i2c, uint8_t *res){
|
|
uint8_t reg = AW87579_REG_PAGC2PR;
|
|
I2cWrite( i2c, AW87579_Addres_Write | 0, ®, 1, AW87579_IO_TIMEOUT);
|
|
I2cRead(i2c, AW87579_Addres_Read | 1, res, 1, AW87579_IO_TIMEOUT);
|
|
reg=AW87579_REG_PAGC2PR;
|
|
}
|
|
|
|
|
|
bool xAmplifierAW87579_SetAll(tI2cIO *i2c, tAW87579_RegsList list){
|
|
IfNotOkRet(xAmplifierAW87579_SetSistemControl(i2c,list.sysctr))
|
|
IfNotOkRet(xAmplifierAW87579_SetBatterySafeguard(i2c, list.batsafe))
|
|
IfNotOkRet(xAmplifierAW87579_SetBoostOutputVoltage(i2c, list.bstvout))
|
|
IfNotOkRet(xAmplifierAW87579_SetBoostControl(i2c, list.bstcpr2))
|
|
IfNotOkRet(xAmplifierAW87579_SetGainControl(i2c, list.pagr))
|
|
IfNotOkRet(xAmplifierAW87579_SetAGC3OutputPower(i2c,list.pagc3Opr))
|
|
IfNotOkRet(xAmplifierAW87579_SetAGC3Parameter(i2c, list.pagc3Pr))
|
|
IfNotOkRet(xAmplifierAW87579_SetAG2OutputPower(i2c, list.pagc2Opr))
|
|
IfNotOkRet(xAmplifierAW87579_SetAGC2Parameter(i2c, list.pagc2Pr))
|
|
IfNotOkRet(xAmplifierAW87579_SetAGC1Parameter(i2c, list.pagc1Pr))
|
|
IfNotOkRet(xAmplifierAW87579_SetADPMode(i2c,list.adpMode))
|
|
IfNotOkRet(xAmplifierAW87579_SetADPBoost(i2c, list.adpbstTime1))
|
|
IfNotOkRet(xAmplifierAW87579_SetADPBoostVTH(i2c, list.adpbstVth))
|
|
return true;
|
|
}
|