dev: Add support for QPNP WLED Driver.

Add support for wled module which is part of
PMI8994. Wled enables backlight for the devices.

Change-Id: I149bbc309eb9c795f612206d21f91f9e16a11e21
diff --git a/dev/pmic/pm8x41/include/pm8x41_wled.h b/dev/pmic/pm8x41/include/pm8x41_wled.h
index 8ad7370..0fe7975 100644
--- a/dev/pmic/pm8x41/include/pm8x41_wled.h
+++ b/dev/pmic/pm8x41/include/pm8x41_wled.h
@@ -77,3 +77,5 @@
 void pm8x41_wled_led_mod_enable(uint8_t enable);
 void pm8x41_wled_enable(uint8_t enable);
 void pm8x41_wled_config_slave_id(uint8_t slave_id);
+uint8_t pm8x41_wled_reg_read(uint32_t addr);
+void pm8x41_wled_reg_write(uint32_t addr, uint8_t val);
diff --git a/dev/pmic/pm8x41/pm8x41.c b/dev/pmic/pm8x41/pm8x41.c
index 480e6e8..09649c6 100644
--- a/dev/pmic/pm8x41/pm8x41.c
+++ b/dev/pmic/pm8x41/pm8x41.c
@@ -35,6 +35,13 @@
 #include <pm8x41.h>
 #include <platform/timer.h>
 
