Quellcodebibliothek Statistik Leitseite products/Sources/formale Sprachen/C/Linux/drivers/leds/   (Open Source Betriebssystem Version 6.17.9©)  Datei vom 24.10.2025 mit Größe 17 kB image not shown  

Quelle  leds-is31fl319x.c   Sprache: C

 
// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright 2015-16 Golden Delicious Computers
 *
 * Author: Nikolaus Schaller <hns@goldelico.com>
 *
 * LED driver for the IS31FL319{0,1,3,6,9} to drive 1, 3, 6 or 9 light
 * effect LEDs.
 */


#include <linux/err.h>
#include <linux/i2c.h>
#include <linux/leds.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>
#include <linux/property.h>
#include <linux/regmap.h>
#include <linux/slab.h>
#include <linux/delay.h>
#include <linux/gpio/consumer.h>

/* register numbers */
#define IS31FL319X_SHUTDOWN  0x00

/* registers for 3190, 3191 and 3193 */
#define IS31FL3190_BREATHING  0x01
#define IS31FL3190_LEDMODE  0x02
#define IS31FL3190_CURRENT  0x03
#define IS31FL3190_PWM(channel)  (0x04 + channel)
#define IS31FL3190_DATA_UPDATE  0x07
#define IS31FL3190_T0(channel)  (0x0a + channel)
#define IS31FL3190_T1T2(channel) (0x10 + channel)
#define IS31FL3190_T3T4(channel) (0x16 + channel)
#define IS31FL3190_TIME_UPDATE  0x1c
#define IS31FL3190_LEDCONTROL  0x1d
#define IS31FL3190_RESET  0x2f

#define IS31FL3190_CURRENT_uA_MIN 5000
#define IS31FL3190_CURRENT_uA_DEFAULT 42000
#define IS31FL3190_CURRENT_uA_MAX 42000
#define IS31FL3190_CURRENT_SHIFT 2
#define IS31FL3190_CURRENT_MASK  GENMASK(4, 2)
#define IS31FL3190_CURRENT_5_mA  0x02
#define IS31FL3190_CURRENT_10_mA 0x01
#define IS31FL3190_CURRENT_17dot5_mA 0x04
#define IS31FL3190_CURRENT_30_mA 0x03
#define IS31FL3190_CURRENT_42_mA 0x00

/* registers for 3196 and 3199 */
#define IS31FL3196_CTRL1  0x01
#define IS31FL3196_CTRL2  0x02
#define IS31FL3196_CONFIG1  0x03
#define IS31FL3196_CONFIG2  0x04
#define IS31FL3196_RAMP_MODE  0x05
#define IS31FL3196_BREATH_MARK  0x06
#define IS31FL3196_PWM(channel)  (0x07 + channel)
#define IS31FL3196_DATA_UPDATE  0x10
#define IS31FL3196_T0(channel)  (0x11 + channel)
#define IS31FL3196_T123_1  0x1a
#define IS31FL3196_T123_2  0x1b
#define IS31FL3196_T123_3  0x1c
#define IS31FL3196_T4(channel)  (0x1d + channel)
#define IS31FL3196_TIME_UPDATE  0x26
#define IS31FL3196_RESET  0xff

#define IS31FL3196_REG_CNT  (IS31FL3196_RESET + 1)

#define IS31FL319X_MAX_LEDS  9

/* CS (Current Setting) in CONFIG2 register */
#define IS31FL3196_CONFIG2_CS_SHIFT 4
#define IS31FL3196_CONFIG2_CS_MASK GENMASK(2, 0)
#define IS31FL3196_CONFIG2_CS_STEP_REF 12

#define IS31FL3196_CURRENT_uA_MIN 5000
#define IS31FL3196_CURRENT_uA_MAX 40000
#define IS31FL3196_CURRENT_uA_STEP 5000
#define IS31FL3196_CURRENT_uA_DEFAULT 20000

/* Audio gain in CONFIG2 register */
#define IS31FL3196_AUDIO_GAIN_DB_MAX ((u32)21)
#define IS31FL3196_AUDIO_GAIN_DB_STEP 3

