asgardius/android_kernel_samsung_heroqlte
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity Actions
android_kernel_samsung_hero.../drivers/pwm/pwm-qpnp.c
HackerOO7 2bd1731e0a init: OSRC G9300ZCU2APF7
2016-08-17 16:41:52 +08:00

2126 lines
56 KiB
C
Raw Permalink Blame History

/* Copyright (c) 2012-2015, The Linux Foundation. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License version 2 and
* only version 2 as published by the Free Software Foundation.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*/
/*
* Qualcomm QPNP Pulse Width Modulation (PWM) driver
*
* The HW module is also called LPG (Light Pattern Generator).
*/
#define pr_fmt(fmt) "%s: " fmt, __func__
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/err.h>
#include <linux/spmi.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/radix-tree.h>
#include <linux/qpnp/pwm.h>
#define QPNP_LPG_DRIVER_NAME "qcom,qpnp-pwm"
#define QPNP_LPG_CHANNEL_BASE "qpnp-lpg-channel-base"
#define QPNP_LPG_LUT_BASE "qpnp-lpg-lut-base"
#define QPNP_PWM_MODE_ONLY_SUB_TYPE 0x0B
#define QPNP_LPG_CHAN_SUB_TYPE 0x2
#define QPNP_LPG_S_CHAN_SUB_TYPE 0x11
/* LPG Control for LPG_PATTERN_CONFIG */
#define QPNP_RAMP_DIRECTION_SHIFT 4
#define QPNP_RAMP_DIRECTION_MASK 0x10
#define QPNP_PATTERN_REPEAT_SHIFT 3
#define QPNP_PATTERN_REPEAT_MASK 0x08
#define QPNP_RAMP_TOGGLE_SHIFT 2
#define QPNP_RAMP_TOGGLE_MASK 0x04
#define QPNP_EN_PAUSE_HI_SHIFT 1
#define QPNP_EN_PAUSE_HI_MASK 0x02
#define QPNP_EN_PAUSE_LO_MASK 0x01
/* LPG Control for LPG_PWM_SIZE_CLK */
#define QPNP_PWM_SIZE_SHIFT_SUB_TYPE 2
#define QPNP_PWM_SIZE_MASK_SUB_TYPE 0x4
#define QPNP_PWM_FREQ_CLK_SELECT_MASK_SUB_TYPE 0x03
#define QPNP_PWM_SIZE_9_BIT_SUB_TYPE 0x01
#define QPNP_SET_PWM_CLK_SUB_TYPE(val, clk, pwm_size) \
do { \
val = (clk + 1) & QPNP_PWM_FREQ_CLK_SELECT_MASK_SUB_TYPE; \
val |= (((pwm_size > 6 ? QPNP_PWM_SIZE_9_BIT_SUB_TYPE : 0) << \
QPNP_PWM_SIZE_SHIFT_SUB_TYPE) & QPNP_PWM_SIZE_MASK_SUB_TYPE); \
} while (0)
#define QPNP_GET_PWM_SIZE_SUB_TYPE(reg) ((reg & QPNP_PWM_SIZE_MASK_SUB_TYPE) \
>> QPNP_PWM_SIZE_SHIFT_SUB_TYPE)
#define QPNP_PWM_SIZE_SHIFT 4
#define QPNP_PWM_SIZE_MASK 0x30
#define QPNP_PWM_FREQ_CLK_SELECT_MASK 0x03
#define QPNP_MIN_PWM_BIT_SIZE 6
#define QPNP_MAX_PWM_BIT_SIZE 9
#define QPNP_PWM_SIZES_SUPPORTED 10
#define QPNP_SET_PWM_CLK(val, clk, pwm_size) \
do { \
val = (clk + 1) & QPNP_PWM_FREQ_CLK_SELECT_MASK; \
val |= (((pwm_size - QPNP_MIN_PWM_BIT_SIZE) << \
QPNP_PWM_SIZE_SHIFT) & QPNP_PWM_SIZE_MASK); \
} while (0)
#define QPNP_GET_PWM_SIZE(reg) ((reg & QPNP_PWM_SIZE_MASK) \
>> QPNP_PWM_SIZE_SHIFT)
/* LPG Control for LPG_PWM_FREQ_PREDIV_CLK */
#define QPNP_PWM_FREQ_PRE_DIVIDE_SHIFT 5
#define QPNP_PWM_FREQ_PRE_DIVIDE_MASK 0x60
#define QPNP_PWM_FREQ_EXP_MASK 0x07
#define QPNP_SET_PWM_FREQ_PREDIV(val, pre_div, pre_div_exp) \
do { \
val = (pre_div << QPNP_PWM_FREQ_PRE_DIVIDE_SHIFT) & \
QPNP_PWM_FREQ_PRE_DIVIDE_MASK; \
val |= (pre_div_exp & QPNP_PWM_FREQ_EXP_MASK); \
} while (0)
/* LPG Control for LPG_PWM_TYPE_CONFIG */
#define QPNP_EN_GLITCH_REMOVAL_SHIFT 5
#define QPNP_EN_GLITCH_REMOVAL_MASK 0x20
#define QPNP_EN_FULL_SCALE_SHIFT 3
#define QPNP_EN_FULL_SCALE_MASK 0x08
#define QPNP_EN_PHASE_STAGGER_SHIFT 2
#define QPNP_EN_PHASE_STAGGER_MASK 0x04
#define QPNP_PHASE_STAGGER_MASK 0x03
/* LPG Control for PWM_VALUE_LSB */
#define QPNP_PWM_VALUE_LSB_MASK 0xFF
/* LPG Control for PWM_VALUE_MSB */
#define QPNP_PWM_VALUE_MSB_SHIFT 8
#define QPNP_PWM_VALUE_MSB_MASK 0x01
/* LPG Control for ENABLE_CONTROL */
#define QPNP_EN_PWM_HIGH_SHIFT 7
#define QPNP_EN_PWM_HIGH_MASK 0x80
#define QPNP_EN_PWM_LO_SHIFT 6
#define QPNP_EN_PWM_LO_MASK 0x40
#define QPNP_EN_PWM_OUTPUT_SHIFT 5
#define QPNP_EN_PWM_OUTPUT_MASK 0x20
#define QPNP_PWM_SRC_SELECT_SHIFT 2
#define QPNP_PWM_SRC_SELECT_MASK 0x04
#define QPNP_PWM_EN_RAMP_GEN_SHIFT 1
#define QPNP_PWM_EN_RAMP_GEN_MASK 0x02
/* LPG Control for PWM_SYNC */
#define QPNP_PWM_SYNC_VALUE 0x01
#define QPNP_PWM_SYNC_MASK 0x01
/* LPG Control for RAMP_CONTROL */
#define QPNP_RAMP_START_MASK 0x01
#define QPNP_ENABLE_LUT_V0(value) (value |= QPNP_RAMP_START_MASK)
#define QPNP_DISABLE_LUT_V0(value) (value &= ~QPNP_RAMP_START_MASK)
#define QPNP_ENABLE_LUT_V1(value, id) (value |= BIT(id))
/* LPG Control for RAMP_STEP_DURATION_LSB */
#define QPNP_RAMP_STEP_DURATION_LSB_MASK 0xFF
/* LPG Control for RAMP_STEP_DURATION_MSB */
#define QPNP_RAMP_STEP_DURATION_MSB_SHIFT 8
#define QPNP_RAMP_STEP_DURATION_MSB_MASK 0x01
#define QPNP_PWM_1KHZ 1024
#define QPNP_GET_RAMP_STEP_DURATION(ramp_time_ms) \
((ramp_time_ms * QPNP_PWM_1KHZ) / 1000)
/* LPG Control for PAUSE_HI_MULTIPLIER_LSB */
#define QPNP_PAUSE_HI_MULTIPLIER_LSB_MASK 0xFF
/* LPG Control for PAUSE_HI_MULTIPLIER_MSB */
#define QPNP_PAUSE_HI_MULTIPLIER_MSB_SHIFT 8
#define QPNP_PAUSE_HI_MULTIPLIER_MSB_MASK 0x1F
/* LPG Control for PAUSE_LO_MULTIPLIER_LSB */
#define QPNP_PAUSE_LO_MULTIPLIER_LSB_MASK 0xFF
/* LPG Control for PAUSE_LO_MULTIPLIER_MSB */
#define QPNP_PAUSE_LO_MULTIPLIER_MSB_SHIFT 8
#define QPNP_PAUSE_LO_MULTIPLIER_MSB_MASK 0x1F
/* LPG Control for HI_INDEX */
#define QPNP_HI_INDEX_MASK 0x3F
/* LPG Control for LO_INDEX */
#define QPNP_LO_INDEX_MASK 0x3F
/* LPG DTEST */
#define QPNP_LPG_DTEST_LINE_MAX 4
#define QPNP_LPG_DTEST_OUTPUT_MAX 5
#define QPNP_DTEST_OUTPUT_MASK 0x07
#define NUM_CLOCKS 3
#define QPNP_PWM_M_MAX 7
#define NSEC_1024HZ (NSEC_PER_SEC / 1024)
#define NSEC_32768HZ (NSEC_PER_SEC / 32768)
#define NSEC_19P2MHZ (NSEC_PER_SEC / 19200000)
#define NUM_LPG_PRE_DIVIDE 4
#define PRE_DIVIDE_1 1
#define PRE_DIVIDE_3 3
#define PRE_DIVIDE_5 5
#define PRE_DIVIDE_6 6
#define SPMI_LPG_REG_BASE_OFFSET 0x40
#define SPMI_LPG_REVISION2_OFFSET 0x1
#define SPMI_LPG_REV1_RAMP_CONTROL_OFFSET 0x86
#define SPMI_LPG_SUB_TYPE_OFFSET 0x5
#define SPMI_LPG_PWM_SYNC 0x7
#define SPMI_LPG_REG_ADDR(b, n) (b + SPMI_LPG_REG_BASE_OFFSET + (n))
#define SPMI_MAX_BUF_LEN 8
#define QPNP_PWM_LUT_NOT_SUPPORTED 0x1
/* Supported PWM sizes */
#define QPNP_PWM_SIZE_6_BIT 6
#define QPNP_PWM_SIZE_7_BIT 7
#define QPNP_PWM_SIZE_8_BIT 8
#define QPNP_PWM_SIZE_9_BIT 9
#define QPNP_PWM_SIZE_6_9_BIT 0x9
#define QPNP_PWM_SIZE_7_8_BIT 0x6
#define QPNP_PWM_SIZE_6_7_9_BIT 0xB
/* Supported time levels */
enum time_level {
LVL_NSEC,
LVL_USEC,
};
/* LPG revisions */
enum qpnp_lpg_revision {
QPNP_LPG_REVISION_0 = 0x0,
QPNP_LPG_REVISION_1 = 0x1,
};
/* LPG LUT MODE STATE */
enum qpnp_lut_state {
QPNP_LUT_ENABLE = 0x0,
QPNP_LUT_DISABLE = 0x1,
};
/* PWM MODE STATE */
enum qpnp_pwm_state {
QPNP_PWM_ENABLE = 0x0,
QPNP_PWM_DISABLE = 0x1,
};
/* SPMI LPG registers */
enum qpnp_lpg_registers_list {
QPNP_LPG_PATTERN_CONFIG,
QPNP_LPG_PWM_SIZE_CLK,
QPNP_LPG_PWM_FREQ_PREDIV_CLK,
QPNP_LPG_PWM_TYPE_CONFIG,
QPNP_PWM_VALUE_LSB,
QPNP_PWM_VALUE_MSB,
QPNP_ENABLE_CONTROL,
QPNP_RAMP_CONTROL,
QPNP_RAMP_STEP_DURATION_LSB = QPNP_RAMP_CONTROL + 9,
QPNP_RAMP_STEP_DURATION_MSB,
QPNP_PAUSE_HI_MULTIPLIER_LSB,
QPNP_PAUSE_HI_MULTIPLIER_MSB,
QPNP_PAUSE_LO_MULTIPLIER_LSB,
QPNP_PAUSE_LO_MULTIPLIER_MSB,
QPNP_HI_INDEX,
QPNP_LO_INDEX,
QPNP_LPG_SEC_ACCESS = QPNP_LO_INDEX + 121,
QPNP_LPG_DTEST = QPNP_LO_INDEX + 139,
QPNP_TOTAL_LPG_SPMI_REGISTERS
};
/*
* Formula from HSID,
* pause_time (hi/lo) = (pause_cnt- 1)*(ramp_ms)
* OR,
* pause_cnt = (pause_time / ramp_ms) + 1
*/
#define QPNP_SET_PAUSE_CNT(to_pause_cnt, from_pause, ramp_ms) \
(to_pause_cnt = (from_pause / (ramp_ms ? ramp_ms : 1)) + 1)
static unsigned int pt_t[NUM_LPG_PRE_DIVIDE][NUM_CLOCKS] = {
{ PRE_DIVIDE_1 * NSEC_1024HZ,
PRE_DIVIDE_1 * NSEC_32768HZ,
PRE_DIVIDE_1 * NSEC_19P2MHZ,
},
{ PRE_DIVIDE_3 * NSEC_1024HZ,
PRE_DIVIDE_3 * NSEC_32768HZ,
PRE_DIVIDE_3 * NSEC_19P2MHZ,
},
{ PRE_DIVIDE_5 * NSEC_1024HZ,
PRE_DIVIDE_5 * NSEC_32768HZ,
PRE_DIVIDE_5 * NSEC_19P2MHZ,
},
{ PRE_DIVIDE_6 * NSEC_1024HZ,
PRE_DIVIDE_6 * NSEC_32768HZ,
PRE_DIVIDE_6 * NSEC_19P2MHZ,
},
};
struct qpnp_lut_config {
u8 *duty_pct_list;
int list_len;
int ramp_index;
int lo_index;
int hi_index;
int lut_pause_hi_cnt;
int lut_pause_lo_cnt;
int ramp_step_ms;
bool ramp_direction;
bool pattern_repeat;
bool ramp_toggle;
bool enable_pause_hi;
bool enable_pause_lo;
};
struct qpnp_lpg_config {
struct qpnp_lut_config lut_config;
u16 base_addr;
u16 lut_base_addr;
u16 lut_size;
};
struct _qpnp_pwm_config {
int pwm_value;
int pwm_period; /* in microseconds */
int pwm_duty; /* in microseconds */
struct pwm_period_config period;
int supported_sizes;
int force_pwm_size;
};
/* Public facing structure */
struct qpnp_pwm_chip {
struct spmi_device *spmi_dev;
struct pwm_chip chip;
bool enabled;
struct _qpnp_pwm_config pwm_config;
struct qpnp_lpg_config lpg_config;
spinlock_t lpg_lock;
enum qpnp_lpg_revision revision;
u8 sub_type;
u32 flags;
u8 qpnp_lpg_registers[QPNP_TOTAL_LPG_SPMI_REGISTERS];
int channel_id;
const char *channel_owner;
u32 dtest_line;
u32 dtest_output;
bool in_test_mode;
};
/* Internal functions */
static inline struct qpnp_pwm_chip *qpnp_pwm_from_pwm_dev(
struct pwm_device *pwm)
{
return container_of(pwm->chip, struct qpnp_pwm_chip, chip);
}
static inline struct qpnp_pwm_chip *qpnp_pwm_from_pwm_chip(
struct pwm_chip *chip)
{
return container_of(chip, struct qpnp_pwm_chip, chip);
}
static inline void qpnp_set_pattern_config(u8 *val,
struct qpnp_lut_config *lut_config)
{
*val = lut_config->enable_pause_lo & QPNP_EN_PAUSE_LO_MASK;
*val |= (lut_config->enable_pause_hi << QPNP_EN_PAUSE_HI_SHIFT) &
QPNP_EN_PAUSE_HI_MASK;
*val |= (lut_config->ramp_toggle << QPNP_RAMP_TOGGLE_SHIFT) &
QPNP_RAMP_TOGGLE_MASK;
*val |= (lut_config->pattern_repeat << QPNP_PATTERN_REPEAT_SHIFT) &
QPNP_PATTERN_REPEAT_MASK;
*val |= (lut_config->ramp_direction << QPNP_RAMP_DIRECTION_SHIFT) &
QPNP_RAMP_DIRECTION_MASK;
}
static inline void qpnp_set_pwm_type_config(u8 *val, bool glitch,
bool full_scale, bool en_phase, bool phase)
{
*val = phase;
*val |= (en_phase << QPNP_EN_PHASE_STAGGER_SHIFT) &
QPNP_EN_PHASE_STAGGER_MASK;
*val |= (full_scale << QPNP_EN_FULL_SCALE_SHIFT) &
QPNP_EN_FULL_SCALE_MASK;
*val |= (glitch << QPNP_EN_GLITCH_REMOVAL_SHIFT) &
QPNP_EN_GLITCH_REMOVAL_MASK;
}
static int qpnp_set_control(struct qpnp_pwm_chip *chip, bool pwm_hi,
bool pwm_lo, bool pwm_out, bool pwm_src, bool ramp_gen)
{
int value;
value = (ramp_gen << QPNP_PWM_EN_RAMP_GEN_SHIFT) |
(pwm_src << QPNP_PWM_SRC_SELECT_SHIFT) |
(pwm_lo << QPNP_EN_PWM_LO_SHIFT) |
(pwm_hi << QPNP_EN_PWM_HIGH_SHIFT);
if (chip->sub_type != QPNP_LPG_S_CHAN_SUB_TYPE)
value |= (pwm_out << QPNP_EN_PWM_OUTPUT_SHIFT);
return value;
}
#define QPNP_ENABLE_LUT_CONTROL(chip) \
qpnp_set_control((chip), 0, 0, 0, 0, 1)
#define QPNP_ENABLE_PWM_CONTROL(chip) \
qpnp_set_control((chip), 0, 0, 0, 1, 0)
#define QPNP_ENABLE_PWM_MODE(chip) \
qpnp_set_control((chip), 1, 1, 1, 1, 0)
#define QPNP_ENABLE_PWM_MODE_GPLED_CHANNEL(chip) \
qpnp_set_control((chip), 1, 1, 1, 1, 1)
#define QPNP_ENABLE_LPG_MODE(chip) \
qpnp_set_control((chip), 1, 1, 1, 0, 1)
#define QPNP_DISABLE_PWM_MODE(chip) \
qpnp_set_control((chip), 0, 0, 0, 1, 0)
#define QPNP_DISABLE_LPG_MODE(chip) \
qpnp_set_control((chip), 0, 0, 0, 0, 1)
#define QPNP_IS_PWM_CONFIG_SELECTED(val) (val & QPNP_PWM_SRC_SELECT_MASK)
#define QPNP_ENABLE_PWM_MODE_ONLY_SUB_TYPE 0x80
#define QPNP_DISABLE_PWM_MODE_ONLY_SUB_TYPE 0x0
#define QPNP_PWM_MODE_ONLY_ENABLE_DISABLE_MASK_SUB_TYPE 0x80
static inline void qpnp_convert_to_lut_flags(int *flags,
struct qpnp_lut_config *l_config)
{
*flags = ((l_config->ramp_direction ? PM_PWM_LUT_RAMP_UP : 0) |
(l_config->pattern_repeat ? PM_PWM_LUT_LOOP : 0)|
(l_config->ramp_toggle ? PM_PWM_LUT_REVERSE : 0) |
(l_config->enable_pause_hi ? PM_PWM_LUT_PAUSE_HI_EN : 0) |
(l_config->enable_pause_lo ? PM_PWM_LUT_PAUSE_LO_EN : 0));
}
static inline void qpnp_set_lut_params(struct lut_params *l_params,
struct qpnp_lut_config *l_config, int s_idx, int size)
{
l_params->start_idx = s_idx;
l_params->idx_len = size;
l_params->lut_pause_hi = l_config->lut_pause_hi_cnt;
l_params->lut_pause_lo = l_config->lut_pause_lo_cnt;
l_params->ramp_step_ms = l_config->ramp_step_ms;
qpnp_convert_to_lut_flags(&l_params->flags, l_config);
}
static void qpnp_lpg_save(u8 *u8p, u8 mask, u8 val)
{
*u8p &= ~mask;
*u8p |= val & mask;
}
static int qpnp_lpg_save_and_write(u8 value, u8 mask, u8 *reg, u16 addr,
u16 size, struct qpnp_pwm_chip *chip)
{
qpnp_lpg_save(reg, mask, value);
return spmi_ext_register_writel(chip->spmi_dev->ctrl,
chip->spmi_dev->sid, addr, reg, size);
}
/*
* PWM Frequency = Clock Frequency / (N * T)
* or
* PWM Period = Clock Period * (N * T)
* where
* N = 2^9 or 2^6 for 9-bit or 6-bit PWM size
* T = Pre-divide * 2^m, where m = 0..7 (exponent)
*
* This is the formula to figure out m for the best pre-divide and clock:
* (PWM Period / N) = (Pre-divide * Clock Period) * 2^m
*/
static void qpnp_lpg_calc_period(enum time_level tm_lvl,
unsigned int period_value,
struct qpnp_pwm_chip *chip)
{
int n, m, clk, div;
int best_m, best_div, best_clk;
unsigned int last_err, cur_err, min_err;
unsigned int tmp_p, period_n;
int supported_sizes = chip->pwm_config.supported_sizes;
int force_pwm_size = chip->pwm_config.force_pwm_size;
struct pwm_period_config *period = &chip->pwm_config.period;
/* PWM Period / N */
if (supported_sizes == QPNP_PWM_SIZE_7_8_BIT)
n = 7;
else
n = 6;
if (tm_lvl == LVL_USEC) {
if (period_value < ((unsigned)(-1) / NSEC_PER_USEC)) {
period_n = (period_value * NSEC_PER_USEC) >> n;
} else {
if (supported_sizes == QPNP_PWM_SIZE_7_8_BIT)
n = 8;
else
n = 9;
period_n = (period_value >> n) * NSEC_PER_USEC;
}
} else {
period_n = period_value >> n;
}
if (force_pwm_size != 0) {
if (n < force_pwm_size)
period_n = period_n >> (force_pwm_size - n);
else
period_n = period_n << (n - force_pwm_size);
n = force_pwm_size;
pr_info("LPG channel '%d' pwm size is forced to=%d\n",
chip->channel_id, n);
}
min_err = last_err = (unsigned)(-1);
best_m = 0;
best_clk = 0;
best_div = 0;
for (clk = 0; clk < NUM_CLOCKS; clk++) {
for (div = 0; div < NUM_LPG_PRE_DIVIDE; div++) {
/* period_n = (PWM Period / N) */
/* tmp_p = (Pre-divide * Clock Period) * 2^m */
tmp_p = pt_t[div][clk];
for (m = 0; m <= QPNP_PWM_M_MAX; m++) {
if (period_n > tmp_p)
cur_err = period_n - tmp_p;
else
cur_err = tmp_p - period_n;
if (cur_err < min_err) {
min_err = cur_err;
best_m = m;
best_clk = clk;
best_div = div;
}
if (m && cur_err > last_err)
/* Break for bigger cur_err */
break;
last_err = cur_err;
tmp_p <<= 1;
}
}
}
/* Adapt to optimal pwm size, the higher the resolution the better */
if (!force_pwm_size) {
if (supported_sizes == QPNP_PWM_SIZE_7_8_BIT) {
if (n == 7 && best_m >= 1) {
n += 1;
best_m -= 1;
}
} else if (n == 6) {
if (best_m >= 3) {
n += 3;
best_m -= 3;
} else if (best_m >= 1 && (
chip->sub_type != QPNP_PWM_MODE_ONLY_SUB_TYPE &&
chip->sub_type != QPNP_LPG_S_CHAN_SUB_TYPE)) {
n += 1;
best_m -= 1;
}
}
}
period->pwm_size = n;
period->clk = best_clk;
period->pre_div = best_div;
period->pre_div_exp = best_m;
}
static void qpnp_lpg_calc_pwm_value(struct _qpnp_pwm_config *pwm_config,
unsigned int period_value,
unsigned int duty_value)
{
unsigned int max_pwm_value, tmp;
/* Figure out pwm_value with overflow handling */
tmp = 1 << (sizeof(tmp) * 8 - pwm_config->period.pwm_size);
if (duty_value < tmp) {
tmp = duty_value << pwm_config->period.pwm_size;
pwm_config->pwm_value = tmp / period_value;
} else {
tmp = period_value >> pwm_config->period.pwm_size;
pwm_config->pwm_value = duty_value / tmp;
}
max_pwm_value = (1 << pwm_config->period.pwm_size) - 1;
if (pwm_config->pwm_value > max_pwm_value)
pwm_config->pwm_value = max_pwm_value;
}
static int qpnp_lpg_change_table(struct qpnp_pwm_chip *chip,
int duty_pct[], int raw_value)
{
unsigned int pwm_value, max_pwm_value;
struct qpnp_lut_config *lut = &chip->lpg_config.lut_config;
int i, pwm_size, rc = 0;
int burst_size = SPMI_MAX_BUF_LEN;
int list_len = lut->list_len << 1;
int offset = (lut->lo_index << 1) - 2;
pwm_size = QPNP_GET_PWM_SIZE(
chip->qpnp_lpg_registers[QPNP_LPG_PWM_SIZE_CLK]) +
QPNP_MIN_PWM_BIT_SIZE;
max_pwm_value = (1 << pwm_size) - 1;
if (unlikely(lut->list_len != (lut->hi_index - lut->lo_index + 1))) {
pr_err("LUT internal Data structure corruption detected\n");
pr_err("LUT list size: %d\n", lut->list_len);
pr_err("However, index size is: %d\n",
(lut->hi_index - lut->lo_index + 1));
return -EINVAL;
}
for (i = 0; i < lut->list_len; i++) {
if (raw_value)
pwm_value = duty_pct[i];
else
pwm_value = (duty_pct[i] << pwm_size) / 100;
if (pwm_value > max_pwm_value)
pwm_value = max_pwm_value;
if (chip->pwm_config.supported_sizes == QPNP_PWM_SIZE_7_8_BIT) {
lut->duty_pct_list[i] = pwm_value;
} else {
lut->duty_pct_list[i*2] = pwm_value;
lut->duty_pct_list[(i*2)+1] = (pwm_value >>
QPNP_PWM_VALUE_MSB_SHIFT) & QPNP_PWM_VALUE_MSB_MASK;
}
}
/*
* For the Keypad Backlight Lookup Table (KPDBL_LUT),
* offset is lo_index.
*/
if (chip->pwm_config.supported_sizes == QPNP_PWM_SIZE_7_8_BIT)
offset = lut->lo_index;
/* Write with max allowable burst mode, each entry is of two bytes */
for (i = 0; i < list_len; i += burst_size) {
if (i + burst_size >= list_len)
burst_size = list_len - i;
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl,
chip->spmi_dev->sid,
chip->lpg_config.lut_base_addr + offset + i,
lut->duty_pct_list + i, burst_size);
}
return rc;
}
static void qpnp_lpg_save_period(struct qpnp_pwm_chip *chip)
{
u8 mask, val;
struct _qpnp_pwm_config *pwm_config = &chip->pwm_config;
if (chip->sub_type == QPNP_PWM_MODE_ONLY_SUB_TYPE) {
QPNP_SET_PWM_CLK_SUB_TYPE(val, pwm_config->period.clk,
pwm_config->period.pwm_size);
mask = QPNP_PWM_SIZE_MASK_SUB_TYPE |
QPNP_PWM_FREQ_CLK_SELECT_MASK_SUB_TYPE;
} else {
QPNP_SET_PWM_CLK(val, pwm_config->period.clk,
pwm_config->period.pwm_size);
mask = QPNP_PWM_SIZE_MASK | QPNP_PWM_FREQ_CLK_SELECT_MASK;
}
qpnp_lpg_save(&chip->qpnp_lpg_registers[QPNP_LPG_PWM_SIZE_CLK],
mask, val);
QPNP_SET_PWM_FREQ_PREDIV(val, pwm_config->period.pre_div,
pwm_config->period.pre_div_exp);
mask = QPNP_PWM_FREQ_PRE_DIVIDE_MASK | QPNP_PWM_FREQ_EXP_MASK;
qpnp_lpg_save(&chip->qpnp_lpg_registers[QPNP_LPG_PWM_FREQ_PREDIV_CLK],
mask, val);
}
static int qpnp_lpg_save_pwm_value(struct qpnp_pwm_chip *chip)
{
unsigned int max_pwm_value;
int pwm_size;
u8 mask, value;
struct _qpnp_pwm_config *pwm_config = &chip->pwm_config;
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
int rc;
if (chip->sub_type == QPNP_PWM_MODE_ONLY_SUB_TYPE)
pwm_size = QPNP_GET_PWM_SIZE_SUB_TYPE(
chip->qpnp_lpg_registers[QPNP_LPG_PWM_SIZE_CLK]) ?
QPNP_MAX_PWM_BIT_SIZE : QPNP_MIN_PWM_BIT_SIZE;
else
pwm_size = QPNP_GET_PWM_SIZE(
chip->qpnp_lpg_registers[QPNP_LPG_PWM_SIZE_CLK]) +
QPNP_MIN_PWM_BIT_SIZE;
max_pwm_value = (1 << pwm_size) - 1;
if (pwm_config->pwm_value > max_pwm_value)
pwm_config->pwm_value = max_pwm_value;
value = pwm_config->pwm_value;
mask = QPNP_PWM_VALUE_LSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PWM_VALUE_LSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PWM_VALUE_LSB), 1, chip);
if (rc)
return rc;
value = (pwm_config->pwm_value >> QPNP_PWM_VALUE_MSB_SHIFT) &
QPNP_PWM_VALUE_MSB_MASK;
mask = QPNP_PWM_VALUE_MSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PWM_VALUE_MSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PWM_VALUE_MSB), 1, chip);
if (rc)
return rc;
if (chip->sub_type == QPNP_PWM_MODE_ONLY_SUB_TYPE ||
chip->sub_type == QPNP_LPG_S_CHAN_SUB_TYPE) {
value = QPNP_PWM_SYNC_VALUE & QPNP_PWM_SYNC_MASK;
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl,
chip->spmi_dev->sid,
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
SPMI_LPG_PWM_SYNC), &value, 1);
}
return rc;
}
static int qpnp_lpg_configure_pattern(struct qpnp_pwm_chip *chip)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
struct qpnp_lut_config *lut_config = &lpg_config->lut_config;
u8 value, mask;
qpnp_set_pattern_config(&value, lut_config);
mask = QPNP_RAMP_DIRECTION_MASK | QPNP_PATTERN_REPEAT_MASK |
QPNP_RAMP_TOGGLE_MASK | QPNP_EN_PAUSE_HI_MASK |
QPNP_EN_PAUSE_LO_MASK;
return qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_LPG_PATTERN_CONFIG],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_LPG_PATTERN_CONFIG), 1, chip);
}
static int qpnp_lpg_configure_pwm(struct qpnp_pwm_chip *chip)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
int rc;
u8 value, mask;
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl, chip->spmi_dev->sid,
SPMI_LPG_REG_ADDR(lpg_config->base_addr, QPNP_LPG_PWM_SIZE_CLK),
&chip->qpnp_lpg_registers[QPNP_LPG_PWM_SIZE_CLK], 1);
if (rc)
return rc;
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl, chip->spmi_dev->sid,
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_LPG_PWM_FREQ_PREDIV_CLK),
&chip->qpnp_lpg_registers[QPNP_LPG_PWM_FREQ_PREDIV_CLK], 1);
if (rc)
return rc;
qpnp_set_pwm_type_config(&value, 1, 0, 0, 0);
mask = QPNP_EN_GLITCH_REMOVAL_MASK | QPNP_EN_FULL_SCALE_MASK |
QPNP_EN_PHASE_STAGGER_MASK | QPNP_PHASE_STAGGER_MASK;
return qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_LPG_PWM_TYPE_CONFIG],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_LPG_PWM_TYPE_CONFIG), 1, chip);
}
static int qpnp_configure_pwm_control(struct qpnp_pwm_chip *chip)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
u8 value, mask;
if (chip->sub_type == QPNP_PWM_MODE_ONLY_SUB_TYPE)
return 0;
value = QPNP_ENABLE_PWM_CONTROL(chip);
mask = QPNP_EN_PWM_HIGH_MASK | QPNP_EN_PWM_LO_MASK |
QPNP_PWM_SRC_SELECT_MASK | QPNP_PWM_EN_RAMP_GEN_MASK;
if (chip->sub_type != QPNP_LPG_S_CHAN_SUB_TYPE)
mask |= QPNP_EN_PWM_OUTPUT_MASK;
return qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_ENABLE_CONTROL],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_ENABLE_CONTROL), 1, chip);
}
static int qpnp_configure_lpg_control(struct qpnp_pwm_chip *chip)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
u8 value, mask;
value = QPNP_ENABLE_LUT_CONTROL(chip);
mask = QPNP_EN_PWM_HIGH_MASK | QPNP_EN_PWM_LO_MASK |
QPNP_PWM_SRC_SELECT_MASK | QPNP_PWM_EN_RAMP_GEN_MASK;
if (chip->sub_type != QPNP_LPG_S_CHAN_SUB_TYPE)
mask |= QPNP_EN_PWM_OUTPUT_MASK;
return qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_ENABLE_CONTROL],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_ENABLE_CONTROL), 1, chip);
}
static int qpnp_lpg_configure_ramp_step_duration(struct qpnp_pwm_chip *chip)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
struct qpnp_lut_config lut_config = lpg_config->lut_config;
int rc, value;
u8 val, mask;
value = QPNP_GET_RAMP_STEP_DURATION(lut_config.ramp_step_ms);
val = value & QPNP_RAMP_STEP_DURATION_LSB_MASK;
mask = QPNP_RAMP_STEP_DURATION_LSB_MASK;
rc = qpnp_lpg_save_and_write(val, mask,
&chip->qpnp_lpg_registers[QPNP_RAMP_STEP_DURATION_LSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_RAMP_STEP_DURATION_LSB), 1, chip);
if (rc)
return rc;
val = (value >> QPNP_RAMP_STEP_DURATION_MSB_SHIFT) &
QPNP_RAMP_STEP_DURATION_MSB_MASK;
mask = QPNP_RAMP_STEP_DURATION_MSB_MASK;
return qpnp_lpg_save_and_write(val, mask,
&chip->qpnp_lpg_registers[QPNP_RAMP_STEP_DURATION_MSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_RAMP_STEP_DURATION_MSB), 1, chip);
}
static int qpnp_lpg_configure_pause(struct qpnp_pwm_chip *chip)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
struct qpnp_lut_config lut_config = lpg_config->lut_config;
u8 value, mask;
int rc = 0;
if (lut_config.enable_pause_hi) {
value = lut_config.lut_pause_hi_cnt;
mask = QPNP_PAUSE_HI_MULTIPLIER_LSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_HI_MULTIPLIER_LSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_HI_MULTIPLIER_LSB), 1, chip);
if (rc)
return rc;
value = (lut_config.lut_pause_hi_cnt >>
QPNP_PAUSE_HI_MULTIPLIER_MSB_SHIFT) &
QPNP_PAUSE_HI_MULTIPLIER_MSB_MASK;
mask = QPNP_PAUSE_HI_MULTIPLIER_MSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_HI_MULTIPLIER_MSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_HI_MULTIPLIER_MSB), 1, chip);
} else {
value = 0;
mask = QPNP_PAUSE_HI_MULTIPLIER_LSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_HI_MULTIPLIER_LSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_HI_MULTIPLIER_LSB), 1, chip);
if (rc)
return rc;
mask = QPNP_PAUSE_HI_MULTIPLIER_MSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_HI_MULTIPLIER_MSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_HI_MULTIPLIER_MSB), 1, chip);
if (rc)
return rc;
}
if (lut_config.enable_pause_lo) {
value = lut_config.lut_pause_lo_cnt;
mask = QPNP_PAUSE_LO_MULTIPLIER_LSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_LO_MULTIPLIER_LSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_LO_MULTIPLIER_LSB), 1, chip);
if (rc)
return rc;
value = (lut_config.lut_pause_lo_cnt >>
QPNP_PAUSE_LO_MULTIPLIER_MSB_SHIFT) &
QPNP_PAUSE_LO_MULTIPLIER_MSB_MASK;
mask = QPNP_PAUSE_LO_MULTIPLIER_MSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_LO_MULTIPLIER_MSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_LO_MULTIPLIER_MSB), 1, chip);
} else {
value = 0;
mask = QPNP_PAUSE_LO_MULTIPLIER_LSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_LO_MULTIPLIER_LSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_LO_MULTIPLIER_LSB), 1, chip);
if (rc)
return rc;
mask = QPNP_PAUSE_LO_MULTIPLIER_MSB_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_PAUSE_LO_MULTIPLIER_MSB],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_PAUSE_LO_MULTIPLIER_MSB), 1, chip);
return rc;
}
return rc;
}
static int qpnp_lpg_configure_index(struct qpnp_pwm_chip *chip)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
struct qpnp_lut_config lut_config = lpg_config->lut_config;
u8 value, mask;
int rc = 0;
value = lut_config.hi_index;
mask = QPNP_HI_INDEX_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_HI_INDEX],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_HI_INDEX), 1, chip);
if (rc)
return rc;
value = lut_config.lo_index;
mask = QPNP_LO_INDEX_MASK;
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_LO_INDEX],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_LO_INDEX), 1, chip);
return rc;
}
static int qpnp_lpg_change_lut(struct qpnp_pwm_chip *chip)
{
int rc;
rc = qpnp_lpg_configure_pattern(chip);
if (rc) {
pr_err("Failed to configure LUT pattern");
return rc;
}
rc = qpnp_lpg_configure_pwm(chip);
if (rc) {
pr_err("Failed to configure LUT pattern");
return rc;
}
rc = qpnp_configure_lpg_control(chip);
if (rc) {
pr_err("Failed to configure pause registers");
return rc;
}
rc = qpnp_lpg_configure_ramp_step_duration(chip);
if (rc) {
pr_err("Failed to configure duty time");
return rc;
}
rc = qpnp_lpg_configure_pause(chip);
if (rc) {
pr_err("Failed to configure pause registers");
return rc;
}
rc = qpnp_lpg_configure_index(chip);
if (rc) {
pr_err("Failed to configure index registers");
return rc;
}
return rc;
}
static int qpnp_dtest_config(struct qpnp_pwm_chip *chip, bool enable)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
u8 value;
u16 addr;
int rc = 0;
if (!chip->dtest_output) {
pr_err("DTEST output not configured for channel %d\n",
chip->channel_id);
return -EPERM;
}
if (chip->dtest_line > QPNP_LPG_DTEST_LINE_MAX ||
chip->dtest_output > QPNP_LPG_DTEST_OUTPUT_MAX) {
pr_err("DTEST line/output values are improper for channel %d\n",
chip->channel_id);
return -EINVAL;
}
value = 0xA5;
addr = SPMI_LPG_REG_ADDR(lpg_config->base_addr, QPNP_LPG_SEC_ACCESS);
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl,
chip->spmi_dev->sid, addr, &value, 1);
if (rc) {
pr_err("Couldn't set the access for test mode\n");
return rc;
}
addr = SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_LPG_DTEST + chip->dtest_line - 1);
if (enable)
value = chip->dtest_output & QPNP_DTEST_OUTPUT_MASK;
else
value = 0;
pr_debug("Setting TEST mode for channel %d addr:%x value: %x\n",
chip->channel_id, addr, value);
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl,
chip->spmi_dev->sid, addr, &value, 1);
return rc;
}
static int qpnp_lpg_configure_lut_state(struct qpnp_pwm_chip *chip,
enum qpnp_lut_state state)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
u8 value1, value2, mask1, mask2;
u8 *reg1, *reg2;
u16 addr, addr1;
int rc;
bool test_enable;
value1 = chip->qpnp_lpg_registers[QPNP_RAMP_CONTROL];
reg1 = &chip->qpnp_lpg_registers[QPNP_RAMP_CONTROL];
reg2 = &chip->qpnp_lpg_registers[QPNP_ENABLE_CONTROL];
mask2 = QPNP_EN_PWM_HIGH_MASK | QPNP_EN_PWM_LO_MASK |
QPNP_PWM_SRC_SELECT_MASK | QPNP_PWM_EN_RAMP_GEN_MASK;
if (chip->sub_type != QPNP_LPG_S_CHAN_SUB_TYPE)
mask2 |= QPNP_EN_PWM_OUTPUT_MASK;
if (chip->sub_type == QPNP_LPG_CHAN_SUB_TYPE
&& chip->revision == QPNP_LPG_REVISION_0) {
if (state == QPNP_LUT_ENABLE) {
QPNP_ENABLE_LUT_V0(value1);
value2 = QPNP_ENABLE_LPG_MODE(chip);
} else {
QPNP_DISABLE_LUT_V0(value1);
value2 = QPNP_DISABLE_LPG_MODE(chip);
}
mask1 = QPNP_RAMP_START_MASK;
addr1 = SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_RAMP_CONTROL);
} else if ((chip->sub_type == QPNP_LPG_CHAN_SUB_TYPE
&& chip->revision == QPNP_LPG_REVISION_1)
|| chip->sub_type == QPNP_LPG_S_CHAN_SUB_TYPE) {
if (state == QPNP_LUT_ENABLE) {
QPNP_ENABLE_LUT_V1(value1,
lpg_config->lut_config.ramp_index);
value2 = QPNP_ENABLE_LPG_MODE(chip);
} else {
value2 = QPNP_DISABLE_LPG_MODE(chip);
}
mask1 = value1;
addr1 = lpg_config->lut_base_addr +
SPMI_LPG_REV1_RAMP_CONTROL_OFFSET;
} else {
pr_err("Unsupported LPG subtype 0x%02x, revision 0x%02x\n",
chip->sub_type, chip->revision);
return -EINVAL;
}
addr = SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_ENABLE_CONTROL);
if (chip->in_test_mode) {
test_enable = (state == QPNP_LUT_ENABLE) ? 1 : 0;
rc = qpnp_dtest_config(chip, test_enable);
if (rc)
pr_err("Failed to configure TEST mode\n");
}
rc = qpnp_lpg_save_and_write(value2, mask2, reg2,
addr, 1, chip);
if (rc)
return rc;
if (state == QPNP_LUT_ENABLE
|| (chip->sub_type == QPNP_LPG_CHAN_SUB_TYPE
&& chip->revision == QPNP_LPG_REVISION_0))
rc = qpnp_lpg_save_and_write(value1, mask1, reg1,
addr1, 1, chip);
return rc;
}
static inline int qpnp_enable_pwm_mode(struct qpnp_pwm_chip *chip)
{
if (chip->pwm_config.supported_sizes == QPNP_PWM_SIZE_7_8_BIT)
return QPNP_ENABLE_PWM_MODE_GPLED_CHANNEL(chip);
return QPNP_ENABLE_PWM_MODE(chip);
}
static int qpnp_lpg_configure_pwm_state(struct qpnp_pwm_chip *chip,
enum qpnp_pwm_state state)
{
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
u8 value, mask;
int rc;
bool test_enable;
if (chip->sub_type == QPNP_PWM_MODE_ONLY_SUB_TYPE) {
if (state == QPNP_PWM_ENABLE)
value = QPNP_ENABLE_PWM_MODE_ONLY_SUB_TYPE;
else
value = QPNP_DISABLE_PWM_MODE_ONLY_SUB_TYPE;
mask = QPNP_PWM_MODE_ONLY_ENABLE_DISABLE_MASK_SUB_TYPE;
} else {
if (state == QPNP_PWM_ENABLE)
value = qpnp_enable_pwm_mode(chip);
else
value = QPNP_DISABLE_PWM_MODE(chip);
mask = QPNP_EN_PWM_HIGH_MASK | QPNP_EN_PWM_LO_MASK |
QPNP_PWM_SRC_SELECT_MASK | QPNP_PWM_EN_RAMP_GEN_MASK;
if (chip->sub_type != QPNP_LPG_S_CHAN_SUB_TYPE)
mask |= QPNP_EN_PWM_OUTPUT_MASK;
}
if (chip->in_test_mode) {
test_enable = (state == QPNP_PWM_ENABLE) ? 1 : 0;
rc = qpnp_dtest_config(chip, test_enable);
if (rc)
pr_err("Failed to configure TEST mode\n");
}
rc = qpnp_lpg_save_and_write(value, mask,
&chip->qpnp_lpg_registers[QPNP_ENABLE_CONTROL],
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_ENABLE_CONTROL), 1, chip);
if (rc)
goto out;
/*
* Due to LPG hardware bug, in the PWM mode, having enabled PWM,
* We have to write PWM values one more time.
*/
if (state == QPNP_PWM_ENABLE)
return qpnp_lpg_save_pwm_value(chip);
out:
return rc;
}
static int _pwm_config(struct qpnp_pwm_chip *chip,
enum time_level tm_lvl,
int duty_value, int period_value)
{
int rc;
struct _qpnp_pwm_config *pwm_config = &chip->pwm_config;
struct pwm_period_config *period = &pwm_config->period;
pwm_config->pwm_duty = (tm_lvl == LVL_USEC) ? duty_value :
duty_value / NSEC_PER_USEC;
qpnp_lpg_calc_pwm_value(pwm_config, period_value, duty_value);
rc = qpnp_lpg_save_pwm_value(chip);
if (rc)
goto out;
rc = qpnp_lpg_configure_pwm(chip);
if (rc)
goto out;
rc = qpnp_configure_pwm_control(chip);
if (rc)
goto out;
if (!rc && chip->enabled)
rc = qpnp_lpg_configure_pwm_state(chip, QPNP_PWM_ENABLE);
pr_debug("duty/period=%u/%u %s: pwm_value=%d (of %d)\n",
(unsigned)duty_value, (unsigned)period_value,
(tm_lvl == LVL_USEC) ? "usec" : "nsec",
pwm_config->pwm_value, 1 << period->pwm_size);
out:
return rc;
}
static int _pwm_lut_config(struct qpnp_pwm_chip *chip, int period_us,
int duty_pct[], struct lut_params lut_params)
{
struct qpnp_lpg_config *lpg_config;
struct qpnp_lut_config *lut_config;
struct pwm_period_config *period;
struct _qpnp_pwm_config *pwm_config;
int start_idx = lut_params.start_idx;
int len = lut_params.idx_len;
int flags = lut_params.flags;
int raw_lut, ramp_step_ms;
int rc = 0;
pwm_config = &chip->pwm_config;
lpg_config = &chip->lpg_config;
lut_config = &lpg_config->lut_config;
period = &pwm_config->period;
if (flags & PM_PWM_LUT_NO_TABLE)
goto after_table_write;
raw_lut = 0;
if (flags & PM_PWM_LUT_USE_RAW_VALUE)
raw_lut = 1;
lut_config->list_len = len;
lut_config->lo_index = start_idx + 1;
lut_config->hi_index = start_idx + len;
rc = qpnp_lpg_change_table(chip, duty_pct, raw_lut);
if (rc) {
pr_err("qpnp_lpg_change_table: rc=%d\n", rc);
return -EINVAL;
}
after_table_write:
ramp_step_ms = lut_params.ramp_step_ms;
if (ramp_step_ms > PM_PWM_LUT_RAMP_STEP_TIME_MAX)
ramp_step_ms = PM_PWM_LUT_RAMP_STEP_TIME_MAX;
QPNP_SET_PAUSE_CNT(lut_config->lut_pause_lo_cnt,
lut_params.lut_pause_lo, ramp_step_ms);
if (lut_config->lut_pause_lo_cnt > PM_PWM_MAX_PAUSE_CNT)
lut_config->lut_pause_lo_cnt = PM_PWM_MAX_PAUSE_CNT;
QPNP_SET_PAUSE_CNT(lut_config->lut_pause_hi_cnt,
lut_params.lut_pause_hi, ramp_step_ms);
if (lut_config->lut_pause_hi_cnt > PM_PWM_MAX_PAUSE_CNT)
lut_config->lut_pause_hi_cnt = PM_PWM_MAX_PAUSE_CNT;
lut_config->ramp_step_ms = ramp_step_ms;
lut_config->ramp_direction = !!(flags & PM_PWM_LUT_RAMP_UP);
lut_config->pattern_repeat = !!(flags & PM_PWM_LUT_LOOP);
lut_config->ramp_toggle = !!(flags & PM_PWM_LUT_REVERSE);
lut_config->enable_pause_hi = !!(flags & PM_PWM_LUT_PAUSE_HI_EN);
lut_config->enable_pause_lo = !!(flags & PM_PWM_LUT_PAUSE_LO_EN);
rc = qpnp_lpg_change_lut(chip);
if (!rc && chip->enabled)
rc = qpnp_lpg_configure_lut_state(chip, QPNP_LUT_ENABLE);
return rc;
}
static int _pwm_enable(struct qpnp_pwm_chip *chip)
{
int rc = 0;
unsigned long flags;
spin_lock_irqsave(&chip->lpg_lock, flags);
if (QPNP_IS_PWM_CONFIG_SELECTED(
chip->qpnp_lpg_registers[QPNP_ENABLE_CONTROL]) ||
chip->flags & QPNP_PWM_LUT_NOT_SUPPORTED) {
rc = qpnp_lpg_configure_pwm_state(chip, QPNP_PWM_ENABLE);
} else if (!(chip->flags & QPNP_PWM_LUT_NOT_SUPPORTED)) {
rc = qpnp_lpg_configure_lut_state(chip,
QPNP_LUT_ENABLE);
}
if (!rc)
chip->enabled = true;
spin_unlock_irqrestore(&chip->lpg_lock, flags);
return rc;
}
/* APIs */
/**
* qpnp_pwm_free - free a PWM device
* @pwm_chip: the PWM chip
* @pwm: the PWM device
*/
static void qpnp_pwm_free(struct pwm_chip *pwm_chip,
struct pwm_device *pwm)
{
struct qpnp_pwm_chip *chip = qpnp_pwm_from_pwm_chip(pwm_chip);
unsigned long flags;
spin_lock_irqsave(&chip->lpg_lock, flags);
qpnp_lpg_configure_pwm_state(chip, QPNP_PWM_DISABLE);
if (!(chip->flags & QPNP_PWM_LUT_NOT_SUPPORTED))
qpnp_lpg_configure_lut_state(chip, QPNP_LUT_DISABLE);
chip->enabled = false;
spin_unlock_irqrestore(&chip->lpg_lock, flags);
}
/**
* qpnp_pwm_config - change a PWM device configuration
* @pwm: the PWM device
* @period_ns: period in nanoseconds
* @duty_ns: duty cycle in nanoseconds
*/
static int qpnp_pwm_config(struct pwm_chip *pwm_chip,
struct pwm_device *pwm, int duty_ns, int period_ns)
{
int rc;
unsigned long flags;
struct qpnp_pwm_chip *chip = qpnp_pwm_from_pwm_chip(pwm_chip);
int prev_period_us = chip->pwm_config.pwm_period;
if ((unsigned)period_ns < PM_PWM_PERIOD_MIN * NSEC_PER_USEC) {
pr_err("Invalid pwm handle or parameters\n");
return -EINVAL;
}
spin_lock_irqsave(&chip->lpg_lock, flags);
if (prev_period_us > INT_MAX / NSEC_PER_USEC ||
prev_period_us * NSEC_PER_USEC != period_ns) {
qpnp_lpg_calc_period(LVL_NSEC, period_ns, chip);
qpnp_lpg_save_period(chip);
pwm->period = period_ns;
chip->pwm_config.pwm_period = period_ns / NSEC_PER_USEC;
}
rc = _pwm_config(chip, LVL_NSEC, duty_ns, period_ns);
spin_unlock_irqrestore(&chip->lpg_lock, flags);
if (rc)
pr_err("Failed to configure PWM mode\n");
return rc;
}
/**
* qpnp_pwm_enable - start a PWM output toggling
* @pwm_chip: the PWM chip
* @pwm: the PWM device
*/
static int qpnp_pwm_enable(struct pwm_chip *pwm_chip,
struct pwm_device *pwm)
{
int rc;
struct qpnp_pwm_chip *chip = qpnp_pwm_from_pwm_chip(pwm_chip);
rc = _pwm_enable(chip);
if (rc)
pr_err("Failed to enable PWM channel: %d\n", chip->channel_id);
return rc;
}
/**
* qpnp_pwm_disable - stop a PWM output toggling
* @pwm_chip: the PWM chip
* @pwm: the PWM device
*/
static void qpnp_pwm_disable(struct pwm_chip *pwm_chip,
struct pwm_device *pwm)
{
struct qpnp_pwm_chip *chip = qpnp_pwm_from_pwm_chip(pwm_chip);
unsigned long flags;
int rc = 0;
spin_lock_irqsave(&chip->lpg_lock, flags);
if (QPNP_IS_PWM_CONFIG_SELECTED(
chip->qpnp_lpg_registers[QPNP_ENABLE_CONTROL]) ||
chip->flags & QPNP_PWM_LUT_NOT_SUPPORTED)
rc = qpnp_lpg_configure_pwm_state(chip,
QPNP_PWM_DISABLE);
else if (!(chip->flags & QPNP_PWM_LUT_NOT_SUPPORTED))
rc = qpnp_lpg_configure_lut_state(chip,
QPNP_LUT_DISABLE);
if (!rc)
chip->enabled = false;
spin_unlock_irqrestore(&chip->lpg_lock, flags);
if (rc)
pr_err("Failed to disable PWM channel: %d\n",
chip->channel_id);
}
static int _pwm_change_mode(struct qpnp_pwm_chip *chip, enum pm_pwm_mode mode)
{
int rc;
if (mode)
rc = qpnp_configure_lpg_control(chip);
else
rc = qpnp_configure_pwm_control(chip);
if (rc)
pr_err("Failed to change the mode\n");
return rc;
}
/**
* pwm_change_mode - Change the PWM mode configuration
* @pwm: the PWM device
* @mode: Mode selection value
*/
int pwm_change_mode(struct pwm_device *pwm, enum pm_pwm_mode mode)
{
int rc;
unsigned long flags;
struct qpnp_pwm_chip *chip;
if (pwm == NULL || IS_ERR(pwm) || pwm->chip == NULL) {
pr_err("Invalid pwm handle or no pwm_chip\n");
return -EINVAL;
}
if (mode < PM_PWM_MODE_PWM || mode > PM_PWM_MODE_LPG) {
pr_err("Invalid mode value\n");
return -EINVAL;
}
chip = qpnp_pwm_from_pwm_dev(pwm);
spin_lock_irqsave(&chip->lpg_lock, flags);
rc = _pwm_change_mode(chip, mode);
spin_unlock_irqrestore(&chip->lpg_lock, flags);
return rc;
}
EXPORT_SYMBOL_GPL(pwm_change_mode);
/**
* pwm_config_period - change PWM period
*
* @pwm: the PWM device
* @pwm_p: period in struct qpnp_lpg_period
*/
int pwm_config_period(struct pwm_device *pwm,
struct pwm_period_config *period)
{
struct _qpnp_pwm_config *pwm_config;
struct qpnp_lpg_config *lpg_config;
struct qpnp_pwm_chip *chip;
unsigned long flags;
int rc = 0;
if (pwm == NULL || IS_ERR(pwm) || period == NULL)
return -EINVAL;
if (pwm->chip == NULL)
return -ENODEV;
chip = qpnp_pwm_from_pwm_dev(pwm);
pwm_config = &chip->pwm_config;
lpg_config = &chip->lpg_config;
spin_lock_irqsave(&chip->lpg_lock, flags);
pwm_config->period.pwm_size = period->pwm_size;
pwm_config->period.clk = period->clk;
pwm_config->period.pre_div = period->pre_div;
pwm_config->period.pre_div_exp = period->pre_div_exp;
qpnp_lpg_save_period(chip);
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl, chip->spmi_dev->sid,
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_LPG_PWM_SIZE_CLK),
&chip->qpnp_lpg_registers[QPNP_LPG_PWM_SIZE_CLK], 1);
if (rc) {
pr_err("Write failed: QPNP_LPG_PWM_SIZE_CLK register, rc: %d\n",
rc);
goto out_unlock;
}
rc = spmi_ext_register_writel(chip->spmi_dev->ctrl, chip->spmi_dev->sid,
SPMI_LPG_REG_ADDR(lpg_config->base_addr,
QPNP_LPG_PWM_FREQ_PREDIV_CLK),
&chip->qpnp_lpg_registers[QPNP_LPG_PWM_FREQ_PREDIV_CLK], 1);
if (rc) {
pr_err("Failed to write to QPNP_LPG_PWM_FREQ_PREDIV_CLK\n");
pr_err("register, rc = %d\n", rc);
}
out_unlock:
spin_unlock_irqrestore(&chip->lpg_lock, flags);
return rc;
}
EXPORT_SYMBOL(pwm_config_period);
/**
* pwm_config_pwm_value - change a PWM device configuration
* @pwm: the PWM device
* @pwm_value: the duty cycle in raw PWM value (< 2^pwm_size)
*/
int pwm_config_pwm_value(struct pwm_device *pwm, int pwm_value)
{
struct qpnp_lpg_config *lpg_config;
struct _qpnp_pwm_config *pwm_config;
struct qpnp_pwm_chip *chip;
unsigned long flags;
int rc = 0;
if (pwm == NULL || IS_ERR(pwm)) {
pr_err("Invalid parameter passed\n");
return -EINVAL;
}
if (pwm->chip == NULL) {
pr_err("Invalid device handle\n");
return -ENODEV;
}
chip = qpnp_pwm_from_pwm_dev(pwm);
lpg_config = &chip->lpg_config;
pwm_config = &chip->pwm_config;
spin_lock_irqsave(&chip->lpg_lock, flags);
if (pwm_config->pwm_value == pwm_value)
goto out_unlock;
pwm_config->pwm_value = pwm_value;
rc = qpnp_lpg_save_pwm_value(chip);
if (rc)
pr_err("Could not update PWM value for channel %d rc=%d\n",
chip->channel_id, rc);
out_unlock:
spin_unlock_irqrestore(&chip->lpg_lock, flags);
return rc;
}
EXPORT_SYMBOL_GPL(pwm_config_pwm_value);
/**
* pwm_config_us - change a PWM device configuration
* @pwm: the PWM device
* @period_us: period in microseconds
* @duty_us: duty cycle in microseconds
*/
int pwm_config_us(struct pwm_device *pwm, int duty_us, int period_us)
{
int rc;
unsigned long flags;
struct qpnp_pwm_chip *chip;
if (pwm == NULL || IS_ERR(pwm) ||
duty_us > period_us ||
(unsigned)period_us > PM_PWM_PERIOD_MAX ||
(unsigned)period_us < PM_PWM_PERIOD_MIN) {
pr_err("Invalid pwm handle or parameters\n");
return -EINVAL;
}
chip = qpnp_pwm_from_pwm_dev(pwm);
spin_lock_irqsave(&chip->lpg_lock, flags);
if (chip->pwm_config.pwm_period != period_us) {
qpnp_lpg_calc_period(LVL_USEC, period_us, chip);
qpnp_lpg_save_period(chip);
chip->pwm_config.pwm_period = period_us;
if ((unsigned)period_us > (unsigned)(-1) / NSEC_PER_USEC)
pwm->period = 0;
else
pwm->period = (unsigned)period_us * NSEC_PER_USEC;
}
rc = _pwm_config(chip, LVL_USEC, duty_us, period_us);
spin_unlock_irqrestore(&chip->lpg_lock, flags);
if (rc)
pr_err("Failed to configure PWM mode\n");
return rc;
}
EXPORT_SYMBOL(pwm_config_us);
/**
* pwm_lut_config - change LPG LUT device configuration
* @pwm: the PWM device
* @period_us: period in micro second
* @duty_pct: array of duty cycles in percent, like 20, 50.
* @lut_params: Lookup table parameters
*/
int pwm_lut_config(struct pwm_device *pwm, int period_us,
int duty_pct[], struct lut_params lut_params)
{
unsigned long flags;
struct qpnp_pwm_chip *chip;
int rc = 0;
if (pwm == NULL || IS_ERR(pwm) || !lut_params.idx_len) {
pr_err("Invalid pwm handle or idx_len=0\n");
return -EINVAL;
}
if (pwm->chip == NULL)
return -ENODEV;
if (duty_pct == NULL && !(lut_params.flags & PM_PWM_LUT_NO_TABLE)) {
pr_err("Invalid duty_pct with flag\n");
return -EINVAL;
}
chip = qpnp_pwm_from_pwm_dev(pwm);
if (chip->flags & QPNP_PWM_LUT_NOT_SUPPORTED) {
pr_err("LUT mode isn't supported\n");
return -EINVAL;
}
if ((lut_params.start_idx + lut_params.idx_len) >
chip->lpg_config.lut_size) {
pr_err("Exceed LUT limit\n");
return -EINVAL;
}
if ((unsigned)period_us > PM_PWM_PERIOD_MAX ||
(unsigned)period_us < PM_PWM_PERIOD_MIN) {
pr_err("Period out of range\n");
return -EINVAL;
}
spin_lock_irqsave(&chip->lpg_lock, flags);
if (chip->pwm_config.pwm_period != period_us) {
qpnp_lpg_calc_period(LVL_USEC, period_us, chip);
qpnp_lpg_save_period(chip);
chip->pwm_config.pwm_period = period_us;
}
rc = _pwm_lut_config(chip, period_us, duty_pct, lut_params);
spin_unlock_irqrestore(&chip->lpg_lock, flags);
if (rc)
pr_err("Failed to configure LUT\n");
return rc;
}
EXPORT_SYMBOL_GPL(pwm_lut_config);
static int qpnp_parse_pwm_dt_config(struct device_node *of_pwm_node,
struct device_node *of_parent, struct qpnp_pwm_chip *chip)
{
int rc, period;
rc = of_property_read_u32(of_parent, "qcom,period", (u32 *)&period);
if (rc) {
pr_err("node is missing PWM Period prop");
return rc;
}
rc = of_property_read_u32(of_pwm_node, "qcom,duty",
&chip->pwm_config.pwm_duty);
if (rc) {
pr_err("node is missing PWM Duty prop");
return rc;
}
rc = _pwm_config(chip, LVL_USEC, chip->pwm_config.pwm_duty, period);
return rc;
}
#define qpnp_check_optional_dt_bindings(func) \
do { \
rc = func; \
if (rc && rc != -EINVAL) \
goto out; \
rc = 0; \
} while (0)
static int qpnp_parse_lpg_dt_config(struct device_node *of_lpg_node,
struct device_node *of_parent, struct qpnp_pwm_chip *chip)
{
int rc, period, list_size, start_idx, *duty_pct_list;
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
struct qpnp_lut_config *lut_config = &lpg_config->lut_config;
struct lut_params lut_params;
rc = of_property_read_u32(of_parent, "qcom,period", &period);
if (rc) {
pr_err("node is missing PWM Period prop\n");
return rc;
}
if (!of_get_property(of_lpg_node, "qcom,duty-percents", &list_size)) {
pr_err("node is missing duty-pct list\n");
return rc;
}
rc = of_property_read_u32(of_lpg_node, "cell-index", &start_idx);
if (rc) {
pr_err("Missing start index\n");
return rc;
}
list_size /= sizeof(u32);
if (list_size + start_idx > lpg_config->lut_size) {
pr_err("duty pct list size overflows\n");
return -EINVAL;
}
duty_pct_list = kzalloc(sizeof(u32) * list_size, GFP_KERNEL);
if (!duty_pct_list) {
pr_err("kzalloc failed on duty_pct_list\n");
return -ENOMEM;
}
rc = of_property_read_u32_array(of_lpg_node, "qcom,duty-percents",
duty_pct_list, list_size);
if (rc) {
pr_err("invalid or missing property:\n");
pr_err("qcom,duty-pcts-list\n");
kfree(duty_pct_list);
return rc;
}
/* Read optional properties */
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,ramp-step-duration", &lut_config->ramp_step_ms));
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,lpg-lut-pause-hi", &lut_config->lut_pause_hi_cnt));
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,lpg-lut-pause-lo", &lut_config->lut_pause_lo_cnt));
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,lpg-lut-ramp-direction",
(u32 *)&lut_config->ramp_direction));
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,lpg-lut-pattern-repeat",
(u32 *)&lut_config->pattern_repeat));
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,lpg-lut-ramp-toggle",
(u32 *)&lut_config->ramp_toggle));
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,lpg-lut-enable-pause-hi",
(u32 *)&lut_config->enable_pause_hi));
qpnp_check_optional_dt_bindings(of_property_read_u32(of_lpg_node,
"qcom,lpg-lut-enable-pause-lo",
(u32 *)&lut_config->enable_pause_lo));
qpnp_set_lut_params(&lut_params, lut_config, start_idx, list_size);
_pwm_lut_config(chip, period, duty_pct_list, lut_params);
out:
kfree(duty_pct_list);
return rc;
}
static int qpnp_lpg_get_rev_subtype(struct qpnp_pwm_chip *chip)
{
int rc;
rc = spmi_ext_register_readl(chip->spmi_dev->ctrl,
chip->spmi_dev->sid,
chip->lpg_config.base_addr + SPMI_LPG_SUB_TYPE_OFFSET,
&chip->sub_type, 1);
if (rc) {
pr_err("Couldn't read subtype rc: %d\n", rc);
goto out;
}
rc = spmi_ext_register_readl(chip->spmi_dev->ctrl,
chip->spmi_dev->sid,
chip->lpg_config.base_addr + SPMI_LPG_REVISION2_OFFSET,
(u8 *) &chip->revision, 1);
if (rc) {
pr_err("Couldn't read revision2 rc: %d\n", rc);
goto out;
}
if (chip->revision < QPNP_LPG_REVISION_0 ||
chip->revision > QPNP_LPG_REVISION_1) {
pr_err("Unknown LPG revision detected, rev:%d\n",
chip->revision);
rc = -EINVAL;
goto out;
}
if (chip->sub_type != QPNP_PWM_MODE_ONLY_SUB_TYPE
&& chip->sub_type != QPNP_LPG_CHAN_SUB_TYPE
&& chip->sub_type != QPNP_LPG_S_CHAN_SUB_TYPE) {
pr_err("Unknown LPG/PWM subtype detected, subtype:%d\n",
chip->sub_type);
rc = -EINVAL;
}
out:
pr_debug("LPG rev 0x%02x subtype 0x%02x rc: %d\n", chip->revision,
chip->sub_type, rc);
return rc;
}
/* Fill in lpg device elements based on values found in device tree. */
static int qpnp_parse_dt_config(struct spmi_device *spmi,
struct qpnp_pwm_chip *chip)
{
int rc, enable, lut_entry_size, list_size, i;
const char *lable;
struct resource *res;
struct device_node *node;
int found_pwm_subnode = 0;
int found_lpg_subnode = 0;
struct device_node *of_node = spmi->dev.of_node;
struct qpnp_lpg_config *lpg_config = &chip->lpg_config;
struct qpnp_lut_config *lut_config = &lpg_config->lut_config;
struct _qpnp_pwm_config *pwm_config = &chip->pwm_config;
int force_pwm_size = 0;
int pwm_size_list[QPNP_PWM_SIZES_SUPPORTED];
rc = of_property_read_u32(of_node, "qcom,channel-id",
&chip->channel_id);
if (rc) {
dev_err(&spmi->dev, "%s: node is missing LPG channel id\n",
__func__);
return -EINVAL;
}
if (!of_get_property(of_node, "qcom,supported-sizes", &list_size)) {
pr_err("Missing qcom,supported-size list\n");
return -EINVAL;
}
list_size /= sizeof(u32);
if (list_size > QPNP_PWM_SIZES_SUPPORTED) {
pr_err(" qcom,supported-size list is too big\n");
return -EINVAL;
}
rc = of_property_read_u32_array(of_node, "qcom,supported-sizes",
pwm_size_list, list_size);
if (rc) {
pr_err("Invalid qcom,supported-size property\n");
return rc;
}
for (i = 0; i < list_size; i++) {
pwm_config->supported_sizes |=
(1 << (pwm_size_list[i] - QPNP_MIN_PWM_BIT_SIZE));
}
if (!(pwm_config->supported_sizes == QPNP_PWM_SIZE_6_9_BIT ||
pwm_config->supported_sizes == QPNP_PWM_SIZE_7_8_BIT ||
pwm_config->supported_sizes == QPNP_PWM_SIZE_6_7_9_BIT)) {
pr_err("PWM sizes list qcom,supported-size is not proper\n");
return -EINVAL;
}
/*
* For cetrain LPG channels PWM size can be forced. So that
* for every requested pwm period closest pwm frequency is
* selected in qpnp_lpg_calc_period() for the forced pwm size.
*/
rc = of_property_read_u32(of_node, "qcom,force-pwm-size",
&force_pwm_size);
if (pwm_config->supported_sizes == QPNP_PWM_SIZE_7_8_BIT) {
if (!(force_pwm_size == QPNP_PWM_SIZE_7_BIT ||
force_pwm_size == QPNP_PWM_SIZE_8_BIT))
force_pwm_size = 0;
} else if (chip->sub_type == QPNP_PWM_MODE_ONLY_SUB_TYPE) {
if (!(force_pwm_size == QPNP_PWM_SIZE_6_BIT ||
force_pwm_size == QPNP_PWM_SIZE_9_BIT))
force_pwm_size = 0;
} else if (pwm_config->supported_sizes == QPNP_PWM_SIZE_6_7_9_BIT) {
if (!(force_pwm_size == QPNP_PWM_SIZE_6_BIT ||
force_pwm_size == QPNP_PWM_SIZE_7_BIT ||
force_pwm_size == QPNP_PWM_SIZE_9_BIT))
force_pwm_size = 0;
}
pwm_config->force_pwm_size = force_pwm_size;
res = spmi_get_resource_byname(spmi, NULL, IORESOURCE_MEM,
QPNP_LPG_CHANNEL_BASE);
if (!res) {
dev_err(&spmi->dev, "%s: node is missing base address\n",
__func__);
return -EINVAL;
}
lpg_config->base_addr = res->start;
rc = qpnp_lpg_get_rev_subtype(chip);
if (rc)
return rc;
res = spmi_get_resource_byname(spmi, NULL, IORESOURCE_MEM,
QPNP_LPG_LUT_BASE);
if (!res) {
chip->flags |= QPNP_PWM_LUT_NOT_SUPPORTED;
} else {
lpg_config->lut_base_addr = res->start;
/* Each entry of LUT is of 2 bytes for generic LUT and of 1 byte
* for KPDBL/GLED LUT.
*/
lpg_config->lut_size = resource_size(res) >> 1;
lut_entry_size = sizeof(u16);
if (pwm_config->supported_sizes == QPNP_PWM_SIZE_7_8_BIT) {
lpg_config->lut_size = resource_size(res);
lut_entry_size = sizeof(u8);
}
lut_config->duty_pct_list = kzalloc(lpg_config->lut_size *
lut_entry_size, GFP_KERNEL);
if (!lut_config->duty_pct_list) {
pr_err("can not allocate duty pct list\n");
return -ENOMEM;
}
rc = of_property_read_u32(of_node, "qcom,ramp-index",
&lut_config->ramp_index);
if (rc) {
pr_err("Missing LPG qcom,ramp-index property\n");
kfree(lut_config->duty_pct_list);
return rc;
}
}
rc = of_property_read_u32(of_node, "qcom,lpg-dtest-line",
&chip->dtest_line);
if (rc) {
chip->in_test_mode = 0;
} else {
chip->in_test_mode = 1;
rc = of_property_read_u32(of_node, "qcom,dtest-output",
&chip->dtest_output);
if (rc) {
pr_err("Missing DTEST output configuration\n");
chip->dtest_output = 0;
}
}
for_each_child_of_node(of_node, node) {
rc = of_property_read_string(node, "label", &lable);
if (rc) {
dev_err(&spmi->dev, "%s: Missing lable property\n",
__func__);
goto out;
}
if (!strncmp(lable, "pwm", 3)) {
rc = qpnp_parse_pwm_dt_config(node, of_node, chip);
if (rc)
goto out;
found_pwm_subnode = 1;
} else if (!strncmp(lable, "lpg", 3) &&
!(chip->flags & QPNP_PWM_LUT_NOT_SUPPORTED)) {
rc = qpnp_parse_lpg_dt_config(node, of_node, chip);
if (rc)
goto out;
found_lpg_subnode = 1;
} else {
dev_err(&spmi->dev, "%s: Invalid value for lable prop",
__func__);
}
}
rc = of_property_read_u32(of_node, "qcom,mode-select", &enable);
if (rc)
goto read_opt_props;
if ((enable == PM_PWM_MODE_PWM && found_pwm_subnode == 0) ||
(enable == PM_PWM_MODE_LPG && found_lpg_subnode == 0)) {
dev_err(&spmi->dev, "%s: Invalid mode select\n", __func__);
rc = -EINVAL;
goto out;
}
_pwm_change_mode(chip, enable);
_pwm_enable(chip);
read_opt_props:
/* Initialize optional config parameters from DT if provided */
of_property_read_string(node, "qcom,channel-owner",
&chip->channel_owner);
return 0;
out:
kfree(lut_config->duty_pct_list);
return rc;
}
static struct pwm_ops qpnp_pwm_ops = {
.enable = qpnp_pwm_enable,
.disable = qpnp_pwm_disable,
.config = qpnp_pwm_config,
.free = qpnp_pwm_free,
.owner = THIS_MODULE,
};
static int qpnp_pwm_probe(struct spmi_device *spmi)
{
struct qpnp_pwm_chip *pwm_chip;
int rc;
pwm_chip = kzalloc(sizeof(*pwm_chip), GFP_KERNEL);
if (pwm_chip == NULL) {
pr_err("kzalloc() failed.\n");
return -ENOMEM;
}
spin_lock_init(&pwm_chip->lpg_lock);
pwm_chip->spmi_dev = spmi;
dev_set_drvdata(&spmi->dev, pwm_chip);
rc = qpnp_parse_dt_config(spmi, pwm_chip);
if (rc)
goto failed_config;
pwm_chip->chip.dev = &spmi->dev;
pwm_chip->chip.ops = &qpnp_pwm_ops;
pwm_chip->chip.base = -1;
pwm_chip->chip.npwm = 1;
rc = pwmchip_add(&pwm_chip->chip);
if (rc < 0) {
pr_err("pwmchip_add() failed: %d\n", rc);
goto failed_insert;
}
if (pwm_chip->channel_owner)
pwm_chip->chip.pwms[0].label = pwm_chip->channel_owner;
return 0;
failed_insert:
kfree(pwm_chip->lpg_config.lut_config.duty_pct_list);
failed_config:
dev_set_drvdata(&spmi->dev, NULL);
kfree(pwm_chip);
return rc;
}
static int qpnp_pwm_remove(struct spmi_device *spmi)
{
struct qpnp_pwm_chip *pwm_chip;
struct qpnp_lpg_config *lpg_config;
pwm_chip = dev_get_drvdata(&spmi->dev);
dev_set_drvdata(&spmi->dev, NULL);
if (pwm_chip) {
lpg_config = &pwm_chip->lpg_config;
pwmchip_remove(&pwm_chip->chip);
kfree(lpg_config->lut_config.duty_pct_list);
kfree(pwm_chip);
}
return 0;
}
static struct of_device_id spmi_match_table[] = {
{ .compatible = QPNP_LPG_DRIVER_NAME, },
{}
};
static const struct spmi_device_id qpnp_lpg_id[] = {
{ QPNP_LPG_DRIVER_NAME, 0 },
{ }
};
MODULE_DEVICE_TABLE(spmi, qpnp_lpg_id);
static struct spmi_driver qpnp_lpg_driver = {
.driver = {
.name = QPNP_LPG_DRIVER_NAME,
.of_match_table = spmi_match_table,
.owner = THIS_MODULE,
},
.probe = qpnp_pwm_probe,
.remove = qpnp_pwm_remove,
.id_table = qpnp_lpg_id,
};
/**
* qpnp_lpg_init() - register spmi driver for qpnp-lpg
*/
int __init qpnp_lpg_init(void)
{
return spmi_driver_register(&qpnp_lpg_driver);
}
static void __exit qpnp_lpg_exit(void)
{
spmi_driver_unregister(&qpnp_lpg_driver);
}
MODULE_DESCRIPTION("QPNP PMIC LPG driver");
MODULE_LICENSE("GPL v2");
MODULE_ALIAS("platform:" QPNP_LPG_DRIVER_NAME);
subsys_initcall(qpnp_lpg_init);
module_exit(qpnp_lpg_exit);
Reference in a new issue View git blame Copy permalink