cregit-Linux how code gets into the kernel

Release 4.11 drivers/video/backlight/pm8941-wled.c

/* Copyright (c) 2015, Sony Mobile Communications, AB.
 *
 * 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.
 */

#include <linux/kernel.h>
#include <linux/backlight.h>
#include <linux/module.h>
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/regmap.h>

/* From DT binding */

#define PM8941_WLED_DEFAULT_BRIGHTNESS		2048


#define PM8941_WLED_REG_VAL_BASE		0x40

#define  PM8941_WLED_REG_VAL_MAX		0xFFF


#define PM8941_WLED_REG_MOD_EN			0x46

#define  PM8941_WLED_REG_MOD_EN_BIT		BIT(7)

#define  PM8941_WLED_REG_MOD_EN_MASK		BIT(7)


#define PM8941_WLED_REG_SYNC			0x47

#define  PM8941_WLED_REG_SYNC_MASK		0x07

#define  PM8941_WLED_REG_SYNC_LED1		BIT(0)

#define  PM8941_WLED_REG_SYNC_LED2		BIT(1)

#define  PM8941_WLED_REG_SYNC_LED3		BIT(2)

#define  PM8941_WLED_REG_SYNC_ALL		0x07

#define  PM8941_WLED_REG_SYNC_CLEAR		0x00


#define PM8941_WLED_REG_FREQ			0x4c

#define  PM8941_WLED_REG_FREQ_MASK		0x0f


#define PM8941_WLED_REG_OVP			0x4d

#define  PM8941_WLED_REG_OVP_MASK		0x03


#define PM8941_WLED_REG_BOOST			0x4e

#define  PM8941_WLED_REG_BOOST_MASK		0x07


#define PM8941_WLED_REG_SINK			0x4f

#define  PM8941_WLED_REG_SINK_MASK		0xe0

#define  PM8941_WLED_REG_SINK_SHFT		0x05

/* Per-'string' registers below */

#define PM8941_WLED_REG_STR_OFFSET		0x10


#define PM8941_WLED_REG_STR_MOD_EN_BASE		0x60

#define  PM8941_WLED_REG_STR_MOD_MASK		BIT(7)

#define  PM8941_WLED_REG_STR_MOD_EN		BIT(7)


#define PM8941_WLED_REG_STR_SCALE_BASE		0x62

#define  PM8941_WLED_REG_STR_SCALE_MASK		0x1f


#define PM8941_WLED_REG_STR_MOD_SRC_BASE	0x63

#define  PM8941_WLED_REG_STR_MOD_SRC_MASK	0x01

#define  PM8941_WLED_REG_STR_MOD_SRC_INT	0x00

#define  PM8941_WLED_REG_STR_MOD_SRC_EXT	0x01


#define PM8941_WLED_REG_STR_CABC_BASE		0x66

#define  PM8941_WLED_REG_STR_CABC_MASK		BIT(7)

#define  PM8941_WLED_REG_STR_CABC_EN		BIT(7)


struct pm8941_wled_config {
	
u32 i_boost_limit;
	
u32 ovp;
	
u32 switch_freq;
	
u32 num_strings;
	
u32 i_limit;
	
bool cs_out_en;
	
bool ext_gen;
	
bool cabc_en;
};


struct pm8941_wled {
	
const char *name;
	
struct regmap *regmap;
	
u16 addr;

	
struct pm8941_wled_config cfg;
};


static int pm8941_wled_update_status(struct backlight_device *bl) { struct pm8941_wled *wled = bl_get_data(bl); u16 val = bl->props.brightness; u8 ctrl = 0; int rc; int i; if (bl->props.power != FB_BLANK_UNBLANK || bl->props.fb_blank != FB_BLANK_UNBLANK || bl->props.state & BL_CORE_FBBLANK) val = 0; if (val != 0) ctrl = PM8941_WLED_REG_MOD_EN_BIT; rc = regmap_update_bits(wled->regmap, wled->addr + PM8941_WLED_REG_MOD_EN, PM8941_WLED_REG_MOD_EN_MASK, ctrl); if (rc) return rc; for (i = 0; i < wled->cfg.num_strings; ++i) { u8 v[2] = { val & 0xff, (val >> 8) & 0xf }; rc = regmap_bulk_write(wled->regmap, wled->addr + PM8941_WLED_REG_VAL_BASE + 2 * i, v, 2); if (rc) return rc; } rc = regmap_update_bits(wled->regmap, wled->addr + PM8941_WLED_REG_SYNC, PM8941_WLED_REG_SYNC_MASK, PM8941_WLED_REG_SYNC_ALL); if (rc) return rc; rc = regmap_update_bits(wled->regmap, wled->addr + PM8941_WLED_REG_SYNC, PM8941_WLED_REG_SYNC_MASK, PM8941_WLED_REG_SYNC_CLEAR); return rc; }

Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin17879.46%150.00%
Björn Andersson4620.54%150.00%
Total224100.00%2100.00%