/*
 * regmap is used as a cache of chip's register space,
 * to avoid reading back brightness values from chip,
 * which is known to hang.
 */

struct is31fl319x_chip {
 const struct is31fl319x_chipdef *cdef;
 struct i2c_client               *client;
 struct gpio_desc  *shutdown_gpio;
 struct regmap                   *regmap;
 struct mutex                    lock;
 u32                             audio_gain_db;

 struct is31fl319x_led {
  struct is31fl319x_chip  *chip;
  struct led_classdev     cdev;
  u32                     max_microamp;
  bool                    configured;
 } leds[IS31FL319X_MAX_LEDS];
};

struct is31fl319x_chipdef {
 int num_leds;
 u8 reset_reg;
 const struct regmap_config *is31fl319x_regmap_config;
 int (*brightness_set)(struct led_classdev *cdev, enum led_brightness brightness);
 u32 current_default;
 u32 current_min;
 u32 current_max;
 bool is_3196or3199;
};

static bool is31fl319x_readable_reg(struct device *dev, unsigned int reg)
{
 /* we have no readable registers */
 return false;
}

static bool is31fl3190_volatile_reg(struct device *dev, unsigned int reg)
{
 /* volatile registers are not cached */
 switch (reg) {
 case IS31FL3190_DATA_UPDATE:
 case IS31FL3190_TIME_UPDATE:
 case IS31FL3190_RESET:
  return true/* always write-through */
 default:
  return false;
 }
}

static const struct reg_default is31fl3190_reg_defaults[] = {
 { IS31FL3190_LEDMODE, 0x00 },
 { IS31FL3190_CURRENT, 0x00 },
 { IS31FL3190_PWM(0), 0x00 },
 { IS31FL3190_PWM(1), 0x00 },
 { IS31FL3190_PWM(2), 0x00 },
};

static const struct regmap_config is31fl3190_regmap_config = {
 .reg_bits = 8,
 .val_bits = 8,
 .max_register = IS31FL3190_RESET,
 .cache_type = REGCACHE_FLAT,
 .readable_reg = is31fl319x_readable_reg,
 .volatile_reg = is31fl3190_volatile_reg,
 .reg_defaults = is31fl3190_reg_defaults,
 .num_reg_defaults = ARRAY_SIZE(is31fl3190_reg_defaults),
};

static bool is31fl3196_volatile_reg(struct device *dev, unsigned int reg)
{
 /* volatile registers are not cached */
 switch (reg) {
 case IS31FL3196_DATA_UPDATE:
 case IS31FL3196_TIME_UPDATE:
 case IS31FL3196_RESET:
  return true/* always write-through */
 default:
  return false;
 }
}

static const struct reg_default is31fl3196_reg_defaults[] = {
 { IS31FL3196_CONFIG1, 0x00 },
 { IS31FL3196_CONFIG2, 0x00 },
 { IS31FL3196_PWM(0), 0x00 },
 { IS31FL3196_PWM(1), 0x00 },
 { IS31FL3196_PWM(2), 0x00 },
 { IS31FL3196_PWM(3), 0x00 },
 { IS31FL3196_PWM(4), 0x00 },
 { IS31FL3196_PWM(5), 0x00 },
 { IS31FL3196_PWM(6), 0x00 },
 { IS31FL3196_PWM(7), 0x00 },
 { IS31FL3196_PWM(8), 0x00 },
};

static const struct regmap_config is31fl3196_regmap_config = {
 .reg_bits = 8,
 .val_bits = 8,
 .max_register = IS31FL3196_REG_CNT,
 .cache_type = REGCACHE_FLAT,
 .readable_reg = is31fl319x_readable_reg,
 .volatile_reg = is31fl3196_volatile_reg,
 .reg_defaults = is31fl3196_reg_defaults,
 .num_reg_defaults = ARRAY_SIZE(is31fl3196_reg_defaults),
};

