blob: 5d4648e37fe4872350881facc999d1afe04cbe2e [file] [log] [blame]
Lloyd Atkinsonab3dd302017-02-13 10:44:55 -08001/* Copyright (c) 2016-2017, The Linux Foundation. All rights reserved.
Clarence Ipdd8021c2016-07-20 16:39:47 -04002 *
3 * This program is free software; you can redistribute it and/or modify
4 * it under the terms of the GNU General Public License version 2 and
5 * only version 2 as published by the Free Software Foundation.
6 *
7 * This program is distributed in the hope that it will be useful,
8 * but WITHOUT ANY WARRANTY; without even the implied warranty of
9 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
10 * GNU General Public License for more details.
11 */
12
13#define pr_fmt(fmt) "sde-drm:[%s] " fmt, __func__
14#include "msm_drv.h"
15
16#include "sde_kms.h"
17#include "sde_connector.h"
Dhaval Patel7cdd6662017-03-08 13:10:37 -080018#include <linux/backlight.h>
19#include "dsi_drm.h"
Ping Li898b1bf2017-02-09 18:03:28 -080020#include "dsi_display.h"
Dhaval Patel7cdd6662017-03-08 13:10:37 -080021
22#define BL_NODE_NAME_SIZE 32
Clarence Ipdd8021c2016-07-20 16:39:47 -040023
Lloyd Atkinsonb6191972016-08-10 18:31:46 -040024static const struct drm_prop_enum_list e_topology_name[] = {
25 {SDE_RM_TOPOLOGY_UNKNOWN, "sde_unknown"},
26 {SDE_RM_TOPOLOGY_SINGLEPIPE, "sde_singlepipe"},
27 {SDE_RM_TOPOLOGY_DUALPIPE, "sde_dualpipe"},
28 {SDE_RM_TOPOLOGY_PPSPLIT, "sde_ppsplit"},
29 {SDE_RM_TOPOLOGY_DUALPIPEMERGE, "sde_dualpipemerge"}
30};
31static const struct drm_prop_enum_list e_topology_control[] = {
32 {SDE_RM_TOPCTL_RESERVE_LOCK, "reserve_lock"},
33 {SDE_RM_TOPCTL_RESERVE_CLEAR, "reserve_clear"},
34 {SDE_RM_TOPCTL_DSPP, "dspp"},
35 {SDE_RM_TOPCTL_FORCE_TILING, "force_tiling"},
36 {SDE_RM_TOPCTL_PPSPLIT, "ppsplit"}
37};
38
Dhaval Patel7cdd6662017-03-08 13:10:37 -080039static int sde_backlight_device_update_status(struct backlight_device *bd)
40{
41 int brightness;
42 struct dsi_display *display;
43 struct sde_connector *c_conn;
44 int bl_lvl;
45
46 brightness = bd->props.brightness;
47
48 if ((bd->props.power != FB_BLANK_UNBLANK) ||
49 (bd->props.state & BL_CORE_FBBLANK) ||
50 (bd->props.state & BL_CORE_SUSPENDED))
51 brightness = 0;
52
53 c_conn = bl_get_data(bd);
54 display = (struct dsi_display *) c_conn->display;
55 if (brightness > display->panel->bl_config.bl_max_level)
56 brightness = display->panel->bl_config.bl_max_level;
57
58 /* map UI brightness into driver backlight level with rounding */
59 bl_lvl = mult_frac(brightness, display->panel->bl_config.bl_max_level,
60 display->panel->bl_config.brightness_max_level);
61
62 if (!bl_lvl && brightness)
63 bl_lvl = 1;
64
65 if (c_conn->ops.set_backlight)
66 c_conn->ops.set_backlight(c_conn->display, bl_lvl);
67
68 return 0;
69}
70
71static int sde_backlight_device_get_brightness(struct backlight_device *bd)
72{
73 return 0;
74}
75
76static const struct backlight_ops sde_backlight_device_ops = {
77 .update_status = sde_backlight_device_update_status,
78 .get_brightness = sde_backlight_device_get_brightness,
79};
80
81static int sde_backlight_setup(struct sde_connector *c_conn)
82{
83 struct backlight_device *bl_device;
84 struct backlight_properties props;
85 struct dsi_display *display;
86 struct dsi_backlight_config *bl_config;
87 static int display_count;
88 char bl_node_name[BL_NODE_NAME_SIZE];
89
90 if (!c_conn) {
91 SDE_ERROR("invalid param\n");
92 return -EINVAL;
93 } else if (c_conn->connector_type != DRM_MODE_CONNECTOR_DSI) {
94 return 0;
95 }
96
97 memset(&props, 0, sizeof(props));
98 props.type = BACKLIGHT_RAW;
99 props.power = FB_BLANK_UNBLANK;
100
101 display = (struct dsi_display *) c_conn->display;
102 bl_config = &display->panel->bl_config;
103 props.max_brightness = bl_config->brightness_max_level;
104 props.brightness = bl_config->brightness_max_level;
105 snprintf(bl_node_name, BL_NODE_NAME_SIZE, "panel%u-backlight",
106 display_count);
107 bl_device = backlight_device_register(bl_node_name, c_conn->base.kdev,
108 c_conn, &sde_backlight_device_ops, &props);
109 if (IS_ERR_OR_NULL(bl_device)) {
110 SDE_ERROR("Failed to register backlight: %ld\n",
111 PTR_ERR(bl_device));
112 return -ENODEV;
113 }
114 display_count++;
115
116 return 0;
117}
118
Clarence Ipa18d4832017-03-13 12:35:44 -0700119int sde_connector_trigger_event(void *drm_connector,
120 uint32_t event_idx, uint32_t instance_idx,
121 uint32_t data0, uint32_t data1,
122 uint32_t data2, uint32_t data3)
123{
124 struct sde_connector *c_conn;
125 unsigned long irq_flags;
126 void (*cb_func)(uint32_t event_idx,
127 uint32_t instance_idx, void *usr,
128 uint32_t data0, uint32_t data1,
129 uint32_t data2, uint32_t data3);
130 void *usr;
131 int rc = 0;
132
133 /*
134 * This function may potentially be called from an ISR context, so
135 * avoid excessive logging/etc.
136 */
137 if (!drm_connector)
138 return -EINVAL;
139 else if (event_idx >= SDE_CONN_EVENT_COUNT)
140 return -EINVAL;
141 c_conn = to_sde_connector(drm_connector);
142
143 spin_lock_irqsave(&c_conn->event_lock, irq_flags);
144 cb_func = c_conn->event_table[event_idx].cb_func;
145 usr = c_conn->event_table[event_idx].usr;
146 spin_unlock_irqrestore(&c_conn->event_lock, irq_flags);
147
148 if (cb_func)
149 cb_func(event_idx, instance_idx, usr,
150 data0, data1, data2, data3);
151 else
152 rc = -EAGAIN;
153
154 return rc;
155}
156
157int sde_connector_register_event(struct drm_connector *connector,
158 uint32_t event_idx,
159 void (*cb_func)(uint32_t event_idx,
160 uint32_t instance_idx, void *usr,
161 uint32_t data0, uint32_t data1,
162 uint32_t data2, uint32_t data3),
163 void *usr)
164{
165 struct sde_connector *c_conn;
166 unsigned long irq_flags;
167
168 if (!connector) {
169 SDE_ERROR("invalid connector\n");
170 return -EINVAL;
171 } else if (event_idx >= SDE_CONN_EVENT_COUNT) {
172 SDE_ERROR("conn%d, invalid event %d\n",
173 connector->base.id, event_idx);
174 return -EINVAL;
175 }
176 c_conn = to_sde_connector(connector);
177
178 spin_lock_irqsave(&c_conn->event_lock, irq_flags);
179 c_conn->event_table[event_idx].cb_func = cb_func;
180 c_conn->event_table[event_idx].usr = usr;
181 spin_unlock_irqrestore(&c_conn->event_lock, irq_flags);
182
183 /* optionally notify display of event registration */
184 if (c_conn->ops.enable_event && c_conn->display)
185 c_conn->ops.enable_event(connector, event_idx,
186 cb_func != NULL, c_conn->display);
187 return 0;
188}
189
190void sde_connector_unregister_event(struct drm_connector *connector,
191 uint32_t event_idx)
192{
193 (void)sde_connector_register_event(connector, event_idx, 0, 0);
194}
195
Clarence Ipcb3afd42016-07-15 16:25:34 -0400196int sde_connector_get_info(struct drm_connector *connector,
197 struct msm_display_info *info)
198{
199 struct sde_connector *c_conn;
200
201 if (!connector || !info) {
202 SDE_ERROR("invalid argument(s), conn %pK, info %pK\n",
203 connector, info);
204 return -EINVAL;
205 }
206
207 c_conn = to_sde_connector(connector);
208
209 if (!c_conn->display || !c_conn->ops.get_info) {
210 SDE_ERROR("display info not supported for %pK\n",
211 c_conn->display);
212 return -EINVAL;
213 }
214
215 return c_conn->ops.get_info(info, c_conn->display);
216}
217
Clarence Ipdd8021c2016-07-20 16:39:47 -0400218static void sde_connector_destroy(struct drm_connector *connector)
219{
220 struct sde_connector *c_conn;
221
222 if (!connector) {
223 SDE_ERROR("invalid connector\n");
224 return;
225 }
226
227 c_conn = to_sde_connector(connector);
228
Dhaval Patel4e574842016-08-23 15:11:37 -0700229 if (c_conn->blob_caps)
230 drm_property_unreference_blob(c_conn->blob_caps);
Ping Li898b1bf2017-02-09 18:03:28 -0800231 if (c_conn->blob_hdr)
232 drm_property_unreference_blob(c_conn->blob_hdr);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400233 msm_property_destroy(&c_conn->property_info);
234
235 drm_connector_unregister(connector);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400236 sde_fence_deinit(&c_conn->retire_fence);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400237 drm_connector_cleanup(connector);
238 kfree(c_conn);
239}
240
241/**
242 * _sde_connector_destroy_fb - clean up connector state's out_fb buffer
243 * @c_conn: Pointer to sde connector structure
244 * @c_state: Pointer to sde connector state structure
245 */
246static void _sde_connector_destroy_fb(struct sde_connector *c_conn,
247 struct sde_connector_state *c_state)
248{
249 if (!c_state || !c_state->out_fb) {
250 SDE_ERROR("invalid state %pK\n", c_state);
251 return;
252 }
253
254 msm_framebuffer_cleanup(c_state->out_fb,
255 c_state->mmu_id);
256 drm_framebuffer_unreference(c_state->out_fb);
257 c_state->out_fb = NULL;
258
259 if (c_conn) {
260 c_state->property_values[CONNECTOR_PROP_OUT_FB] =
261 msm_property_get_default(&c_conn->property_info,
262 CONNECTOR_PROP_OUT_FB);
263 } else {
264 c_state->property_values[CONNECTOR_PROP_OUT_FB] = ~0;
265 }
266}
267
268static void sde_connector_atomic_destroy_state(struct drm_connector *connector,
269 struct drm_connector_state *state)
270{
271 struct sde_connector *c_conn = NULL;
272 struct sde_connector_state *c_state = NULL;
273
274 if (!state) {
275 SDE_ERROR("invalid state\n");
276 return;
277 }
278
279 /*
280 * The base DRM framework currently always passes in a NULL
281 * connector pointer. This is not correct, but attempt to
282 * handle that case as much as possible.
283 */
284 if (connector)
285 c_conn = to_sde_connector(connector);
286 c_state = to_sde_connector_state(state);
287
288 if (c_state->out_fb)
289 _sde_connector_destroy_fb(c_conn, c_state);
290
291 if (!c_conn) {
292 kfree(c_state);
293 } else {
294 /* destroy value helper */
295 msm_property_destroy_state(&c_conn->property_info, c_state,
296 c_state->property_values, 0);
297 }
298}
299
300static void sde_connector_atomic_reset(struct drm_connector *connector)
301{
302 struct sde_connector *c_conn;
303 struct sde_connector_state *c_state;
304
305 if (!connector) {
306 SDE_ERROR("invalid connector\n");
307 return;
308 }
309
310 c_conn = to_sde_connector(connector);
311
312 if (connector->state) {
313 sde_connector_atomic_destroy_state(connector, connector->state);
314 connector->state = 0;
315 }
316
317 c_state = msm_property_alloc_state(&c_conn->property_info);
318 if (!c_state) {
319 SDE_ERROR("state alloc failed\n");
320 return;
321 }
322
323 /* reset value helper, zero out state structure and reset properties */
324 msm_property_reset_state(&c_conn->property_info, c_state,
325 c_state->property_values, 0);
326
327 c_state->base.connector = connector;
328 connector->state = &c_state->base;
329}
330
331static struct drm_connector_state *
332sde_connector_atomic_duplicate_state(struct drm_connector *connector)
333{
334 struct sde_connector *c_conn;
335 struct sde_connector_state *c_state, *c_oldstate;
336 int rc;
337
338 if (!connector || !connector->state) {
339 SDE_ERROR("invalid connector %pK\n", connector);
340 return NULL;
341 }
342
343 c_conn = to_sde_connector(connector);
344 c_oldstate = to_sde_connector_state(connector->state);
345 c_state = msm_property_alloc_state(&c_conn->property_info);
346 if (!c_state) {
347 SDE_ERROR("state alloc failed\n");
348 return NULL;
349 }
350
351 /* duplicate value helper */
352 msm_property_duplicate_state(&c_conn->property_info,
353 c_oldstate, c_state, c_state->property_values, 0);
354
355 /* additional handling for drm framebuffer objects */
356 if (c_state->out_fb) {
357 drm_framebuffer_reference(c_state->out_fb);
358 rc = msm_framebuffer_prepare(c_state->out_fb,
359 c_state->mmu_id);
360 if (rc)
361 SDE_ERROR("failed to prepare fb, %d\n", rc);
362 }
363
364 return &c_state->base;
365}
366
367static int sde_connector_atomic_set_property(struct drm_connector *connector,
368 struct drm_connector_state *state,
369 struct drm_property *property,
370 uint64_t val)
371{
372 struct sde_connector *c_conn;
373 struct sde_connector_state *c_state;
374 int idx, rc;
375
376 if (!connector || !state || !property) {
377 SDE_ERROR("invalid argument(s), conn %pK, state %pK, prp %pK\n",
378 connector, state, property);
379 return -EINVAL;
380 }
381
382 c_conn = to_sde_connector(connector);
383 c_state = to_sde_connector_state(state);
384
385 /* generic property handling */
386 rc = msm_property_atomic_set(&c_conn->property_info,
387 c_state->property_values, 0, property, val);
388 if (rc)
389 goto end;
390
391 /* connector-specific property handling */
392 idx = msm_property_index(&c_conn->property_info, property);
393
394 if (idx == CONNECTOR_PROP_OUT_FB) {
395 /* clear old fb, if present */
396 if (c_state->out_fb)
397 _sde_connector_destroy_fb(c_conn, c_state);
398
399 /* convert fb val to drm framebuffer and prepare it */
400 c_state->out_fb =
401 drm_framebuffer_lookup(connector->dev, val);
Alan Kwongae1b1142017-03-05 16:07:10 -0800402 if (!c_state->out_fb && val) {
Clarence Ipdd8021c2016-07-20 16:39:47 -0400403 SDE_ERROR("failed to look up fb %lld\n", val);
404 rc = -EFAULT;
Alan Kwongae1b1142017-03-05 16:07:10 -0800405 } else if (!c_state->out_fb && !val) {
406 SDE_DEBUG("cleared fb_id\n");
407 rc = 0;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400408 } else {
Alan Kwong578cdaf2017-01-28 17:25:43 -0800409 msm_framebuffer_set_kmap(c_state->out_fb,
410 c_conn->fb_kmap);
411
Alan Kwongdfa8c082016-07-29 04:10:00 -0400412 if (c_state->out_fb->flags & DRM_MODE_FB_SECURE)
413 c_state->mmu_id =
414 c_conn->mmu_id[SDE_IOMMU_DOMAIN_SECURE];
415 else
416 c_state->mmu_id =
417 c_conn->mmu_id[SDE_IOMMU_DOMAIN_UNSECURE];
Clarence Ipdd8021c2016-07-20 16:39:47 -0400418
419 rc = msm_framebuffer_prepare(c_state->out_fb,
420 c_state->mmu_id);
421 if (rc)
422 SDE_ERROR("prep fb failed, %d\n", rc);
423 }
424 }
425
Lloyd Atkinson11f34442016-08-11 11:19:52 -0400426 if (idx == CONNECTOR_PROP_TOPOLOGY_CONTROL) {
427 rc = sde_rm_check_property_topctl(val);
428 if (rc)
429 SDE_ERROR("invalid topology_control: 0x%llX\n", val);
430 }
431
Clarence Ipdd8021c2016-07-20 16:39:47 -0400432 /* check for custom property handling */
433 if (!rc && c_conn->ops.set_property) {
434 rc = c_conn->ops.set_property(connector,
435 state,
436 idx,
437 val,
438 c_conn->display);
439
440 /* potentially clean up out_fb if rc != 0 */
441 if ((idx == CONNECTOR_PROP_OUT_FB) && rc)
442 _sde_connector_destroy_fb(c_conn, c_state);
443 }
444end:
445 return rc;
446}
447
448static int sde_connector_set_property(struct drm_connector *connector,
449 struct drm_property *property,
450 uint64_t val)
451{
452 if (!connector) {
453 SDE_ERROR("invalid connector\n");
454 return -EINVAL;
455 }
456
457 return sde_connector_atomic_set_property(connector,
458 connector->state, property, val);
459}
460
461static int sde_connector_atomic_get_property(struct drm_connector *connector,
462 const struct drm_connector_state *state,
463 struct drm_property *property,
464 uint64_t *val)
465{
466 struct sde_connector *c_conn;
467 struct sde_connector_state *c_state;
468 int idx, rc = -EINVAL;
469
470 if (!connector || !state) {
471 SDE_ERROR("invalid argument(s), conn %pK, state %pK\n",
472 connector, state);
473 return -EINVAL;
474 }
475
476 c_conn = to_sde_connector(connector);
477 c_state = to_sde_connector_state(state);
478
479 idx = msm_property_index(&c_conn->property_info, property);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400480 if (idx == CONNECTOR_PROP_RETIRE_FENCE)
Clarence Ip9a74a442016-08-25 18:29:03 -0400481 /*
482 * Set a fence offset if not a virtual connector, so that the
483 * fence signals after one additional commit rather than at the
484 * end of the current one.
485 */
486 rc = sde_fence_create(&c_conn->retire_fence, val,
487 c_conn->connector_type != DRM_MODE_CONNECTOR_VIRTUAL);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400488 else
489 /* get cached property value */
490 rc = msm_property_atomic_get(&c_conn->property_info,
491 c_state->property_values, 0, property, val);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400492
493 /* allow for custom override */
494 if (c_conn->ops.get_property)
495 rc = c_conn->ops.get_property(connector,
496 (struct drm_connector_state *)state,
497 idx,
498 val,
499 c_conn->display);
500 return rc;
501}
502
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400503void sde_connector_prepare_fence(struct drm_connector *connector)
504{
505 if (!connector) {
506 SDE_ERROR("invalid connector\n");
507 return;
508 }
509
510 sde_fence_prepare(&to_sde_connector(connector)->retire_fence);
511}
512
513void sde_connector_complete_commit(struct drm_connector *connector)
514{
515 if (!connector) {
516 SDE_ERROR("invalid connector\n");
517 return;
518 }
519
520 /* signal connector's retire fence */
521 sde_fence_signal(&to_sde_connector(connector)->retire_fence, 0);
522}
523
Clarence Ipdd8021c2016-07-20 16:39:47 -0400524static enum drm_connector_status
525sde_connector_detect(struct drm_connector *connector, bool force)
526{
527 enum drm_connector_status status = connector_status_unknown;
528 struct sde_connector *c_conn;
529
530 if (!connector) {
531 SDE_ERROR("invalid connector\n");
532 return status;
533 }
534
535 c_conn = to_sde_connector(connector);
536
537 if (c_conn->ops.detect)
538 status = c_conn->ops.detect(connector,
539 force,
540 c_conn->display);
541
542 return status;
543}
544
Alan Kwong578cdaf2017-01-28 17:25:43 -0800545#ifdef CONFIG_DEBUG_FS
546/**
547 * sde_connector_init_debugfs - initialize connector debugfs
548 * @connector: Pointer to drm connector
549 */
550static int sde_connector_init_debugfs(struct drm_connector *connector)
551{
552 struct sde_connector *sde_connector;
553
554 if (!connector || !connector->debugfs_entry) {
555 SDE_ERROR("invalid connector\n");
556 return -EINVAL;
557 }
558
559 sde_connector = to_sde_connector(connector);
560
561 if (!debugfs_create_bool("fb_kmap", 0644, connector->debugfs_entry,
562 &sde_connector->fb_kmap)) {
563 SDE_ERROR("failed to create connector fb_kmap\n");
564 return -ENOMEM;
565 }
566
567 return 0;
568}
569#else
570static int sde_connector_init_debugfs(struct drm_connector *connector)
571{
572 return 0;
573}
574#endif
575
576static int sde_connector_late_register(struct drm_connector *connector)
577{
578 return sde_connector_init_debugfs(connector);
579}
580
Lloyd Atkinsonb020e0f2017-03-14 08:05:18 -0700581static void sde_connector_early_unregister(struct drm_connector *connector)
582{
583 /* debugfs under connector->debugfs are deleted by drm_debugfs */
584}
585
Clarence Ipdd8021c2016-07-20 16:39:47 -0400586static const struct drm_connector_funcs sde_connector_ops = {
587 .dpms = drm_atomic_helper_connector_dpms,
588 .reset = sde_connector_atomic_reset,
589 .detect = sde_connector_detect,
590 .destroy = sde_connector_destroy,
591 .fill_modes = drm_helper_probe_single_connector_modes,
592 .atomic_duplicate_state = sde_connector_atomic_duplicate_state,
593 .atomic_destroy_state = sde_connector_atomic_destroy_state,
594 .atomic_set_property = sde_connector_atomic_set_property,
595 .atomic_get_property = sde_connector_atomic_get_property,
596 .set_property = sde_connector_set_property,
Alan Kwong578cdaf2017-01-28 17:25:43 -0800597 .late_register = sde_connector_late_register,
Lloyd Atkinsonb020e0f2017-03-14 08:05:18 -0700598 .early_unregister = sde_connector_early_unregister,
Clarence Ipdd8021c2016-07-20 16:39:47 -0400599};
600
601static int sde_connector_get_modes(struct drm_connector *connector)
602{
603 struct sde_connector *c_conn;
604
605 if (!connector) {
606 SDE_ERROR("invalid connector\n");
607 return 0;
608 }
609
610 c_conn = to_sde_connector(connector);
611 if (!c_conn->ops.get_modes) {
612 SDE_DEBUG("missing get_modes callback\n");
613 return 0;
614 }
615
616 return c_conn->ops.get_modes(connector, c_conn->display);
617}
618
619static enum drm_mode_status
620sde_connector_mode_valid(struct drm_connector *connector,
621 struct drm_display_mode *mode)
622{
623 struct sde_connector *c_conn;
624
625 if (!connector || !mode) {
626 SDE_ERROR("invalid argument(s), conn %pK, mode %pK\n",
627 connector, mode);
628 return MODE_ERROR;
629 }
630
631 c_conn = to_sde_connector(connector);
632
633 if (c_conn->ops.mode_valid)
634 return c_conn->ops.mode_valid(connector, mode, c_conn->display);
635
636 /* assume all modes okay by default */
637 return MODE_OK;
638}
639
640static struct drm_encoder *
641sde_connector_best_encoder(struct drm_connector *connector)
642{
643 struct sde_connector *c_conn = to_sde_connector(connector);
644
645 if (!connector) {
646 SDE_ERROR("invalid connector\n");
647 return NULL;
648 }
649
650 /*
651 * This is true for now, revisit this code when multiple encoders are
652 * supported.
653 */
654 return c_conn->encoder;
655}
656
657static const struct drm_connector_helper_funcs sde_connector_helper_ops = {
658 .get_modes = sde_connector_get_modes,
659 .mode_valid = sde_connector_mode_valid,
660 .best_encoder = sde_connector_best_encoder,
661};
662
663struct drm_connector *sde_connector_init(struct drm_device *dev,
664 struct drm_encoder *encoder,
665 struct drm_panel *panel,
666 void *display,
667 const struct sde_connector_ops *ops,
668 int connector_poll,
669 int connector_type)
670{
671 struct msm_drm_private *priv;
672 struct sde_kms *sde_kms;
673 struct sde_kms_info *info;
674 struct sde_connector *c_conn = NULL;
Ping Li898b1bf2017-02-09 18:03:28 -0800675 struct dsi_display *dsi_display;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400676 int rc;
677
678 if (!dev || !dev->dev_private || !encoder) {
679 SDE_ERROR("invalid argument(s), dev %pK, enc %pK\n",
680 dev, encoder);
681 return ERR_PTR(-EINVAL);
682 }
683
684 priv = dev->dev_private;
685 if (!priv->kms) {
686 SDE_ERROR("invalid kms reference\n");
687 return ERR_PTR(-EINVAL);
688 }
689
690 c_conn = kzalloc(sizeof(*c_conn), GFP_KERNEL);
691 if (!c_conn) {
692 SDE_ERROR("failed to alloc sde connector\n");
693 return ERR_PTR(-ENOMEM);
694 }
695
696 rc = drm_connector_init(dev,
697 &c_conn->base,
698 &sde_connector_ops,
699 connector_type);
700 if (rc)
701 goto error_free_conn;
702
Clarence Ipa18d4832017-03-13 12:35:44 -0700703 spin_lock_init(&c_conn->event_lock);
704
Clarence Ipdd8021c2016-07-20 16:39:47 -0400705 c_conn->connector_type = connector_type;
706 c_conn->encoder = encoder;
707 c_conn->panel = panel;
708 c_conn->display = display;
709
Alan Kwongdfa8c082016-07-29 04:10:00 -0400710 /* cache mmu_id's for later */
Clarence Ipdd8021c2016-07-20 16:39:47 -0400711 sde_kms = to_sde_kms(priv->kms);
Alan Kwongdfa8c082016-07-29 04:10:00 -0400712 if (sde_kms->vbif[VBIF_NRT]) {
713 c_conn->mmu_id[SDE_IOMMU_DOMAIN_UNSECURE] =
714 sde_kms->mmu_id[MSM_SMMU_DOMAIN_NRT_UNSECURE];
715 c_conn->mmu_id[SDE_IOMMU_DOMAIN_SECURE] =
716 sde_kms->mmu_id[MSM_SMMU_DOMAIN_NRT_SECURE];
717 } else {
718 c_conn->mmu_id[SDE_IOMMU_DOMAIN_UNSECURE] =
719 sde_kms->mmu_id[MSM_SMMU_DOMAIN_UNSECURE];
720 c_conn->mmu_id[SDE_IOMMU_DOMAIN_SECURE] =
721 sde_kms->mmu_id[MSM_SMMU_DOMAIN_SECURE];
722 }
Clarence Ipdd8021c2016-07-20 16:39:47 -0400723
724 if (ops)
725 c_conn->ops = *ops;
726
727 c_conn->base.helper_private = &sde_connector_helper_ops;
728 c_conn->base.polled = connector_poll;
729 c_conn->base.interlace_allowed = 0;
730 c_conn->base.doublescan_allowed = 0;
731
732 snprintf(c_conn->name,
733 SDE_CONNECTOR_NAME_SIZE,
734 "conn%u",
735 c_conn->base.base.id);
736
Lloyd Atkinson5d40d312016-09-06 08:34:13 -0400737 rc = sde_fence_init(&c_conn->retire_fence, c_conn->name,
738 c_conn->base.base.id);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400739 if (rc) {
740 SDE_ERROR("failed to init fence, %d\n", rc);
741 goto error_cleanup_conn;
742 }
743
Clarence Ipdd8021c2016-07-20 16:39:47 -0400744 rc = drm_mode_connector_attach_encoder(&c_conn->base, encoder);
745 if (rc) {
746 SDE_ERROR("failed to attach encoder to connector, %d\n", rc);
Lloyd Atkinsonab3dd302017-02-13 10:44:55 -0800747 goto error_cleanup_fence;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400748 }
749
Dhaval Patel7cdd6662017-03-08 13:10:37 -0800750 rc = sde_backlight_setup(c_conn);
751 if (rc) {
752 SDE_ERROR("failed to setup backlight, rc=%d\n", rc);
753 goto error_cleanup_fence;
Vishnuvardhan Prodduturi75b96802016-10-17 18:45:55 +0530754 }
755
Clarence Ipdd8021c2016-07-20 16:39:47 -0400756 /* create properties */
757 msm_property_init(&c_conn->property_info, &c_conn->base.base, dev,
758 priv->conn_property, c_conn->property_data,
759 CONNECTOR_PROP_COUNT, CONNECTOR_PROP_BLOBCOUNT,
760 sizeof(struct sde_connector_state));
761
762 if (c_conn->ops.post_init) {
763 info = kmalloc(sizeof(*info), GFP_KERNEL);
764 if (!info) {
765 SDE_ERROR("failed to allocate info buffer\n");
766 rc = -ENOMEM;
Lloyd Atkinsonab3dd302017-02-13 10:44:55 -0800767 goto error_cleanup_fence;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400768 }
769
770 sde_kms_info_reset(info);
771 rc = c_conn->ops.post_init(&c_conn->base, info, display);
772 if (rc) {
773 SDE_ERROR("post-init failed, %d\n", rc);
774 kfree(info);
Lloyd Atkinsonab3dd302017-02-13 10:44:55 -0800775 goto error_cleanup_fence;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400776 }
777
778 msm_property_install_blob(&c_conn->property_info,
Dhaval Patel4e574842016-08-23 15:11:37 -0700779 "capabilities",
Clarence Ipdd8021c2016-07-20 16:39:47 -0400780 DRM_MODE_PROP_IMMUTABLE,
781 CONNECTOR_PROP_SDE_INFO);
782
783 msm_property_set_blob(&c_conn->property_info,
Dhaval Patel4e574842016-08-23 15:11:37 -0700784 &c_conn->blob_caps,
Clarence Ipdd8021c2016-07-20 16:39:47 -0400785 SDE_KMS_INFO_DATA(info),
786 SDE_KMS_INFO_DATALEN(info),
787 CONNECTOR_PROP_SDE_INFO);
788 kfree(info);
789 }
790
Ping Li898b1bf2017-02-09 18:03:28 -0800791 if (connector_type == DRM_MODE_CONNECTOR_DSI) {
792 dsi_display = (struct dsi_display *)(display);
793 if (dsi_display && dsi_display->panel &&
794 dsi_display->panel->hdr_props.hdr_enabled == true) {
795 msm_property_install_blob(&c_conn->property_info,
796 "hdr_properties",
797 DRM_MODE_PROP_IMMUTABLE,
798 CONNECTOR_PROP_HDR_INFO);
799
800 msm_property_set_blob(&c_conn->property_info,
801 &c_conn->blob_hdr,
802 &dsi_display->panel->hdr_props,
803 sizeof(dsi_display->panel->hdr_props),
804 CONNECTOR_PROP_HDR_INFO);
805 }
806 }
807
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400808 msm_property_install_range(&c_conn->property_info, "RETIRE_FENCE",
Dhaval Patel4e574842016-08-23 15:11:37 -0700809 0x0, 0, INR_OPEN_MAX, 0, CONNECTOR_PROP_RETIRE_FENCE);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400810
Lloyd Atkinsonb6191972016-08-10 18:31:46 -0400811 /* enum/bitmask properties */
812 msm_property_install_enum(&c_conn->property_info, "topology_name",
813 DRM_MODE_PROP_IMMUTABLE, 0, e_topology_name,
814 ARRAY_SIZE(e_topology_name),
815 CONNECTOR_PROP_TOPOLOGY_NAME);
816 msm_property_install_enum(&c_conn->property_info, "topology_control",
817 0, 1, e_topology_control,
818 ARRAY_SIZE(e_topology_control),
819 CONNECTOR_PROP_TOPOLOGY_CONTROL);
820
Clarence Ipdd8021c2016-07-20 16:39:47 -0400821 rc = msm_property_install_get_status(&c_conn->property_info);
822 if (rc) {
823 SDE_ERROR("failed to create one or more properties\n");
824 goto error_destroy_property;
825 }
826
Lloyd Atkinsonb6191972016-08-10 18:31:46 -0400827 SDE_DEBUG("connector %d attach encoder %d\n",
828 c_conn->base.base.id, encoder->base.id);
829
Clarence Ipdd8021c2016-07-20 16:39:47 -0400830 priv->connectors[priv->num_connectors++] = &c_conn->base;
831
832 return &c_conn->base;
833
834error_destroy_property:
Dhaval Patel4e574842016-08-23 15:11:37 -0700835 if (c_conn->blob_caps)
836 drm_property_unreference_blob(c_conn->blob_caps);
Ping Li898b1bf2017-02-09 18:03:28 -0800837 if (c_conn->blob_hdr)
838 drm_property_unreference_blob(c_conn->blob_hdr);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400839 msm_property_destroy(&c_conn->property_info);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400840error_cleanup_fence:
841 sde_fence_deinit(&c_conn->retire_fence);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400842error_cleanup_conn:
843 drm_connector_cleanup(&c_conn->base);
844error_free_conn:
845 kfree(c_conn);
846
847 return ERR_PTR(rc);
848}