1 // SPDX-License-Identifier: GPL-2.0-only
3 * Generic DSI Command Mode panel driver
5 * Copyright (C) 2013 Texas Instruments
6 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
11 #include <linux/backlight.h>
12 #include <linux/delay.h>
14 #include <linux/gpio.h>
15 #include <linux/interrupt.h>
16 #include <linux/jiffies.h>
17 #include <linux/module.h>
18 #include <linux/platform_device.h>
19 #include <linux/sched/signal.h>
20 #include <linux/slab.h>
21 #include <linux/workqueue.h>
22 #include <linux/of_device.h>
23 #include <linux/of_gpio.h>
25 #include <video/omapfb_dss.h>
26 #include <video/mipi_display.h>
28 /* DSI Virtual channel. Hardcoded for now. */
31 #define DCS_READ_NUM_ERRORS 0x05
32 #define DCS_BRIGHTNESS 0x51
33 #define DCS_CTRL_DISPLAY 0x53
34 #define DCS_GET_ID1 0xda
35 #define DCS_GET_ID2 0xdb
36 #define DCS_GET_ID3 0xdc
38 struct panel_drv_data {
39 struct omap_dss_device dssdev;
40 struct omap_dss_device *in;
42 struct omap_video_timings timings;
44 struct platform_device *pdev;
48 struct backlight_device *bldev;
50 unsigned long hw_guard_end; /* next value of jiffies when we can
51 * issue the next sleep in/out command
53 unsigned long hw_guard_wait; /* max guard time in jiffies */
55 /* panel HW configuration from DT or platform data */
59 bool use_dsi_backlight;
61 struct omap_dsi_pin_config pin_config;
63 /* runtime variables */
71 struct delayed_work te_timeout_work;
76 unsigned ulps_timeout;
77 struct delayed_work ulps_work;
80 #define to_panel_data(p) container_of(p, struct panel_drv_data, dssdev)
82 static irqreturn_t dsicm_te_isr(int irq, void *data);
83 static void dsicm_te_timeout_work_callback(struct work_struct *work);
84 static int _dsicm_enable_te(struct panel_drv_data *ddata, bool enable);
86 static int dsicm_panel_reset(struct panel_drv_data *ddata);
88 static void dsicm_ulps_work(struct work_struct *work);
90 static void hw_guard_start(struct panel_drv_data *ddata, int guard_msec)
92 ddata->hw_guard_wait = msecs_to_jiffies(guard_msec);
93 ddata->hw_guard_end = jiffies + ddata->hw_guard_wait;
96 static void hw_guard_wait(struct panel_drv_data *ddata)
98 unsigned long wait = ddata->hw_guard_end - jiffies;
100 if ((long)wait > 0 && time_before_eq(wait, ddata->hw_guard_wait)) {
101 set_current_state(TASK_UNINTERRUPTIBLE);
102 schedule_timeout(wait);
106 static int dsicm_dcs_read_1(struct panel_drv_data *ddata, u8 dcs_cmd, u8 *data)
108 struct omap_dss_device *in = ddata->in;
112 r = in->ops.dsi->dcs_read(in, ddata->channel, dcs_cmd, buf, 1);
122 static int dsicm_dcs_write_0(struct panel_drv_data *ddata, u8 dcs_cmd)
124 struct omap_dss_device *in = ddata->in;
125 return in->ops.dsi->dcs_write(in, ddata->channel, &dcs_cmd, 1);
128 static int dsicm_dcs_write_1(struct panel_drv_data *ddata, u8 dcs_cmd, u8 param)
130 struct omap_dss_device *in = ddata->in;
131 u8 buf[2] = { dcs_cmd, param };
133 return in->ops.dsi->dcs_write(in, ddata->channel, buf, 2);
136 static int dsicm_sleep_in(struct panel_drv_data *ddata)
139 struct omap_dss_device *in = ddata->in;
143 hw_guard_wait(ddata);
145 cmd = MIPI_DCS_ENTER_SLEEP_MODE;
146 r = in->ops.dsi->dcs_write_nosync(in, ddata->channel, &cmd, 1);
150 hw_guard_start(ddata, 120);
152 usleep_range(5000, 10000);
157 static int dsicm_sleep_out(struct panel_drv_data *ddata)
161 hw_guard_wait(ddata);
163 r = dsicm_dcs_write_0(ddata, MIPI_DCS_EXIT_SLEEP_MODE);
167 hw_guard_start(ddata, 120);
169 usleep_range(5000, 10000);
174 static int dsicm_get_id(struct panel_drv_data *ddata, u8 *id1, u8 *id2, u8 *id3)
178 r = dsicm_dcs_read_1(ddata, DCS_GET_ID1, id1);
181 r = dsicm_dcs_read_1(ddata, DCS_GET_ID2, id2);
184 r = dsicm_dcs_read_1(ddata, DCS_GET_ID3, id3);
191 static int dsicm_set_update_window(struct panel_drv_data *ddata,
192 u16 x, u16 y, u16 w, u16 h)
194 struct omap_dss_device *in = ddata->in;
202 buf[0] = MIPI_DCS_SET_COLUMN_ADDRESS;
203 buf[1] = (x1 >> 8) & 0xff;
204 buf[2] = (x1 >> 0) & 0xff;
205 buf[3] = (x2 >> 8) & 0xff;
206 buf[4] = (x2 >> 0) & 0xff;
208 r = in->ops.dsi->dcs_write_nosync(in, ddata->channel, buf, sizeof(buf));
212 buf[0] = MIPI_DCS_SET_PAGE_ADDRESS;
213 buf[1] = (y1 >> 8) & 0xff;
214 buf[2] = (y1 >> 0) & 0xff;
215 buf[3] = (y2 >> 8) & 0xff;
216 buf[4] = (y2 >> 0) & 0xff;
218 r = in->ops.dsi->dcs_write_nosync(in, ddata->channel, buf, sizeof(buf));
222 in->ops.dsi->bta_sync(in, ddata->channel);
227 static void dsicm_queue_ulps_work(struct panel_drv_data *ddata)
229 if (ddata->ulps_timeout > 0)
230 schedule_delayed_work(&ddata->ulps_work,
231 msecs_to_jiffies(ddata->ulps_timeout));
234 static void dsicm_cancel_ulps_work(struct panel_drv_data *ddata)
236 cancel_delayed_work(&ddata->ulps_work);
239 static int dsicm_enter_ulps(struct panel_drv_data *ddata)
241 struct omap_dss_device *in = ddata->in;
244 if (ddata->ulps_enabled)
247 dsicm_cancel_ulps_work(ddata);
249 r = _dsicm_enable_te(ddata, false);
253 if (gpio_is_valid(ddata->ext_te_gpio))
254 disable_irq(gpio_to_irq(ddata->ext_te_gpio));
256 in->ops.dsi->disable(in, false, true);
258 ddata->ulps_enabled = true;
263 dev_err(&ddata->pdev->dev, "enter ULPS failed");
264 dsicm_panel_reset(ddata);
266 ddata->ulps_enabled = false;
268 dsicm_queue_ulps_work(ddata);
273 static int dsicm_exit_ulps(struct panel_drv_data *ddata)
275 struct omap_dss_device *in = ddata->in;
278 if (!ddata->ulps_enabled)
281 r = in->ops.dsi->enable(in);
283 dev_err(&ddata->pdev->dev, "failed to enable DSI\n");
287 in->ops.dsi->enable_hs(in, ddata->channel, true);
289 r = _dsicm_enable_te(ddata, true);
291 dev_err(&ddata->pdev->dev, "failed to re-enable TE");
295 if (gpio_is_valid(ddata->ext_te_gpio))
296 enable_irq(gpio_to_irq(ddata->ext_te_gpio));
298 dsicm_queue_ulps_work(ddata);
300 ddata->ulps_enabled = false;
305 dev_err(&ddata->pdev->dev, "failed to exit ULPS");
307 r = dsicm_panel_reset(ddata);
309 if (gpio_is_valid(ddata->ext_te_gpio))
310 enable_irq(gpio_to_irq(ddata->ext_te_gpio));
311 ddata->ulps_enabled = false;
314 dsicm_queue_ulps_work(ddata);
319 static int dsicm_wake_up(struct panel_drv_data *ddata)
321 if (ddata->ulps_enabled)
322 return dsicm_exit_ulps(ddata);
324 dsicm_cancel_ulps_work(ddata);
325 dsicm_queue_ulps_work(ddata);
329 static int dsicm_bl_update_status(struct backlight_device *dev)
331 struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
332 struct omap_dss_device *in = ddata->in;
336 if (dev->props.fb_blank == FB_BLANK_UNBLANK &&
337 dev->props.power == FB_BLANK_UNBLANK)
338 level = dev->props.brightness;
342 dev_dbg(&ddata->pdev->dev, "update brightness to %d\n", level);
344 mutex_lock(&ddata->lock);
346 if (ddata->enabled) {
347 in->ops.dsi->bus_lock(in);
349 r = dsicm_wake_up(ddata);
351 r = dsicm_dcs_write_1(ddata, DCS_BRIGHTNESS, level);
353 in->ops.dsi->bus_unlock(in);
358 mutex_unlock(&ddata->lock);
363 static int dsicm_bl_get_intensity(struct backlight_device *dev)
365 if (dev->props.fb_blank == FB_BLANK_UNBLANK &&
366 dev->props.power == FB_BLANK_UNBLANK)
367 return dev->props.brightness;
372 static const struct backlight_ops dsicm_bl_ops = {
373 .get_brightness = dsicm_bl_get_intensity,
374 .update_status = dsicm_bl_update_status,
377 static void dsicm_get_resolution(struct omap_dss_device *dssdev,
378 u16 *xres, u16 *yres)
380 *xres = dssdev->panel.timings.x_res;
381 *yres = dssdev->panel.timings.y_res;
384 static ssize_t dsicm_num_errors_show(struct device *dev,
385 struct device_attribute *attr, char *buf)
387 struct panel_drv_data *ddata = dev_get_drvdata(dev);
388 struct omap_dss_device *in = ddata->in;
392 mutex_lock(&ddata->lock);
394 if (ddata->enabled) {
395 in->ops.dsi->bus_lock(in);
397 r = dsicm_wake_up(ddata);
399 r = dsicm_dcs_read_1(ddata, DCS_READ_NUM_ERRORS,
402 in->ops.dsi->bus_unlock(in);
407 mutex_unlock(&ddata->lock);
412 return snprintf(buf, PAGE_SIZE, "%d\n", errors);
415 static ssize_t dsicm_hw_revision_show(struct device *dev,
416 struct device_attribute *attr, char *buf)
418 struct panel_drv_data *ddata = dev_get_drvdata(dev);
419 struct omap_dss_device *in = ddata->in;
423 mutex_lock(&ddata->lock);
425 if (ddata->enabled) {
426 in->ops.dsi->bus_lock(in);
428 r = dsicm_wake_up(ddata);
430 r = dsicm_get_id(ddata, &id1, &id2, &id3);
432 in->ops.dsi->bus_unlock(in);
437 mutex_unlock(&ddata->lock);
442 return snprintf(buf, PAGE_SIZE, "%02x.%02x.%02x\n", id1, id2, id3);
445 static ssize_t dsicm_store_ulps(struct device *dev,
446 struct device_attribute *attr,
447 const char *buf, size_t count)
449 struct panel_drv_data *ddata = dev_get_drvdata(dev);
450 struct omap_dss_device *in = ddata->in;
454 r = kstrtoul(buf, 0, &t);
458 mutex_lock(&ddata->lock);
460 if (ddata->enabled) {
461 in->ops.dsi->bus_lock(in);
464 r = dsicm_enter_ulps(ddata);
466 r = dsicm_wake_up(ddata);
468 in->ops.dsi->bus_unlock(in);
471 mutex_unlock(&ddata->lock);
479 static ssize_t dsicm_show_ulps(struct device *dev,
480 struct device_attribute *attr,
483 struct panel_drv_data *ddata = dev_get_drvdata(dev);
486 mutex_lock(&ddata->lock);
487 t = ddata->ulps_enabled;
488 mutex_unlock(&ddata->lock);
490 return snprintf(buf, PAGE_SIZE, "%u\n", t);
493 static ssize_t dsicm_store_ulps_timeout(struct device *dev,
494 struct device_attribute *attr,
495 const char *buf, size_t count)
497 struct panel_drv_data *ddata = dev_get_drvdata(dev);
498 struct omap_dss_device *in = ddata->in;
502 r = kstrtoul(buf, 0, &t);
506 mutex_lock(&ddata->lock);
507 ddata->ulps_timeout = t;
509 if (ddata->enabled) {
510 /* dsicm_wake_up will restart the timer */
511 in->ops.dsi->bus_lock(in);
512 r = dsicm_wake_up(ddata);
513 in->ops.dsi->bus_unlock(in);
516 mutex_unlock(&ddata->lock);
524 static ssize_t dsicm_show_ulps_timeout(struct device *dev,
525 struct device_attribute *attr,
528 struct panel_drv_data *ddata = dev_get_drvdata(dev);
531 mutex_lock(&ddata->lock);
532 t = ddata->ulps_timeout;
533 mutex_unlock(&ddata->lock);
535 return snprintf(buf, PAGE_SIZE, "%u\n", t);
538 static DEVICE_ATTR(num_dsi_errors, S_IRUGO, dsicm_num_errors_show, NULL);
539 static DEVICE_ATTR(hw_revision, S_IRUGO, dsicm_hw_revision_show, NULL);
540 static DEVICE_ATTR(ulps, S_IRUGO | S_IWUSR,
541 dsicm_show_ulps, dsicm_store_ulps);
542 static DEVICE_ATTR(ulps_timeout, S_IRUGO | S_IWUSR,
543 dsicm_show_ulps_timeout, dsicm_store_ulps_timeout);
545 static struct attribute *dsicm_attrs[] = {
546 &dev_attr_num_dsi_errors.attr,
547 &dev_attr_hw_revision.attr,
549 &dev_attr_ulps_timeout.attr,
553 static const struct attribute_group dsicm_attr_group = {
554 .attrs = dsicm_attrs,
557 static void dsicm_hw_reset(struct panel_drv_data *ddata)
559 if (!gpio_is_valid(ddata->reset_gpio))
562 gpio_set_value(ddata->reset_gpio, 1);
564 /* reset the panel */
565 gpio_set_value(ddata->reset_gpio, 0);
568 gpio_set_value(ddata->reset_gpio, 1);
569 /* wait after releasing reset */
570 usleep_range(5000, 10000);
573 static int dsicm_power_on(struct panel_drv_data *ddata)
575 struct omap_dss_device *in = ddata->in;
578 struct omap_dss_dsi_config dsi_config = {
579 .mode = OMAP_DSS_DSI_CMD_MODE,
580 .pixel_format = OMAP_DSS_DSI_FMT_RGB888,
581 .timings = &ddata->timings,
582 .hs_clk_min = 150000000,
583 .hs_clk_max = 300000000,
584 .lp_clk_min = 7000000,
585 .lp_clk_max = 10000000,
588 if (ddata->pin_config.num_pins > 0) {
589 r = in->ops.dsi->configure_pins(in, &ddata->pin_config);
591 dev_err(&ddata->pdev->dev,
592 "failed to configure DSI pins\n");
597 r = in->ops.dsi->set_config(in, &dsi_config);
599 dev_err(&ddata->pdev->dev, "failed to configure DSI\n");
603 r = in->ops.dsi->enable(in);
605 dev_err(&ddata->pdev->dev, "failed to enable DSI\n");
609 dsicm_hw_reset(ddata);
611 in->ops.dsi->enable_hs(in, ddata->channel, false);
613 r = dsicm_sleep_out(ddata);
617 r = dsicm_get_id(ddata, &id1, &id2, &id3);
621 r = dsicm_dcs_write_1(ddata, DCS_BRIGHTNESS, 0xff);
625 r = dsicm_dcs_write_1(ddata, DCS_CTRL_DISPLAY,
626 (1<<2) | (1<<5)); /* BL | BCTRL */
630 r = dsicm_dcs_write_1(ddata, MIPI_DCS_SET_PIXEL_FORMAT,
631 MIPI_DCS_PIXEL_FMT_24BIT);
635 r = dsicm_dcs_write_0(ddata, MIPI_DCS_SET_DISPLAY_ON);
639 r = _dsicm_enable_te(ddata, ddata->te_enabled);
643 r = in->ops.dsi->enable_video_output(in, ddata->channel);
649 if (!ddata->intro_printed) {
650 dev_info(&ddata->pdev->dev, "panel revision %02x.%02x.%02x\n",
652 ddata->intro_printed = true;
655 in->ops.dsi->enable_hs(in, ddata->channel, true);
659 dev_err(&ddata->pdev->dev, "error while enabling panel, issuing HW reset\n");
661 dsicm_hw_reset(ddata);
663 in->ops.dsi->disable(in, true, false);
668 static void dsicm_power_off(struct panel_drv_data *ddata)
670 struct omap_dss_device *in = ddata->in;
673 in->ops.dsi->disable_video_output(in, ddata->channel);
675 r = dsicm_dcs_write_0(ddata, MIPI_DCS_SET_DISPLAY_OFF);
677 r = dsicm_sleep_in(ddata);
680 dev_err(&ddata->pdev->dev,
681 "error disabling panel, issuing HW reset\n");
682 dsicm_hw_reset(ddata);
685 in->ops.dsi->disable(in, true, false);
690 static int dsicm_panel_reset(struct panel_drv_data *ddata)
692 dev_err(&ddata->pdev->dev, "performing LCD reset\n");
694 dsicm_power_off(ddata);
695 dsicm_hw_reset(ddata);
696 return dsicm_power_on(ddata);
699 static int dsicm_connect(struct omap_dss_device *dssdev)
701 struct panel_drv_data *ddata = to_panel_data(dssdev);
702 struct omap_dss_device *in = ddata->in;
703 struct device *dev = &ddata->pdev->dev;
706 if (omapdss_device_is_connected(dssdev))
709 r = in->ops.dsi->connect(in, dssdev);
711 dev_err(dev, "Failed to connect to video source\n");
715 r = in->ops.dsi->request_vc(ddata->in, &ddata->channel);
717 dev_err(dev, "failed to get virtual channel\n");
721 r = in->ops.dsi->set_vc_id(ddata->in, ddata->channel, TCH);
723 dev_err(dev, "failed to set VC_ID\n");
730 in->ops.dsi->release_vc(ddata->in, ddata->channel);
732 in->ops.dsi->disconnect(in, dssdev);
736 static void dsicm_disconnect(struct omap_dss_device *dssdev)
738 struct panel_drv_data *ddata = to_panel_data(dssdev);
739 struct omap_dss_device *in = ddata->in;
741 if (!omapdss_device_is_connected(dssdev))
744 in->ops.dsi->release_vc(in, ddata->channel);
745 in->ops.dsi->disconnect(in, dssdev);
748 static int dsicm_enable(struct omap_dss_device *dssdev)
750 struct panel_drv_data *ddata = to_panel_data(dssdev);
751 struct omap_dss_device *in = ddata->in;
754 dev_dbg(&ddata->pdev->dev, "enable\n");
756 mutex_lock(&ddata->lock);
758 if (!omapdss_device_is_connected(dssdev)) {
763 if (omapdss_device_is_enabled(dssdev)) {
768 in->ops.dsi->bus_lock(in);
770 r = dsicm_power_on(ddata);
772 in->ops.dsi->bus_unlock(in);
777 dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
779 mutex_unlock(&ddata->lock);
783 dev_dbg(&ddata->pdev->dev, "enable failed\n");
784 mutex_unlock(&ddata->lock);
788 static void dsicm_disable(struct omap_dss_device *dssdev)
790 struct panel_drv_data *ddata = to_panel_data(dssdev);
791 struct omap_dss_device *in = ddata->in;
794 dev_dbg(&ddata->pdev->dev, "disable\n");
796 mutex_lock(&ddata->lock);
798 dsicm_cancel_ulps_work(ddata);
800 in->ops.dsi->bus_lock(in);
802 if (omapdss_device_is_enabled(dssdev)) {
803 r = dsicm_wake_up(ddata);
805 dsicm_power_off(ddata);
808 in->ops.dsi->bus_unlock(in);
810 dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
812 mutex_unlock(&ddata->lock);
815 static void dsicm_framedone_cb(int err, void *data)
817 struct panel_drv_data *ddata = data;
818 struct omap_dss_device *in = ddata->in;
820 dev_dbg(&ddata->pdev->dev, "framedone, err %d\n", err);
821 in->ops.dsi->bus_unlock(ddata->in);
824 static irqreturn_t dsicm_te_isr(int irq, void *data)
826 struct panel_drv_data *ddata = data;
827 struct omap_dss_device *in = ddata->in;
831 old = atomic_cmpxchg(&ddata->do_update, 1, 0);
834 cancel_delayed_work(&ddata->te_timeout_work);
836 r = in->ops.dsi->update(in, ddata->channel, dsicm_framedone_cb,
844 dev_err(&ddata->pdev->dev, "start update failed\n");
845 in->ops.dsi->bus_unlock(in);
849 static void dsicm_te_timeout_work_callback(struct work_struct *work)
851 struct panel_drv_data *ddata = container_of(work, struct panel_drv_data,
852 te_timeout_work.work);
853 struct omap_dss_device *in = ddata->in;
855 dev_err(&ddata->pdev->dev, "TE not received for 250ms!\n");
857 atomic_set(&ddata->do_update, 0);
858 in->ops.dsi->bus_unlock(in);
861 static int dsicm_update(struct omap_dss_device *dssdev,
862 u16 x, u16 y, u16 w, u16 h)
864 struct panel_drv_data *ddata = to_panel_data(dssdev);
865 struct omap_dss_device *in = ddata->in;
868 dev_dbg(&ddata->pdev->dev, "update %d, %d, %d x %d\n", x, y, w, h);
870 mutex_lock(&ddata->lock);
871 in->ops.dsi->bus_lock(in);
873 r = dsicm_wake_up(ddata);
877 if (!ddata->enabled) {
882 /* XXX no need to send this every frame, but dsi break if not done */
883 r = dsicm_set_update_window(ddata, 0, 0,
884 dssdev->panel.timings.x_res,
885 dssdev->panel.timings.y_res);
889 if (ddata->te_enabled && gpio_is_valid(ddata->ext_te_gpio)) {
890 schedule_delayed_work(&ddata->te_timeout_work,
891 msecs_to_jiffies(250));
892 atomic_set(&ddata->do_update, 1);
894 r = in->ops.dsi->update(in, ddata->channel, dsicm_framedone_cb,
900 /* note: no bus_unlock here. unlock is in framedone_cb */
901 mutex_unlock(&ddata->lock);
904 in->ops.dsi->bus_unlock(in);
905 mutex_unlock(&ddata->lock);
909 static int dsicm_sync(struct omap_dss_device *dssdev)
911 struct panel_drv_data *ddata = to_panel_data(dssdev);
912 struct omap_dss_device *in = ddata->in;
914 dev_dbg(&ddata->pdev->dev, "sync\n");
916 mutex_lock(&ddata->lock);
917 in->ops.dsi->bus_lock(in);
918 in->ops.dsi->bus_unlock(in);
919 mutex_unlock(&ddata->lock);
921 dev_dbg(&ddata->pdev->dev, "sync done\n");
926 static int _dsicm_enable_te(struct panel_drv_data *ddata, bool enable)
928 struct omap_dss_device *in = ddata->in;
932 r = dsicm_dcs_write_1(ddata, MIPI_DCS_SET_TEAR_ON, 0);
934 r = dsicm_dcs_write_0(ddata, MIPI_DCS_SET_TEAR_OFF);
936 if (!gpio_is_valid(ddata->ext_te_gpio))
937 in->ops.dsi->enable_te(in, enable);
939 /* possible panel bug */
945 static int dsicm_enable_te(struct omap_dss_device *dssdev, bool enable)
947 struct panel_drv_data *ddata = to_panel_data(dssdev);
948 struct omap_dss_device *in = ddata->in;
951 mutex_lock(&ddata->lock);
953 if (ddata->te_enabled == enable)
956 in->ops.dsi->bus_lock(in);
958 if (ddata->enabled) {
959 r = dsicm_wake_up(ddata);
963 r = _dsicm_enable_te(ddata, enable);
968 ddata->te_enabled = enable;
970 in->ops.dsi->bus_unlock(in);
972 mutex_unlock(&ddata->lock);
976 in->ops.dsi->bus_unlock(in);
977 mutex_unlock(&ddata->lock);
982 static int dsicm_get_te(struct omap_dss_device *dssdev)
984 struct panel_drv_data *ddata = to_panel_data(dssdev);
987 mutex_lock(&ddata->lock);
988 r = ddata->te_enabled;
989 mutex_unlock(&ddata->lock);
994 static int dsicm_memory_read(struct omap_dss_device *dssdev,
995 void *buf, size_t size,
996 u16 x, u16 y, u16 w, u16 h)
998 struct panel_drv_data *ddata = to_panel_data(dssdev);
999 struct omap_dss_device *in = ddata->in;
1003 unsigned buf_used = 0;
1005 if (size < w * h * 3)
1008 mutex_lock(&ddata->lock);
1010 if (!ddata->enabled) {
1015 size = min(w * h * 3,
1016 dssdev->panel.timings.x_res *
1017 dssdev->panel.timings.y_res * 3);
1019 in->ops.dsi->bus_lock(in);
1021 r = dsicm_wake_up(ddata);
1025 /* plen 1 or 2 goes into short packet. until checksum error is fixed,
1026 * use short packets. plen 32 works, but bigger packets seem to cause
1033 dsicm_set_update_window(ddata, x, y, w, h);
1035 r = in->ops.dsi->set_max_rx_packet_size(in, ddata->channel, plen);
1039 while (buf_used < size) {
1040 u8 dcs_cmd = first ? 0x2e : 0x3e;
1043 r = in->ops.dsi->dcs_read(in, ddata->channel, dcs_cmd,
1044 buf + buf_used, size - buf_used);
1047 dev_err(dssdev->dev, "read error\n");
1054 dev_err(&ddata->pdev->dev, "short read\n");
1058 if (signal_pending(current)) {
1059 dev_err(&ddata->pdev->dev, "signal pending, "
1060 "aborting memory read\n");
1069 in->ops.dsi->set_max_rx_packet_size(in, ddata->channel, 1);
1071 in->ops.dsi->bus_unlock(in);
1073 mutex_unlock(&ddata->lock);
1077 static void dsicm_ulps_work(struct work_struct *work)
1079 struct panel_drv_data *ddata = container_of(work, struct panel_drv_data,
1081 struct omap_dss_device *dssdev = &ddata->dssdev;
1082 struct omap_dss_device *in = ddata->in;
1084 mutex_lock(&ddata->lock);
1086 if (dssdev->state != OMAP_DSS_DISPLAY_ACTIVE || !ddata->enabled) {
1087 mutex_unlock(&ddata->lock);
1091 in->ops.dsi->bus_lock(in);
1093 dsicm_enter_ulps(ddata);
1095 in->ops.dsi->bus_unlock(in);
1096 mutex_unlock(&ddata->lock);
1099 static struct omap_dss_driver dsicm_ops = {
1100 .connect = dsicm_connect,
1101 .disconnect = dsicm_disconnect,
1103 .enable = dsicm_enable,
1104 .disable = dsicm_disable,
1106 .update = dsicm_update,
1109 .get_resolution = dsicm_get_resolution,
1110 .get_recommended_bpp = omapdss_default_get_recommended_bpp,
1112 .enable_te = dsicm_enable_te,
1113 .get_te = dsicm_get_te,
1115 .memory_read = dsicm_memory_read,
1118 static int dsicm_probe_of(struct platform_device *pdev)
1120 struct device_node *node = pdev->dev.of_node;
1121 struct panel_drv_data *ddata = platform_get_drvdata(pdev);
1122 struct omap_dss_device *in;
1125 gpio = of_get_named_gpio(node, "reset-gpios", 0);
1126 if (!gpio_is_valid(gpio)) {
1127 dev_err(&pdev->dev, "failed to parse reset gpio\n");
1130 ddata->reset_gpio = gpio;
1132 gpio = of_get_named_gpio(node, "te-gpios", 0);
1133 if (gpio_is_valid(gpio) || gpio == -ENOENT) {
1134 ddata->ext_te_gpio = gpio;
1136 dev_err(&pdev->dev, "failed to parse TE gpio\n");
1140 in = omapdss_of_find_source_for_first_ep(node);
1142 dev_err(&pdev->dev, "failed to find video source\n");
1148 /* TODO: ulps, backlight */
1153 static int dsicm_probe(struct platform_device *pdev)
1155 struct backlight_properties props;
1156 struct panel_drv_data *ddata;
1157 struct backlight_device *bldev = NULL;
1158 struct device *dev = &pdev->dev;
1159 struct omap_dss_device *dssdev;
1162 dev_dbg(dev, "probe\n");
1164 if (!pdev->dev.of_node)
1167 ddata = devm_kzalloc(dev, sizeof(*ddata), GFP_KERNEL);
1171 platform_set_drvdata(pdev, ddata);
1174 r = dsicm_probe_of(pdev);
1178 ddata->timings.x_res = 864;
1179 ddata->timings.y_res = 480;
1180 ddata->timings.pixelclock = 864 * 480 * 60;
1182 dssdev = &ddata->dssdev;
1184 dssdev->driver = &dsicm_ops;
1185 dssdev->panel.timings = ddata->timings;
1186 dssdev->type = OMAP_DISPLAY_TYPE_DSI;
1187 dssdev->owner = THIS_MODULE;
1189 dssdev->panel.dsi_pix_fmt = OMAP_DSS_DSI_FMT_RGB888;
1190 dssdev->caps = OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE |
1191 OMAP_DSS_DISPLAY_CAP_TEAR_ELIM;
1193 r = omapdss_register_display(dssdev);
1195 dev_err(dev, "Failed to register panel\n");
1199 mutex_init(&ddata->lock);
1201 atomic_set(&ddata->do_update, 0);
1203 if (gpio_is_valid(ddata->reset_gpio)) {
1204 r = devm_gpio_request_one(dev, ddata->reset_gpio,
1205 GPIOF_OUT_INIT_LOW, "taal rst");
1207 dev_err(dev, "failed to request reset gpio\n");
1212 if (gpio_is_valid(ddata->ext_te_gpio)) {
1213 r = devm_gpio_request_one(dev, ddata->ext_te_gpio,
1214 GPIOF_IN, "taal irq");
1216 dev_err(dev, "GPIO request failed\n");
1220 r = devm_request_irq(dev, gpio_to_irq(ddata->ext_te_gpio),
1222 IRQF_TRIGGER_RISING,
1223 "taal vsync", ddata);
1226 dev_err(dev, "IRQ request failed\n");
1230 INIT_DEFERRABLE_WORK(&ddata->te_timeout_work,
1231 dsicm_te_timeout_work_callback);
1233 dev_dbg(dev, "Using GPIO TE\n");
1236 INIT_DELAYED_WORK(&ddata->ulps_work, dsicm_ulps_work);
1238 dsicm_hw_reset(ddata);
1240 if (ddata->use_dsi_backlight) {
1241 memset(&props, 0, sizeof(struct backlight_properties));
1242 props.max_brightness = 255;
1244 props.type = BACKLIGHT_RAW;
1245 bldev = backlight_device_register(dev_name(dev),
1246 dev, ddata, &dsicm_bl_ops, &props);
1247 if (IS_ERR(bldev)) {
1252 ddata->bldev = bldev;
1254 bldev->props.fb_blank = FB_BLANK_UNBLANK;
1255 bldev->props.power = FB_BLANK_UNBLANK;
1256 bldev->props.brightness = 255;
1258 dsicm_bl_update_status(bldev);
1261 r = sysfs_create_group(&dev->kobj, &dsicm_attr_group);
1263 dev_err(dev, "failed to create sysfs files\n");
1264 goto err_sysfs_create;
1271 backlight_device_unregister(bldev);
1276 static int __exit dsicm_remove(struct platform_device *pdev)
1278 struct panel_drv_data *ddata = platform_get_drvdata(pdev);
1279 struct omap_dss_device *dssdev = &ddata->dssdev;
1280 struct backlight_device *bldev;
1282 dev_dbg(&pdev->dev, "remove\n");
1284 omapdss_unregister_display(dssdev);
1286 dsicm_disable(dssdev);
1287 dsicm_disconnect(dssdev);
1289 sysfs_remove_group(&pdev->dev.kobj, &dsicm_attr_group);
1291 bldev = ddata->bldev;
1292 if (bldev != NULL) {
1293 bldev->props.power = FB_BLANK_POWERDOWN;
1294 dsicm_bl_update_status(bldev);
1295 backlight_device_unregister(bldev);
1298 omap_dss_put_device(ddata->in);
1300 dsicm_cancel_ulps_work(ddata);
1302 /* reset, to be sure that the panel is in a valid state */
1303 dsicm_hw_reset(ddata);
1308 static const struct of_device_id dsicm_of_match[] = {
1309 { .compatible = "omapdss,panel-dsi-cm", },
1313 MODULE_DEVICE_TABLE(of, dsicm_of_match);
1315 static struct platform_driver dsicm_driver = {
1316 .probe = dsicm_probe,
1317 .remove = __exit_p(dsicm_remove),
1319 .name = "panel-dsi-cm",
1320 .of_match_table = dsicm_of_match,
1321 .suppress_bind_attrs = true,
1325 module_platform_driver(dsicm_driver);
1327 MODULE_AUTHOR("Tomi Valkeinen <tomi.valkeinen@ti.com>");
1328 MODULE_DESCRIPTION("Generic DSI Command Mode Panel Driver");
1329 MODULE_LICENSE("GPL");