static int is31fl3190_brightness_set(struct led_classdev *cdev,
         enum led_brightness brightness)
{
 struct is31fl319x_led *led = container_of(cdev, struct is31fl319x_led, cdev);
 struct is31fl319x_chip *is31 = led->chip;
 int chan = led - is31->leds;
 int ret;
 int i;
 u8 ctrl = 0;

 dev_dbg(&is31->client->dev, "channel %d: %d\n", chan, brightness);

 mutex_lock(&is31->lock);

 /* update PWM register */
 ret = regmap_write(is31->regmap, IS31FL3190_PWM(chan), brightness);
 if (ret < 0)
  goto out;

 /* read current brightness of all PWM channels */
 for (i = 0; i < is31->cdef->num_leds; i++) {
  unsigned int pwm_value;
  bool on;

  /*
 * since neither cdev nor the chip can provide
 * the current setting, we read from the regmap cache
 */


  ret = regmap_read(is31->regmap, IS31FL3190_PWM(i), &pwm_value);
  on = ret >= 0 && pwm_value > LED_OFF;

  ctrl |= on << i;
 }

 if (ctrl > 0) {
  dev_dbg(&is31->client->dev, "power up %02x\n", ctrl);
  regmap_write(is31->regmap, IS31FL3190_LEDCONTROL, ctrl);
  /* update PWMs */
  regmap_write(is31->regmap, IS31FL3190_DATA_UPDATE, 0x00);
  /* enable chip from shut down and enable all channels */
  ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x20);
 } else {
  dev_dbg(&is31->client->dev, "power down\n");
  /* shut down (no need to clear LEDCONTROL) */
  ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x01);
 }

out:
 mutex_unlock(&is31->lock);

 return ret;
}

static int is31fl3196_brightness_set(struct led_classdev *cdev,
         enum led_brightness brightness)
{
 struct is31fl319x_led *led = container_of(cdev, struct is31fl319x_led, cdev);
 struct is31fl319x_chip *is31 = led->chip;
 int chan = led - is31->leds;
 int ret;
 int i;
 u8 ctrl1 = 0, ctrl2 = 0;

 dev_dbg(&is31->client->dev, "channel %d: %d\n", chan, brightness);

 mutex_lock(&is31->lock);

 /* update PWM register */
 ret = regmap_write(is31->regmap, IS31FL3196_PWM(chan), brightness);
 if (ret < 0)
  goto out;

 /* read current brightness of all PWM channels */
 for (i = 0; i < is31->cdef->num_leds; i++) {
  unsigned int pwm_value;
  bool on;

  /*
 * since neither cdev nor the chip can provide
 * the current setting, we read from the regmap cache
 */


  ret = regmap_read(is31->regmap, IS31FL3196_PWM(i), &pwm_value);
  on = ret >= 0 && pwm_value > LED_OFF;

  if (i < 3)
   ctrl1 |= on << i;       /* 0..2 => bit 0..2 */
  else if (i < 6)
   ctrl1 |= on << (i + 1); /* 3..5 => bit 4..6 */
  else
   ctrl2 |= on << (i - 6); /* 6..8 => bit 0..2 */
 }

 if (ctrl1 > 0 || ctrl2 > 0) {
  dev_dbg(&is31->client->dev, "power up %02x %02x\n",
   ctrl1, ctrl2);
  regmap_write(is31->regmap, IS31FL3196_CTRL1, ctrl1);
  regmap_write(is31->regmap, IS31FL3196_CTRL2, ctrl2);
  /* update PWMs */
  regmap_write(is31->regmap, IS31FL3196_DATA_UPDATE, 0x00);
  /* enable chip from shut down */
  ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x01);
 } else {
  dev_dbg(&is31->client->dev, "power down\n");
  /* shut down (no need to clear CTRL1/2) */
  ret = regmap_write(is31->regmap, IS31FL319X_SHUTDOWN, 0x00);
 }

out:
 mutex_unlock(&is31->lock);

 return ret;
}

