add device bq27220.

xrobot-org · Jan 27, 2024 · 4fde113 · 4fde113
1 parent 0c08b91
commit 4fde113
Show file tree

Hide file tree

Showing 4 changed files with 169 additions and 0 deletions.
diff --git a/src/device/bq27220/Kconfig b/src/device/bq27220/Kconfig
diff --git a/src/device/bq27220/dev_bq27220.cpp b/src/device/bq27220/dev_bq27220.cpp
@@ -0,0 +1,137 @@
+#include "dev_bq27220.hpp"
+
+#include "bsp_i2c.h"
+
+#define BQ27220_DEVICE_ID (0x55)
+#define CTRL_REG_ADDR (0x00)
+#define OPERATION_STATUS_ADDR (0x3B)
+#define DESIGN_CAPACITY_CTRL_ADDR (0x3E)
+#define DESIGN_CAPACITY_ADDR (0x40)
+#define CAPACITY_DATA_SUM_ADDR (0x60)
+#define CAPACITY_DATA_SUM_LEN_ADDR (0x61)
+#define TEMPERATURE_ADDR (0x06)
+
+using namespace Device;
+
+BQ27220::BQ27220(Param& param) : param_(param) {
+  /* Read old capacity */
+  static uint8_t old_capacity[2];
+  old_capacity[1] = bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                          DESIGN_CAPACITY_ADDR);
+  old_capacity[0] = bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                          DESIGN_CAPACITY_ADDR + 1);
+
+  auto old_cap = *reinterpret_cast<uint16_t*>(old_capacity);
+  if (old_cap != param_.capacity_mha) {
+    WriteParam();
+  }
+
+  auto task_fun = [](BQ27220* bq27220) {
+    static uint8_t tmp[10];
+    uint16_t* data = reinterpret_cast<uint16_t*>(tmp);
+
+    bsp_i2c_mem_read(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, TEMPERATURE_ADDR, tmp,
+                     10, true);
+    bq27220->data_.temperate = data[0];
+    bq27220->data_.voltage = data[1];
+    bq27220->data_.current = data[3];
+    bq27220->data_.real_capacity = data[4];
+    bq27220->data_.percentage = data[4] / bq27220->param_.capacity_mha * 100;
+  };
+
+  System::Timer::Create(task_fun, this, 10000);
+}
+
+void BQ27220::WriteParam() { /* UNSEAL it by sending the appropriate keys to
+                                Control */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR,
+                         0X14);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR + 1,
+                         0X04);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR,
+                         0X72);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR + 1,
+                         0X36);
+
+  /* Enter FULL ACCESS */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR,
+                         0XFF);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR + 1,
+                         0XFF);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR,
+                         0XFF);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR + 1,
+                         0XFF);
+
+  /* Send ENTER_CGF_UPDATE command */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR,
+                         0X90);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR + 1,
+                         0X00);
+
+  /* Wait CFGUPDATE, May take up to 1 second. */
+  while ((bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                OPERATION_STATUS_ADDR) &
+          (1 << 2)) != (1 << 2)) {
+  }
+
+  /* Enable access of Design Capacity */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, DESIGN_CAPACITY_CTRL_ADDR,
+                         DESIGN_CAPACITY_CTRL_ADDR, 0x9F);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                         DESIGN_CAPACITY_CTRL_ADDR + 1, 0x92);
+
+  /* Read MACDataSum and MACDataLen */
+  static uint8_t old_cap_sum_data, old_cap_sum_len;
+  old_cap_sum_data = bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                           CAPACITY_DATA_SUM_ADDR);
+  old_cap_sum_len = bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                          CAPACITY_DATA_SUM_LEN_ADDR);
+
+  /* Read old capacity */
+  static uint8_t old_capacity[2];
+  old_capacity[1] = bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                          DESIGN_CAPACITY_ADDR);
+  old_capacity[0] = bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                          DESIGN_CAPACITY_ADDR + 1);
+
+  auto old_cap = *reinterpret_cast<uint16_t*>(old_capacity);
+  if (old_cap == param_.capacity_mha) {
+    return;
+  }
+
+  /* Write new capacity */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                         DESIGN_CAPACITY_ADDR, old_cap >> 8);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                         DESIGN_CAPACITY_ADDR + 1, old_cap);
+
+  /* Write new sum */
+  uint8_t new_sum =
+      255 - (old_cap_sum_data - old_capacity[0] - old_capacity[1]) % 256;
+
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                         CAPACITY_DATA_SUM_ADDR, new_sum);
+
+  /* Write new length */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                         CAPACITY_DATA_SUM_LEN_ADDR, 0x24);
+
+  /* Exit CFGUPDATE mode */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR,
+                         0X92);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR + 1,
+                         0X00);
+
+  /* Wait CFGUPDATE, May take up to 1 second. */
+  while ((bsp_i2c_mem_read_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID,
+                                OPERATION_STATUS_ADDR) &
+          (1 << 2)) != 0) {
+  }
+
+  /* return to SEALED mode */
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR,
+                         0X30);
+  bsp_i2c_mem_write_byte(BSP_I2C_BQ27220, BQ27220_DEVICE_ID, CTRL_REG_ADDR + 1,
+                         0X00);
+}
diff --git a/src/device/bq27220/dev_bq27220.hpp b/src/device/bq27220/dev_bq27220.hpp
@@ -0,0 +1,26 @@
+#include "device.hpp"
+
+namespace Device {
+class BQ27220 {
+ public:
+  typedef struct {
+    uint16_t capacity_mha;
+  } Param;
+
+  typedef struct {
+    uint32_t voltage;
+    uint32_t temperate;
+    uint32_t current;
+    uint32_t real_capacity;
+    uint16_t percentage;
+  } Data;
+
+  BQ27220(Param& param);
+
+  void WriteParam();
+
+  Param param_;
+
+  Data data_ = {};
+};
+}  // namespace Device
diff --git a/src/device/bq27220/info.cmake b/src/device/bq27220/info.cmake
@@ -0,0 +1,6 @@
+CHECK_SUB_ENABLE(MODULE_ENABLE device)
+if(${MODULE_ENABLE})
+    file(GLOB CUR_SOURCES "${SUB_DIR}/*.cpp")
+    SUB_ADD_SRC(CUR_SOURCES)
+    SUB_ADD_INC(SUB_DIR)
+endif()