hc
2024-05-10 cde9070d9970eef1f7ec2360586c802a16230ad8
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (C) 2014 Red Hat
 * Author: Rob Clark <robdclark@gmail.com>
 * Author: Vinay Simha <vinaysimha@inforcecomputing.com>
 */
 
#include "mdp4_kms.h"
 
struct mdp4_lvds_connector {
   struct drm_connector base;
   struct drm_encoder *encoder;
   struct device_node *panel_node;
   struct drm_panel *panel;
};
#define to_mdp4_lvds_connector(x) container_of(x, struct mdp4_lvds_connector, base)
 
static enum drm_connector_status mdp4_lvds_connector_detect(
       struct drm_connector *connector, bool force)
{
   struct mdp4_lvds_connector *mdp4_lvds_connector =
           to_mdp4_lvds_connector(connector);
 
   if (!mdp4_lvds_connector->panel) {
       mdp4_lvds_connector->panel =
           of_drm_find_panel(mdp4_lvds_connector->panel_node);
       if (IS_ERR(mdp4_lvds_connector->panel))
           mdp4_lvds_connector->panel = NULL;
   }
 
   return mdp4_lvds_connector->panel ?
           connector_status_connected :
           connector_status_disconnected;
}
 
static void mdp4_lvds_connector_destroy(struct drm_connector *connector)
{
   struct mdp4_lvds_connector *mdp4_lvds_connector =
           to_mdp4_lvds_connector(connector);
 
   drm_connector_cleanup(connector);
 
   kfree(mdp4_lvds_connector);
}
 
static int mdp4_lvds_connector_get_modes(struct drm_connector *connector)
{
   struct mdp4_lvds_connector *mdp4_lvds_connector =
           to_mdp4_lvds_connector(connector);
   struct drm_panel *panel = mdp4_lvds_connector->panel;
   int ret = 0;
 
   if (panel)
       ret = drm_panel_get_modes(panel, connector);
 
   return ret;
}
 
static enum drm_mode_status
mdp4_lvds_connector_mode_valid(struct drm_connector *connector,
                  struct drm_display_mode *mode)
{
   struct mdp4_lvds_connector *mdp4_lvds_connector =
           to_mdp4_lvds_connector(connector);
   struct drm_encoder *encoder = mdp4_lvds_connector->encoder;
   long actual, requested;
 
   requested = 1000 * mode->clock;
   actual = mdp4_lcdc_round_pixclk(encoder, requested);
 
   DBG("requested=%ld, actual=%ld", requested, actual);
 
   if (actual != requested)
       return MODE_CLOCK_RANGE;
 
   return MODE_OK;
}
 
static const struct drm_connector_funcs mdp4_lvds_connector_funcs = {
   .detect = mdp4_lvds_connector_detect,
   .fill_modes = drm_helper_probe_single_connector_modes,
   .destroy = mdp4_lvds_connector_destroy,
   .reset = drm_atomic_helper_connector_reset,
   .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
   .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
};
 
static const struct drm_connector_helper_funcs mdp4_lvds_connector_helper_funcs = {
   .get_modes = mdp4_lvds_connector_get_modes,
   .mode_valid = mdp4_lvds_connector_mode_valid,
};
 
/* initialize connector */
struct drm_connector *mdp4_lvds_connector_init(struct drm_device *dev,
       struct device_node *panel_node, struct drm_encoder *encoder)
{
   struct drm_connector *connector = NULL;
   struct mdp4_lvds_connector *mdp4_lvds_connector;
 
   mdp4_lvds_connector = kzalloc(sizeof(*mdp4_lvds_connector), GFP_KERNEL);
   if (!mdp4_lvds_connector)
       return ERR_PTR(-ENOMEM);
 
   mdp4_lvds_connector->encoder = encoder;
   mdp4_lvds_connector->panel_node = panel_node;
 
   connector = &mdp4_lvds_connector->base;
 
   drm_connector_init(dev, connector, &mdp4_lvds_connector_funcs,
           DRM_MODE_CONNECTOR_LVDS);
   drm_connector_helper_add(connector, &mdp4_lvds_connector_helper_funcs);
 
   connector->polled = 0;
 
   connector->interlace_allowed = 0;
   connector->doublescan_allowed = 0;
 
   drm_connector_attach_encoder(connector, encoder);
 
   return connector;
}