static const struct is31fl319x_chipdef is31fl3190_cdef = {
 .num_leds = 1,
 .reset_reg = IS31FL3190_RESET,
 .is31fl319x_regmap_config = &is31fl3190_regmap_config,
 .brightness_set = is31fl3190_brightness_set,
 .current_default = IS31FL3190_CURRENT_uA_DEFAULT,
 .current_min = IS31FL3190_CURRENT_uA_MIN,
 .current_max = IS31FL3190_CURRENT_uA_MAX,
 .is_3196or3199 = false,
};

static const struct is31fl319x_chipdef is31fl3193_cdef = {
 .num_leds = 3,
 .reset_reg = IS31FL3190_RESET,
 .is31fl319x_regmap_config = &is31fl3190_regmap_config,
 .brightness_set = is31fl3190_brightness_set,
 .current_default = IS31FL3190_CURRENT_uA_DEFAULT,
 .current_min = IS31FL3190_CURRENT_uA_MIN,
 .current_max = IS31FL3190_CURRENT_uA_MAX,
 .is_3196or3199 = false,
};

static const struct is31fl319x_chipdef is31fl3196_cdef = {
 .num_leds = 6,
 .reset_reg = IS31FL3196_RESET,
 .is31fl319x_regmap_config = &is31fl3196_regmap_config,
 .brightness_set = is31fl3196_brightness_set,
 .current_default = IS31FL3196_CURRENT_uA_DEFAULT,
 .current_min = IS31FL3196_CURRENT_uA_MIN,
 .current_max = IS31FL3196_CURRENT_uA_MAX,
 .is_3196or3199 = true,
};

static const struct is31fl319x_chipdef is31fl3199_cdef = {
 .num_leds = 9,
 .reset_reg = IS31FL3196_RESET,
 .is31fl319x_regmap_config = &is31fl3196_regmap_config,
 .brightness_set = is31fl3196_brightness_set,
 .current_default = IS31FL3196_CURRENT_uA_DEFAULT,
 .current_min = IS31FL3196_CURRENT_uA_MIN,
 .current_max = IS31FL3196_CURRENT_uA_MAX,
 .is_3196or3199 = true,
};

static const struct of_device_id of_is31fl319x_match[] = {
 { .compatible = "issi,is31fl3190", .data = &is31fl3190_cdef, },
 { .compatible = "issi,is31fl3191", .data = &is31fl3190_cdef, },
 { .compatible = "issi,is31fl3193", .data = &is31fl3193_cdef, },
 { .compatible = "issi,is31fl3196", .data = &is31fl3196_cdef, },
 { .compatible = "issi,is31fl3199", .data = &is31fl3199_cdef, },
 { .compatible = "si-en,sn3190",    .data = &is31fl3190_cdef, },
 { .compatible = "si-en,sn3191",    .data = &is31fl3190_cdef, },
 { .compatible = "si-en,sn3193",    .data = &is31fl3193_cdef, },
 { .compatible = "si-en,sn3196",    .data = &is31fl3196_cdef, },
 { .compatible = "si-en,sn3199",    .data = &is31fl3199_cdef, },
 { }
};
MODULE_DEVICE_TABLE(of, of_is31fl319x_match);

static int is31fl319x_parse_child_fw(const struct device *dev,
         const struct fwnode_handle *child,
         struct is31fl319x_led *led,
         struct is31fl319x_chip *is31)
{
 struct led_classdev *cdev = &led->cdev;
 int ret;

 if (fwnode_property_read_string(child, "label", &cdev->name))
  cdev->name = fwnode_get_name(child);

 ret = fwnode_property_read_string(child, "linux,default-trigger", &cdev->default_trigger);
 if (ret < 0 && ret != -EINVAL) /* is optional */
  return ret;

 led->max_microamp = is31->cdef->current_default;
 ret = fwnode_property_read_u32(child, "led-max-microamp", &led->max_microamp);
 if (!ret) {
  if (led->max_microamp < is31->cdef->current_min)
   return -EINVAL; /* not supported */
  led->max_microamp = min(led->max_microamp,
     is31->cdef->current_max);
 }

 return 0;
}

