mirror of
https://github.com/torvalds/linux.git
synced 2026-04-18 06:44:00 -04:00
All the functions operating on the 'handle' pointer are claiming it is a
pointer to const thus they should not modify the handle. In fact that's
a false statement, because first thing these functions do is drop the
cast to const with container_of:
struct acpm_info *acpm = handle_to_acpm_info(handle);
And with such cast the handle is easily writable with simple:
acpm->handle.ops.pmic_ops.read_reg = NULL;
The code is not correct logically, either, because functions like
acpm_get_by_node() and acpm_handle_put() are meant to modify the handle
reference counting, thus they must modify the handle. Modification here
happens anyway, even if the reference counting is stored in the
container which the handle is part of.
The code does not have actual visible bug, but incorrect 'const'
annotations could lead to incorrect compiler decisions.
Fixes: a88927b534 ("firmware: add Exynos ACPM protocol driver")
Cc: stable@vger.kernel.org
Signed-off-by: Krzysztof Kozlowski <krzysztof.kozlowski@oss.qualcomm.com>
Link: https://patch.msgid.link/20260224104203.42950-2-krzysztof.kozlowski@oss.qualcomm.com
Signed-off-by: Krzysztof Kozlowski <krzk@kernel.org>
585 lines
18 KiB
C
585 lines
18 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
|
/*
|
|
* Copyright 2020 Google Inc
|
|
* Copyright 2025 Linaro Ltd.
|
|
*
|
|
* Samsung S2MPG1x ACPM driver
|
|
*/
|
|
|
|
#include <linux/array_size.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/device.h>
|
|
#include <linux/firmware/samsung/exynos-acpm-protocol.h>
|
|
#include <linux/mfd/samsung/core.h>
|
|
#include <linux/mfd/samsung/rtc.h>
|
|
#include <linux/mfd/samsung/s2mpg10.h>
|
|
#include <linux/mfd/samsung/s2mpg11.h>
|
|
#include <linux/mod_devicetable.h>
|
|
#include <linux/module.h>
|
|
#include <linux/of.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/property.h>
|
|
#include <linux/regmap.h>
|
|
#include "sec-core.h"
|
|
|
|
#define ACPM_ADDR_BITS 8
|
|
#define ACPM_MAX_BULK_DATA 8
|
|
|
|
struct sec_pmic_acpm_platform_data {
|
|
int device_type;
|
|
|
|
unsigned int acpm_chan_id;
|
|
u8 speedy_channel;
|
|
|
|
const struct regmap_config *regmap_cfg_common;
|
|
const struct regmap_config *regmap_cfg_pmic;
|
|
const struct regmap_config *regmap_cfg_rtc;
|
|
const struct regmap_config *regmap_cfg_meter;
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_common_registers[] = {
|
|
regmap_reg_range(0x00, 0x02), /* CHIP_ID_M, INT, INT_MASK */
|
|
regmap_reg_range(0x0a, 0x0c), /* Speedy control */
|
|
regmap_reg_range(0x1a, 0x2a), /* Debug */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_common_ro_registers[] = {
|
|
regmap_reg_range(0x00, 0x01), /* CHIP_ID_M, INT */
|
|
regmap_reg_range(0x28, 0x2a), /* Debug */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_common_nonvolatile_registers[] = {
|
|
regmap_reg_range(0x00, 0x00), /* CHIP_ID_M */
|
|
regmap_reg_range(0x02, 0x02), /* INT_MASK */
|
|
regmap_reg_range(0x0a, 0x0c), /* Speedy control */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_common_precious_registers[] = {
|
|
regmap_reg_range(0x01, 0x01), /* INT */
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_common_wr_table = {
|
|
.yes_ranges = s2mpg10_common_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_common_registers),
|
|
.no_ranges = s2mpg10_common_ro_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg10_common_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_common_rd_table = {
|
|
.yes_ranges = s2mpg10_common_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_common_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_common_volatile_table = {
|
|
.no_ranges = s2mpg10_common_nonvolatile_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg10_common_nonvolatile_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_common_precious_table = {
|
|
.yes_ranges = s2mpg10_common_precious_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_common_precious_registers),
|
|
};
|
|
|
|
static const struct regmap_config s2mpg10_regmap_config_common = {
|
|
.name = "common",
|
|
.reg_bits = ACPM_ADDR_BITS,
|
|
.val_bits = 8,
|
|
.max_register = S2MPG10_COMMON_SPD_DEBUG4,
|
|
.wr_table = &s2mpg10_common_wr_table,
|
|
.rd_table = &s2mpg10_common_rd_table,
|
|
.volatile_table = &s2mpg10_common_volatile_table,
|
|
.precious_table = &s2mpg10_common_precious_table,
|
|
.num_reg_defaults_raw = S2MPG10_COMMON_SPD_DEBUG4 + 1,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_pmic_registers[] = {
|
|
regmap_reg_range(0x00, 0xf6), /* All PMIC registers */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_pmic_ro_registers[] = {
|
|
regmap_reg_range(0x00, 0x05), /* INTx */
|
|
regmap_reg_range(0x0c, 0x0f), /* STATUSx PWRONSRC OFFSRC */
|
|
regmap_reg_range(0xc7, 0xc7), /* GPIO input */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_pmic_nonvolatile_registers[] = {
|
|
regmap_reg_range(0x06, 0x0b), /* INTxM */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_pmic_precious_registers[] = {
|
|
regmap_reg_range(0x00, 0x05), /* INTx */
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_pmic_wr_table = {
|
|
.yes_ranges = s2mpg10_pmic_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_pmic_registers),
|
|
.no_ranges = s2mpg10_pmic_ro_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg10_pmic_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_pmic_rd_table = {
|
|
.yes_ranges = s2mpg10_pmic_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_pmic_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_pmic_volatile_table = {
|
|
.no_ranges = s2mpg10_pmic_nonvolatile_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg10_pmic_nonvolatile_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_pmic_precious_table = {
|
|
.yes_ranges = s2mpg10_pmic_precious_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_pmic_precious_registers),
|
|
};
|
|
|
|
static const struct regmap_config s2mpg10_regmap_config_pmic = {
|
|
.name = "pmic",
|
|
.reg_bits = ACPM_ADDR_BITS,
|
|
.val_bits = 8,
|
|
.max_register = S2MPG10_PMIC_LDO_SENSE4,
|
|
.wr_table = &s2mpg10_pmic_wr_table,
|
|
.rd_table = &s2mpg10_pmic_rd_table,
|
|
.volatile_table = &s2mpg10_pmic_volatile_table,
|
|
.precious_table = &s2mpg10_pmic_precious_table,
|
|
.num_reg_defaults_raw = S2MPG10_PMIC_LDO_SENSE4 + 1,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_rtc_registers[] = {
|
|
regmap_reg_range(0x00, 0x2b), /* All RTC registers */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_rtc_volatile_registers[] = {
|
|
regmap_reg_range(0x01, 0x01), /* RTC_UPDATE */
|
|
regmap_reg_range(0x05, 0x0c), /* Time / date */
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_rtc_rd_table = {
|
|
.yes_ranges = s2mpg10_rtc_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_rtc_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_rtc_volatile_table = {
|
|
.yes_ranges = s2mpg10_rtc_volatile_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_rtc_volatile_registers),
|
|
};
|
|
|
|
static const struct regmap_config s2mpg10_regmap_config_rtc = {
|
|
.name = "rtc",
|
|
.reg_bits = ACPM_ADDR_BITS,
|
|
.val_bits = 8,
|
|
.max_register = S2MPG10_RTC_OSC_CTRL,
|
|
.rd_table = &s2mpg10_rtc_rd_table,
|
|
.volatile_table = &s2mpg10_rtc_volatile_table,
|
|
.num_reg_defaults_raw = S2MPG10_RTC_OSC_CTRL + 1,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_meter_registers[] = {
|
|
regmap_reg_range(0x00, 0x21), /* Meter config */
|
|
regmap_reg_range(0x40, 0x8a), /* Meter data */
|
|
regmap_reg_range(0xee, 0xee), /* Offset */
|
|
regmap_reg_range(0xf1, 0xf1), /* Trim */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg10_meter_ro_registers[] = {
|
|
regmap_reg_range(0x40, 0x8a), /* Meter data */
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_meter_wr_table = {
|
|
.yes_ranges = s2mpg10_meter_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_meter_registers),
|
|
.no_ranges = s2mpg10_meter_ro_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg10_meter_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_meter_rd_table = {
|
|
.yes_ranges = s2mpg10_meter_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_meter_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg10_meter_volatile_table = {
|
|
.yes_ranges = s2mpg10_meter_ro_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg10_meter_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_config s2mpg10_regmap_config_meter = {
|
|
.name = "meter",
|
|
.reg_bits = ACPM_ADDR_BITS,
|
|
.val_bits = 8,
|
|
.max_register = S2MPG10_METER_BUCK_METER_TRIM3,
|
|
.wr_table = &s2mpg10_meter_wr_table,
|
|
.rd_table = &s2mpg10_meter_rd_table,
|
|
.volatile_table = &s2mpg10_meter_volatile_table,
|
|
.num_reg_defaults_raw = S2MPG10_METER_BUCK_METER_TRIM3 + 1,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_common_registers[] = {
|
|
regmap_reg_range(0x00, 0x02), /* CHIP_ID_S, INT, INT_MASK */
|
|
regmap_reg_range(0x0a, 0x0c), /* Speedy control */
|
|
regmap_reg_range(0x1a, 0x27), /* Debug */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_common_ro_registers[] = {
|
|
regmap_reg_range(0x00, 0x01), /* CHIP_ID_S, INT */
|
|
regmap_reg_range(0x25, 0x27), /* Debug */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_common_nonvolatile_registers[] = {
|
|
regmap_reg_range(0x00, 0x00), /* CHIP_ID_S */
|
|
regmap_reg_range(0x02, 0x02), /* INT_MASK */
|
|
regmap_reg_range(0x0a, 0x0c), /* Speedy control */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_common_precious_registers[] = {
|
|
regmap_reg_range(0x01, 0x01), /* INT */
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_common_wr_table = {
|
|
.yes_ranges = s2mpg11_common_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_common_registers),
|
|
.no_ranges = s2mpg11_common_ro_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg11_common_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_common_rd_table = {
|
|
.yes_ranges = s2mpg11_common_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_common_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_common_volatile_table = {
|
|
.no_ranges = s2mpg11_common_nonvolatile_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg11_common_nonvolatile_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_common_precious_table = {
|
|
.yes_ranges = s2mpg11_common_precious_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_common_precious_registers),
|
|
};
|
|
|
|
static const struct regmap_config s2mpg11_regmap_config_common = {
|
|
.name = "common",
|
|
.reg_bits = ACPM_ADDR_BITS,
|
|
.val_bits = 8,
|
|
.max_register = S2MPG11_COMMON_SPD_DEBUG4,
|
|
.wr_table = &s2mpg11_common_wr_table,
|
|
.rd_table = &s2mpg11_common_rd_table,
|
|
.volatile_table = &s2mpg11_common_volatile_table,
|
|
.precious_table = &s2mpg11_common_precious_table,
|
|
.num_reg_defaults_raw = S2MPG11_COMMON_SPD_DEBUG4 + 1,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_pmic_registers[] = {
|
|
regmap_reg_range(0x00, 0x5a), /* All PMIC registers */
|
|
regmap_reg_range(0x5c, 0xb7), /* All PMIC registers */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_pmic_ro_registers[] = {
|
|
regmap_reg_range(0x00, 0x05), /* INTx */
|
|
regmap_reg_range(0x0c, 0x0d), /* STATUS OFFSRC */
|
|
regmap_reg_range(0x98, 0x98), /* GPIO input */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_pmic_nonvolatile_registers[] = {
|
|
regmap_reg_range(0x06, 0x0b), /* INTxM */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_pmic_precious_registers[] = {
|
|
regmap_reg_range(0x00, 0x05), /* INTx */
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_pmic_wr_table = {
|
|
.yes_ranges = s2mpg11_pmic_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_pmic_registers),
|
|
.no_ranges = s2mpg11_pmic_ro_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg11_pmic_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_pmic_rd_table = {
|
|
.yes_ranges = s2mpg11_pmic_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_pmic_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_pmic_volatile_table = {
|
|
.no_ranges = s2mpg11_pmic_nonvolatile_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg11_pmic_nonvolatile_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_pmic_precious_table = {
|
|
.yes_ranges = s2mpg11_pmic_precious_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_pmic_precious_registers),
|
|
};
|
|
|
|
static const struct regmap_config s2mpg11_regmap_config_pmic = {
|
|
.name = "pmic",
|
|
.reg_bits = ACPM_ADDR_BITS,
|
|
.val_bits = 8,
|
|
.max_register = S2MPG11_PMIC_LDO_SENSE2,
|
|
.wr_table = &s2mpg11_pmic_wr_table,
|
|
.rd_table = &s2mpg11_pmic_rd_table,
|
|
.volatile_table = &s2mpg11_pmic_volatile_table,
|
|
.precious_table = &s2mpg11_pmic_precious_table,
|
|
.num_reg_defaults_raw = S2MPG11_PMIC_LDO_SENSE2 + 1,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_meter_registers[] = {
|
|
regmap_reg_range(0x00, 0x3e), /* Meter config */
|
|
regmap_reg_range(0x40, 0x8a), /* Meter data */
|
|
regmap_reg_range(0x8d, 0x9c), /* Meter data */
|
|
};
|
|
|
|
static const struct regmap_range s2mpg11_meter_ro_registers[] = {
|
|
regmap_reg_range(0x40, 0x9c), /* Meter data */
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_meter_wr_table = {
|
|
.yes_ranges = s2mpg11_meter_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_meter_registers),
|
|
.no_ranges = s2mpg11_meter_ro_registers,
|
|
.n_no_ranges = ARRAY_SIZE(s2mpg11_meter_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_meter_rd_table = {
|
|
.yes_ranges = s2mpg11_meter_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_meter_registers),
|
|
};
|
|
|
|
static const struct regmap_access_table s2mpg11_meter_volatile_table = {
|
|
.yes_ranges = s2mpg11_meter_ro_registers,
|
|
.n_yes_ranges = ARRAY_SIZE(s2mpg11_meter_ro_registers),
|
|
};
|
|
|
|
static const struct regmap_config s2mpg11_regmap_config_meter = {
|
|
.name = "meter",
|
|
.reg_bits = ACPM_ADDR_BITS,
|
|
.val_bits = 8,
|
|
.max_register = S2MPG11_METER_LPF_DATA_NTC7_2,
|
|
.wr_table = &s2mpg11_meter_wr_table,
|
|
.rd_table = &s2mpg11_meter_rd_table,
|
|
.volatile_table = &s2mpg11_meter_volatile_table,
|
|
.num_reg_defaults_raw = S2MPG11_METER_LPF_DATA_NTC7_2 + 1,
|
|
.cache_type = REGCACHE_FLAT,
|
|
};
|
|
|
|
struct sec_pmic_acpm_shared_bus_context {
|
|
struct acpm_handle *acpm;
|
|
unsigned int acpm_chan_id;
|
|
u8 speedy_channel;
|
|
};
|
|
|
|
enum sec_pmic_acpm_accesstype {
|
|
SEC_PMIC_ACPM_ACCESSTYPE_COMMON = 0x00,
|
|
SEC_PMIC_ACPM_ACCESSTYPE_PMIC = 0x01,
|
|
SEC_PMIC_ACPM_ACCESSTYPE_RTC = 0x02,
|
|
SEC_PMIC_ACPM_ACCESSTYPE_METER = 0x0a,
|
|
SEC_PMIC_ACPM_ACCESSTYPE_WLWP = 0x0b,
|
|
SEC_PMIC_ACPM_ACCESSTYPE_TRIM = 0x0f,
|
|
};
|
|
|
|
struct sec_pmic_acpm_bus_context {
|
|
struct sec_pmic_acpm_shared_bus_context *shared;
|
|
enum sec_pmic_acpm_accesstype type;
|
|
};
|
|
|
|
static int sec_pmic_acpm_bus_write(void *context, const void *data,
|
|
size_t count)
|
|
{
|
|
struct sec_pmic_acpm_bus_context *ctx = context;
|
|
struct acpm_handle *acpm = ctx->shared->acpm;
|
|
const struct acpm_pmic_ops *pmic_ops = &acpm->ops.pmic_ops;
|
|
size_t val_count = count - BITS_TO_BYTES(ACPM_ADDR_BITS);
|
|
const u8 *d = data;
|
|
const u8 *vals = &d[BITS_TO_BYTES(ACPM_ADDR_BITS)];
|
|
u8 reg;
|
|
|
|
if (val_count < 1 || val_count > ACPM_MAX_BULK_DATA)
|
|
return -EINVAL;
|
|
|
|
reg = d[0];
|
|
|
|
return pmic_ops->bulk_write(acpm, ctx->shared->acpm_chan_id, ctx->type, reg,
|
|
ctx->shared->speedy_channel, val_count, vals);
|
|
}
|
|
|
|
static int sec_pmic_acpm_bus_read(void *context, const void *reg_buf, size_t reg_size,
|
|
void *val_buf, size_t val_size)
|
|
{
|
|
struct sec_pmic_acpm_bus_context *ctx = context;
|
|
struct acpm_handle *acpm = ctx->shared->acpm;
|
|
const struct acpm_pmic_ops *pmic_ops = &acpm->ops.pmic_ops;
|
|
const u8 *r = reg_buf;
|
|
u8 reg;
|
|
|
|
if (reg_size != BITS_TO_BYTES(ACPM_ADDR_BITS) || !val_size ||
|
|
val_size > ACPM_MAX_BULK_DATA)
|
|
return -EINVAL;
|
|
|
|
reg = r[0];
|
|
|
|
return pmic_ops->bulk_read(acpm, ctx->shared->acpm_chan_id, ctx->type, reg,
|
|
ctx->shared->speedy_channel, val_size, val_buf);
|
|
}
|
|
|
|
static int sec_pmic_acpm_bus_reg_update_bits(void *context, unsigned int reg, unsigned int mask,
|
|
unsigned int val)
|
|
{
|
|
struct sec_pmic_acpm_bus_context *ctx = context;
|
|
struct acpm_handle *acpm = ctx->shared->acpm;
|
|
const struct acpm_pmic_ops *pmic_ops = &acpm->ops.pmic_ops;
|
|
|
|
return pmic_ops->update_reg(acpm, ctx->shared->acpm_chan_id, ctx->type, reg & 0xff,
|
|
ctx->shared->speedy_channel, val, mask);
|
|
}
|
|
|
|
static const struct regmap_bus sec_pmic_acpm_regmap_bus = {
|
|
.write = sec_pmic_acpm_bus_write,
|
|
.read = sec_pmic_acpm_bus_read,
|
|
.reg_update_bits = sec_pmic_acpm_bus_reg_update_bits,
|
|
.max_raw_read = ACPM_MAX_BULK_DATA,
|
|
.max_raw_write = ACPM_MAX_BULK_DATA,
|
|
};
|
|
|
|
static struct regmap *sec_pmic_acpm_regmap_init(struct device *dev,
|
|
struct sec_pmic_acpm_shared_bus_context *shared_ctx,
|
|
enum sec_pmic_acpm_accesstype type,
|
|
const struct regmap_config *cfg, bool do_attach)
|
|
{
|
|
struct sec_pmic_acpm_bus_context *ctx;
|
|
struct regmap *regmap;
|
|
|
|
ctx = devm_kzalloc(dev, sizeof(*ctx), GFP_KERNEL);
|
|
if (!ctx)
|
|
return ERR_PTR(-ENOMEM);
|
|
|
|
ctx->shared = shared_ctx;
|
|
ctx->type = type;
|
|
|
|
regmap = devm_regmap_init(dev, &sec_pmic_acpm_regmap_bus, ctx, cfg);
|
|
if (IS_ERR(regmap))
|
|
return dev_err_cast_probe(dev, regmap, "regmap init (%s) failed\n", cfg->name);
|
|
|
|
if (do_attach) {
|
|
int ret;
|
|
|
|
ret = regmap_attach_dev(dev, regmap, cfg);
|
|
if (ret)
|
|
return dev_err_ptr_probe(dev, ret, "regmap attach (%s) failed\n",
|
|
cfg->name);
|
|
}
|
|
|
|
return regmap;
|
|
}
|
|
|
|
static int sec_pmic_acpm_probe(struct platform_device *pdev)
|
|
{
|
|
struct regmap *regmap_common, *regmap_pmic, *regmap;
|
|
const struct sec_pmic_acpm_platform_data *pdata;
|
|
struct sec_pmic_acpm_shared_bus_context *shared_ctx;
|
|
struct acpm_handle *acpm;
|
|
struct device *dev = &pdev->dev;
|
|
int ret, irq;
|
|
|
|
pdata = device_get_match_data(dev);
|
|
if (!pdata)
|
|
return dev_err_probe(dev, -ENODEV, "unsupported device type\n");
|
|
|
|
acpm = devm_acpm_get_by_node(dev, dev->parent->of_node);
|
|
if (IS_ERR(acpm))
|
|
return dev_err_probe(dev, PTR_ERR(acpm), "failed to get acpm\n");
|
|
|
|
irq = platform_get_irq(pdev, 0);
|
|
if (irq < 0)
|
|
return irq;
|
|
|
|
shared_ctx = devm_kzalloc(dev, sizeof(*shared_ctx), GFP_KERNEL);
|
|
if (!shared_ctx)
|
|
return -ENOMEM;
|
|
|
|
shared_ctx->acpm = acpm;
|
|
shared_ctx->acpm_chan_id = pdata->acpm_chan_id;
|
|
shared_ctx->speedy_channel = pdata->speedy_channel;
|
|
|
|
regmap_common = sec_pmic_acpm_regmap_init(dev, shared_ctx, SEC_PMIC_ACPM_ACCESSTYPE_COMMON,
|
|
pdata->regmap_cfg_common, true);
|
|
if (IS_ERR(regmap_common))
|
|
return PTR_ERR(regmap_common);
|
|
|
|
regmap_pmic = sec_pmic_acpm_regmap_init(dev, shared_ctx, SEC_PMIC_ACPM_ACCESSTYPE_PMIC,
|
|
pdata->regmap_cfg_pmic, false);
|
|
if (IS_ERR(regmap_pmic))
|
|
return PTR_ERR(regmap_pmic);
|
|
|
|
if (pdata->regmap_cfg_rtc) {
|
|
regmap = sec_pmic_acpm_regmap_init(dev, shared_ctx, SEC_PMIC_ACPM_ACCESSTYPE_RTC,
|
|
pdata->regmap_cfg_rtc, true);
|
|
if (IS_ERR(regmap))
|
|
return PTR_ERR(regmap);
|
|
}
|
|
|
|
regmap = sec_pmic_acpm_regmap_init(dev, shared_ctx, SEC_PMIC_ACPM_ACCESSTYPE_METER,
|
|
pdata->regmap_cfg_meter, true);
|
|
if (IS_ERR(regmap))
|
|
return PTR_ERR(regmap);
|
|
|
|
ret = sec_pmic_probe(dev, pdata->device_type, irq, regmap_pmic, NULL);
|
|
if (ret)
|
|
return ret;
|
|
|
|
if (device_property_read_bool(dev, "wakeup-source"))
|
|
devm_device_init_wakeup(dev);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void sec_pmic_acpm_shutdown(struct platform_device *pdev)
|
|
{
|
|
sec_pmic_shutdown(&pdev->dev);
|
|
}
|
|
|
|
static const struct sec_pmic_acpm_platform_data s2mpg10_data = {
|
|
.device_type = S2MPG10,
|
|
.acpm_chan_id = 2,
|
|
.speedy_channel = 0,
|
|
.regmap_cfg_common = &s2mpg10_regmap_config_common,
|
|
.regmap_cfg_pmic = &s2mpg10_regmap_config_pmic,
|
|
.regmap_cfg_rtc = &s2mpg10_regmap_config_rtc,
|
|
.regmap_cfg_meter = &s2mpg10_regmap_config_meter,
|
|
};
|
|
|
|
static const struct sec_pmic_acpm_platform_data s2mpg11_data = {
|
|
.device_type = S2MPG11,
|
|
.acpm_chan_id = 2,
|
|
.speedy_channel = 1,
|
|
.regmap_cfg_common = &s2mpg11_regmap_config_common,
|
|
.regmap_cfg_pmic = &s2mpg11_regmap_config_pmic,
|
|
.regmap_cfg_meter = &s2mpg11_regmap_config_meter,
|
|
};
|
|
|
|
static const struct of_device_id sec_pmic_acpm_of_match[] = {
|
|
{ .compatible = "samsung,s2mpg10-pmic", .data = &s2mpg10_data, },
|
|
{ .compatible = "samsung,s2mpg11-pmic", .data = &s2mpg11_data, },
|
|
{ },
|
|
};
|
|
MODULE_DEVICE_TABLE(of, sec_pmic_acpm_of_match);
|
|
|
|
static struct platform_driver sec_pmic_acpm_driver = {
|
|
.driver = {
|
|
.name = "sec-pmic-acpm",
|
|
.probe_type = PROBE_PREFER_ASYNCHRONOUS,
|
|
.pm = pm_sleep_ptr(&sec_pmic_pm_ops),
|
|
.of_match_table = sec_pmic_acpm_of_match,
|
|
},
|
|
.probe = sec_pmic_acpm_probe,
|
|
.shutdown = sec_pmic_acpm_shutdown,
|
|
};
|
|
module_platform_driver(sec_pmic_acpm_driver);
|
|
|
|
MODULE_AUTHOR("André Draszik <andre.draszik@linaro.org>");
|
|
MODULE_DESCRIPTION("ACPM driver for the Samsung S2MPG1x");
|
|
MODULE_LICENSE("GPL");
|