static int pm8941_wled_setup(struct pm8941_wled *wled) { int rc; int i; rc = regmap_update_bits(wled->regmap, wled->addr + PM8941_WLED_REG_OVP, PM8941_WLED_REG_OVP_MASK, wled->cfg.ovp); if (rc) return rc; rc = regmap_update_bits(wled->regmap, wled->addr + PM8941_WLED_REG_BOOST, PM8941_WLED_REG_BOOST_MASK, wled->cfg.i_boost_limit); if (rc) return rc; rc = regmap_update_bits(wled->regmap, wled->addr + PM8941_WLED_REG_FREQ, PM8941_WLED_REG_FREQ_MASK, wled->cfg.switch_freq); if (rc) return rc; if (wled->cfg.cs_out_en) { u8 all = (BIT(wled->cfg.num_strings) - 1) << PM8941_WLED_REG_SINK_SHFT; rc = regmap_update_bits(wled->regmap, wled->addr + PM8941_WLED_REG_SINK, PM8941_WLED_REG_SINK_MASK, all); if (rc) return rc; } for (i = 0; i < wled->cfg.num_strings; ++i) { u16 addr = wled->addr + PM8941_WLED_REG_STR_OFFSET * i; rc = regmap_update_bits(wled->regmap, addr + PM8941_WLED_REG_STR_MOD_EN_BASE, PM8941_WLED_REG_STR_MOD_MASK, PM8941_WLED_REG_STR_MOD_EN); if (rc) return rc; if (wled->cfg.ext_gen) { rc = regmap_update_bits(wled->regmap, addr + PM8941_WLED_REG_STR_MOD_SRC_BASE, PM8941_WLED_REG_STR_MOD_SRC_MASK, PM8941_WLED_REG_STR_MOD_SRC_EXT); if (rc) return rc; } rc = regmap_update_bits(wled->regmap, addr + PM8941_WLED_REG_STR_SCALE_BASE, PM8941_WLED_REG_STR_SCALE_MASK, wled->cfg.i_limit); if (rc) return rc; rc = regmap_update_bits(wled->regmap, addr + PM8941_WLED_REG_STR_CABC_BASE, PM8941_WLED_REG_STR_CABC_MASK, wled->cfg.cabc_en ? PM8941_WLED_REG_STR_CABC_EN : 0); if (rc) return rc; } return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin312100.00%1100.00%
Total312100.00%1100.00%

static const struct pm8941_wled_config pm8941_wled_config_defaults = { .i_boost_limit = 3, .i_limit = 20, .ovp = 2, .switch_freq = 5, .num_strings = 0, .cs_out_en = false, .ext_gen = false, .cabc_en = false, }; struct pm8941_wled_var_cfg { const u32 *values; u32 (*fn)(u32); int size; }; static const u32 pm8941_wled_i_boost_limit_values[] = { 105, 385, 525, 805, 980, 1260, 1400, 1680, }; static const struct pm8941_wled_var_cfg pm8941_wled_i_boost_limit_cfg = { .values = pm8941_wled_i_boost_limit_values, .size = ARRAY_SIZE(pm8941_wled_i_boost_limit_values), }; static const u32 pm8941_wled_ovp_values[] = { 35, 32, 29, 27, }; static const struct pm8941_wled_var_cfg pm8941_wled_ovp_cfg = { .values = pm8941_wled_ovp_values, .size = ARRAY_SIZE(pm8941_wled_ovp_values), };
static u32 pm8941_wled_num_strings_values_fn(u32 idx) { return idx + 1; }

Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin14100.00%1100.00%
Total14100.00%1100.00%

static const struct pm8941_wled_var_cfg pm8941_wled_num_strings_cfg = { .fn = pm8941_wled_num_strings_values_fn, .size = 3, };
static u32 pm8941_wled_switch_freq_values_fn(u32 idx) { return 19200 / (2 * (1 + idx)); }

Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin22100.00%1100.00%
Total22100.00%1100.00%

static const struct pm8941_wled_var_cfg pm8941_wled_switch_freq_cfg = { .fn = pm8941_wled_switch_freq_values_fn, .size = 16, }; static const struct pm8941_wled_var_cfg pm8941_wled_i_limit_cfg = { .size = 26, };
static u32 pm8941_wled_values(const struct pm8941_wled_var_cfg *cfg, u32 idx) { if (idx >= cfg->size) return UINT_MAX; if (cfg->fn) return cfg->fn(idx); if (cfg->values) return cfg->values[idx]; return idx; }

Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin57100.00%1100.00%
Total57100.00%1100.00%


static int pm8941_wled_configure(struct pm8941_wled *wled, struct device *dev) { struct pm8941_wled_config *cfg = &wled->cfg; u32 val; int rc; u32 c; int i; int j; const struct { const char *name; u32 *val_ptr; const struct pm8941_wled_var_cfg *cfg; } u32_opts[] = { { "qcom,current-boost-limit", &cfg->i_boost_limit, .cfg = &pm8941_wled_i_boost_limit_cfg, }, { "qcom,current-limit", &cfg->i_limit, .cfg = &pm8941_wled_i_limit_cfg, }, { "qcom,ovp", &cfg->ovp, .cfg = &pm8941_wled_ovp_cfg, }, { "qcom,switching-freq", &cfg->switch_freq, .cfg = &pm8941_wled_switch_freq_cfg, }, { "qcom,num-strings", &cfg->num_strings, .cfg = &pm8941_wled_num_strings_cfg, }, }; const struct { const char *name; bool *val_ptr; } bool_opts[] = { { "qcom,cs-out", &cfg->cs_out_en, }, { "qcom,ext-gen", &cfg->ext_gen, }, { "qcom,cabc", &cfg->cabc_en, }, }; rc = of_property_read_u32(dev->of_node, "reg", &val); if (rc || val > 0xffff) { dev_err(dev, "invalid IO resources\n"); return rc ? rc : -EINVAL; } wled->addr = val; rc = of_property_read_string(dev->of_node, "label", &wled->name); if (rc) wled->name = dev->of_node->name; *cfg = pm8941_wled_config_defaults; for (i = 0; i < ARRAY_SIZE(u32_opts); ++i) { rc = of_property_read_u32(dev->of_node, u32_opts[i].name, &val); if (rc == -EINVAL) { continue; } else if (rc) { dev_err(dev, "error reading '%s'\n", u32_opts[i].name); return rc; } c = UINT_MAX; for (j = 0; c != val; j++) { c = pm8941_wled_values(u32_opts[i].cfg, j); if (c == UINT_MAX) { dev_err(dev, "invalid value for '%s'\n", u32_opts[i].name); return -EINVAL; } } dev_dbg(dev, "'%s' = %u\n", u32_opts[i].name, c); *u32_opts[i].val_ptr = j; } for (i = 0; i < ARRAY_SIZE(bool_opts); ++i) { if (of_property_read_bool(dev->of_node, bool_opts[i].name)) *bool_opts[i].val_ptr = true; } cfg->num_strings = cfg->num_strings + 1; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin478100.00%1100.00%
Total478100.00%1100.00%

static const struct backlight_ops pm8941_wled_ops = { .update_status = pm8941_wled_update_status, };
static int pm8941_wled_probe(struct platform_device *pdev) { struct backlight_properties props; struct backlight_device *bl; struct pm8941_wled *wled; struct regmap *regmap; u32 val; int rc; regmap = dev_get_regmap(pdev->dev.parent, NULL); if (!regmap) { dev_err(&pdev->dev, "Unable to get regmap\n"); return -EINVAL; } wled = devm_kzalloc(&pdev->dev, sizeof(*wled), GFP_KERNEL); if (!wled) return -ENOMEM; wled->regmap = regmap; rc = pm8941_wled_configure(wled, &pdev->dev); if (rc) return rc; rc = pm8941_wled_setup(wled); if (rc) return rc; val = PM8941_WLED_DEFAULT_BRIGHTNESS; of_property_read_u32(pdev->dev.of_node, "default-brightness", &val); memset(&props, 0, sizeof(struct backlight_properties)); props.type = BACKLIGHT_RAW; props.brightness = val; props.max_brightness = PM8941_WLED_REG_VAL_MAX; bl = devm_backlight_device_register(&pdev->dev, wled->name, &pdev->dev, wled, &pm8941_wled_ops, &props); return PTR_ERR_OR_ZERO(bl); }

Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin14164.38%125.00%
Björn Andersson7735.16%250.00%
Fengguang Wu10.46%125.00%
Total219100.00%4100.00%

; static const struct of_device_id pm8941_wled_match_table[] = { { .compatible = "qcom,pm8941-wled" }, {} }; MODULE_DEVICE_TABLE(of, pm8941_wled_match_table); static struct platform_driver pm8941_wled_driver = { .probe = pm8941_wled_probe, .driver = { .name = "pm8941-wled", .of_match_table = pm8941_wled_match_table, }, }; module_platform_driver(pm8941_wled_driver); MODULE_DESCRIPTION("pm8941 wled driver"); MODULE_LICENSE("GPL v2");

Overall Contributors

PersonTokensPropCommitsCommitProp
Courtney Cavin167291.87%125.00%
Björn Andersson1478.08%250.00%
Fengguang Wu10.05%125.00%
Total1820100.00%4100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with cregit.