Power: bq25896 and bq27220 drivers, portable power api. (#224)
* Power: add portability layer, port to F3. * F3: bq25896 driver stab * GUI: new primary and secondary fonts * F3: bq25896 register map, basic functions * F3: move bq27220 command descritpion to separate file. Code format. * Power: OTG enable/disable * Power: choose more correct profile * F3: pet bq25896 watchdog sometimes
This commit is contained in:
99
firmware/targets/f3/Src/bq25896.c
Normal file
99
firmware/targets/f3/Src/bq25896.c
Normal file
@@ -0,0 +1,99 @@
|
||||
|
||||
#include <bq25896.h>
|
||||
#include <bq25896_reg.h>
|
||||
#include <i2c.h>
|
||||
|
||||
uint8_t bit_reverse(uint8_t b) {
|
||||
b = (b & 0xF0) >> 4 | (b & 0x0F) << 4;
|
||||
b = (b & 0xCC) >> 2 | (b & 0x33) << 2;
|
||||
b = (b & 0xAA) >> 1 | (b & 0x55) << 1;
|
||||
return b;
|
||||
}
|
||||
|
||||
bool bq25896_read(uint8_t address, uint8_t* data, size_t size) {
|
||||
if (HAL_I2C_Master_Transmit(&POWER_I2C, BQ25896_ADDRESS, &address, 1, 2000) != HAL_OK) {
|
||||
return false;
|
||||
}
|
||||
if (HAL_I2C_Master_Receive(&POWER_I2C, BQ25896_ADDRESS, data, size, 2000) != HAL_OK) {
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
bool bq25896_read_reg(uint8_t address, uint8_t* data) {
|
||||
bq25896_read(address, data, 1);
|
||||
return true;
|
||||
}
|
||||
|
||||
bool bq25896_write_reg(uint8_t address, uint8_t* data) {
|
||||
uint8_t buffer[2] = { address, *data };
|
||||
|
||||
if (HAL_I2C_Master_Transmit(&POWER_I2C, BQ25896_ADDRESS, buffer, 2, 2000) != HAL_OK) {
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
typedef struct {
|
||||
REG00 r00;
|
||||
REG01 r01;
|
||||
REG02 r02;
|
||||
REG03 r03;
|
||||
REG04 r04;
|
||||
REG05 r05;
|
||||
REG06 r06;
|
||||
REG07 r07;
|
||||
REG08 r08;
|
||||
REG09 r09;
|
||||
REG0A r0A;
|
||||
REG0B r0B;
|
||||
REG0C r0C;
|
||||
REG0D r0D;
|
||||
REG0E r0E;
|
||||
REG0F r0F;
|
||||
REG10 r10;
|
||||
REG11 r11;
|
||||
REG12 r12;
|
||||
REG13 r13;
|
||||
REG14 r14;
|
||||
} bq25896_regs_t;
|
||||
|
||||
static bq25896_regs_t bq25896_regs;
|
||||
|
||||
void bq25896_init() {
|
||||
bq25896_read(0x00, (uint8_t*)&bq25896_regs, sizeof(bq25896_regs));
|
||||
|
||||
bq25896_regs.r09.BATFET_DIS = 0;
|
||||
bq25896_write_reg(0x09, (uint8_t*)&bq25896_regs.r09);
|
||||
|
||||
bq25896_regs.r14.REG_RST = 1;
|
||||
bq25896_write_reg(0x14, (uint8_t*)&bq25896_regs.r14);
|
||||
|
||||
// bq25896_regs.r07.WATCHDOG = 0b00;
|
||||
// bq25896_write_reg(0x07, (uint8_t*)&bq25896_regs.r07);
|
||||
|
||||
bq25896_read(0x00, (uint8_t*)&bq25896_regs, sizeof(bq25896_regs));
|
||||
}
|
||||
|
||||
void bq25896_poweroff() {
|
||||
bq25896_regs.r09.BATFET_DIS=1;
|
||||
bq25896_write_reg(0x09, (uint8_t*)&bq25896_regs.r09);
|
||||
}
|
||||
|
||||
bool bq25896_is_charging() {
|
||||
bq25896_regs.r03.WD_RST = 1;
|
||||
bq25896_write_reg(0x03, (uint8_t*)&bq25896_regs.r03);
|
||||
|
||||
bq25896_read_reg(0x0B, (uint8_t*)&bq25896_regs.r0B);
|
||||
return bq25896_regs.r0B.CHRG_STAT != ChrgStatNo;
|
||||
}
|
||||
|
||||
void bq25896_enable_otg() {
|
||||
bq25896_regs.r03.OTG_CONFIG = 1;
|
||||
bq25896_write_reg(0x09, (uint8_t*)&bq25896_regs.r03);
|
||||
}
|
||||
|
||||
void bq25896_disable_otg() {
|
||||
bq25896_regs.r03.OTG_CONFIG = 0;
|
||||
bq25896_write_reg(0x09, (uint8_t*)&bq25896_regs.r03);
|
||||
}
|
53
firmware/targets/f3/Src/bq27220.c
Normal file
53
firmware/targets/f3/Src/bq27220.c
Normal file
@@ -0,0 +1,53 @@
|
||||
#include <bq27220.h>
|
||||
#include <bq27220_reg.h>
|
||||
#include <i2c.h>
|
||||
#include <stdbool.h>
|
||||
|
||||
uint16_t bq27220_read_word(uint8_t address) {
|
||||
uint8_t data[2] = { address };
|
||||
if (HAL_I2C_Master_Transmit(&POWER_I2C, BQ27220_ADDRESS, data, 1, 2000) != HAL_OK) {
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (HAL_I2C_Master_Receive(&POWER_I2C, BQ27220_ADDRESS, data, 2, 2000) != HAL_OK) {
|
||||
return 0;
|
||||
}
|
||||
return *(uint16_t*)data;
|
||||
}
|
||||
|
||||
bool bq27220_control(uint16_t control) {
|
||||
uint8_t data[3] = { CommandControl };
|
||||
data[1] = (control>>8) & 0xFF;
|
||||
data[2] = control & 0xFF;
|
||||
if (HAL_I2C_Master_Transmit(&POWER_I2C, BQ27220_ADDRESS, data, 3, 2000) != HAL_OK) {
|
||||
return false;
|
||||
}
|
||||
|
||||
return true;
|
||||
}
|
||||
|
||||
void bq27220_init() {
|
||||
bq27220_control(Control_ENTER_CFG_UPDATE);
|
||||
bq27220_control(Control_SET_PROFILE_2);
|
||||
bq27220_control(Control_EXIT_CFG_UPDATE);
|
||||
}
|
||||
|
||||
uint16_t bq27220_get_voltage() {
|
||||
return bq27220_read_word(CommandVoltage);
|
||||
}
|
||||
|
||||
int16_t bq27220_get_current() {
|
||||
return (int16_t)bq27220_read_word(CommandCurrent);
|
||||
}
|
||||
|
||||
uint16_t bq27220_get_full_charge_capacity() {
|
||||
return bq27220_read_word(CommandFullChargeCapacity);
|
||||
}
|
||||
|
||||
uint16_t bq27220_get_remaining_capacity() {
|
||||
return bq27220_read_word(CommandRemainingCapacity);
|
||||
}
|
||||
|
||||
uint16_t bq27220_get_state_of_charge() {
|
||||
return bq27220_read_word(CommandStateOfCharge);
|
||||
}
|
Reference in New Issue
Block a user