+static uint8_t mpp_slave_id;
+
+uint8_t pmi8994_config_mpp_slave_id(uint8_t slave_id)
+{
+	mpp_slave_id = slave_id;
+}
+
 /* SPMI helper functions */
 uint8_t pm8x41_reg_read(uint32_t addr)
 {
@@ -384,16 +391,16 @@
 {
 	ASSERT(mpp);
 
-	REG_WRITE(mpp->base + MPP_EN_CTL, enable << MPP_EN_CTL_ENABLE_SHIFT);
+	REG_WRITE(((mpp->base + MPP_EN_CTL) + (mpp_slave_id << 16)), enable << MPP_EN_CTL_ENABLE_SHIFT);
 }
 
 void pm8x41_config_output_mpp(struct pm8x41_mpp *mpp)
 {
 	ASSERT(mpp);
 
-	REG_WRITE(mpp->base + MPP_DIG_VIN_CTL, mpp->vin);
+	REG_WRITE(((mpp->base + MPP_DIG_VIN_CTL) + (mpp_slave_id << 16)), mpp->vin);
 
-	REG_WRITE(mpp->base + MPP_MODE_CTL, mpp->mode | (MPP_DIGITAL_OUTPUT << MPP_MODE_CTL_MODE_SHIFT));
+	REG_WRITE(((mpp->base + MPP_MODE_CTL) + (mpp_slave_id << 16)), mpp->mode | (MPP_DIGITAL_OUTPUT << MPP_MODE_CTL_MODE_SHIFT));
 }
 
 uint8_t pm8x41_get_is_cold_boot()
diff --git a/dev/pmic/pm8x41/pm8x41_wled.c b/dev/pmic/pm8x41/pm8x41_wled.c
index 42283e1..9c3b6d3 100644
--- a/dev/pmic/pm8x41/pm8x41_wled.c
+++ b/dev/pmic/pm8x41/pm8x41_wled.c
@@ -1,4 +1,4 @@
-/* Copyright (c) 2013, The Linux Foundation. All rights reserved.
+/* Copyright (c) 2013-2014, 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
@@ -33,7 +33,7 @@
 
 static uint8_t wled_slave_id;
 
-static void wled_reg_write(uint32_t addr, uint8_t val)
+void pm8x41_wled_reg_write(uint32_t addr, uint8_t val)
 {
 	uint32_t new_addr;
 	if (wled_slave_id) {
@@ -45,6 +45,21 @@
 	}
 }
 
+uint8_t pm8x41_wled_reg_read(uint32_t addr)
+{
+	uint32_t new_addr;
+	uint8_t val;
+
+	if (wled_slave_id) {
+		new_addr = addr + (wled_slave_id << 16);
+		val = REG_READ(new_addr);
+	} else {
+		new_addr = addr + (DEFAULT_SLAVE_ID << 16);
+		val = REG_READ(new_addr);
+	}
+	return val;
+}
+
 void pm8x41_wled_config_slave_id(uint8_t slave_id)
 {
 	wled_slave_id = slave_id;
@@ -57,22 +72,22 @@
 		return;
 	}
 
-	wled_reg_write(PM_WLED_MODULATION_SCHEME, wled_ctrl->mod_scheme);
+	pm8x41_wled_reg_write(PM_WLED_MODULATION_SCHEME, wled_ctrl->mod_scheme);
 
-	wled_reg_write(PM_WLED_LED1_BRIGHTNESS_LSB, (wled_ctrl->led1_brightness & 0xFF));
-	wled_reg_write(PM_WLED_LED1_BRIGHTNESS_MSB, ((wled_ctrl->led1_brightness >> 8) & 0xFF));
-	wled_reg_write(PM_WLED_LED2_BRIGHTNESS_LSB, (wled_ctrl->led2_brightness & 0xFF));
-	wled_reg_write(PM_WLED_LED2_BRIGHTNESS_MSB, ((wled_ctrl->led2_brightness >> 8) & 0xFF));
-	wled_reg_write(PM_WLED_LED3_BRIGHTNESS_LSB, (wled_ctrl->led3_brightness & 0xFF));
-	wled_reg_write(PM_WLED_LED3_BRIGHTNESS_MSB, ((wled_ctrl->led3_brightness >> 8) & 0xFF));
+	pm8x41_wled_reg_write(PM_WLED_LED1_BRIGHTNESS_LSB, (wled_ctrl->led1_brightness & 0xFF));
+	pm8x41_wled_reg_write(PM_WLED_LED1_BRIGHTNESS_MSB, ((wled_ctrl->led1_brightness >> 8) & 0xFF));
+	pm8x41_wled_reg_write(PM_WLED_LED2_BRIGHTNESS_LSB, (wled_ctrl->led2_brightness & 0xFF));
+	pm8x41_wled_reg_write(PM_WLED_LED2_BRIGHTNESS_MSB, ((wled_ctrl->led2_brightness >> 8) & 0xFF));
+	pm8x41_wled_reg_write(PM_WLED_LED3_BRIGHTNESS_LSB, (wled_ctrl->led3_brightness & 0xFF));
+	pm8x41_wled_reg_write(PM_WLED_LED3_BRIGHTNESS_MSB, ((wled_ctrl->led3_brightness >> 8) & 0xFF));
 
-	wled_reg_write(PM_WLED_MAX_DUTY_CYCLE, wled_ctrl->max_duty_cycle);
-	wled_reg_write(PM_WLED_OVP, wled_ctrl->ovp);
-	wled_reg_write(LEDn_FULL_SCALE_CURRENT(1), wled_ctrl->full_current_scale);
-	wled_reg_write(LEDn_FULL_SCALE_CURRENT(2), wled_ctrl->full_current_scale);
-	wled_reg_write(LEDn_FULL_SCALE_CURRENT(3), wled_ctrl->full_current_scale);
+	pm8x41_wled_reg_write(PM_WLED_MAX_DUTY_CYCLE, wled_ctrl->max_duty_cycle);
+	pm8x41_wled_reg_write(PM_WLED_OVP, wled_ctrl->ovp);
+	pm8x41_wled_reg_write(LEDn_FULL_SCALE_CURRENT(1), wled_ctrl->full_current_scale);
+	pm8x41_wled_reg_write(LEDn_FULL_SCALE_CURRENT(2), wled_ctrl->full_current_scale);
+	pm8x41_wled_reg_write(LEDn_FULL_SCALE_CURRENT(3), wled_ctrl->full_current_scale);
 
-	wled_reg_write(PM_WLED_FDBCK_CONTROL, wled_ctrl->fdbck);
+	pm8x41_wled_reg_write(PM_WLED_FDBCK_CONTROL, wled_ctrl->fdbck);
 	dprintf(SPEW, "WLED Configuration Success.\n");
 
 }
@@ -87,7 +102,7 @@
 			PM_WLED_LED3_SINK_MASK;
 	}
 
-	wled_reg_write(PM_WLED_CURRENT_SINK, value);
+	pm8x41_wled_reg_write(PM_WLED_CURRENT_SINK, value);
 
 	dprintf(SPEW, "WLED Sink Success\n");
 
@@ -103,7 +118,7 @@
 			PM_WLED_LED3_ILED_SYNC_MASK;
 	}
 
-	wled_reg_write(PM_WLED_ILED_SYNC_BIT, value);
+	pm8x41_wled_reg_write(PM_WLED_ILED_SYNC_BIT, value);
 
 	dprintf(SPEW, "WLED ILED Sync Success\n");
 
@@ -116,9 +131,9 @@
 	if (enable)
 		value = PM_WLED_LED_MODULATOR_EN;
 
-	wled_reg_write(PM_WLED_LED_CTNL_REG(1), value);
-	wled_reg_write(PM_WLED_LED_CTNL_REG(2), value);
-	wled_reg_write(PM_WLED_LED_CTNL_REG(3), value);
+	pm8x41_wled_reg_write(PM_WLED_LED_CTNL_REG(1), value);
+	pm8x41_wled_reg_write(PM_WLED_LED_CTNL_REG(2), value);
+	pm8x41_wled_reg_write(PM_WLED_LED_CTNL_REG(3), value);
 
 	dprintf(SPEW, "WLED LED Module Enable Success\n");
 
@@ -131,7 +146,7 @@
 	if (enable)
 		value = PM_WLED_ENABLE_MODULE_MASK;
 
-	wled_reg_write(PM_WLED_ENABLE, value);
+	pm8x41_wled_reg_write(PM_WLED_ENABLE, value);
 
 	dprintf(SPEW, "WLED Enable Success\n");
 
diff --git a/dev/qpnp_wled/include/qpnp_wled.h b/dev/qpnp_wled/include/qpnp_wled.h
new file mode 100644
index 0000000..751509d
--- /dev/null
+++ b/dev/qpnp_wled/include/qpnp_wled.h
@@ -0,0 +1,253 @@
+/* Copyright (c) 2014, 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 <bits.h>
+#include <debug.h>
+#include <reg.h>
+
+/* base addresses */
+#define QPNP_WLED_CTRL_BASE                    0xd800
+#define QPNP_WLED_SINK_BASE                    0xd900
+#define QPNP_WLED_IBB_BASE                     0xdc00
+#define QPNP_WLED_LAB_BASE                     0xde00
+
+/* ctrl registers */
+#define QPNP_WLED_EN_REG(b)                    (b + 0x46)
+#define QPNP_WLED_FDBK_OP_REG(b)               (b + 0x48)
+#define QPNP_WLED_VREF_REG(b)                  (b + 0x49)
+#define QPNP_WLED_BOOST_DUTY_REG(b)            (b + 0x4B)
+#define QPNP_WLED_SWITCH_FREQ_REG(b)           (b + 0x4C)
+#define QPNP_WLED_OVP_REG(b)                   (b + 0x4D)
+#define QPNP_WLED_ILIM_REG(b)                  (b + 0x4E)
+
+#define QPNP_WLED_EN_MASK                      0x7F
+#define QPNP_WLED_EN_SHIFT                     7
+#define QPNP_WLED_FDBK_OP_MASK                 0xF8
+#define QPNP_WLED_VREF_MASK                    0xF0
+#define QPNP_WLED_VREF_STEP_MV                 25
+#define QPNP_WLED_VREF_MIN_MV                  300
+#define QPNP_WLED_VREF_MAX_MV                  675
+#define QPNP_WLED_DFLT_VREF_MV                 350
+#define QPNP_WLED_ILIM_MASK                    0xF8
+#define QPNP_WLED_ILIM_MIN_MA                  105
+#define QPNP_WLED_ILIM_MAX_MA                  1980
+#define QPNP_WLED_ILIM_STEP_MA                 280
+#define QPNP_WLED_DFLT_ILIM_MA                 980
+#define QPNP_WLED_BOOST_DUTY_MASK              0xFC
+#define QPNP_WLED_BOOST_DUTY_STEP_NS           52
+#define QPNP_WLED_BOOST_DUTY_MIN_NS            26
+#define QPNP_WLED_BOOST_DUTY_MAX_NS            156
+#define QPNP_WLED_DEF_BOOST_DUTY_NS            104
+#define QPNP_WLED_DFLT_HYB_THRES               625
+#define QPNP_WLED_SWITCH_FREQ_MASK             0xF0
+#define QPNP_WLED_SWITCH_FREQ_800_KHZ          800
+#define QPNP_WLED_SWITCH_FREQ_1600_KHZ         1600
+#define QPNP_WLED_OVP_MASK                     0xFC
+#define QPNP_WLED_OVP_17800_MV                 17800
+#define QPNP_WLED_OVP_19400_MV                 19400
+#define QPNP_WLED_OVP_29500_MV                 29500
+#define QPNP_WLED_OVP_31000_MV                 31000
+
+/* sink registers */
+#define QPNP_WLED_CURR_SINK_REG(b)             (b + 0x46)
+#define QPNP_WLED_SYNC_REG(b)                  (b + 0x47)
+#define QPNP_WLED_MOD_REG(b)                   (b + 0x4A)
+#define QPNP_WLED_HYB_THRES_REG(b)             (b + 0x4B)
+#define QPNP_WLED_MOD_EN_REG(b, n)             (b + 0x50 + (n * 0x10))
+#define QPNP_WLED_SYNC_DLY_REG(b, n)           (QPNP_WLED_MOD_EN_REG(b, n) + 0x01)
+#define QPNP_WLED_FS_CURR_REG(b, n)            (QPNP_WLED_MOD_EN_REG(b, n) + 0x02)
+#define QPNP_WLED_CABC_REG(b, n)               (QPNP_WLED_MOD_EN_REG(b, n) + 0x06)
+#define QPNP_WLED_BRIGHT_LSB_REG(b, n)         (QPNP_WLED_MOD_EN_REG(b, n) + 0x07)
+#define QPNP_WLED_BRIGHT_MSB_REG(b, n)         (QPNP_WLED_MOD_EN_REG(b, n) + 0x08)
+
+#define QPNP_WLED_MOD_FREQ_1200_KHZ            1200
+#define QPNP_WLED_MOD_FREQ_2400_KHZ            2400
+#define QPNP_WLED_MOD_FREQ_9600_KHZ            9600
+#define QPNP_WLED_MOD_FREQ_19200_KHZ           19200
+#define QPNP_WLED_MOD_FREQ_MASK                0x3F
+#define QPNP_WLED_MOD_FREQ_SHIFT               6
+#define QPNP_WLED_PHASE_STAG_MASK              0xDF
+#define QPNP_WLED_PHASE_STAG_SHIFT             5
+#define QPNP_WLED_DIM_RES_MASK                 0xFD
+#define QPNP_WLED_DIM_RES_SHIFT                1
+#define QPNP_WLED_DIM_HYB_MASK                 0xFB
+#define QPNP_WLED_DIM_HYB_SHIFT                2
+#define QPNP_WLED_DIM_ANA_MASK                 0xFE
+#define QPNP_WLED_HYB_THRES_MASK               0xF8
+#define QPNP_WLED_HYB_THRES_MIN                78
+#define QPNP_WLED_DEF_HYB_THRES                625
+#define QPNP_WLED_HYB_THRES_MAX                10000
+#define QPNP_WLED_MOD_EN_MASK                  0x7F
+#define QPNP_WLED_MOD_EN_SHFT                  7
+#define QPNP_WLED_MOD_EN                       1
+#define QPNP_WLED_SYNC_DLY_MASK                0xF8
+#define QPNP_WLED_SYNC_DLY_MIN_US              0
+#define QPNP_WLED_SYNC_DLY_MAX_US              1400
+#define QPNP_WLED_SYNC_DLY_STEP_US             200
+#define QPNP_WLED_DEF_SYNC_DLY_US              400
+#define QPNP_WLED_FS_CURR_MASK                 0xF0
+#define QPNP_WLED_FS_CURR_MIN_UA               0
+#define QPNP_WLED_FS_CURR_MAX_UA               30000
+#define QPNP_WLED_FS_CURR_STEP_UA              2500
+#define QPNP_WLED_CABC_MASK                    0x7F
+#define QPNP_WLED_CABC_SHIFT                   7
+#define QPNP_WLED_CURR_SINK_SHIFT              4
+#define QPNP_WLED_BRIGHT_LSB_MASK              0xFF
+#define QPNP_WLED_BRIGHT_MSB_SHIFT             8
+#define QPNP_WLED_BRIGHT_MSB_MASK              0x0F
+#define QPNP_WLED_SYNC                         0x0F
+#define QPNP_WLED_SYNC_RESET                   0x00
+
+#define QPNP_WLED_SWITCH_FREQ_800_KHZ_CODE     0x0B
+#define QPNP_WLED_SWITCH_FREQ_1600_KHZ_CODE    0x05
+
+#define QPNP_WLED_DISP_SEL_REG(b)              (b + 0x44)
+#define QPNP_WLED_MODULE_RDY_REG(b)            (b + 0x45)
+#define QPNP_WLED_MODULE_EN_REG(b)             (b + 0x46)
+#define QPNP_WLED_MODULE_RDY_MASK              0x7F
+#define QPNP_WLED_MODULE_RDY_SHIFT             7
+#define QPNP_WLED_MODULE_EN_MASK               0x7F
+#define QPNP_WLED_MODULE_EN_SHIFT              7
+#define QPNP_WLED_DISP_SEL_MASK                0x7F
+#define QPNP_WLED_DISP_SEL_SHIFT               7
+
+#define QPNP_WLED_IBB_BIAS_REG(b)              (b + 0x58)
+#define QPNP_WLED_IBB_BIAS_MASK                0x7F
+#define QPNP_WLED_IBB_BIAS_SHIFT               7
+#define QPNP_WLED_IBB_PWRUP_DLY_MASK           0xCF
+#define QPNP_WLED_IBB_PWRUP_DLY_SHIFT          4
+#define QPNP_WLED_IBB_PWRUP_DLY_MIN_MS         1
+#define QPNP_WLED_IBB_PWRUP_DLY_MAX_MS         8
+
+#define QPNP_WLED_LAB_IBB_RDY_REG(b)           (b + 0x49)
+#define QPNP_WLED_LAB_FAST_PC_REG(b)           (b + 0x5E)
+#define QPNP_WLED_LAB_FAST_PC_MASK             0xFB
+#define QPNP_WLED_LAB_START_DLY_US             8
+#define QPNP_WLED_LAB_FAST_PC_SHIFT            2
+
+#define QPNP_WLED_SEC_ACCESS_REG(b)            (b + 0xD0)
+#define QPNP_WLED_SEC_UNLOCK                   0xA5
+
+#define QPNP_WLED_MAX_STRINGS                  4
+#define WLED_MAX_LEVEL_511                     511
+#define WLED_MAX_LEVEL_4095                    4095
+#define QPNP_WLED_RAMP_DLY_MS                  20
+#define QPNP_WLED_TRIGGER_NONE                 "none"
+#define QPNP_WLED_STR_SIZE                     20
+#define QPNP_WLED_MIN_MSLEEP                   20
+#define QPNP_WLED_MAX_BR_LEVEL                 1638
+
+/* output feedback mode */
+enum qpnp_wled_fdbk_op {
+       QPNP_WLED_FDBK_AUTO,
+       QPNP_WLED_FDBK_WLED1,
+       QPNP_WLED_FDBK_WLED2,
+       QPNP_WLED_FDBK_WLED3,
+       QPNP_WLED_FDBK_WLED4,
+};
+
+/* dimming modes */
+enum qpnp_wled_dim_mode {
+       QPNP_WLED_DIM_ANALOG,
+       QPNP_WLED_DIM_DIGITAL,
+       QPNP_WLED_DIM_HYBRID,
+};
+
+/* dimming curve shapes */
+enum qpnp_wled_dim_shape {
+       QPNP_WLED_DIM_SHAPE_LOG,
+       QPNP_WLED_DIM_SHAPE_LINEAR,
+       QPNP_WLED_DIM_SHAPE_SQUARE,
+};
+
+
+/**
+ *  qpnp_wled - wed data structure
+ *  @ fdbk_op - output feedback mode
+ *  @ dim_mode - dimming mode
+ *  @ dim_shape - dimming curve shape
+ *  @ ctrl_base - base address for wled ctrl
+ *  @ sink_base - base address for wled sink
+ *  @ ibb_base - base address for IBB(Inverting Buck Boost)
+ *  @ lab_base - base address for LAB(LCD/AMOLED Boost)
+ *  @ mod_freq_khz - modulator frequency in KHZ
+ *  @ hyb_thres - threshold for hybrid dimming
+ *  @ sync_dly_us - sync delay in us
+ *  @ vref_mv - ref voltage in mv
+ *  @ switch_freq_khz - switching frequency in KHZ
+ *  @ ovp_mv - over voltage protection in mv
+ *  @ ilim_ma - current limiter in ma
+ *  @ boost_duty_ns - boost duty cycle in ns
+ *  @ fs_curr_ua - full scale current in ua
+ *  @ ramp_ms - delay between ramp steps in ms
+ *  @ ramp_step - ramp step size
+ *  @ strings - supported list of strings
+ *  @ num_strings - number of strings
+ *  @ en_9b_dim_res - enable or disable 9bit dimming
+ *  @ en_phase_stag - enable or disable phase staggering
+ *  @ en_cabc - enable or disable cabc
+ *  @ disp_type_amoled - type of display: LCD/AMOLED
+ *  @ ibb_bias_active - activate display bias
+ *  @ lab_fast_precharge - fast/slow precharge
+ */
+struct qpnp_wled {
+	enum qpnp_wled_fdbk_op fdbk_op;
+	enum qpnp_wled_dim_mode dim_mode;
+	enum qpnp_wled_dim_shape dim_shape;
+	uint16_t ctrl_base;
+	uint16_t sink_base;
+	uint16_t ibb_base;
+	uint16_t lab_base;
+	uint16_t mod_freq_khz;
+	uint16_t hyb_thres;
+	uint16_t sync_dly_us;
+	uint16_t vref_mv;
+	uint16_t switch_freq_khz;
+	uint16_t ovp_mv;
+	uint16_t ilim_ma;
+	uint16_t boost_duty_ns;
+	uint16_t fs_curr_ua;
+	uint16_t ibb_pwrup_dly_ms;
+	uint16_t ramp_ms;
+	uint16_t ramp_step;
+	uint8_t strings[QPNP_WLED_MAX_STRINGS];
+	uint8_t num_strings;
+	bool en_9b_dim_res;
+	bool en_phase_stag;
+	bool en_cabc;
+	bool disp_type_amoled;
+	bool ibb_bias_active;
+	bool lab_fast_precharge;
+};
+
+/* WLED Initial Setup */
+int qpnp_wled_init();
+
+/* Enable IBB */
+int qpnp_ibb_enable();
+void qpnp_wled_enable_backlight(enable);
diff --git a/dev/qpnp_wled/qpnp_wled.c b/dev/qpnp_wled/qpnp_wled.c
new file mode 100644
index 0000000..a342197
--- /dev/null
+++ b/dev/qpnp_wled/qpnp_wled.c
@@ -0,0 +1,537 @@
+ /* Copyright (c) 2014, 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, Inc. 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 <stdio.h>
+#include <err.h>
+#include <qpnp_wled.h>
+
+static int fls(uint16_t n)
+{
+	int i = 0;
+	for (; n; n >>= 1, i++);
+	  return i;
+}
+
+static struct qpnp_wled *gwled;
+
+static int qpnp_wled_sec_access(struct qpnp_wled *wled, uint16_t base_addr)
+{
+	int rc;
+	uint8_t reg = QPNP_WLED_SEC_UNLOCK;
+
+	pm8x41_wled_reg_write(QPNP_WLED_SEC_ACCESS_REG(base_addr), reg);
+
+	return 0;
+}
+
+/* set wled to a level of brightness */
+static int qpnp_wled_set_level(struct qpnp_wled *wled, int level)
+{
+	int i, rc;
+	uint8_t reg;
+
+	/* set brightness registers */
+	for (i = 0; i < wled->num_strings; i++) {
+		reg = level & QPNP_WLED_BRIGHT_LSB_MASK;
+		pm8x41_wled_reg_write(QPNP_WLED_BRIGHT_LSB_REG(wled->sink_base,
+						wled->strings[i]), reg);
+
+		reg = level >> QPNP_WLED_BRIGHT_MSB_SHIFT;
+		reg = reg & QPNP_WLED_BRIGHT_MSB_MASK;
+		pm8x41_wled_reg_write(QPNP_WLED_BRIGHT_MSB_REG(wled->sink_base,
+						wled->strings[i]), reg);
+	}
+
+	/* sync */
+	reg = QPNP_WLED_SYNC;
+	pm8x41_wled_reg_write(QPNP_WLED_SYNC_REG(wled->sink_base), reg);
+
+	reg = QPNP_WLED_SYNC_RESET;
+	pm8x41_wled_reg_write(QPNP_WLED_SYNC_REG(wled->sink_base), reg);
+
+	return 0;
+}
+
+static int qpnp_wled_enable(struct qpnp_wled *wled,
+				uint16_t base_addr, bool state)
+{
+	uint8_t reg;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_MODULE_EN_REG(base_addr));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_MODULE_EN_MASK;
+	reg |= (state << QPNP_WLED_MODULE_EN_SHIFT);
+	pm8x41_wled_reg_write(QPNP_WLED_MODULE_EN_REG(base_addr), reg);
+
+	return 0;
+}
+
+int qpnp_ibb_enable(bool state)
+{
+	int rc = 0;
+	uint8_t reg;
+
+	if (!gwled) {
+		dprintf(CRITICAL, "%s: wled is not initialized yet\n", __func__);
+		return ERROR;
+	}
+
+	/* enable lab */
+	if (gwled->ibb_bias_active) {
+		rc = qpnp_wled_enable(gwled, gwled->lab_base, state);
+		if (rc < 0)
+			return rc;
+			udelay(QPNP_WLED_LAB_START_DLY_US + 1);
+	} else {
+		reg = pm8x41_wled_reg_read(QPNP_WLED_LAB_IBB_RDY_REG(gwled->lab_base));
+		if (reg < 0)
+			return reg;
+
+		reg &= QPNP_WLED_MODULE_EN_MASK;
+		reg |= (state << QPNP_WLED_MODULE_EN_SHIFT);
+		pm8x41_wled_reg_write(QPNP_WLED_LAB_IBB_RDY_REG(gwled->lab_base), reg);
+	}
+
+	rc = qpnp_wled_enable(gwled, gwled->ibb_base, state);
+
+	return rc;
+}
+
+/* enable / disable wled brightness */
+void qpnp_wled_enable_backlight(int enable)
+{
+	int level, rc;
+
+	if (!gwled) {
+		dprintf(CRITICAL, "%s: wled is not initialized yet\n", __func__);
+		return ERROR;
+	}
+
+	if (enable) {
+		rc = qpnp_wled_set_level(gwled, QPNP_WLED_MAX_BR_LEVEL);
+		if (rc) {
+			dprintf(CRITICAL,"wled set level failed\n");
+			return;
+		}
+	}
+	rc = qpnp_wled_enable(gwled, gwled->ctrl_base, enable);
+
+	if (rc) {
+		dprintf(CRITICAL,"wled %sable failed\n",
+					enable ? "en" : "dis");
+		return;
+	}
+
+}
+
+static int qpnp_wled_set_display_type(struct qpnp_wled *wled, uint16_t base_addr)
+{
+	int rc;
+	uint8_t reg = 0;
+
+	/* display type */
+	reg = pm8x41_wled_reg_read(QPNP_WLED_DISP_SEL_REG(base_addr));
+	if (reg < 0)
+		return reg;
+
+	reg &= QPNP_WLED_DISP_SEL_MASK;
+	reg |= (wled->disp_type_amoled << QPNP_WLED_DISP_SEL_SHIFT);
+	pm8x41_wled_reg_write(QPNP_WLED_DISP_SEL_REG(base_addr), reg);
+
+	return 0;
+}
+
+static int qpnp_wled_module_ready(struct qpnp_wled *wled, uint16_t base_addr, bool state)
+{
+	int rc;
+	uint8_t reg;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_MODULE_RDY_REG(base_addr));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_MODULE_RDY_MASK;
+	reg |= (state << QPNP_WLED_MODULE_RDY_SHIFT);
+	pm8x41_wled_reg_write(QPNP_WLED_MODULE_RDY_REG(base_addr), reg);
+
+	return 0;
+}
+
+/* Configure WLED registers */
+static int qpnp_wled_config(struct qpnp_wled *wled)
+{
+	int rc, i, temp;
+	uint8_t reg = 0;
+
+	/* Configure display type */
+	rc = qpnp_wled_set_display_type(wled, wled->ctrl_base);
+	if (rc < 0)
+		return rc;
+
+	/* Configure the FEEDBACK OUTPUT register */
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_FDBK_OP_REG(wled->ctrl_base));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_FDBK_OP_MASK;
+	reg |= wled->fdbk_op;
+	pm8x41_wled_reg_write(QPNP_WLED_FDBK_OP_REG(wled->ctrl_base), reg);
+
+	/* Configure the VREF register */
+	if (wled->vref_mv < QPNP_WLED_VREF_MIN_MV)
+		wled->vref_mv = QPNP_WLED_VREF_MIN_MV;
+	else if (wled->vref_mv > QPNP_WLED_VREF_MAX_MV)
+		wled->vref_mv = QPNP_WLED_VREF_MAX_MV;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_VREF_REG(wled->ctrl_base));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_VREF_MASK;
+	temp = wled->vref_mv - QPNP_WLED_VREF_MIN_MV;
+	reg |= (temp / QPNP_WLED_VREF_STEP_MV);
+	pm8x41_wled_reg_write(QPNP_WLED_VREF_REG(wled->ctrl_base), reg);
+
+	/* Configure the ILIM register */
+	if (wled->ilim_ma < QPNP_WLED_ILIM_MIN_MA)
+		wled->ilim_ma = QPNP_WLED_ILIM_MIN_MA;
+	else if (wled->ilim_ma > QPNP_WLED_ILIM_MAX_MA)
+		wled->ilim_ma = QPNP_WLED_ILIM_MAX_MA;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_ILIM_REG(wled->ctrl_base));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_ILIM_MASK;
+	reg |= (wled->ilim_ma / QPNP_WLED_ILIM_STEP_MA);
+	pm8x41_wled_reg_write(QPNP_WLED_ILIM_REG(wled->ctrl_base), reg);
+
+	/* Configure the MAX BOOST DUTY register */
+	if (wled->boost_duty_ns < QPNP_WLED_BOOST_DUTY_MIN_NS)
+		wled->boost_duty_ns = QPNP_WLED_BOOST_DUTY_MIN_NS;
+	else if (wled->boost_duty_ns > QPNP_WLED_BOOST_DUTY_MAX_NS)
+		wled->boost_duty_ns = QPNP_WLED_BOOST_DUTY_MAX_NS;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_BOOST_DUTY_REG(wled->ctrl_base));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_BOOST_DUTY_MASK;
+	reg |= (wled->boost_duty_ns / QPNP_WLED_BOOST_DUTY_STEP_NS);
+	pm8x41_wled_reg_write(QPNP_WLED_BOOST_DUTY_REG(wled->ctrl_base), reg);
+
+	/* Configure the SWITCHING FREQ register */
+	if (wled->switch_freq_khz == QPNP_WLED_SWITCH_FREQ_1600_KHZ)
+		temp = QPNP_WLED_SWITCH_FREQ_1600_KHZ_CODE;
+	else
+		temp = QPNP_WLED_SWITCH_FREQ_800_KHZ_CODE;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_SWITCH_FREQ_REG(wled->ctrl_base));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_SWITCH_FREQ_MASK;
+	reg |= temp;
+	pm8x41_wled_reg_write(QPNP_WLED_SWITCH_FREQ_REG(wled->ctrl_base), reg);
+
+	/* Configure the OVP register */
+	if (wled->ovp_mv <= QPNP_WLED_OVP_17800_MV) {
+		wled->ovp_mv = QPNP_WLED_OVP_17800_MV;
+		temp = 3;
+	} else if (wled->ovp_mv <= QPNP_WLED_OVP_19400_MV) {
+		wled->ovp_mv = QPNP_WLED_OVP_19400_MV;
+		temp = 2;
+	} else if (wled->ovp_mv <= QPNP_WLED_OVP_29500_MV) {
+		wled->ovp_mv = QPNP_WLED_OVP_29500_MV;
+		temp = 1;
+	} else {
+		wled->ovp_mv = QPNP_WLED_OVP_31000_MV;
+		temp = 0;
+	}
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_OVP_REG(wled->ctrl_base));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_OVP_MASK;
+	reg |= temp;
+	pm8x41_wled_reg_write(QPNP_WLED_OVP_REG(wled->ctrl_base), reg);
+
+	/* Configure the MODULATION register */
+	if (wled->mod_freq_khz <= QPNP_WLED_MOD_FREQ_1200_KHZ) {
+		wled->mod_freq_khz = QPNP_WLED_MOD_FREQ_1200_KHZ;
+		temp = 3;
+	} else if (wled->mod_freq_khz <= QPNP_WLED_MOD_FREQ_2400_KHZ) {
+		wled->mod_freq_khz = QPNP_WLED_MOD_FREQ_2400_KHZ;
+		temp = 2;
+	} else if (wled->mod_freq_khz <= QPNP_WLED_MOD_FREQ_9600_KHZ) {
+		wled->mod_freq_khz = QPNP_WLED_MOD_FREQ_9600_KHZ;
+		temp = 1;
+	} else {
+		wled->mod_freq_khz = QPNP_WLED_MOD_FREQ_19200_KHZ;
+		temp = 0;
+	}
+	reg = pm8x41_wled_reg_read(QPNP_WLED_MOD_REG(wled->sink_base));
+	if (reg < 0)
+		return reg;
+
+	reg &= QPNP_WLED_MOD_FREQ_MASK;
+	reg |= (temp << QPNP_WLED_MOD_FREQ_SHIFT);
+
+	reg &= QPNP_WLED_PHASE_STAG_MASK;
+	reg |= (wled->en_phase_stag << QPNP_WLED_PHASE_STAG_SHIFT);
+
+	reg &= QPNP_WLED_DIM_RES_MASK;
+	reg |= (wled->en_9b_dim_res << QPNP_WLED_DIM_RES_SHIFT);
+
+	if (wled->dim_mode == QPNP_WLED_DIM_HYBRID) {
+		reg &= QPNP_WLED_DIM_HYB_MASK;
+		reg |= (1 << QPNP_WLED_DIM_HYB_SHIFT);
+	} else {
+		reg &= QPNP_WLED_DIM_HYB_MASK;
+		reg |= (0 << QPNP_WLED_DIM_HYB_SHIFT);
+		reg &= QPNP_WLED_DIM_ANA_MASK;
+		reg |= wled->dim_mode;
+	}
+
+	pm8x41_wled_reg_write(QPNP_WLED_MOD_REG(wled->sink_base), reg);
+
+	/* Configure the HYBRID THRESHOLD register */
+	if (wled->hyb_thres < QPNP_WLED_HYB_THRES_MIN)
+		wled->hyb_thres = QPNP_WLED_HYB_THRES_MIN;
+	else if (wled->hyb_thres > QPNP_WLED_HYB_THRES_MAX)
+		wled->hyb_thres = QPNP_WLED_HYB_THRES_MAX;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_HYB_THRES_REG(wled->sink_base));
+	if (reg < 0)
+		return reg;
+
+	reg &= QPNP_WLED_HYB_THRES_MASK;
+	temp = fls(wled->hyb_thres / QPNP_WLED_HYB_THRES_MIN) - 1;
+	reg |= temp;
+	pm8x41_wled_reg_write(QPNP_WLED_HYB_THRES_REG(wled->sink_base), reg);
+
+	for (i = 0; i < wled->num_strings; i++) {
+		if (wled->strings[i] >= QPNP_WLED_MAX_STRINGS) {
+			dprintf(CRITICAL,"Invalid string number\n");
+			return ERR_NOT_VALID;
+		}
+
+		/* MODULATOR */
+		reg = pm8x41_wled_reg_read(
+				QPNP_WLED_MOD_EN_REG(wled->sink_base,
+						wled->strings[i]));
+		if (reg < 0)
+			return reg;
+		reg &= QPNP_WLED_MOD_EN_MASK;
+		reg |= (QPNP_WLED_MOD_EN << QPNP_WLED_MOD_EN_SHFT);
+		pm8x41_wled_reg_write(QPNP_WLED_MOD_EN_REG(wled->sink_base,
+						wled->strings[i]), reg);
+
+		/* SYNC DELAY */
+		if (wled->sync_dly_us < QPNP_WLED_SYNC_DLY_MIN_US)
+			wled->sync_dly_us = QPNP_WLED_SYNC_DLY_MIN_US;
+		else if (wled->sync_dly_us > QPNP_WLED_SYNC_DLY_MAX_US)
+			wled->sync_dly_us = QPNP_WLED_SYNC_DLY_MAX_US;
+
+		reg = pm8x41_wled_reg_read(
+				QPNP_WLED_SYNC_DLY_REG(wled->sink_base,
+						wled->strings[i]));
+		if (reg < 0)
+			return reg;
+		reg &= QPNP_WLED_SYNC_DLY_MASK;
+		temp = wled->sync_dly_us / QPNP_WLED_SYNC_DLY_STEP_US;
+		reg |= temp;
+		pm8x41_wled_reg_write(QPNP_WLED_SYNC_DLY_REG(wled->sink_base,
+						wled->strings[i]), reg);
+
+		/* FULL SCALE CURRENT */
+		if (wled->fs_curr_ua < QPNP_WLED_FS_CURR_MIN_UA)
+			wled->fs_curr_ua = QPNP_WLED_FS_CURR_MIN_UA;
+		else if (wled->fs_curr_ua > QPNP_WLED_FS_CURR_MAX_UA)
+			wled->fs_curr_ua = QPNP_WLED_FS_CURR_MAX_UA;
+
+		reg = pm8x41_wled_reg_read(
+				QPNP_WLED_FS_CURR_REG(wled->sink_base,
+						wled->strings[i]));
+		if (reg < 0)
+			return reg;
+		reg &= QPNP_WLED_FS_CURR_MASK;
+		temp = wled->fs_curr_ua / QPNP_WLED_FS_CURR_STEP_UA;
+		reg |= temp;
+		pm8x41_wled_reg_write(QPNP_WLED_FS_CURR_REG(wled->sink_base,
+						wled->strings[i]), reg);
+
+		/* CABC */
+		reg = pm8x41_wled_reg_read(
+				QPNP_WLED_CABC_REG(wled->sink_base,
+						wled->strings[i]));
+		if (reg < 0)
+			return reg;
+		reg &= QPNP_WLED_CABC_MASK;
+		reg |= (wled->en_cabc << QPNP_WLED_CABC_SHIFT);
+		pm8x41_wled_reg_write(QPNP_WLED_CABC_REG(wled->sink_base,
+						wled->strings[i]), reg);
+
+		/* Enable CURRENT SINK */
+		reg = pm8x41_wled_reg_read(
+				QPNP_WLED_CURR_SINK_REG(wled->sink_base));
+		if (reg < 0)
+			return reg;
+		temp = wled->strings[i] + QPNP_WLED_CURR_SINK_SHIFT;
+		reg |= (1 << temp);
+		pm8x41_wled_reg_write(QPNP_WLED_CURR_SINK_REG(wled->sink_base), reg);
+	}
+
+	/* LAB fast precharge */
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_LAB_FAST_PC_REG(wled->lab_base));
+	if (reg < 0)
+		return reg;
+	reg &= QPNP_WLED_LAB_FAST_PC_MASK;
+	reg |= (wled->lab_fast_precharge << QPNP_WLED_LAB_FAST_PC_SHIFT);
+	pm8x41_wled_reg_write(QPNP_WLED_LAB_FAST_PC_REG(wled->lab_base), reg);
+
+	/* Configure lab display type */
+	rc = qpnp_wled_set_display_type(wled, wled->lab_base);
+	if (rc < 0)
+		return rc;
+
+	/* make LAB module ready */
+	rc = qpnp_wled_module_ready(wled, wled->lab_base, true);
+	if (rc < 0)
+		return rc;
+
+	/* IBB active bias */
+	if (wled->ibb_pwrup_dly_ms < QPNP_WLED_IBB_PWRUP_DLY_MIN_MS)
+		wled->ibb_pwrup_dly_ms = QPNP_WLED_IBB_PWRUP_DLY_MIN_MS;
+	else if (wled->ibb_pwrup_dly_ms > QPNP_WLED_IBB_PWRUP_DLY_MAX_MS)
+		wled->ibb_pwrup_dly_ms = QPNP_WLED_IBB_PWRUP_DLY_MAX_MS;
+
+	reg = pm8x41_wled_reg_read(
+			QPNP_WLED_IBB_BIAS_REG(wled->ibb_base));
+	if (reg < 0)
+		return reg;
+
+	reg &= QPNP_WLED_IBB_BIAS_MASK;
+	reg |= (!wled->ibb_bias_active << QPNP_WLED_IBB_BIAS_SHIFT);
+
+	temp = fls(wled->ibb_pwrup_dly_ms) - 1;
+	reg &= QPNP_WLED_IBB_PWRUP_DLY_MASK;
+	reg |= (temp << QPNP_WLED_IBB_PWRUP_DLY_SHIFT);
+
+	rc = qpnp_wled_sec_access(wled, wled->ibb_base);
+	if (rc)
+		return rc;
+
+	pm8x41_wled_reg_write(QPNP_WLED_IBB_BIAS_REG(wled->ibb_base), reg);
+
+	/* Configure ibb display type */
+	rc = qpnp_wled_set_display_type(wled, wled->ibb_base);
+	if (rc < 0)
+		return rc;
+
+	/* make IBB module ready */
+	rc = qpnp_wled_module_ready(wled, wled->ibb_base, true);
+	if (rc < 0)
+		return rc;
+
+	return 0;
+}
+
+/* Setup wled default parameters */
+static int qpnp_wled_setup(struct qpnp_wled *wled)
+{
+	int rc, i;
+
+	wled->sink_base = QPNP_WLED_SINK_BASE;
+	wled->ctrl_base = QPNP_WLED_CTRL_BASE;
+	wled->ibb_base = QPNP_WLED_IBB_BASE;
+	wled->lab_base = QPNP_WLED_LAB_BASE;
+	wled->fdbk_op = QPNP_WLED_FDBK_AUTO;
+	wled->vref_mv = QPNP_WLED_DFLT_VREF_MV;
+	wled->switch_freq_khz = QPNP_WLED_SWITCH_FREQ_800_KHZ;
+	wled->ovp_mv = QPNP_WLED_OVP_29500_MV;
+	wled->ilim_ma = QPNP_WLED_DFLT_ILIM_MA;
+	wled->boost_duty_ns = QPNP_WLED_BOOST_DUTY_MIN_NS;
+	wled->mod_freq_khz = QPNP_WLED_MOD_FREQ_19200_KHZ;
+	wled->dim_mode = QPNP_WLED_DIM_HYBRID;
+	wled->dim_shape = QPNP_WLED_DIM_SHAPE_LINEAR;
+
+	if (wled->dim_mode == QPNP_WLED_DIM_HYBRID) {
+		wled->hyb_thres = QPNP_WLED_DFLT_HYB_THRES;
+	}
+
+	wled->sync_dly_us = 800;
+	wled->fs_curr_ua = 16000;
+	wled->en_9b_dim_res = 0;
+	wled->en_phase_stag = true;
+	wled->en_cabc = 0;
+
+	wled->num_strings = QPNP_WLED_MAX_STRINGS;
+		for (i = 0; i < wled->num_strings; i++)
+			wled->strings[i] = i;
+
+	wled->ibb_bias_active = false;
+	wled->ibb_pwrup_dly_ms = 8;
+	wled->lab_fast_precharge = false;
+	wled->disp_type_amoled = false;
+
+	return 0;
+}
+
+int qpnp_wled_init()
+{
+	int rc, i;
+	struct qpnp_wled *wled;
+
+	wled = malloc(sizeof(struct qpnp_wled));
+	if (!wled)
+		return ERR_NO_MEMORY;
+
+	memset(wled, 0, sizeof(struct qpnp_wled));
+
+	rc = qpnp_wled_setup(wled);
+	if (rc) {
+		dprintf(CRITICAL, "Setting WLED parameters failed\n");
+		return rc;
+	}
+
+	rc = qpnp_wled_config(wled);
+	if (rc) {
+		dprintf(CRITICAL, "wled config failed\n");
+		return rc;
+	}
+
+	gwled = wled;
+
+	return rc;
+}
diff --git a/dev/qpnp_wled/rules.mk b/dev/qpnp_wled/rules.mk
new file mode 100644
index 0000000..d60c07f
--- /dev/null
+++ b/dev/qpnp_wled/rules.mk
@@ -0,0 +1,6 @@
+LOCAL_DIR := $(GET_LOCAL_DIR)
+
+INCLUDES += -I$(LOCAL_DIR)/include
+
+OBJS += \
+	$(LOCAL_DIR)/qpnp_wled.o