/kern_oII/drivers/video/backlight/da903x_bl.c

http://omnia2droid.googlecode.com/ · C · 203 lines · 156 code · 34 blank · 13 comment · 17 complexity · 9eb2ac0133829724c295011c52abfc70 MD5 · raw file

  1. /*
  2. * Backlight driver for Dialog Semiconductor DA9030/DA9034
  3. *
  4. * Copyright (C) 2008 Compulab, Ltd.
  5. * Mike Rapoport <mike@compulab.co.il>
  6. *
  7. * Copyright (C) 2006-2008 Marvell International Ltd.
  8. * Eric Miao <eric.miao@marvell.com>
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License version 2 as
  12. * published by the Free Software Foundation.
  13. */
  14. #include <linux/kernel.h>
  15. #include <linux/init.h>
  16. #include <linux/platform_device.h>
  17. #include <linux/fb.h>
  18. #include <linux/backlight.h>
  19. #include <linux/mfd/da903x.h>
  20. #define DA9030_WLED_CONTROL 0x25
  21. #define DA9030_WLED_CP_EN (1 << 6)
  22. #define DA9030_WLED_TRIM(x) ((x) & 0x7)
  23. #define DA9034_WLED_CONTROL1 0x3C
  24. #define DA9034_WLED_CONTROL2 0x3D
  25. #define DA9034_WLED_BOOST_EN (1 << 5)
  26. #define DA9030_MAX_BRIGHTNESS 7
  27. #define DA9034_MAX_BRIGHTNESS 0x7f
  28. struct da903x_backlight_data {
  29. struct device *da903x_dev;
  30. int id;
  31. int current_brightness;
  32. };
  33. static int da903x_backlight_set(struct backlight_device *bl, int brightness)
  34. {
  35. struct da903x_backlight_data *data = bl_get_data(bl);
  36. struct device *dev = data->da903x_dev;
  37. uint8_t val;
  38. int ret = 0;
  39. switch (data->id) {
  40. case DA9034_ID_WLED:
  41. ret = da903x_update(dev, DA9034_WLED_CONTROL1,
  42. brightness, 0x7f);
  43. if (ret)
  44. return ret;
  45. if (data->current_brightness && brightness == 0)
  46. ret = da903x_clr_bits(dev,
  47. DA9034_WLED_CONTROL2,
  48. DA9034_WLED_BOOST_EN);
  49. if (data->current_brightness == 0 && brightness)
  50. ret = da903x_set_bits(dev,
  51. DA9034_WLED_CONTROL2,
  52. DA9034_WLED_BOOST_EN);
  53. break;
  54. case DA9030_ID_WLED:
  55. val = DA9030_WLED_TRIM(brightness);
  56. val |= brightness ? DA9030_WLED_CP_EN : 0;
  57. ret = da903x_write(dev, DA9030_WLED_CONTROL, val);
  58. break;
  59. }
  60. if (ret)
  61. return ret;
  62. data->current_brightness = brightness;
  63. return 0;
  64. }
  65. static int da903x_backlight_update_status(struct backlight_device *bl)
  66. {
  67. int brightness = bl->props.brightness;
  68. if (bl->props.power != FB_BLANK_UNBLANK)
  69. brightness = 0;
  70. if (bl->props.fb_blank != FB_BLANK_UNBLANK)
  71. brightness = 0;
  72. return da903x_backlight_set(bl, brightness);
  73. }
  74. static int da903x_backlight_get_brightness(struct backlight_device *bl)
  75. {
  76. struct da903x_backlight_data *data = bl_get_data(bl);
  77. return data->current_brightness;
  78. }
  79. static struct backlight_ops da903x_backlight_ops = {
  80. .update_status = da903x_backlight_update_status,
  81. .get_brightness = da903x_backlight_get_brightness,
  82. };
  83. static int da903x_backlight_probe(struct platform_device *pdev)
  84. {
  85. struct da903x_backlight_data *data;
  86. struct backlight_device *bl;
  87. int max_brightness;
  88. data = kzalloc(sizeof(*data), GFP_KERNEL);
  89. if (data == NULL)
  90. return -ENOMEM;
  91. switch (pdev->id) {
  92. case DA9030_ID_WLED:
  93. max_brightness = DA9030_MAX_BRIGHTNESS;
  94. break;
  95. case DA9034_ID_WLED:
  96. max_brightness = DA9034_MAX_BRIGHTNESS;
  97. break;
  98. default:
  99. dev_err(&pdev->dev, "invalid backlight device ID(%d)\n",
  100. pdev->id);
  101. kfree(data);
  102. return -EINVAL;
  103. }
  104. data->id = pdev->id;
  105. data->da903x_dev = pdev->dev.parent;
  106. data->current_brightness = 0;
  107. bl = backlight_device_register(pdev->name, data->da903x_dev,
  108. data, &da903x_backlight_ops);
  109. if (IS_ERR(bl)) {
  110. dev_err(&pdev->dev, "failed to register backlight\n");
  111. kfree(data);
  112. return PTR_ERR(bl);
  113. }
  114. bl->props.max_brightness = max_brightness;
  115. bl->props.brightness = max_brightness;
  116. platform_set_drvdata(pdev, bl);
  117. backlight_update_status(bl);
  118. return 0;
  119. }
  120. static int da903x_backlight_remove(struct platform_device *pdev)
  121. {
  122. struct backlight_device *bl = platform_get_drvdata(pdev);
  123. struct da903x_backlight_data *data = bl_get_data(bl);
  124. backlight_device_unregister(bl);
  125. kfree(data);
  126. return 0;
  127. }
  128. #ifdef CONFIG_PM
  129. static int da903x_backlight_suspend(struct platform_device *pdev,
  130. pm_message_t state)
  131. {
  132. struct backlight_device *bl = platform_get_drvdata(pdev);
  133. return da903x_backlight_set(bl, 0);
  134. }
  135. static int da903x_backlight_resume(struct platform_device *pdev)
  136. {
  137. struct backlight_device *bl = platform_get_drvdata(pdev);
  138. backlight_update_status(bl);
  139. return 0;
  140. }
  141. #else
  142. #define da903x_backlight_suspend NULL
  143. #define da903x_backlight_resume NULL
  144. #endif
  145. static struct platform_driver da903x_backlight_driver = {
  146. .driver = {
  147. .name = "da903x-backlight",
  148. .owner = THIS_MODULE,
  149. },
  150. .probe = da903x_backlight_probe,
  151. .remove = da903x_backlight_remove,
  152. .suspend = da903x_backlight_suspend,
  153. .resume = da903x_backlight_resume,
  154. };
  155. static int __init da903x_backlight_init(void)
  156. {
  157. return platform_driver_register(&da903x_backlight_driver);
  158. }
  159. module_init(da903x_backlight_init);
  160. static void __exit da903x_backlight_exit(void)
  161. {
  162. platform_driver_unregister(&da903x_backlight_driver);
  163. }
  164. module_exit(da903x_backlight_exit);
  165. MODULE_DESCRIPTION("Backlight Driver for Dialog Semiconductor DA9030/DA9034");
  166. MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
  167. "Mike Rapoport <mike@compulab.co.il>");
  168. MODULE_LICENSE("GPL");
  169. MODULE_ALIAS("platform:da903x-backlight");