void init_init_code(void) {
  uint8_t read_buf[16];
  uint8_t addr = 0;
  uint8_t len = 0;
  uint8_t send_buf[16];
  printf("==============START==========\r\n");

  int i = 0x78;
  for (i = 0x78; i < 0x81; i++) {
    if (i == 0x79) {
      memset(read_buf, 0, sizeof(read_buf));
      I2C_ReadBytes(read_buf, i, 2);
      printf("(0x%02x) ReadBuf: 0x%02x,0x%02x\r\n", i, read_buf[1],
             read_buf[0]);
      delay_1ms(300);
    } else if (i == 0x7F) {
      printf("Skipping address 0x7F\r\n");
      continue;
    } else if (i == 0x7F) {
      continue;
    } else {
      memset(read_buf, 0, sizeof(read_buf));
      I2C_ReadBytes(read_buf, i, 1);
      printf("(0x%02x) ReadBuf: 0x%02x\r\n", i, read_buf[0]);
      delay_1ms(400);
    }
  }
#if 1
  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0x00;
  I2C_WriteBytes(send_buf, TPS53681_ON_OFF_CONFIG, 1);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0x00;
  I2C_WriteBytes(send_buf, TPS53681_PAGE, 1);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_PAGE, 1);
  printf("TPS53681_PAGE(0x00) ReadBuf: 0x%02x\r\n", read_buf[0]);
  delay_1ms(100);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0xFF;
  I2C_WriteBytes(send_buf, TPS53681_PHASE, 1);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_PHASE, 1);
  printf("TPS53681_PHASE(0x04) ReadBuf: 0x%02x\r\n", read_buf[0]);
  delay_1ms(100);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0x23;
  I2C_WriteBytes(send_buf, TPS53681_VBOOT, 1);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_VBOOT, 1);
  printf("TPS53681_VBOOT(0xDB) ReadBuf: 0x%02x\r\n", read_buf[0]);
  delay_1ms(100);

  memset(send_buf, 0, sizeof(send_buf));
  // send_buf[0] = 0x23;
  // send_buf[0] = 0x97;
  send_buf[0] = 0x50;
  send_buf[1] = 0x00;
  I2C_WriteBytes(send_buf, TPS53681_VOUT_COMMAND, 2);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_VOUT_COMMAND, 2);
  printf("TPS53681_VOUT_COMMAND(0x21) ReadBuf: 0x%02x,0x%02x\r\n", read_buf[1],
         read_buf[0]);
  delay_1ms(100);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0x01;
  send_buf[1] = 0x00;
  I2C_WriteBytes(send_buf, TPS53681_VOUT_MIN, 2);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_VOUT_MIN, 2);
  printf("TPS53681_VOUT_MIN(0x2B) ReadBuf: 0x%02x, 0x%02x\r\n", read_buf[1],
         read_buf[0]);
  delay_1ms(100);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0xFF;
  send_buf[1] = 0x00;
  I2C_WriteBytes(send_buf, TPS53681_VOUT_MAX, 2);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_VOUT_MAX, 2);
  printf("TPS53681_VOUT_MAX(0x24) ReadBuf: 0x%02x, 0x%02x\r\n", read_buf[1],
         read_buf[0]);
  delay_1ms(100);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0x18;
  I2C_WriteBytes(send_buf, TPS53681_ON_OFF_CONFIG, 1);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_ON_OFF_CONFIG, 1);
  printf("TPS53681_ON_OFF_CONFIG(0x02) ReadBuf: 0x%02x\r\n", read_buf[0]);
  delay_1ms(100);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = read_buf[0];
  send_buf[1] = read_buf[1];
  I2C_WriteBytes(send_buf, TPS53681_MFR_SPECIFIC_14, 2);

  memset(send_buf, 0, sizeof(send_buf));
  send_buf[0] = 0x80;
  I2C_WriteBytes(send_buf, TPS53681_OPERATE, 1);
#endif
  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, TPS53681_OPERATE, 1);
  printf("TPS53681_OPERATE(0x01) ReadBuf: 0x%02x\r\n", read_buf[0]);
  delay_1ms(100);

  memset(read_buf, 0, sizeof(read_buf));
  I2C_ReadBytes(read_buf, 0x44, 2);
  tps53681_read_vout_voltage();

  printf("====== 0x44  ReadBuf: 0x%02x,0x%02x\r\n", read_buf[1], read_buf[0]);
  delay_1ms(100);

  while (1) {
    for (i = 0x78; i < 0x81; i++) {
      if (i == 0x79) {
        memset(read_buf, 0, sizeof(read_buf));
        I2C_ReadBytes(read_buf, i, 2);
        printf("(0x%02x) ReadBuf: 0x%02x,0x%02x\r\n", i, read_buf[1],
               read_buf[0]);
        delay_1ms(100);
      } else if (i == 0x7F) {
        printf("Skipping address 0x7F\r\n");
        continue;
      } else {
        memset(read_buf, 0, sizeof(read_buf));
        I2C_ReadBytes(read_buf, i, 1);
        printf("(0x%02x) ReadBuf: 0x%02x\r\n", i, read_buf[0]);
        delay_1ms(100);
      }
    }
    delay_1ms(3000);
    printf("\r\n\r\n");
  }
}