healthd_board_msm.cpp - LeafOS-Project/android_vendor_qcom_opensource_healthd-ext - Gitiles

 /*
  *Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
  *
  *Redistribution and use in source and binary forms, with or without
  *modification, are permitted provided that the following conditions are
  *met:
  *    * Redistributions of source code must retain the above copyright
  *      notice, this list of conditions and the following disclaimer.
  *    * Redistributions in binary form must reproduce the above
  *      copyright notice, this list of conditions and the following
  *      disclaimer in the documentation and/or other materials provided
  *      with the distribution.
  *    * Neither the name of The Linux Foundation nor the names of its
  *      contributors may be used to endorse or promote products derived
  *      from this software without specific prior written permission.
  *
  *THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
  *WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
  *MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
  *ARE DISCLAIMED.  IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
  *BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  *CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  *SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
  *BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
  *WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
  *OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
  *IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  */

 #include <dirent.h>
 #include <errno.h>
 #include <string.h>
 #include <fcntl.h>
 #include <unistd.h>
 #include <cutils/klog.h>
 #include <batteryservice/BatteryService.h>
 #include <cutils/android_reboot.h>
 #include <cutils/properties.h>
 #include <healthd.h>
 #include "minui/minui.h"
 #include "healthd_msm.h"
 #define ARRAY_SIZE(x)           (sizeof(x)/sizeof(x[0]))

 #define HVDCP_CHARGER           "USB_HVDCP"
 #define HVDCP_BLINK_TYPE        2

 #define RED_LED_PATH            "/sys/class/leds/red/brightness"
 #define GREEN_LED_PATH          "/sys/class/leds/green/brightness"
 #define BLUE_LED_PATH           "/sys/class/leds/blue/brightness"
 #define RED_LED_BLINK_PATH      "/sys/class/leds/red/blink"
 #define GREEN_LED_BLINK_PATH    "/sys/class/leds/green/blink"
 #define BACKLIGHT_PATH          "/sys/class/backlight/panel0-backlight/brightness"

 #define CHARGING_ENABLED_PATH   "/sys/class/power_supply/battery/charging_enabled"
 #define CHARGER_TYPE_PATH       "/sys/class/power_supply/usb/type"
 #define BMS_READY_PATH          "/sys/class/power_supply/bms/soc_reporting_ready"
 #define BMS_BATT_INFO_PATH      "/sys/class/power_supply/bms/battery_info"
 #define BMS_BATT_INFO_ID_PATH   "/sys/class/power_supply/bms/battery_info_id"
 #define BMS_BATT_RES_ID_PATH    "/sys/class/power_supply/bms/resistance_id"
 #define PERSIST_BATT_INFO_PATH  "/persist/bms/batt_info.txt"

 #define CHGR_TAG                "charger"
 #define HEALTHD_TAG             "healthd_msm"
 #define LOGE(tag, x...) do { KLOG_ERROR(tag, x); } while (0)
 #define LOGW(tag, x...) do { KLOG_WARNING(tag, x); } while (0)
 #define LOGV(tag, x...) do { KLOG_DEBUG(tag, x); } while (0)

 enum {
     RED_LED = 0x01 << 0,
     GREEN_LED = 0x01 << 1,
     BLUE_LED = 0x01 << 2,
 };

 enum batt_info_params {
     BATT_INFO_NOTIFY = 0,
     BATT_INFO_SOC,
     BATT_INFO_RES_ID,
     BATT_INFO_VOLTAGE,
     BATT_INFO_TEMP,
     BATT_INFO_FCC,
     BATT_INFO_MAX,
 };

 struct led_ctl {
     int color;
     const char *path;
 };

 struct led_ctl leds[3] =
     {{RED_LED, RED_LED_PATH},
     {GREEN_LED, GREEN_LED_PATH},
     {BLUE_LED, BLUE_LED_PATH}};

 #define HVDCP_COLOR_MAP         (RED_LED | GREEN_LED)

 struct soc_led_color_mapping {
     int soc;
     int color;
 };

 struct soc_led_color_mapping soc_leds[3] = {
     {15, RED_LED},
     {90, RED_LED | GREEN_LED},
     {100, GREEN_LED},
 };

 static int batt_info_cached[BATT_INFO_MAX];
 static bool healthd_msm_err_log_once;
 static int8_t healthd_msm_log_en;
 static int8_t healthd_msm_store_params;

 static int write_file_int(char const* path, int value)
 {
     int fd;
     char buffer[20];
     int rc = -1, bytes;

     fd = open(path, O_WRONLY);
     if (fd >= 0) {
         bytes = snprintf(buffer, sizeof(buffer), "%d\n", value);
         rc = write(fd, buffer, bytes);
         close(fd);
     }

     return rc > 0 ? 0 : -1;
 }

 static int set_tricolor_led(int on, int color)
 {
     int rc, i;
     char buffer[10];

     for (i = 0; i < (int)ARRAY_SIZE(leds); i++) {
         if ((color & leds[i].color) && (access(leds[i].path, R_OK | W_OK) == 0)) {
             rc = write_file_int(leds[i].path, on ? 255 : 0);
             if (rc < 0)
                 return rc;
         }
     }

     return 0;
 }

 static bool is_hvdcp_inserted()
 {
     bool hvdcp = false;
     char buff[12] = "\0";
     int fd, cnt;

     fd = open(CHARGER_TYPE_PATH, O_RDONLY);
     if (fd >= 0) {
         cnt = read(fd, buff, (sizeof(buff) - 1));
         if (cnt > 0 && !strncmp(buff, HVDCP_CHARGER, 9))
             hvdcp = true;
         close(fd);
     }

     return hvdcp;
 }

 static int get_blink_led_for_hvdcp(void)
 {
     int ret, rc = 0, bytes;
     int red_blink_fd = -1, green_blink_fd = -1, type_fd = -1;
     char buf[20];

     type_fd = open(CHARGER_TYPE_PATH, O_RDONLY);

     if (type_fd < 0) {
         LOGE(CHGR_TAG, "Could not open USB type node\n");
         return rc;
     } else {
         close(type_fd);
         ret = write_file_int(GREEN_LED_BLINK_PATH, 0);
         if (ret < 0) {
             LOGE(CHGR_TAG, "Fail to write: %s\n", GREEN_LED_BLINK_PATH);
         } else {
             rc |= GREEN_LED;
 	}

         ret = write_file_int(RED_LED_BLINK_PATH, 0);
         if (ret < 0) {
             LOGE(CHGR_TAG, "Fail to write: %s\n", RED_LED_BLINK_PATH);
         } else {
             rc |= RED_LED;
 	}
     }

     return rc;
 }

 #if QTI_BSP
 #define STR_LEN 8
 void healthd_board_mode_charger_draw_battery(
                 struct android::BatteryProperties *batt_prop)
 {
     char cap_str[STR_LEN];
     int x, y;
     int str_len_px;
     static int char_height = -1, char_width = -1;

     if (char_height == -1 && char_width == -1)
         gr_font_size(&char_width, &char_height);
     snprintf(cap_str, (STR_LEN - 1), "%d%%", batt_prop->batteryLevel);
     str_len_px = gr_measure(cap_str);
     x = (gr_fb_width() - str_len_px) / 2;
     y = (gr_fb_height() + char_height) / 2;
     gr_color(0xa4, 0xc6, 0x39, 255);
     gr_text(x, y, cap_str, 0);
 }
 #endif

 void healthd_board_mode_charger_battery_update(
                 struct android::BatteryProperties *batt_prop)
 {
     static int blink_for_hvdcp = -1;
     static int old_color = 0;
     int i, color, soc, rc;
     bool blink = false;

     if (blink_for_hvdcp == -1)
         blink_for_hvdcp = get_blink_led_for_hvdcp();

     if ((blink_for_hvdcp > 0) && is_hvdcp_inserted())
         blink = true;

     soc = batt_prop->batteryLevel;

     for (i = 0; i < ((int)ARRAY_SIZE(soc_leds) - 1); i++) {
         if (soc < soc_leds[i].soc)
             break;
     }
     color = soc_leds[i].color;

     if (old_color != color) {
         if ((color == HVDCP_COLOR_MAP) && blink) {
             if (blink_for_hvdcp & RED_LED) {
                 rc = write_file_int(RED_LED_BLINK_PATH, HVDCP_BLINK_TYPE);
                 if (rc < 0) {
                     LOGE(CHGR_TAG, "Fail to write: %s\n", RED_LED_BLINK_PATH);
                     return;
                 }
             }
             if (blink_for_hvdcp & GREEN_LED) {
                 rc = write_file_int(GREEN_LED_BLINK_PATH, HVDCP_BLINK_TYPE);
                 if (rc < 0) {
                     LOGE(CHGR_TAG, "Fail to write: %s\n", GREEN_LED_BLINK_PATH);
                     return;
                 }
             }
         } else {
                 rc = set_tricolor_led(0, old_color);
                 if (rc < 0)
                     LOGE(CHGR_TAG, "Error in setting old_color on tricolor_led\n");

                 rc = set_tricolor_led(1, color);
                 if (rc < 0)
                     LOGE(CHGR_TAG, "Error in setting color on tricolor_led\n");

                 if (!rc) {
                     old_color = color;
                     LOGV(CHGR_TAG, "soc = %d, set led color 0x%x\n", soc, soc_leds[i].color);
                 }
         }
     }
 }

 #define BACKLIGHT_ON_LEVEL    100
 #define BACKLIGHT_OFF_LEVEL    0
 void healthd_board_mode_charger_set_backlight(bool en)
 {
     int rc;

     if (access(BACKLIGHT_PATH, R_OK | W_OK) != 0)
     {
         LOGW(CHGR_TAG, "Backlight control not support\n");
         return;
     }

     rc = write_file_int(BACKLIGHT_PATH, en ? BACKLIGHT_ON_LEVEL :
                 BACKLIGHT_OFF_LEVEL);
     if (rc < 0) {
         LOGE(CHGR_TAG, "Could not write to backlight node : %s\n", strerror(errno));
         return;
     }

     LOGV(CHGR_TAG, "set backlight status to %d\n", en);
 }

 static inline void get_healthd_props()
 {
     healthd_msm_log_en = property_get_bool("persist.healthd_msm.log_en", 1);
     healthd_msm_store_params =
                 property_get_bool("persist.healthd_msm.store_params", 0);
 }

 #define WAIT_BMS_READY_TIMES_MAX	200
 #define WAIT_BMS_READY_INTERVAL_USEC	200000
 void healthd_board_mode_charger_init()
 {
     int ret;
     char buff[8] = "\0";
     int charging_enabled = 0;
     int bms_ready = 0;
     int wait_count = 0;
     int fd;

     /* check the charging is enabled or not */
     fd = open(CHARGING_ENABLED_PATH, O_RDONLY);
     if (fd < 0)
         return;
     ret = read(fd, buff, (sizeof(buff) - 1));
     close(fd);
     if (ret > 0) {
         buff[ret] = '\0';
         sscanf(buff, "%d\n", &charging_enabled);
         LOGW(CHGR_TAG, "android charging is %s\n",
                 !!charging_enabled ? "enabled" : "disabled");
         /* if charging is disabled, reboot and exit power off charging */
         if (!charging_enabled)
             android_reboot(ANDROID_RB_RESTART, 0, 0);
     }
     fd = open(BMS_READY_PATH, O_RDONLY);
     if (fd < 0)
             return;
     while (1) {
         ret = read(fd, buff, (sizeof(buff) - 1));
         if (ret > 0) {
             buff[ret] = '\0';
             sscanf(buff, "%d\n", &bms_ready);
         } else {
             LOGE(CHGR_TAG, "read soc-ready failed, ret=%d\n", ret);
             break;
         }

         if ((bms_ready > 0) || (wait_count++ > WAIT_BMS_READY_TIMES_MAX))
             break;
         usleep(WAIT_BMS_READY_INTERVAL_USEC);
         lseek(fd, 0, SEEK_SET);
     }
     close(fd);
     LOGV(CHGR_TAG, "Checking BMS SoC ready done %d!\n", bms_ready);
 }

 static void healthd_batt_info_notify()
 {
     int rc, fd, id = 0;
     int bms_ready = 0;
     int wait_count = 0;
     char buff[100] = "";
     int batt_info[BATT_INFO_MAX];
     char *ptr, *tmp, *temp_str;
     char path_str[50] = "";
     bool notify_bms = false;

     if (!healthd_msm_store_params) {
         return;
     }

     fd = open(PERSIST_BATT_INFO_PATH, O_RDONLY);
     if (fd < 0) {
         LOGW(HEALTHD_TAG, "Error in opening batt_info.txt, fd=%d\n", fd);
         fd = creat(PERSIST_BATT_INFO_PATH, S_IRWXU);
         if (fd < 0) {
             LOGE(HEALTHD_TAG, "Couldn't create file, fd=%d errno=%s\n", fd,
                  strerror(errno));
             goto out;
         }
         LOGV(HEALTHD_TAG, "Created file %s\n", PERSIST_BATT_INFO_PATH);
         close(fd);
         goto out;
     } else {
         LOGV(HEALTHD_TAG, "opened %s\n", PERSIST_BATT_INFO_PATH);
     }

     rc = read(fd, buff, (sizeof(buff) - 1));
     if (rc < 0) {
         LOGE(HEALTHD_TAG, "Error in reading fd %d, rc=%d\n", fd, rc);
         close(fd);
         goto out;
     }
     close(fd);
     buff[rc] = '\0';
     temp_str = strtok_r(buff, ":", &ptr);
     id = 1;
     while (temp_str != NULL && id < BATT_INFO_MAX) {
         batt_info[id++] = (int)strtol(temp_str, &tmp, 10);
         temp_str = strtok_r(NULL, ":", &ptr);
     }

     if (id < BATT_INFO_MAX) {
         LOGE(HEALTHD_TAG, "Read %d batt_info parameters\n", id);
         goto out;
     }

     /* Send batt_info parameters to FG driver */
     for (id = 1; id < BATT_INFO_MAX; id++) {
         snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_ID_PATH);
         rc = write_file_int(path_str, id);
         if (rc < 0) {
             LOGE(HEALTHD_TAG, "Error in writing batt_info_id %d, rc=%d\n", id,
                 rc);
             goto out;
         }

         snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_PATH);
         rc = write_file_int(path_str, batt_info[id]);
         if (rc < 0) {
             LOGE(HEALTHD_TAG, "Error in writing batt_info %d, rc=%d\n",
                 batt_info[id], rc);
             goto out;
         }
     }

     notify_bms = true;

 out:
     fd = open(BMS_READY_PATH, O_RDONLY);
     if (fd < 0) {
         LOGE(HEALTHD_TAG, "Couldn't open %s\n", BMS_READY_PATH);
         return;
     }

     /* Wait for soc_reporting_ready */
     wait_count = 0;
     memset(buff, 0, sizeof(buff));
     while (1) {
         rc = read(fd, buff, 1);
         if (rc > 0) {
             sscanf(buff, "%d\n", &bms_ready);
         } else {
             LOGE(HEALTHD_TAG, "read soc-ready failed, rc=%d\n", rc);
             break;
         }

         if ((bms_ready > 0) || (wait_count++ > WAIT_BMS_READY_TIMES_MAX))
             break;

         usleep(WAIT_BMS_READY_INTERVAL_USEC);
         lseek(fd, 0, SEEK_SET);
     }
     close(fd);

     if (!bms_ready)
         notify_bms = false;

     if (!notify_bms) {
         LOGE(HEALTHD_TAG, "Not notifying BMS\n");
         return;
     }

     /* Notify FG driver */
     snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_ID_PATH);
     rc = write_file_int(path_str, BATT_INFO_NOTIFY);
     if (rc < 0) {
         LOGE(HEALTHD_TAG, "Error in writing batt_info_id, rc=%d\n", rc);
         return;
     }

     snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_PATH);
     rc = write_file_int(path_str, INT_MAX - 1);
     if (rc < 0)
         LOGE(HEALTHD_TAG, "Error in writing batt_info, rc=%d\n", rc);
 }

 void healthd_board_init(struct healthd_config*)
 {
     // use defaults
     get_healthd_props();
     power_off_alarm_init();
     healthd_batt_info_notify();
 }

 static void healthd_store_batt_props(const struct android::BatteryProperties* props)
 {
     char buff[100];
     int fd, rc, len, batteryId = 0;

     if (!healthd_msm_store_params) {
         return;
     }

     if (!props->batteryPresent) {
         return;
     }

     if (props->batteryLevel == 0 || props->batteryVoltage == 0) {
         return;
     }

     memset(buff, 0, sizeof(buff));
     fd = open(BMS_BATT_RES_ID_PATH, O_RDONLY);
     if (fd < 0) {
         if (!healthd_msm_err_log_once) {
             LOGE(HEALTHD_TAG, "Couldn't open %s\n", BMS_BATT_RES_ID_PATH);
             healthd_msm_err_log_once = true;
         }
     } else {
         rc = read(fd, buff, 6);
         if (rc > 0) {
             sscanf(buff, "%d\n", &batteryId);
             batteryId /= 1000;
         } else if (!healthd_msm_err_log_once) {
             LOGE(HEALTHD_TAG, "reading batt_res_id failed, rc=%d\n", rc);
             healthd_msm_err_log_once = true;
         }
     }

     if (fd >= 0)
         close(fd);

     if (props->batteryLevel == batt_info_cached[BATT_INFO_SOC] &&
         props->batteryVoltage == batt_info_cached[BATT_INFO_VOLTAGE] &&
         props->batteryTemperature == batt_info_cached[BATT_INFO_TEMP] &&
         props->batteryFullCharge == batt_info_cached[BATT_INFO_FCC] &&
         batteryId == batt_info_cached[BATT_INFO_RES_ID])
         return;

     fd = open(PERSIST_BATT_INFO_PATH, O_RDWR | O_TRUNC);
     if (fd < 0) {
         /*
          * Print the error just only once as this function can be called as
          * long as the system is running and logs should not flood the console.
          */
         if (!healthd_msm_err_log_once) {
             LOGE(HEALTHD_TAG, "Error in opening batt_info.txt, fd=%d\n", fd);
             healthd_msm_err_log_once = true;
         }
         return;
     }

     len = snprintf(buff, sizeof(buff), "%d:%d:%d:%d:%d", props->batteryLevel,
                    batteryId, props->batteryVoltage,
                    props->batteryTemperature, props->batteryFullCharge);
     if (len < 0) {
         if (!healthd_msm_err_log_once) {
             LOGE(HEALTHD_TAG, "Error in printing to buff, len=%d\n", len);
             healthd_msm_err_log_once = true;
         }
         goto out;
     }

     buff[len] = '\0';
     rc = write(fd, buff, sizeof(buff));
     if (rc < 0) {
         if (!healthd_msm_err_log_once) {
             LOGE(HEALTHD_TAG, "Error in writing to batt_info.txt, rc=%d\n", rc);
             healthd_msm_err_log_once = true;
         }
         goto out;
     }

     batt_info_cached[BATT_INFO_SOC] = props->batteryLevel;
     batt_info_cached[BATT_INFO_RES_ID] = batteryId;
     batt_info_cached[BATT_INFO_VOLTAGE] = props->batteryVoltage;
     batt_info_cached[BATT_INFO_TEMP] = props->batteryTemperature;
     batt_info_cached[BATT_INFO_FCC] = props->batteryFullCharge;

 out:
     if (fd >= 0)
         close(fd);
 }

 int healthd_board_battery_update(struct android::BatteryProperties* props)
 {
     // return 0 to log periodic polled battery status to kernel log
     healthd_store_batt_props(props);
     if (healthd_msm_log_en)
         return 0;
     return 1;
 }
	/*
	*Copyright (c) 2015-2016, The Linux Foundation. All rights reserved.
	*
	*Redistribution and use in source and binary forms, with or without
	*modification, are permitted provided that the following conditions are
	*met:
	* * Redistributions of source code must retain the above copyright
	* notice, this list of conditions and the following disclaimer.
	* * Redistributions in binary form must reproduce the above
	* copyright notice, this list of conditions and the following
	* disclaimer in the documentation and/or other materials provided
	* with the distribution.
	* * Neither the name of The Linux Foundation nor the names of its
	* contributors may be used to endorse or promote products derived
	* from this software without specific prior written permission.
	*
	*THIS SOFTWARE IS PROVIDED "AS IS" AND ANY EXPRESS OR IMPLIED
	*WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
	*MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT
	*ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS
	*BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
	*CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
	*SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
	*BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
	*WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE
	*OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN
	*IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
	*/

	#include <dirent.h>
	#include <errno.h>
	#include <string.h>
	#include <fcntl.h>
	#include <unistd.h>
	#include <cutils/klog.h>
	#include <batteryservice/BatteryService.h>
	#include <cutils/android_reboot.h>
	#include <cutils/properties.h>
	#include <healthd.h>
	#include "minui/minui.h"
	#include "healthd_msm.h"
	#define ARRAY_SIZE(x) (sizeof(x)/sizeof(x[0]))

	#define HVDCP_CHARGER "USB_HVDCP"
	#define HVDCP_BLINK_TYPE 2

	#define RED_LED_PATH "/sys/class/leds/red/brightness"
	#define GREEN_LED_PATH "/sys/class/leds/green/brightness"
	#define BLUE_LED_PATH "/sys/class/leds/blue/brightness"
	#define RED_LED_BLINK_PATH "/sys/class/leds/red/blink"
	#define GREEN_LED_BLINK_PATH "/sys/class/leds/green/blink"
	#define BACKLIGHT_PATH "/sys/class/backlight/panel0-backlight/brightness"

	#define CHARGING_ENABLED_PATH "/sys/class/power_supply/battery/charging_enabled"
	#define CHARGER_TYPE_PATH "/sys/class/power_supply/usb/type"
	#define BMS_READY_PATH "/sys/class/power_supply/bms/soc_reporting_ready"
	#define BMS_BATT_INFO_PATH "/sys/class/power_supply/bms/battery_info"
	#define BMS_BATT_INFO_ID_PATH "/sys/class/power_supply/bms/battery_info_id"
	#define BMS_BATT_RES_ID_PATH "/sys/class/power_supply/bms/resistance_id"
	#define PERSIST_BATT_INFO_PATH "/persist/bms/batt_info.txt"

	#define CHGR_TAG "charger"
	#define HEALTHD_TAG "healthd_msm"
	#define LOGE(tag, x...) do { KLOG_ERROR(tag, x); } while (0)
	#define LOGW(tag, x...) do { KLOG_WARNING(tag, x); } while (0)
	#define LOGV(tag, x...) do { KLOG_DEBUG(tag, x); } while (0)

	enum {
	RED_LED = 0x01 << 0,
	GREEN_LED = 0x01 << 1,
	BLUE_LED = 0x01 << 2,
	};

	enum batt_info_params {
	BATT_INFO_NOTIFY = 0,
	BATT_INFO_SOC,
	BATT_INFO_RES_ID,
	BATT_INFO_VOLTAGE,
	BATT_INFO_TEMP,
	BATT_INFO_FCC,
	BATT_INFO_MAX,
	};

	struct led_ctl {
	int color;
	const char *path;
	};

	struct led_ctl leds[3] =
	{{RED_LED, RED_LED_PATH},
	{GREEN_LED, GREEN_LED_PATH},
	{BLUE_LED, BLUE_LED_PATH}};

	#define HVDCP_COLOR_MAP (RED_LED \| GREEN_LED)

	struct soc_led_color_mapping {
	int soc;
	int color;
	};

	struct soc_led_color_mapping soc_leds[3] = {
	{15, RED_LED},
	{90, RED_LED \| GREEN_LED},
	{100, GREEN_LED},
	};

	static int batt_info_cached[BATT_INFO_MAX];
	static bool healthd_msm_err_log_once;
	static int8_t healthd_msm_log_en;
	static int8_t healthd_msm_store_params;

	static int write_file_int(char const* path, int value)
	{
	int fd;
	char buffer[20];
	int rc = -1, bytes;

	fd = open(path, O_WRONLY);
	if (fd >= 0) {
	bytes = snprintf(buffer, sizeof(buffer), "%d\n", value);
	rc = write(fd, buffer, bytes);
	close(fd);
	}

	return rc > 0 ? 0 : -1;
	}

	static int set_tricolor_led(int on, int color)
	{
	int rc, i;
	char buffer[10];

	for (i = 0; i < (int)ARRAY_SIZE(leds); i++) {
	if ((color & leds[i].color) && (access(leds[i].path, R_OK \| W_OK) == 0)) {
	rc = write_file_int(leds[i].path, on ? 255 : 0);
	if (rc < 0)
	return rc;
	}
	}

	return 0;
	}

	static bool is_hvdcp_inserted()
	{
	bool hvdcp = false;
	char buff[12] = "\0";
	int fd, cnt;

	fd = open(CHARGER_TYPE_PATH, O_RDONLY);
	if (fd >= 0) {
	cnt = read(fd, buff, (sizeof(buff) - 1));
	if (cnt > 0 && !strncmp(buff, HVDCP_CHARGER, 9))
	hvdcp = true;
	close(fd);
	}

	return hvdcp;
	}

	static int get_blink_led_for_hvdcp(void)
	{
	int ret, rc = 0, bytes;
	int red_blink_fd = -1, green_blink_fd = -1, type_fd = -1;
	char buf[20];

	type_fd = open(CHARGER_TYPE_PATH, O_RDONLY);

	if (type_fd < 0) {
	LOGE(CHGR_TAG, "Could not open USB type node\n");
	return rc;
	} else {
	close(type_fd);
	ret = write_file_int(GREEN_LED_BLINK_PATH, 0);
	if (ret < 0) {
	LOGE(CHGR_TAG, "Fail to write: %s\n", GREEN_LED_BLINK_PATH);
	} else {
	rc \|= GREEN_LED;
	}

	ret = write_file_int(RED_LED_BLINK_PATH, 0);
	if (ret < 0) {
	LOGE(CHGR_TAG, "Fail to write: %s\n", RED_LED_BLINK_PATH);
	} else {
	rc \|= RED_LED;
	}
	}

	return rc;
	}

	#if QTI_BSP
	#define STR_LEN 8
	void healthd_board_mode_charger_draw_battery(
	struct android::BatteryProperties *batt_prop)
	{
	char cap_str[STR_LEN];
	int x, y;
	int str_len_px;
	static int char_height = -1, char_width = -1;

	if (char_height == -1 && char_width == -1)
	gr_font_size(&char_width, &char_height);
	snprintf(cap_str, (STR_LEN - 1), "%d%%", batt_prop->batteryLevel);
	str_len_px = gr_measure(cap_str);
	x = (gr_fb_width() - str_len_px) / 2;
	y = (gr_fb_height() + char_height) / 2;
	gr_color(0xa4, 0xc6, 0x39, 255);
	gr_text(x, y, cap_str, 0);
	}
	#endif

	void healthd_board_mode_charger_battery_update(
	struct android::BatteryProperties *batt_prop)
	{
	static int blink_for_hvdcp = -1;
	static int old_color = 0;
	int i, color, soc, rc;
	bool blink = false;

	if (blink_for_hvdcp == -1)
	blink_for_hvdcp = get_blink_led_for_hvdcp();

	if ((blink_for_hvdcp > 0) && is_hvdcp_inserted())
	blink = true;

	soc = batt_prop->batteryLevel;

	for (i = 0; i < ((int)ARRAY_SIZE(soc_leds) - 1); i++) {
	if (soc < soc_leds[i].soc)
	break;
	}
	color = soc_leds[i].color;

	if (old_color != color) {
	if ((color == HVDCP_COLOR_MAP) && blink) {
	if (blink_for_hvdcp & RED_LED) {
	rc = write_file_int(RED_LED_BLINK_PATH, HVDCP_BLINK_TYPE);
	if (rc < 0) {
	LOGE(CHGR_TAG, "Fail to write: %s\n", RED_LED_BLINK_PATH);
	return;
	}
	}
	if (blink_for_hvdcp & GREEN_LED) {
	rc = write_file_int(GREEN_LED_BLINK_PATH, HVDCP_BLINK_TYPE);
	if (rc < 0) {
	LOGE(CHGR_TAG, "Fail to write: %s\n", GREEN_LED_BLINK_PATH);
	return;
	}
	}
	} else {
	rc = set_tricolor_led(0, old_color);
	if (rc < 0)
	LOGE(CHGR_TAG, "Error in setting old_color on tricolor_led\n");

	rc = set_tricolor_led(1, color);
	if (rc < 0)
	LOGE(CHGR_TAG, "Error in setting color on tricolor_led\n");

	if (!rc) {
	old_color = color;
	LOGV(CHGR_TAG, "soc = %d, set led color 0x%x\n", soc, soc_leds[i].color);
	}
	}
	}
	}

	#define BACKLIGHT_ON_LEVEL 100
	#define BACKLIGHT_OFF_LEVEL 0
	void healthd_board_mode_charger_set_backlight(bool en)
	{
	int rc;

	if (access(BACKLIGHT_PATH, R_OK \| W_OK) != 0)
	{
	LOGW(CHGR_TAG, "Backlight control not support\n");
	return;
	}

	rc = write_file_int(BACKLIGHT_PATH, en ? BACKLIGHT_ON_LEVEL :
	BACKLIGHT_OFF_LEVEL);
	if (rc < 0) {
	LOGE(CHGR_TAG, "Could not write to backlight node : %s\n", strerror(errno));
	return;
	}

	LOGV(CHGR_TAG, "set backlight status to %d\n", en);
	}

	static inline void get_healthd_props()
	{
	healthd_msm_log_en = property_get_bool("persist.healthd_msm.log_en", 1);
	healthd_msm_store_params =
	property_get_bool("persist.healthd_msm.store_params", 0);
	}

	#define WAIT_BMS_READY_TIMES_MAX 200
	#define WAIT_BMS_READY_INTERVAL_USEC 200000
	void healthd_board_mode_charger_init()
	{
	int ret;
	char buff[8] = "\0";
	int charging_enabled = 0;
	int bms_ready = 0;
	int wait_count = 0;
	int fd;

	/* check the charging is enabled or not */
	fd = open(CHARGING_ENABLED_PATH, O_RDONLY);
	if (fd < 0)
	return;
	ret = read(fd, buff, (sizeof(buff) - 1));
	close(fd);
	if (ret > 0) {
	buff[ret] = '\0';
	sscanf(buff, "%d\n", &charging_enabled);
	LOGW(CHGR_TAG, "android charging is %s\n",
	!!charging_enabled ? "enabled" : "disabled");
	/* if charging is disabled, reboot and exit power off charging */
	if (!charging_enabled)
	android_reboot(ANDROID_RB_RESTART, 0, 0);
	}
	fd = open(BMS_READY_PATH, O_RDONLY);
	if (fd < 0)
	return;
	while (1) {
	ret = read(fd, buff, (sizeof(buff) - 1));
	if (ret > 0) {
	buff[ret] = '\0';
	sscanf(buff, "%d\n", &bms_ready);
	} else {
	LOGE(CHGR_TAG, "read soc-ready failed, ret=%d\n", ret);
	break;
	}

	if ((bms_ready > 0) \|\| (wait_count++ > WAIT_BMS_READY_TIMES_MAX))
	break;
	usleep(WAIT_BMS_READY_INTERVAL_USEC);
	lseek(fd, 0, SEEK_SET);
	}
	close(fd);
	LOGV(CHGR_TAG, "Checking BMS SoC ready done %d!\n", bms_ready);
	}

	static void healthd_batt_info_notify()
	{
	int rc, fd, id = 0;
	int bms_ready = 0;
	int wait_count = 0;
	char buff[100] = "";
	int batt_info[BATT_INFO_MAX];
	char ptr, tmp, *temp_str;
	char path_str[50] = "";
	bool notify_bms = false;

	if (!healthd_msm_store_params) {
	return;
	}

	fd = open(PERSIST_BATT_INFO_PATH, O_RDONLY);
	if (fd < 0) {
	LOGW(HEALTHD_TAG, "Error in opening batt_info.txt, fd=%d\n", fd);
	fd = creat(PERSIST_BATT_INFO_PATH, S_IRWXU);
	if (fd < 0) {
	LOGE(HEALTHD_TAG, "Couldn't create file, fd=%d errno=%s\n", fd,
	strerror(errno));
	goto out;
	}
	LOGV(HEALTHD_TAG, "Created file %s\n", PERSIST_BATT_INFO_PATH);
	close(fd);
	goto out;
	} else {
	LOGV(HEALTHD_TAG, "opened %s\n", PERSIST_BATT_INFO_PATH);
	}

	rc = read(fd, buff, (sizeof(buff) - 1));
	if (rc < 0) {
	LOGE(HEALTHD_TAG, "Error in reading fd %d, rc=%d\n", fd, rc);
	close(fd);
	goto out;
	}
	close(fd);
	buff[rc] = '\0';
	temp_str = strtok_r(buff, ":", &ptr);
	id = 1;
	while (temp_str != NULL && id < BATT_INFO_MAX) {
	batt_info[id++] = (int)strtol(temp_str, &tmp, 10);
	temp_str = strtok_r(NULL, ":", &ptr);
	}

	if (id < BATT_INFO_MAX) {
	LOGE(HEALTHD_TAG, "Read %d batt_info parameters\n", id);
	goto out;
	}

	/* Send batt_info parameters to FG driver */
	for (id = 1; id < BATT_INFO_MAX; id++) {
	snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_ID_PATH);
	rc = write_file_int(path_str, id);
	if (rc < 0) {
	LOGE(HEALTHD_TAG, "Error in writing batt_info_id %d, rc=%d\n", id,
	rc);
	goto out;
	}

	snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_PATH);
	rc = write_file_int(path_str, batt_info[id]);
	if (rc < 0) {
	LOGE(HEALTHD_TAG, "Error in writing batt_info %d, rc=%d\n",
	batt_info[id], rc);
	goto out;
	}
	}

	notify_bms = true;

	out:
	fd = open(BMS_READY_PATH, O_RDONLY);
	if (fd < 0) {
	LOGE(HEALTHD_TAG, "Couldn't open %s\n", BMS_READY_PATH);
	return;
	}

	/* Wait for soc_reporting_ready */
	wait_count = 0;
	memset(buff, 0, sizeof(buff));
	while (1) {
	rc = read(fd, buff, 1);
	if (rc > 0) {
	sscanf(buff, "%d\n", &bms_ready);
	} else {
	LOGE(HEALTHD_TAG, "read soc-ready failed, rc=%d\n", rc);
	break;
	}

	if ((bms_ready > 0) \|\| (wait_count++ > WAIT_BMS_READY_TIMES_MAX))
	break;

	usleep(WAIT_BMS_READY_INTERVAL_USEC);
	lseek(fd, 0, SEEK_SET);
	}
	close(fd);

	if (!bms_ready)
	notify_bms = false;

	if (!notify_bms) {
	LOGE(HEALTHD_TAG, "Not notifying BMS\n");
	return;
	}

	/* Notify FG driver */
	snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_ID_PATH);
	rc = write_file_int(path_str, BATT_INFO_NOTIFY);
	if (rc < 0) {
	LOGE(HEALTHD_TAG, "Error in writing batt_info_id, rc=%d\n", rc);
	return;
	}

	snprintf(path_str, sizeof(path_str), "%s", BMS_BATT_INFO_PATH);
	rc = write_file_int(path_str, INT_MAX - 1);
	if (rc < 0)
	LOGE(HEALTHD_TAG, "Error in writing batt_info, rc=%d\n", rc);
	}

	void healthd_board_init(struct healthd_config*)
	{
	// use defaults
	get_healthd_props();
	power_off_alarm_init();
	healthd_batt_info_notify();
	}

	static void healthd_store_batt_props(const struct android::BatteryProperties* props)
	{
	char buff[100];
	int fd, rc, len, batteryId = 0;

	if (!healthd_msm_store_params) {
	return;
	}

	if (!props->batteryPresent) {
	return;
	}

	if (props->batteryLevel == 0 \|\| props->batteryVoltage == 0) {
	return;
	}

	memset(buff, 0, sizeof(buff));
	fd = open(BMS_BATT_RES_ID_PATH, O_RDONLY);
	if (fd < 0) {
	if (!healthd_msm_err_log_once) {
	LOGE(HEALTHD_TAG, "Couldn't open %s\n", BMS_BATT_RES_ID_PATH);
	healthd_msm_err_log_once = true;
	}
	} else {
	rc = read(fd, buff, 6);
	if (rc > 0) {
	sscanf(buff, "%d\n", &batteryId);
	batteryId /= 1000;
	} else if (!healthd_msm_err_log_once) {
	LOGE(HEALTHD_TAG, "reading batt_res_id failed, rc=%d\n", rc);
	healthd_msm_err_log_once = true;
	}
	}

	if (fd >= 0)
	close(fd);

	if (props->batteryLevel == batt_info_cached[BATT_INFO_SOC] &&
	props->batteryVoltage == batt_info_cached[BATT_INFO_VOLTAGE] &&
	props->batteryTemperature == batt_info_cached[BATT_INFO_TEMP] &&
	props->batteryFullCharge == batt_info_cached[BATT_INFO_FCC] &&
	batteryId == batt_info_cached[BATT_INFO_RES_ID])
	return;

	fd = open(PERSIST_BATT_INFO_PATH, O_RDWR \| O_TRUNC);
	if (fd < 0) {
	/*
	* Print the error just only once as this function can be called as
	* long as the system is running and logs should not flood the console.
	*/
	if (!healthd_msm_err_log_once) {
	LOGE(HEALTHD_TAG, "Error in opening batt_info.txt, fd=%d\n", fd);
	healthd_msm_err_log_once = true;
	}
	return;
	}

	len = snprintf(buff, sizeof(buff), "%d:%d:%d:%d:%d", props->batteryLevel,
	batteryId, props->batteryVoltage,
	props->batteryTemperature, props->batteryFullCharge);
	if (len < 0) {
	if (!healthd_msm_err_log_once) {
	LOGE(HEALTHD_TAG, "Error in printing to buff, len=%d\n", len);
	healthd_msm_err_log_once = true;
	}
	goto out;
	}

	buff[len] = '\0';
	rc = write(fd, buff, sizeof(buff));
	if (rc < 0) {
	if (!healthd_msm_err_log_once) {
	LOGE(HEALTHD_TAG, "Error in writing to batt_info.txt, rc=%d\n", rc);
	healthd_msm_err_log_once = true;
	}
	goto out;
	}

	batt_info_cached[BATT_INFO_SOC] = props->batteryLevel;
	batt_info_cached[BATT_INFO_RES_ID] = batteryId;
	batt_info_cached[BATT_INFO_VOLTAGE] = props->batteryVoltage;
	batt_info_cached[BATT_INFO_TEMP] = props->batteryTemperature;
	batt_info_cached[BATT_INFO_FCC] = props->batteryFullCharge;

	out:
	if (fd >= 0)
	close(fd);
	}

	int healthd_board_battery_update(struct android::BatteryProperties* props)
	{
	// return 0 to log periodic polled battery status to kernel log
	healthd_store_batt_props(props);
	if (healthd_msm_log_en)
	return 0;
	return 1;
	}