static int is31fl319x_parse_fw(struct device *dev, struct is31fl319x_chip *is31)
{
 struct fwnode_handle *fwnode = dev_fwnode(dev);
 int count;
 int ret;

 is31->shutdown_gpio = devm_gpiod_get_optional(dev, "shutdown", GPIOD_OUT_HIGH);
 if (IS_ERR(is31->shutdown_gpio))
  return dev_err_probe(dev, PTR_ERR(is31->shutdown_gpio),
         "Failed to get shutdown gpio\n");

 is31->cdef = device_get_match_data(dev);

 count = 0;
 device_for_each_child_node_scoped(dev, child)
  count++;

 dev_dbg(dev, "probing with %d leds defined in DT\n", count);

 if (!count || count > is31->cdef->num_leds)
  return dev_err_probe(dev, -ENODEV,
         "Number of leds defined must be between 1 and %u\n",
         is31->cdef->num_leds);

 device_for_each_child_node_scoped(dev, child) {
  struct is31fl319x_led *led;
  u32 reg;

  ret = fwnode_property_read_u32(child, "reg", ®);
  if (ret)
   return dev_err_probe(dev, ret, "Failed to read led 'reg' property\n");

  if (reg < 1 || reg > is31->cdef->num_leds)
   return dev_err_probe(dev, -EINVAL, "invalid led reg %u\n", reg);

  led = &is31->leds[reg - 1];

  if (led->configured)
   return dev_err_probe(dev, -EINVAL, "led %u is already configured\n", reg);

  ret = is31fl319x_parse_child_fw(dev, child, led, is31);
  if (ret)
   return dev_err_probe(dev, ret, "led %u DT parsing failed\n", reg);

  led->configured = true;
 }

 is31->audio_gain_db = 0;
 if (is31->cdef->is_3196or3199) {
  ret = fwnode_property_read_u32(fwnode, "audio-gain-db", &is31->audio_gain_db);
  if (!ret)
   is31->audio_gain_db = min(is31->audio_gain_db,
        IS31FL3196_AUDIO_GAIN_DB_MAX);
 }

 return 0;
}

static inline int is31fl3190_microamp_to_cs(struct device *dev, u32 microamp)
{
 switch (microamp) {
 case 5000:
  return IS31FL3190_CURRENT_5_mA;
 case 10000:
  return IS31FL3190_CURRENT_10_mA;
 case 17500:
  return IS31FL3190_CURRENT_17dot5_mA;
 case 30000:
  return IS31FL3190_CURRENT_30_mA;
 case 42000:
  return IS31FL3190_CURRENT_42_mA;
 default:
  dev_warn(dev, "Unsupported current value: %d, using 5000 µA!\n", microamp);
  return IS31FL3190_CURRENT_5_mA;
 }
}

static inline int is31fl3196_microamp_to_cs(struct device *dev, u32 microamp)
{
 /* round down to nearest supported value (range check done by caller) */
 u32 step = microamp / IS31FL3196_CURRENT_uA_STEP;

 return ((IS31FL3196_CONFIG2_CS_STEP_REF - step) &
  IS31FL3196_CONFIG2_CS_MASK) <<
  IS31FL3196_CONFIG2_CS_SHIFT; /* CS encoding */
}

static inline int is31fl3196_db_to_gain(u32 dezibel)
{
 /* round down to nearest supported value (range check done by caller) */
 return dezibel / IS31FL3196_AUDIO_GAIN_DB_STEP;
}

static void is31f1319x_mutex_destroy(void *lock)
{
 mutex_destroy(lock);
}

