Dan,

On 10/8/19 10:47 PM, Dan Murphy wrote:
> Add multicolor framework support for the lp55xx family.
> 
> Signed-off-by: Dan Murphy <dmur...@ti.com>
> ---
>  drivers/leds/Kconfig                      |   1 +
>  drivers/leds/leds-lp55xx-common.c         | 176 +++++++++++++++++++---
>  drivers/leds/leds-lp55xx-common.h         |  11 ++
>  include/linux/platform_data/leds-lp55xx.h |   5 +
>  4 files changed, 169 insertions(+), 24 deletions(-)
> 
[...]
>  
> +static int lp5xx_parse_common_child(struct device_node *np,
> +                                 struct lp55xx_led_config *cfg,
> +                                 int chan_num, bool is_multicolor,
> +                                 int color_num)
> +{
> +     u32 led_number;
> +     int ret;
> +
> +     of_property_read_string(np, "chan-name",
> +                             &cfg[chan_num].name);
> +     of_property_read_u8(np, "led-cur",
> +                         &cfg[chan_num].led_current);
> +     of_property_read_u8(np, "max-cur",
> +                         &cfg[chan_num].max_current);
> +
> +     ret = of_property_read_u32(np, "reg", &led_number);
> +     if (ret)
> +             return ret;
> +
> +     if (led_number < 0 || led_number > 6)
> +             return -EINVAL;
> +
> +     if (is_multicolor)
> +             cfg[chan_num].color_component[color_num].output_num =
> +                                                             led_number;
> +     else
> +             cfg[chan_num].chan_nr = led_number;
> +
> +     return 0;
> +}
> +
> +static int lp5xx_parse_channel_child(struct device_node *np,
> +                                  struct lp55xx_led_config *cfg,
> +                                  int child_number)
> +{
> +     struct device_node *child;
> +     int channel_color;
> +     int num_colors = 0;
> +     u32 color_id;
> +     int ret;
> +
> +     cfg[child_number].default_trigger =
> +                     of_get_property(np, "linux,default-trigger", NULL);
> +
> +     ret = of_property_read_u32(np, "color", &channel_color);
> +     if (ret)
> +             channel_color = ret;
> +
> +
> +     if (channel_color == LED_COLOR_ID_MULTI) {
> +             for_each_child_of_node(np, child) {
> +                     ret = lp5xx_parse_common_child(child, cfg,
> +                                                    child_number, true,
> +                                                    num_colors);
> +                     if (ret)
> +                             return ret;
> +
> +                     ret = of_property_read_u32(child, "color", &color_id);
> +                     if (ret)
> +                             return ret;
> +
> +                     cfg[child_number].color_component[num_colors].color_id =
> +                                             color_id;
> +                     set_bit(color_id, &cfg[child_number].available_colors);
> +                     num_colors++;
> +             }
> +
> +             cfg[child_number].num_colors = num_colors;
> +     } else {
> +             return lp5xx_parse_common_child(np, cfg, child_number, false,
> +                                             num_colors);
> +     }
> +
> +     return 0;
> +}
> +
>  struct lp55xx_platform_data *lp55xx_of_populate_pdata(struct device *dev,
>                                                     struct device_node *np)
>  {
> @@ -546,6 +678,7 @@ struct lp55xx_platform_data 
> *lp55xx_of_populate_pdata(struct device *dev,
>       struct lp55xx_led_config *cfg;
>       int num_channels;
>       int i = 0;
> +     int ret;
>  
>       pdata = devm_kzalloc(dev, sizeof(*pdata), GFP_KERNEL);
>       if (!pdata)
> @@ -565,14 +698,9 @@ struct lp55xx_platform_data 
> *lp55xx_of_populate_pdata(struct device *dev,
>       pdata->num_channels = num_channels;
>  
>       for_each_child_of_node(np, child) {
> -             cfg[i].chan_nr = i;
> -
> -             of_property_read_string(child, "chan-name", &cfg[i].name);
> -             of_property_read_u8(child, "led-cur", &cfg[i].led_current);
> -             of_property_read_u8(child, "max-cur", &cfg[i].max_current);
> -             cfg[i].default_trigger =
> -                     of_get_property(child, "linux,default-trigger", NULL);
> -
> +             ret = lp5xx_parse_channel_child(child, cfg, i);
> +             if (ret)
> +                     return ERR_PTR(-EINVAL);
>               i++;
>       }
>  
> diff --git a/drivers/leds/leds-lp55xx-common.h 
> b/drivers/leds/leds-lp55xx-common.h
> index 783ed5103ce5..55d420f704d1 100644
> --- a/drivers/leds/leds-lp55xx-common.h
> +++ b/drivers/leds/leds-lp55xx-common.h
> @@ -12,6 +12,10 @@
>  #ifndef _LEDS_LP55XX_COMMON_H
>  #define _LEDS_LP55XX_COMMON_H
>  
> +#include <linux/led-class-multicolor.h>
> +
> +#define LP55XX_MAX_GROUPED_CHAN      4
> +
>  enum lp55xx_engine_index {
>       LP55XX_ENGINE_INVALID,
>       LP55XX_ENGINE_1,
> @@ -109,6 +113,9 @@ struct lp55xx_device_config {
>       /* access brightness register */
>       int (*brightness_fn)(struct lp55xx_led *led);
>  
> +     /* access specific brightness register */
> +     int (*color_intensity_fn)(struct lp55xx_led *led);
> +
>       /* current setting function */
>       void (*set_led_current) (struct lp55xx_led *led, u8 led_current);
>  
> @@ -159,6 +166,8 @@ struct lp55xx_chip {
>   * struct lp55xx_led
>   * @chan_nr         : Channel number
>   * @cdev            : LED class device
> + * @mc_cdev      : Multi color class device
> + * @color_component : Multi color LED map information
>   * @led_current     : Current setting at each led channel
>   * @max_current     : Maximun current at each led channel
>   * @brightness      : Brightness value
> @@ -167,6 +176,8 @@ struct lp55xx_chip {
>  struct lp55xx_led {
>       int chan_nr;
>       struct led_classdev cdev;
> +     struct led_classdev_mc mc_cdev;
> +     struct led_mc_color_conversion color_component[LP55XX_MAX_GROUPED_CHAN];
>       u8 led_current;
>       u8 max_current;
>       u8 brightness;
> diff --git a/include/linux/platform_data/leds-lp55xx.h 
> b/include/linux/platform_data/leds-lp55xx.h
> index 96a787100fda..1e7a25ed9a87 100644
> --- a/include/linux/platform_data/leds-lp55xx.h
> +++ b/include/linux/platform_data/leds-lp55xx.h
> @@ -12,6 +12,8 @@
>  #ifndef _LEDS_LP55XX_H
>  #define _LEDS_LP55XX_H
>  
> +#include <linux/led-class-multicolor.h>
> +
>  /* Clock configuration */
>  #define LP55XX_CLOCK_AUTO    0
>  #define LP55XX_CLOCK_INT     1
> @@ -23,6 +25,9 @@ struct lp55xx_led_config {
>       u8 chan_nr;
>       u8 led_current; /* mA x10, 0 if led is not connected */
>       u8 max_current;
> +     int num_colors;
> +     unsigned long available_colors;
> +     struct led_mc_color_conversion color_component[LED_COLOR_ID_MAX];

I can't see why the array length can't be LP55XX_MAX_GROUPED_CHAN here
too. You're indexing it with num_colors counter and not with color_id.

>  };
>  
>  struct lp55xx_predef_pattern {
> 

-- 
Best regards,
Jacek Anaszewski

Reply via email to