blob: 9caadcadd284eba5fc6ad032d34f4fdb86687786 [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);
402 if (!c_state->out_fb) {
403 SDE_ERROR("failed to look up fb %lld\n", val);
404 rc = -EFAULT;
405 } else {
Alan Kwong578cdaf2017-01-28 17:25:43 -0800406 msm_framebuffer_set_kmap(c_state->out_fb,
407 c_conn->fb_kmap);
408
Alan Kwongdfa8c082016-07-29 04:10:00 -0400409 if (c_state->out_fb->flags & DRM_MODE_FB_SECURE)
410 c_state->mmu_id =
411 c_conn->mmu_id[SDE_IOMMU_DOMAIN_SECURE];
412 else
413 c_state->mmu_id =
414 c_conn->mmu_id[SDE_IOMMU_DOMAIN_UNSECURE];
Clarence Ipdd8021c2016-07-20 16:39:47 -0400415
416 rc = msm_framebuffer_prepare(c_state->out_fb,
417 c_state->mmu_id);
418 if (rc)
419 SDE_ERROR("prep fb failed, %d\n", rc);
420 }
421 }
422
Lloyd Atkinson11f34442016-08-11 11:19:52 -0400423 if (idx == CONNECTOR_PROP_TOPOLOGY_CONTROL) {
424 rc = sde_rm_check_property_topctl(val);
425 if (rc)
426 SDE_ERROR("invalid topology_control: 0x%llX\n", val);
427 }
428
Clarence Ipdd8021c2016-07-20 16:39:47 -0400429 /* check for custom property handling */
430 if (!rc && c_conn->ops.set_property) {
431 rc = c_conn->ops.set_property(connector,
432 state,
433 idx,
434 val,
435 c_conn->display);
436
437 /* potentially clean up out_fb if rc != 0 */
438 if ((idx == CONNECTOR_PROP_OUT_FB) && rc)
439 _sde_connector_destroy_fb(c_conn, c_state);
440 }
441end:
442 return rc;
443}
444
445static int sde_connector_set_property(struct drm_connector *connector,
446 struct drm_property *property,
447 uint64_t val)
448{
449 if (!connector) {
450 SDE_ERROR("invalid connector\n");
451 return -EINVAL;
452 }
453
454 return sde_connector_atomic_set_property(connector,
455 connector->state, property, val);
456}
457
458static int sde_connector_atomic_get_property(struct drm_connector *connector,
459 const struct drm_connector_state *state,
460 struct drm_property *property,
461 uint64_t *val)
462{
463 struct sde_connector *c_conn;
464 struct sde_connector_state *c_state;
465 int idx, rc = -EINVAL;
466
467 if (!connector || !state) {
468 SDE_ERROR("invalid argument(s), conn %pK, state %pK\n",
469 connector, state);
470 return -EINVAL;
471 }
472
473 c_conn = to_sde_connector(connector);
474 c_state = to_sde_connector_state(state);
475
476 idx = msm_property_index(&c_conn->property_info, property);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400477 if (idx == CONNECTOR_PROP_RETIRE_FENCE)
Clarence Ip9a74a442016-08-25 18:29:03 -0400478 /*
479 * Set a fence offset if not a virtual connector, so that the
480 * fence signals after one additional commit rather than at the
481 * end of the current one.
482 */
483 rc = sde_fence_create(&c_conn->retire_fence, val,
484 c_conn->connector_type != DRM_MODE_CONNECTOR_VIRTUAL);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400485 else
486 /* get cached property value */
487 rc = msm_property_atomic_get(&c_conn->property_info,
488 c_state->property_values, 0, property, val);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400489
490 /* allow for custom override */
491 if (c_conn->ops.get_property)
492 rc = c_conn->ops.get_property(connector,
493 (struct drm_connector_state *)state,
494 idx,
495 val,
496 c_conn->display);
497 return rc;
498}
499
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400500void sde_connector_prepare_fence(struct drm_connector *connector)
501{
502 if (!connector) {
503 SDE_ERROR("invalid connector\n");
504 return;
505 }
506
507 sde_fence_prepare(&to_sde_connector(connector)->retire_fence);
508}
509
510void sde_connector_complete_commit(struct drm_connector *connector)
511{
512 if (!connector) {
513 SDE_ERROR("invalid connector\n");
514 return;
515 }
516
517 /* signal connector's retire fence */
518 sde_fence_signal(&to_sde_connector(connector)->retire_fence, 0);
519}
520
Clarence Ipdd8021c2016-07-20 16:39:47 -0400521static enum drm_connector_status
522sde_connector_detect(struct drm_connector *connector, bool force)
523{
524 enum drm_connector_status status = connector_status_unknown;
525 struct sde_connector *c_conn;
526
527 if (!connector) {
528 SDE_ERROR("invalid connector\n");
529 return status;
530 }
531
532 c_conn = to_sde_connector(connector);
533
534 if (c_conn->ops.detect)
535 status = c_conn->ops.detect(connector,
536 force,
537 c_conn->display);
538
539 return status;
540}
541
Alan Kwong578cdaf2017-01-28 17:25:43 -0800542#ifdef CONFIG_DEBUG_FS
543/**
544 * sde_connector_init_debugfs - initialize connector debugfs
545 * @connector: Pointer to drm connector
546 */
547static int sde_connector_init_debugfs(struct drm_connector *connector)
548{
549 struct sde_connector *sde_connector;
550
551 if (!connector || !connector->debugfs_entry) {
552 SDE_ERROR("invalid connector\n");
553 return -EINVAL;
554 }
555
556 sde_connector = to_sde_connector(connector);
557
558 if (!debugfs_create_bool("fb_kmap", 0644, connector->debugfs_entry,
559 &sde_connector->fb_kmap)) {
560 SDE_ERROR("failed to create connector fb_kmap\n");
561 return -ENOMEM;
562 }
563
564 return 0;
565}
566#else
567static int sde_connector_init_debugfs(struct drm_connector *connector)
568{
569 return 0;
570}
571#endif
572
573static int sde_connector_late_register(struct drm_connector *connector)
574{
575 return sde_connector_init_debugfs(connector);
576}
577
Lloyd Atkinsonb020e0f2017-03-14 08:05:18 -0700578static void sde_connector_early_unregister(struct drm_connector *connector)
579{
580 /* debugfs under connector->debugfs are deleted by drm_debugfs */
581}
582
Clarence Ipdd8021c2016-07-20 16:39:47 -0400583static const struct drm_connector_funcs sde_connector_ops = {
584 .dpms = drm_atomic_helper_connector_dpms,
585 .reset = sde_connector_atomic_reset,
586 .detect = sde_connector_detect,
587 .destroy = sde_connector_destroy,
588 .fill_modes = drm_helper_probe_single_connector_modes,
589 .atomic_duplicate_state = sde_connector_atomic_duplicate_state,
590 .atomic_destroy_state = sde_connector_atomic_destroy_state,
591 .atomic_set_property = sde_connector_atomic_set_property,
592 .atomic_get_property = sde_connector_atomic_get_property,
593 .set_property = sde_connector_set_property,
Alan Kwong578cdaf2017-01-28 17:25:43 -0800594 .late_register = sde_connector_late_register,
Lloyd Atkinsonb020e0f2017-03-14 08:05:18 -0700595 .early_unregister = sde_connector_early_unregister,
Clarence Ipdd8021c2016-07-20 16:39:47 -0400596};
597
598static int sde_connector_get_modes(struct drm_connector *connector)
599{
600 struct sde_connector *c_conn;
601
602 if (!connector) {
603 SDE_ERROR("invalid connector\n");
604 return 0;
605 }
606
607 c_conn = to_sde_connector(connector);
608 if (!c_conn->ops.get_modes) {
609 SDE_DEBUG("missing get_modes callback\n");
610 return 0;
611 }
612
613 return c_conn->ops.get_modes(connector, c_conn->display);
614}
615
616static enum drm_mode_status
617sde_connector_mode_valid(struct drm_connector *connector,
618 struct drm_display_mode *mode)
619{
620 struct sde_connector *c_conn;
621
622 if (!connector || !mode) {
623 SDE_ERROR("invalid argument(s), conn %pK, mode %pK\n",
624 connector, mode);
625 return MODE_ERROR;
626 }
627
628 c_conn = to_sde_connector(connector);
629
630 if (c_conn->ops.mode_valid)
631 return c_conn->ops.mode_valid(connector, mode, c_conn->display);
632
633 /* assume all modes okay by default */
634 return MODE_OK;
635}
636
637static struct drm_encoder *
638sde_connector_best_encoder(struct drm_connector *connector)
639{
640 struct sde_connector *c_conn = to_sde_connector(connector);
641
642 if (!connector) {
643 SDE_ERROR("invalid connector\n");
644 return NULL;
645 }
646
647 /*
648 * This is true for now, revisit this code when multiple encoders are
649 * supported.
650 */
651 return c_conn->encoder;
652}
653
654static const struct drm_connector_helper_funcs sde_connector_helper_ops = {
655 .get_modes = sde_connector_get_modes,
656 .mode_valid = sde_connector_mode_valid,
657 .best_encoder = sde_connector_best_encoder,
658};
659
660struct drm_connector *sde_connector_init(struct drm_device *dev,
661 struct drm_encoder *encoder,
662 struct drm_panel *panel,
663 void *display,
664 const struct sde_connector_ops *ops,
665 int connector_poll,
666 int connector_type)
667{
668 struct msm_drm_private *priv;
669 struct sde_kms *sde_kms;
670 struct sde_kms_info *info;
671 struct sde_connector *c_conn = NULL;
Ping Li898b1bf2017-02-09 18:03:28 -0800672 struct dsi_display *dsi_display;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400673 int rc;
674
675 if (!dev || !dev->dev_private || !encoder) {
676 SDE_ERROR("invalid argument(s), dev %pK, enc %pK\n",
677 dev, encoder);
678 return ERR_PTR(-EINVAL);
679 }
680
681 priv = dev->dev_private;
682 if (!priv->kms) {
683 SDE_ERROR("invalid kms reference\n");
684 return ERR_PTR(-EINVAL);
685 }
686
687 c_conn = kzalloc(sizeof(*c_conn), GFP_KERNEL);
688 if (!c_conn) {
689 SDE_ERROR("failed to alloc sde connector\n");
690 return ERR_PTR(-ENOMEM);
691 }
692
693 rc = drm_connector_init(dev,
694 &c_conn->base,
695 &sde_connector_ops,
696 connector_type);
697 if (rc)
698 goto error_free_conn;
699
Clarence Ipa18d4832017-03-13 12:35:44 -0700700 spin_lock_init(&c_conn->event_lock);
701
Clarence Ipdd8021c2016-07-20 16:39:47 -0400702 c_conn->connector_type = connector_type;
703 c_conn->encoder = encoder;
704 c_conn->panel = panel;
705 c_conn->display = display;
706
Alan Kwongdfa8c082016-07-29 04:10:00 -0400707 /* cache mmu_id's for later */
Clarence Ipdd8021c2016-07-20 16:39:47 -0400708 sde_kms = to_sde_kms(priv->kms);
Alan Kwongdfa8c082016-07-29 04:10:00 -0400709 if (sde_kms->vbif[VBIF_NRT]) {
710 c_conn->mmu_id[SDE_IOMMU_DOMAIN_UNSECURE] =
711 sde_kms->mmu_id[MSM_SMMU_DOMAIN_NRT_UNSECURE];
712 c_conn->mmu_id[SDE_IOMMU_DOMAIN_SECURE] =
713 sde_kms->mmu_id[MSM_SMMU_DOMAIN_NRT_SECURE];
714 } else {
715 c_conn->mmu_id[SDE_IOMMU_DOMAIN_UNSECURE] =
716 sde_kms->mmu_id[MSM_SMMU_DOMAIN_UNSECURE];
717 c_conn->mmu_id[SDE_IOMMU_DOMAIN_SECURE] =
718 sde_kms->mmu_id[MSM_SMMU_DOMAIN_SECURE];
719 }
Clarence Ipdd8021c2016-07-20 16:39:47 -0400720
721 if (ops)
722 c_conn->ops = *ops;
723
724 c_conn->base.helper_private = &sde_connector_helper_ops;
725 c_conn->base.polled = connector_poll;
726 c_conn->base.interlace_allowed = 0;
727 c_conn->base.doublescan_allowed = 0;
728
729 snprintf(c_conn->name,
730 SDE_CONNECTOR_NAME_SIZE,
731 "conn%u",
732 c_conn->base.base.id);
733
Lloyd Atkinson5d40d312016-09-06 08:34:13 -0400734 rc = sde_fence_init(&c_conn->retire_fence, c_conn->name,
735 c_conn->base.base.id);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400736 if (rc) {
737 SDE_ERROR("failed to init fence, %d\n", rc);
738 goto error_cleanup_conn;
739 }
740
Clarence Ipdd8021c2016-07-20 16:39:47 -0400741 rc = drm_mode_connector_attach_encoder(&c_conn->base, encoder);
742 if (rc) {
743 SDE_ERROR("failed to attach encoder to connector, %d\n", rc);
Lloyd Atkinsonab3dd302017-02-13 10:44:55 -0800744 goto error_cleanup_fence;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400745 }
746
Dhaval Patel7cdd6662017-03-08 13:10:37 -0800747 rc = sde_backlight_setup(c_conn);
748 if (rc) {
749 SDE_ERROR("failed to setup backlight, rc=%d\n", rc);
750 goto error_cleanup_fence;
Vishnuvardhan Prodduturi75b96802016-10-17 18:45:55 +0530751 }
752
Clarence Ipdd8021c2016-07-20 16:39:47 -0400753 /* create properties */
754 msm_property_init(&c_conn->property_info, &c_conn->base.base, dev,
755 priv->conn_property, c_conn->property_data,
756 CONNECTOR_PROP_COUNT, CONNECTOR_PROP_BLOBCOUNT,
757 sizeof(struct sde_connector_state));
758
759 if (c_conn->ops.post_init) {
760 info = kmalloc(sizeof(*info), GFP_KERNEL);
761 if (!info) {
762 SDE_ERROR("failed to allocate info buffer\n");
763 rc = -ENOMEM;
Lloyd Atkinsonab3dd302017-02-13 10:44:55 -0800764 goto error_cleanup_fence;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400765 }
766
767 sde_kms_info_reset(info);
768 rc = c_conn->ops.post_init(&c_conn->base, info, display);
769 if (rc) {
770 SDE_ERROR("post-init failed, %d\n", rc);
771 kfree(info);
Lloyd Atkinsonab3dd302017-02-13 10:44:55 -0800772 goto error_cleanup_fence;
Clarence Ipdd8021c2016-07-20 16:39:47 -0400773 }
774
775 msm_property_install_blob(&c_conn->property_info,
Dhaval Patel4e574842016-08-23 15:11:37 -0700776 "capabilities",
Clarence Ipdd8021c2016-07-20 16:39:47 -0400777 DRM_MODE_PROP_IMMUTABLE,
778 CONNECTOR_PROP_SDE_INFO);
779
780 msm_property_set_blob(&c_conn->property_info,
Dhaval Patel4e574842016-08-23 15:11:37 -0700781 &c_conn->blob_caps,
Clarence Ipdd8021c2016-07-20 16:39:47 -0400782 SDE_KMS_INFO_DATA(info),
783 SDE_KMS_INFO_DATALEN(info),
784 CONNECTOR_PROP_SDE_INFO);
785 kfree(info);
786 }
787
Ping Li898b1bf2017-02-09 18:03:28 -0800788 if (connector_type == DRM_MODE_CONNECTOR_DSI) {
789 dsi_display = (struct dsi_display *)(display);
790 if (dsi_display && dsi_display->panel &&
791 dsi_display->panel->hdr_props.hdr_enabled == true) {
792 msm_property_install_blob(&c_conn->property_info,
793 "hdr_properties",
794 DRM_MODE_PROP_IMMUTABLE,
795 CONNECTOR_PROP_HDR_INFO);
796
797 msm_property_set_blob(&c_conn->property_info,
798 &c_conn->blob_hdr,
799 &dsi_display->panel->hdr_props,
800 sizeof(dsi_display->panel->hdr_props),
801 CONNECTOR_PROP_HDR_INFO);
802 }
803 }
804
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400805 msm_property_install_range(&c_conn->property_info, "RETIRE_FENCE",
Dhaval Patel4e574842016-08-23 15:11:37 -0700806 0x0, 0, INR_OPEN_MAX, 0, CONNECTOR_PROP_RETIRE_FENCE);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400807
Lloyd Atkinsonb6191972016-08-10 18:31:46 -0400808 /* enum/bitmask properties */
809 msm_property_install_enum(&c_conn->property_info, "topology_name",
810 DRM_MODE_PROP_IMMUTABLE, 0, e_topology_name,
811 ARRAY_SIZE(e_topology_name),
812 CONNECTOR_PROP_TOPOLOGY_NAME);
813 msm_property_install_enum(&c_conn->property_info, "topology_control",
814 0, 1, e_topology_control,
815 ARRAY_SIZE(e_topology_control),
816 CONNECTOR_PROP_TOPOLOGY_CONTROL);
817
Clarence Ipdd8021c2016-07-20 16:39:47 -0400818 rc = msm_property_install_get_status(&c_conn->property_info);
819 if (rc) {
820 SDE_ERROR("failed to create one or more properties\n");
821 goto error_destroy_property;
822 }
823
Lloyd Atkinsonb6191972016-08-10 18:31:46 -0400824 SDE_DEBUG("connector %d attach encoder %d\n",
825 c_conn->base.base.id, encoder->base.id);
826
Clarence Ipdd8021c2016-07-20 16:39:47 -0400827 priv->connectors[priv->num_connectors++] = &c_conn->base;
828
829 return &c_conn->base;
830
831error_destroy_property:
Dhaval Patel4e574842016-08-23 15:11:37 -0700832 if (c_conn->blob_caps)
833 drm_property_unreference_blob(c_conn->blob_caps);
Ping Li898b1bf2017-02-09 18:03:28 -0800834 if (c_conn->blob_hdr)
835 drm_property_unreference_blob(c_conn->blob_hdr);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400836 msm_property_destroy(&c_conn->property_info);
Clarence Ipe59fb3f2016-07-26 13:39:59 -0400837error_cleanup_fence:
838 sde_fence_deinit(&c_conn->retire_fence);
Clarence Ipdd8021c2016-07-20 16:39:47 -0400839error_cleanup_conn:
840 drm_connector_cleanup(&c_conn->base);
841error_free_conn:
842 kfree(c_conn);
843
844 return ERR_PTR(rc);
845}