jornada720_lcd.c 2.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. /*
  3. *
  4. * LCD driver for HP Jornada 700 series (710/720/728)
  5. * Copyright (C) 2006-2009 Kristoffer Ericson <kristoffer.ericson@gmail.com>
  6. */
  7. #include <linux/device.h>
  8. #include <linux/fb.h>
  9. #include <linux/kernel.h>
  10. #include <linux/lcd.h>
  11. #include <linux/module.h>
  12. #include <linux/platform_device.h>
  13. #include <linux/delay.h>
  14. #include <mach/jornada720.h>
  15. #include <mach/hardware.h>
  16. #include <video/s1d13xxxfb.h>
  17. #define LCD_MAX_CONTRAST 0xff
  18. #define LCD_DEF_CONTRAST 0x80
  19. static int jornada_lcd_get_power(struct lcd_device *ld)
  20. {
  21. return PPSR & PPC_LDD2 ? FB_BLANK_UNBLANK : FB_BLANK_POWERDOWN;
  22. }
  23. static int jornada_lcd_get_contrast(struct lcd_device *ld)
  24. {
  25. int ret;
  26. if (jornada_lcd_get_power(ld) != FB_BLANK_UNBLANK)
  27. return 0;
  28. jornada_ssp_start();
  29. if (jornada_ssp_byte(GETCONTRAST) == TXDUMMY) {
  30. ret = jornada_ssp_byte(TXDUMMY);
  31. goto success;
  32. }
  33. dev_err(&ld->dev, "failed to set contrast\n");
  34. ret = -ETIMEDOUT;
  35. success:
  36. jornada_ssp_end();
  37. return ret;
  38. }
  39. static int jornada_lcd_set_contrast(struct lcd_device *ld, int value)
  40. {
  41. int ret = 0;
  42. jornada_ssp_start();
  43. /* start by sending our set contrast cmd to mcu */
  44. if (jornada_ssp_byte(SETCONTRAST) == TXDUMMY) {
  45. /* if successful push the new value */
  46. if (jornada_ssp_byte(value) == TXDUMMY)
  47. goto success;
  48. }
  49. dev_err(&ld->dev, "failed to set contrast\n");
  50. ret = -ETIMEDOUT;
  51. success:
  52. jornada_ssp_end();
  53. return ret;
  54. }
  55. static int jornada_lcd_set_power(struct lcd_device *ld, int power)
  56. {
  57. if (power != FB_BLANK_UNBLANK) {
  58. PPSR &= ~PPC_LDD2;
  59. PPDR |= PPC_LDD2;
  60. } else {
  61. PPSR |= PPC_LDD2;
  62. }
  63. return 0;
  64. }
  65. static struct lcd_ops jornada_lcd_props = {
  66. .get_contrast = jornada_lcd_get_contrast,
  67. .set_contrast = jornada_lcd_set_contrast,
  68. .get_power = jornada_lcd_get_power,
  69. .set_power = jornada_lcd_set_power,
  70. };
  71. static int jornada_lcd_probe(struct platform_device *pdev)
  72. {
  73. struct lcd_device *lcd_device;
  74. int ret;
  75. lcd_device = devm_lcd_device_register(&pdev->dev, S1D_DEVICENAME,
  76. &pdev->dev, NULL, &jornada_lcd_props);
  77. if (IS_ERR(lcd_device)) {
  78. ret = PTR_ERR(lcd_device);
  79. dev_err(&pdev->dev, "failed to register device\n");
  80. return ret;
  81. }
  82. platform_set_drvdata(pdev, lcd_device);
  83. /* lets set our default values */
  84. jornada_lcd_set_contrast(lcd_device, LCD_DEF_CONTRAST);
  85. jornada_lcd_set_power(lcd_device, FB_BLANK_UNBLANK);
  86. /* give it some time to startup */
  87. msleep(100);
  88. return 0;
  89. }
  90. static struct platform_driver jornada_lcd_driver = {
  91. .probe = jornada_lcd_probe,
  92. .driver = {
  93. .name = "jornada_lcd",
  94. },
  95. };
  96. module_platform_driver(jornada_lcd_driver);
  97. MODULE_AUTHOR("Kristoffer Ericson <kristoffer.ericson@gmail.com>");
  98. MODULE_DESCRIPTION("HP Jornada 710/720/728 LCD driver");
  99. MODULE_LICENSE("GPL");