lv5207lp.c 3.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Sanyo LV5207LP LED Driver
  4. *
  5. * Copyright (C) 2013 Ideas on board SPRL
  6. *
  7. * Contact: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
  8. */
  9. #include <linux/backlight.h>
  10. #include <linux/err.h>
  11. #include <linux/fb.h>
  12. #include <linux/i2c.h>
  13. #include <linux/module.h>
  14. #include <linux/platform_data/lv5207lp.h>
  15. #include <linux/slab.h>
  16. #define LV5207LP_CTRL1 0x00
  17. #define LV5207LP_CPSW (1 << 7)
  18. #define LV5207LP_SCTEN (1 << 6)
  19. #define LV5207LP_C10 (1 << 5)
  20. #define LV5207LP_CKSW (1 << 4)
  21. #define LV5207LP_RSW (1 << 3)
  22. #define LV5207LP_GSW (1 << 2)
  23. #define LV5207LP_BSW (1 << 1)
  24. #define LV5207LP_CTRL2 0x01
  25. #define LV5207LP_MSW (1 << 7)
  26. #define LV5207LP_MLED4 (1 << 6)
  27. #define LV5207LP_RED 0x02
  28. #define LV5207LP_GREEN 0x03
  29. #define LV5207LP_BLUE 0x04
  30. #define LV5207LP_MAX_BRIGHTNESS 32
  31. struct lv5207lp {
  32. struct i2c_client *client;
  33. struct backlight_device *backlight;
  34. struct lv5207lp_platform_data *pdata;
  35. };
  36. static int lv5207lp_write(struct lv5207lp *lv, u8 reg, u8 data)
  37. {
  38. return i2c_smbus_write_byte_data(lv->client, reg, data);
  39. }
  40. static int lv5207lp_backlight_update_status(struct backlight_device *backlight)
  41. {
  42. struct lv5207lp *lv = bl_get_data(backlight);
  43. int brightness = backlight_get_brightness(backlight);
  44. if (brightness) {
  45. lv5207lp_write(lv, LV5207LP_CTRL1,
  46. LV5207LP_CPSW | LV5207LP_C10 | LV5207LP_CKSW);
  47. lv5207lp_write(lv, LV5207LP_CTRL2,
  48. LV5207LP_MSW | LV5207LP_MLED4 |
  49. (brightness - 1));
  50. } else {
  51. lv5207lp_write(lv, LV5207LP_CTRL1, 0);
  52. lv5207lp_write(lv, LV5207LP_CTRL2, 0);
  53. }
  54. return 0;
  55. }
  56. static int lv5207lp_backlight_check_fb(struct backlight_device *backlight,
  57. struct fb_info *info)
  58. {
  59. struct lv5207lp *lv = bl_get_data(backlight);
  60. return lv->pdata->fbdev == NULL || lv->pdata->fbdev == info->dev;
  61. }
  62. static const struct backlight_ops lv5207lp_backlight_ops = {
  63. .options = BL_CORE_SUSPENDRESUME,
  64. .update_status = lv5207lp_backlight_update_status,
  65. .check_fb = lv5207lp_backlight_check_fb,
  66. };
  67. static int lv5207lp_probe(struct i2c_client *client,
  68. const struct i2c_device_id *id)
  69. {
  70. struct lv5207lp_platform_data *pdata = dev_get_platdata(&client->dev);
  71. struct backlight_device *backlight;
  72. struct backlight_properties props;
  73. struct lv5207lp *lv;
  74. if (pdata == NULL) {
  75. dev_err(&client->dev, "No platform data supplied\n");
  76. return -EINVAL;
  77. }
  78. if (!i2c_check_functionality(client->adapter,
  79. I2C_FUNC_SMBUS_BYTE_DATA)) {
  80. dev_warn(&client->dev,
  81. "I2C adapter doesn't support I2C_FUNC_SMBUS_BYTE\n");
  82. return -EIO;
  83. }
  84. lv = devm_kzalloc(&client->dev, sizeof(*lv), GFP_KERNEL);
  85. if (!lv)
  86. return -ENOMEM;
  87. lv->client = client;
  88. lv->pdata = pdata;
  89. memset(&props, 0, sizeof(props));
  90. props.type = BACKLIGHT_RAW;
  91. props.max_brightness = min_t(unsigned int, pdata->max_value,
  92. LV5207LP_MAX_BRIGHTNESS);
  93. props.brightness = clamp_t(unsigned int, pdata->def_value, 0,
  94. props.max_brightness);
  95. backlight = devm_backlight_device_register(&client->dev,
  96. dev_name(&client->dev), &lv->client->dev,
  97. lv, &lv5207lp_backlight_ops, &props);
  98. if (IS_ERR(backlight)) {
  99. dev_err(&client->dev, "failed to register backlight\n");
  100. return PTR_ERR(backlight);
  101. }
  102. backlight_update_status(backlight);
  103. i2c_set_clientdata(client, backlight);
  104. return 0;
  105. }
  106. static int lv5207lp_remove(struct i2c_client *client)
  107. {
  108. struct backlight_device *backlight = i2c_get_clientdata(client);
  109. backlight->props.brightness = 0;
  110. backlight_update_status(backlight);
  111. return 0;
  112. }
  113. static const struct i2c_device_id lv5207lp_ids[] = {
  114. { "lv5207lp", 0 },
  115. { }
  116. };
  117. MODULE_DEVICE_TABLE(i2c, lv5207lp_ids);
  118. static struct i2c_driver lv5207lp_driver = {
  119. .driver = {
  120. .name = "lv5207lp",
  121. },
  122. .probe = lv5207lp_probe,
  123. .remove = lv5207lp_remove,
  124. .id_table = lv5207lp_ids,
  125. };
  126. module_i2c_driver(lv5207lp_driver);
  127. MODULE_DESCRIPTION("Sanyo LV5207LP Backlight Driver");
  128. MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@ideasonboard.com>");
  129. MODULE_LICENSE("GPL");