1386570d7SVadim Pasternak // SPDX-License-Identifier: (GPL-2.0 OR BSD-3-Clause) 2386570d7SVadim Pasternak // 3386570d7SVadim Pasternak // Copyright (c) 2018 Mellanox Technologies. All rights reserved. 4386570d7SVadim Pasternak // Copyright (c) 2018 Vadim Pasternak <vadimp@mellanox.com> 5386570d7SVadim Pasternak 6386570d7SVadim Pasternak #include <linux/bitops.h> 7386570d7SVadim Pasternak #include <linux/device.h> 8386570d7SVadim Pasternak #include <linux/io.h> 9386570d7SVadim Pasternak #include <linux/leds.h> 10386570d7SVadim Pasternak #include <linux/module.h> 11386570d7SVadim Pasternak #include <linux/of_device.h> 12386570d7SVadim Pasternak #include <linux/platform_data/mlxreg.h> 13386570d7SVadim Pasternak #include <linux/platform_device.h> 14386570d7SVadim Pasternak #include <linux/regmap.h> 15386570d7SVadim Pasternak 16386570d7SVadim Pasternak /* Codes for LEDs. */ 17386570d7SVadim Pasternak #define MLXREG_LED_OFFSET_BLINK_3HZ 0x01 /* Offset from solid: 3Hz blink */ 18386570d7SVadim Pasternak #define MLXREG_LED_OFFSET_BLINK_6HZ 0x02 /* Offset from solid: 6Hz blink */ 19386570d7SVadim Pasternak #define MLXREG_LED_IS_OFF 0x00 /* Off */ 20386570d7SVadim Pasternak #define MLXREG_LED_RED_SOLID 0x05 /* Solid red */ 21386570d7SVadim Pasternak #define MLXREG_LED_GREEN_SOLID 0x0D /* Solid green */ 22386570d7SVadim Pasternak #define MLXREG_LED_AMBER_SOLID 0x09 /* Solid amber */ 23386570d7SVadim Pasternak #define MLXREG_LED_BLINK_3HZ 167 /* ~167 msec off/on - HW support */ 24386570d7SVadim Pasternak #define MLXREG_LED_BLINK_6HZ 83 /* ~83 msec off/on - HW support */ 25386570d7SVadim Pasternak 26386570d7SVadim Pasternak /** 27386570d7SVadim Pasternak * struct mlxreg_led_data - led control data: 28386570d7SVadim Pasternak * 29386570d7SVadim Pasternak * @data: led configuration data; 30386570d7SVadim Pasternak * @led_classdev: led class data; 31386570d7SVadim Pasternak * @base_color: base led color (other colors have constant offset from base); 32386570d7SVadim Pasternak * @led_data: led data; 33386570d7SVadim Pasternak * @data_parent: pointer to private device control data of parent; 34386570d7SVadim Pasternak */ 35386570d7SVadim Pasternak struct mlxreg_led_data { 36386570d7SVadim Pasternak struct mlxreg_core_data *data; 37386570d7SVadim Pasternak struct led_classdev led_cdev; 38386570d7SVadim Pasternak u8 base_color; 39386570d7SVadim Pasternak void *data_parent; 40386570d7SVadim Pasternak char led_cdev_name[MLXREG_CORE_LABEL_MAX_SIZE]; 41386570d7SVadim Pasternak }; 42386570d7SVadim Pasternak 43386570d7SVadim Pasternak #define cdev_to_priv(c) container_of(c, struct mlxreg_led_data, led_cdev) 44386570d7SVadim Pasternak 45386570d7SVadim Pasternak /** 46386570d7SVadim Pasternak * struct mlxreg_led_priv_data - platform private data: 47386570d7SVadim Pasternak * 48386570d7SVadim Pasternak * @pdev: platform device; 49386570d7SVadim Pasternak * @pdata: platform data; 50386570d7SVadim Pasternak * @access_lock: mutex for attribute IO access; 51386570d7SVadim Pasternak */ 52386570d7SVadim Pasternak struct mlxreg_led_priv_data { 53386570d7SVadim Pasternak struct platform_device *pdev; 54386570d7SVadim Pasternak struct mlxreg_core_platform_data *pdata; 55386570d7SVadim Pasternak struct mutex access_lock; /* protect IO operations */ 56386570d7SVadim Pasternak }; 57386570d7SVadim Pasternak 58386570d7SVadim Pasternak static int 59386570d7SVadim Pasternak mlxreg_led_store_hw(struct mlxreg_led_data *led_data, u8 vset) 60386570d7SVadim Pasternak { 61386570d7SVadim Pasternak struct mlxreg_led_priv_data *priv = led_data->data_parent; 62386570d7SVadim Pasternak struct mlxreg_core_platform_data *led_pdata = priv->pdata; 63386570d7SVadim Pasternak struct mlxreg_core_data *data = led_data->data; 64386570d7SVadim Pasternak u32 regval; 65386570d7SVadim Pasternak u32 nib; 66386570d7SVadim Pasternak int ret; 67386570d7SVadim Pasternak 68386570d7SVadim Pasternak /* 69386570d7SVadim Pasternak * Each LED is controlled through low or high nibble of the relevant 70386570d7SVadim Pasternak * register byte. Register offset is specified by off parameter. 71386570d7SVadim Pasternak * Parameter vset provides color code: 0x0 for off, 0x5 for solid red, 72386570d7SVadim Pasternak * 0x6 for 3Hz blink red, 0xd for solid green, 0xe for 3Hz blink 73386570d7SVadim Pasternak * green. 74386570d7SVadim Pasternak * Parameter mask specifies which nibble is used for specific LED: mask 75386570d7SVadim Pasternak * 0xf0 - lower nibble is to be used (bits from 0 to 3), mask 0x0f - 76386570d7SVadim Pasternak * higher nibble (bits from 4 to 7). 77386570d7SVadim Pasternak */ 78386570d7SVadim Pasternak mutex_lock(&priv->access_lock); 79386570d7SVadim Pasternak 80386570d7SVadim Pasternak ret = regmap_read(led_pdata->regmap, data->reg, ®val); 81386570d7SVadim Pasternak if (ret) 82386570d7SVadim Pasternak goto access_error; 83386570d7SVadim Pasternak 84386570d7SVadim Pasternak nib = (ror32(data->mask, data->bit) == 0xf0) ? rol32(vset, data->bit) : 85386570d7SVadim Pasternak rol32(vset, data->bit + 4); 86386570d7SVadim Pasternak regval = (regval & data->mask) | nib; 87386570d7SVadim Pasternak 88386570d7SVadim Pasternak ret = regmap_write(led_pdata->regmap, data->reg, regval); 89386570d7SVadim Pasternak 90386570d7SVadim Pasternak access_error: 91386570d7SVadim Pasternak mutex_unlock(&priv->access_lock); 92386570d7SVadim Pasternak 93386570d7SVadim Pasternak return ret; 94386570d7SVadim Pasternak } 95386570d7SVadim Pasternak 96386570d7SVadim Pasternak static enum led_brightness 97386570d7SVadim Pasternak mlxreg_led_get_hw(struct mlxreg_led_data *led_data) 98386570d7SVadim Pasternak { 99386570d7SVadim Pasternak struct mlxreg_led_priv_data *priv = led_data->data_parent; 100386570d7SVadim Pasternak struct mlxreg_core_platform_data *led_pdata = priv->pdata; 101386570d7SVadim Pasternak struct mlxreg_core_data *data = led_data->data; 102386570d7SVadim Pasternak u32 regval; 103386570d7SVadim Pasternak int err; 104386570d7SVadim Pasternak 105386570d7SVadim Pasternak /* 106386570d7SVadim Pasternak * Each LED is controlled through low or high nibble of the relevant 107386570d7SVadim Pasternak * register byte. Register offset is specified by off parameter. 108386570d7SVadim Pasternak * Parameter vset provides color code: 0x0 for off, 0x5 for solid red, 109386570d7SVadim Pasternak * 0x6 for 3Hz blink red, 0xd for solid green, 0xe for 3Hz blink 110386570d7SVadim Pasternak * green. 111386570d7SVadim Pasternak * Parameter mask specifies which nibble is used for specific LED: mask 112386570d7SVadim Pasternak * 0xf0 - lower nibble is to be used (bits from 0 to 3), mask 0x0f - 113386570d7SVadim Pasternak * higher nibble (bits from 4 to 7). 114386570d7SVadim Pasternak */ 115386570d7SVadim Pasternak err = regmap_read(led_pdata->regmap, data->reg, ®val); 116386570d7SVadim Pasternak if (err < 0) { 117386570d7SVadim Pasternak dev_warn(led_data->led_cdev.dev, "Failed to get current brightness, error: %d\n", 118386570d7SVadim Pasternak err); 119386570d7SVadim Pasternak /* Assume the LED is OFF */ 120386570d7SVadim Pasternak return LED_OFF; 121386570d7SVadim Pasternak } 122386570d7SVadim Pasternak 123386570d7SVadim Pasternak regval = regval & ~data->mask; 124386570d7SVadim Pasternak regval = (ror32(data->mask, data->bit) == 0xf0) ? ror32(regval, 125386570d7SVadim Pasternak data->bit) : ror32(regval, data->bit + 4); 126386570d7SVadim Pasternak if (regval >= led_data->base_color && 127386570d7SVadim Pasternak regval <= (led_data->base_color + MLXREG_LED_OFFSET_BLINK_6HZ)) 128386570d7SVadim Pasternak return LED_FULL; 129386570d7SVadim Pasternak 130386570d7SVadim Pasternak return LED_OFF; 131386570d7SVadim Pasternak } 132386570d7SVadim Pasternak 133386570d7SVadim Pasternak static int 134386570d7SVadim Pasternak mlxreg_led_brightness_set(struct led_classdev *cled, enum led_brightness value) 135386570d7SVadim Pasternak { 136386570d7SVadim Pasternak struct mlxreg_led_data *led_data = cdev_to_priv(cled); 137386570d7SVadim Pasternak 138386570d7SVadim Pasternak if (value) 139386570d7SVadim Pasternak return mlxreg_led_store_hw(led_data, led_data->base_color); 140386570d7SVadim Pasternak else 141386570d7SVadim Pasternak return mlxreg_led_store_hw(led_data, MLXREG_LED_IS_OFF); 142386570d7SVadim Pasternak } 143386570d7SVadim Pasternak 144386570d7SVadim Pasternak static enum led_brightness 145386570d7SVadim Pasternak mlxreg_led_brightness_get(struct led_classdev *cled) 146386570d7SVadim Pasternak { 147386570d7SVadim Pasternak struct mlxreg_led_data *led_data = cdev_to_priv(cled); 148386570d7SVadim Pasternak 149386570d7SVadim Pasternak return mlxreg_led_get_hw(led_data); 150386570d7SVadim Pasternak } 151386570d7SVadim Pasternak 152386570d7SVadim Pasternak static int 153386570d7SVadim Pasternak mlxreg_led_blink_set(struct led_classdev *cled, unsigned long *delay_on, 154386570d7SVadim Pasternak unsigned long *delay_off) 155386570d7SVadim Pasternak { 156386570d7SVadim Pasternak struct mlxreg_led_data *led_data = cdev_to_priv(cled); 157386570d7SVadim Pasternak int err; 158386570d7SVadim Pasternak 159386570d7SVadim Pasternak /* 160386570d7SVadim Pasternak * HW supports two types of blinking: full (6Hz) and half (3Hz). 161386570d7SVadim Pasternak * For delay on/off zero LED is setting to solid color. For others 162386570d7SVadim Pasternak * combination blinking is to be controlled by the software timer. 163386570d7SVadim Pasternak */ 164386570d7SVadim Pasternak if (!(*delay_on == 0 && *delay_off == 0) && 165386570d7SVadim Pasternak !(*delay_on == MLXREG_LED_BLINK_3HZ && 166386570d7SVadim Pasternak *delay_off == MLXREG_LED_BLINK_3HZ) && 167386570d7SVadim Pasternak !(*delay_on == MLXREG_LED_BLINK_6HZ && 168386570d7SVadim Pasternak *delay_off == MLXREG_LED_BLINK_6HZ)) 169386570d7SVadim Pasternak return -EINVAL; 170386570d7SVadim Pasternak 171386570d7SVadim Pasternak if (*delay_on == MLXREG_LED_BLINK_6HZ) 172386570d7SVadim Pasternak err = mlxreg_led_store_hw(led_data, led_data->base_color + 173386570d7SVadim Pasternak MLXREG_LED_OFFSET_BLINK_6HZ); 174386570d7SVadim Pasternak else if (*delay_on == MLXREG_LED_BLINK_3HZ) 175386570d7SVadim Pasternak err = mlxreg_led_store_hw(led_data, led_data->base_color + 176386570d7SVadim Pasternak MLXREG_LED_OFFSET_BLINK_3HZ); 177386570d7SVadim Pasternak else 178386570d7SVadim Pasternak err = mlxreg_led_store_hw(led_data, led_data->base_color); 179386570d7SVadim Pasternak 180386570d7SVadim Pasternak return err; 181386570d7SVadim Pasternak } 182386570d7SVadim Pasternak 183386570d7SVadim Pasternak static int mlxreg_led_config(struct mlxreg_led_priv_data *priv) 184386570d7SVadim Pasternak { 185386570d7SVadim Pasternak struct mlxreg_core_platform_data *led_pdata = priv->pdata; 186386570d7SVadim Pasternak struct mlxreg_core_data *data = led_pdata->data; 187386570d7SVadim Pasternak struct mlxreg_led_data *led_data; 188386570d7SVadim Pasternak struct led_classdev *led_cdev; 189386570d7SVadim Pasternak enum led_brightness brightness; 190386570d7SVadim Pasternak int i; 191386570d7SVadim Pasternak int err; 192386570d7SVadim Pasternak 193386570d7SVadim Pasternak for (i = 0; i < led_pdata->counter; i++, data++) { 194386570d7SVadim Pasternak led_data = devm_kzalloc(&priv->pdev->dev, sizeof(*led_data), 195386570d7SVadim Pasternak GFP_KERNEL); 196386570d7SVadim Pasternak if (!led_data) 197386570d7SVadim Pasternak return -ENOMEM; 198386570d7SVadim Pasternak 199386570d7SVadim Pasternak led_cdev = &led_data->led_cdev; 200386570d7SVadim Pasternak led_data->data_parent = priv; 201386570d7SVadim Pasternak if (strstr(data->label, "red") || 202386570d7SVadim Pasternak strstr(data->label, "orange")) { 203386570d7SVadim Pasternak brightness = LED_OFF; 204386570d7SVadim Pasternak led_data->base_color = MLXREG_LED_RED_SOLID; 205386570d7SVadim Pasternak } else if (strstr(data->label, "amber")) { 206386570d7SVadim Pasternak brightness = LED_OFF; 207386570d7SVadim Pasternak led_data->base_color = MLXREG_LED_AMBER_SOLID; 208386570d7SVadim Pasternak } else { 209386570d7SVadim Pasternak brightness = LED_OFF; 210386570d7SVadim Pasternak led_data->base_color = MLXREG_LED_GREEN_SOLID; 211386570d7SVadim Pasternak } 212386570d7SVadim Pasternak sprintf(led_data->led_cdev_name, "%s:%s", "mlxreg", 213386570d7SVadim Pasternak data->label); 214386570d7SVadim Pasternak led_cdev->name = led_data->led_cdev_name; 215386570d7SVadim Pasternak led_cdev->brightness = brightness; 216386570d7SVadim Pasternak led_cdev->max_brightness = LED_ON; 217386570d7SVadim Pasternak led_cdev->brightness_set_blocking = 218386570d7SVadim Pasternak mlxreg_led_brightness_set; 219386570d7SVadim Pasternak led_cdev->brightness_get = mlxreg_led_brightness_get; 220386570d7SVadim Pasternak led_cdev->blink_set = mlxreg_led_blink_set; 221386570d7SVadim Pasternak led_cdev->flags = LED_CORE_SUSPENDRESUME; 222386570d7SVadim Pasternak led_data->data = data; 223386570d7SVadim Pasternak err = devm_led_classdev_register(&priv->pdev->dev, led_cdev); 224386570d7SVadim Pasternak if (err) 225386570d7SVadim Pasternak return err; 226386570d7SVadim Pasternak 227386570d7SVadim Pasternak if (led_cdev->brightness) 228386570d7SVadim Pasternak mlxreg_led_brightness_set(led_cdev, 229386570d7SVadim Pasternak led_cdev->brightness); 230386570d7SVadim Pasternak dev_info(led_cdev->dev, "label: %s, mask: 0x%02x, offset:0x%02x\n", 231386570d7SVadim Pasternak data->label, data->mask, data->reg); 232386570d7SVadim Pasternak } 233386570d7SVadim Pasternak 234386570d7SVadim Pasternak return 0; 235386570d7SVadim Pasternak } 236386570d7SVadim Pasternak 237386570d7SVadim Pasternak static int mlxreg_led_probe(struct platform_device *pdev) 238386570d7SVadim Pasternak { 239386570d7SVadim Pasternak struct mlxreg_core_platform_data *led_pdata; 240386570d7SVadim Pasternak struct mlxreg_led_priv_data *priv; 241386570d7SVadim Pasternak 242386570d7SVadim Pasternak led_pdata = dev_get_platdata(&pdev->dev); 243386570d7SVadim Pasternak if (!led_pdata) { 244386570d7SVadim Pasternak dev_err(&pdev->dev, "Failed to get platform data.\n"); 245386570d7SVadim Pasternak return -EINVAL; 246386570d7SVadim Pasternak } 247386570d7SVadim Pasternak 248386570d7SVadim Pasternak priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL); 249386570d7SVadim Pasternak if (!priv) 250386570d7SVadim Pasternak return -ENOMEM; 251386570d7SVadim Pasternak 252386570d7SVadim Pasternak mutex_init(&priv->access_lock); 253386570d7SVadim Pasternak priv->pdev = pdev; 254386570d7SVadim Pasternak priv->pdata = led_pdata; 255386570d7SVadim Pasternak 256386570d7SVadim Pasternak return mlxreg_led_config(priv); 257386570d7SVadim Pasternak } 258386570d7SVadim Pasternak 259386570d7SVadim Pasternak static int mlxreg_led_remove(struct platform_device *pdev) 260386570d7SVadim Pasternak { 261386570d7SVadim Pasternak struct mlxreg_led_priv_data *priv = dev_get_drvdata(&pdev->dev); 262386570d7SVadim Pasternak 263386570d7SVadim Pasternak mutex_destroy(&priv->access_lock); 264386570d7SVadim Pasternak 265386570d7SVadim Pasternak return 0; 266386570d7SVadim Pasternak } 267386570d7SVadim Pasternak 268386570d7SVadim Pasternak static struct platform_driver mlxreg_led_driver = { 269386570d7SVadim Pasternak .driver = { 270386570d7SVadim Pasternak .name = "leds-mlxreg", 271386570d7SVadim Pasternak }, 272386570d7SVadim Pasternak .probe = mlxreg_led_probe, 273386570d7SVadim Pasternak .remove = mlxreg_led_remove, 274386570d7SVadim Pasternak }; 275386570d7SVadim Pasternak 276386570d7SVadim Pasternak module_platform_driver(mlxreg_led_driver); 277386570d7SVadim Pasternak 278386570d7SVadim Pasternak MODULE_AUTHOR("Vadim Pasternak <vadimp@mellanox.com>"); 279386570d7SVadim Pasternak MODULE_DESCRIPTION("Mellanox LED regmap driver"); 280386570d7SVadim Pasternak MODULE_LICENSE("Dual BSD/GPL"); 281386570d7SVadim Pasternak MODULE_ALIAS("platform:leds-mlxreg"); 282