static int is31fl319x_probe(struct i2c_client *client)
{
 struct is31fl319x_chip *is31;
 struct device *dev = &client->dev;
 int err;
 int i = 0;
 u32 aggregated_led_microamp;

 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
  return -EIO;

 is31 = devm_kzalloc(&client->dev, sizeof(*is31), GFP_KERNEL);
 if (!is31)
  return -ENOMEM;

 mutex_init(&is31->lock);
 err = devm_add_action_or_reset(dev, is31f1319x_mutex_destroy, &is31->lock);
 if (err)
  return err;

 err = is31fl319x_parse_fw(&client->dev, is31);
 if (err)
  return err;

 if (is31->shutdown_gpio) {
  gpiod_direction_output(is31->shutdown_gpio, 0);
  mdelay(5);
  gpiod_direction_output(is31->shutdown_gpio, 1);
 }

 is31->client = client;
 is31->regmap = devm_regmap_init_i2c(client, is31->cdef->is31fl319x_regmap_config);
 if (IS_ERR(is31->regmap))
  return dev_err_probe(dev, PTR_ERR(is31->regmap), "failed to allocate register map\n");

 i2c_set_clientdata(client, is31);

 /* check for write-reply from chip (we can't read any registers) */
 err = regmap_write(is31->regmap, is31->cdef->reset_reg, 0x00);
 if (err < 0)
  return dev_err_probe(dev, err, "no response from chip write\n");

 /*
 * Kernel conventions require per-LED led-max-microamp property.
 * But the chip does not allow to limit individual LEDs.
 * So we take minimum from all subnodes for safety of hardware.
 */

 aggregated_led_microamp = is31->cdef->current_max;
 for (i = 0; i < is31->cdef->num_leds; i++)
  if (is31->leds[i].configured &&
      is31->leds[i].max_microamp < aggregated_led_microamp)
   aggregated_led_microamp = is31->leds[i].max_microamp;

 if (is31->cdef->is_3196or3199)
  regmap_write(is31->regmap, IS31FL3196_CONFIG2,
        is31fl3196_microamp_to_cs(dev, aggregated_led_microamp) |
        is31fl3196_db_to_gain(is31->audio_gain_db));
 else
  regmap_update_bits(is31->regmap, IS31FL3190_CURRENT, IS31FL3190_CURRENT_MASK,
       is31fl3190_microamp_to_cs(dev, aggregated_led_microamp) << IS31FL3190_CURRENT_SHIFT);

 for (i = 0; i < is31->cdef->num_leds; i++) {
  struct is31fl319x_led *led = &is31->leds[i];

  if (!led->configured)
   continue;

  led->chip = is31;
  led->cdev.brightness_set_blocking = is31->cdef->brightness_set;

  err = devm_led_classdev_register(&client->dev, &led->cdev);
  if (err < 0)
   return err;
 }

 return 0;
}

/*
 * i2c-core (and modalias) requires that id_table be properly filled,
 * even though it is not used for DeviceTree based instantiation.
 */

static const struct i2c_device_id is31fl319x_id[] = {
 { "is31fl3190" },
 { "is31fl3191" },
 { "is31fl3193" },
 { "is31fl3196" },
 { "is31fl3199" },
 { "sn3190" },
 { "sn3191" },
 { "sn3193" },
 { "sn3196" },
 { "sn3199" },
 {},
};
MODULE_DEVICE_TABLE(i2c, is31fl319x_id);

static struct i2c_driver is31fl319x_driver = {
 .driver   = {
  .name           = "leds-is31fl319x",
  .of_match_table = of_is31fl319x_match,
 },
 .probe = is31fl319x_probe,
 .id_table = is31fl319x_id,
};

module_i2c_driver(is31fl319x_driver);

MODULE_AUTHOR("H. Nikolaus Schaller ");
MODULE_AUTHOR("Andrey Utkin ");
MODULE_DESCRIPTION("IS31FL319X LED driver");
MODULE_LICENSE("GPL v2");

Messung V0.5
C=93 H=93 G=92

¤ Dauer der Verarbeitung: 0.5 Sekunden  ¤

*© Formatika GbR, Deutschland






Wurzel

Suchen

Beweissystem der NASA

Beweissystem Isabelle

NIST Cobol Testsuite

Cephes Mathematical Library

Wiener Entwicklungsmethode

Haftungshinweis

Die Informationen auf dieser Webseite wurden nach bestem Wissen sorgfältig zusammengestellt. Es wird jedoch weder Vollständigkeit, noch Richtigkeit, noch Qualität der bereit gestellten Informationen zugesichert.

Bemerkung:

Die farbliche Syntaxdarstellung und die Messung sind noch experimentell.