dev : qpnp_wled : Fix configuration of avdd_trim registers
Update the sequence to configure the trim register and the OVP
register based on predetermined values mapped to the target voltage.
Change-Id: Iaf53f2cafca0a4f62eb06e89468b53ca18e5202c
diff --git a/dev/qpnp_wled/qpnp_wled.c b/dev/qpnp_wled/qpnp_wled.c
index 3aa41f8..ad2f5d5 100644
--- a/dev/qpnp_wled/qpnp_wled.c
+++ b/dev/qpnp_wled/qpnp_wled.c
@@ -34,6 +34,18 @@
#include <pm8x41_wled.h>
#include <qtimer.h>
+static int qpnp_wled_avdd_target_voltages[NUM_SUPPORTED_AVDD_VOLTAGES] = {
+ 7900, 7600, 7300, 6400, 6100, 5800,
+};
+
+static uint8_t qpnp_wled_ovp_reg_settings[NUM_SUPPORTED_AVDD_VOLTAGES] = {
+ 0x0, 0x0, 0x1, 0x2, 0x2, 0x3,
+};
+
+static int qpnp_wled_avdd_trim_adjustments[NUM_SUPPORTED_AVDD_VOLTAGES] = {
+ 3, 0, -2, 7, 3, 3,
+};
+
static int fls(uint16_t n)
{
int i = 0;
@@ -311,6 +323,44 @@
reg |= temp;
pm8x41_wled_reg_write(QPNP_WLED_OVP_REG(wled->ctrl_base), reg);
+ if (wled->disp_type_amoled) {
+ for (i = 0; i < NUM_SUPPORTED_AVDD_VOLTAGES; i++) {
+ if (QPNP_WLED_AVDD_DEFAULT_VOLTAGE_MV == qpnp_wled_avdd_target_voltages[i])
+ break;
+ }
+ if (i == NUM_SUPPORTED_AVDD_VOLTAGES)
+ {
+ dprintf(CRITICAL, "Invalid avdd target voltage specified \n");
+ return ERR_NOT_VALID;
+ }
+ /* Update WLED_OVP register based on desired target voltage */
+ reg = qpnp_wled_ovp_reg_settings[i];
+ pm8x41_wled_reg_write(QPNP_WLED_OVP_REG(wled->ctrl_base), reg);
+ /* Update WLED_TRIM register based on desired target voltage */
+ reg = pm8x41_wled_reg_read(
+ QPNP_WLED_REF_7P7_TRIM_REG(wled->ctrl_base));
+ reg += qpnp_wled_avdd_trim_adjustments[i];
+ if ((int8_t)reg < QPNP_WLED_AVDD_MIN_TRIM_VALUE)
+ reg = QPNP_WLED_AVDD_MIN_TRIM_VALUE;
+ else if((int8_t)reg > QPNP_WLED_AVDD_MAX_TRIM_VALUE)
+ reg = QPNP_WLED_AVDD_MAX_TRIM_VALUE;
+
+ rc = qpnp_wled_sec_access(wled, wled->ctrl_base);
+ if (rc)
+ return rc;
+
+ temp = pm8x41_wled_reg_read(
+ QPNP_WLED_REF_7P7_TRIM_REG(wled->ctrl_base));
+ temp &= ~QPNP_WLED_7P7_TRIM_MASK;
+ temp |= (reg & QPNP_WLED_7P7_TRIM_MASK);
+ pm8x41_wled_reg_write(QPNP_WLED_REF_7P7_TRIM_REG(wled->ctrl_base), temp);
+ /* Write to spare to avoid reconfiguration in HLOS */
+ reg = pm8x41_wled_reg_read(
+ QPNP_WLED_CTRL_SPARE_REG(wled->ctrl_base));
+ reg |= QPNP_WLED_AVDD_SET_BIT;
+ pm8x41_wled_reg_write(QPNP_WLED_CTRL_SPARE_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;