1 // SPDX-License-Identifier: MIT
2 /*
3 * Copyright 2020 Noralf Trønnes
4 */
5
6 #include <linux/backlight.h>
7 #include <linux/workqueue.h>
8
9 #include <drm/drm_atomic.h>
10 #include <drm/drm_atomic_state_helper.h>
11 #include <drm/drm_connector.h>
12 #include <drm/drm_drv.h>
13 #include <drm/drm_edid.h>
14 #include <drm/drm_encoder.h>
15 #include <drm/drm_file.h>
16 #include <drm/drm_modeset_helper_vtables.h>
17 #include <drm/drm_print.h>
18 #include <drm/drm_probe_helper.h>
19 #include <drm/drm_simple_kms_helper.h>
20 #include <drm/gud.h>
21
22 #include "gud_internal.h"
23
24 struct gud_connector {
25 struct drm_connector connector;
26 struct drm_encoder encoder;
27 struct backlight_device *backlight;
28 struct work_struct backlight_work;
29
30 /* Supported properties */
31 u16 *properties;
32 unsigned int num_properties;
33
34 /* Initial gadget tv state if applicable, applied on state reset */
35 struct drm_tv_connector_state initial_tv_state;
36
37 /*
38 * Initial gadget backlight brightness if applicable, applied on state reset.
39 * The value -ENODEV is used to signal no backlight.
40 */
41 int initial_brightness;
42 };
43
to_gud_connector(struct drm_connector * connector)44 static inline struct gud_connector *to_gud_connector(struct drm_connector *connector)
45 {
46 return container_of(connector, struct gud_connector, connector);
47 }
48
gud_conn_err(struct drm_connector * connector,const char * msg,int ret)49 static void gud_conn_err(struct drm_connector *connector, const char *msg, int ret)
50 {
51 dev_err(connector->dev->dev, "%s: %s (ret=%d)\n", connector->name, msg, ret);
52 }
53
54 /*
55 * Use a worker to avoid taking kms locks inside the backlight lock.
56 * Other display drivers use backlight within their kms locks.
57 * This avoids inconsistent locking rules, which would upset lockdep.
58 */
gud_connector_backlight_update_status_work(struct work_struct * work)59 static void gud_connector_backlight_update_status_work(struct work_struct *work)
60 {
61 struct gud_connector *gconn = container_of(work, struct gud_connector, backlight_work);
62 struct drm_connector *connector = &gconn->connector;
63 struct drm_connector_state *connector_state;
64 struct drm_device *drm = connector->dev;
65 struct drm_modeset_acquire_ctx ctx;
66 struct drm_atomic_state *state;
67 int idx, ret;
68
69 if (!drm_dev_enter(drm, &idx))
70 return;
71
72 state = drm_atomic_state_alloc(drm);
73 if (!state) {
74 ret = -ENOMEM;
75 goto exit;
76 }
77
78 drm_modeset_acquire_init(&ctx, 0);
79 state->acquire_ctx = &ctx;
80 retry:
81 connector_state = drm_atomic_get_connector_state(state, connector);
82 if (IS_ERR(connector_state)) {
83 ret = PTR_ERR(connector_state);
84 goto out;
85 }
86
87 /* Reuse tv.brightness to avoid having to subclass */
88 connector_state->tv.brightness = gconn->backlight->props.brightness;
89
90 ret = drm_atomic_commit(state);
91 out:
92 if (ret == -EDEADLK) {
93 drm_atomic_state_clear(state);
94 drm_modeset_backoff(&ctx);
95 goto retry;
96 }
97
98 drm_atomic_state_put(state);
99
100 drm_modeset_drop_locks(&ctx);
101 drm_modeset_acquire_fini(&ctx);
102 exit:
103 drm_dev_exit(idx);
104
105 if (ret)
106 dev_err(drm->dev, "Failed to update backlight, err=%d\n", ret);
107 }
108
gud_connector_backlight_update_status(struct backlight_device * bd)109 static int gud_connector_backlight_update_status(struct backlight_device *bd)
110 {
111 struct drm_connector *connector = bl_get_data(bd);
112 struct gud_connector *gconn = to_gud_connector(connector);
113
114 /* The USB timeout is 5 seconds so use system_long_wq for worst case scenario */
115 queue_work(system_long_wq, &gconn->backlight_work);
116
117 return 0;
118 }
119
120 static const struct backlight_ops gud_connector_backlight_ops = {
121 .update_status = gud_connector_backlight_update_status,
122 };
123
gud_connector_backlight_register(struct gud_connector * gconn)124 static int gud_connector_backlight_register(struct gud_connector *gconn)
125 {
126 struct drm_connector *connector = &gconn->connector;
127 struct backlight_device *bd;
128 const char *name;
129 const struct backlight_properties props = {
130 .type = BACKLIGHT_RAW,
131 .scale = BACKLIGHT_SCALE_NON_LINEAR,
132 .max_brightness = 100,
133 .brightness = gconn->initial_brightness,
134 };
135
136 name = kasprintf(GFP_KERNEL, "card%d-%s-backlight",
137 connector->dev->primary->index, connector->name);
138 if (!name)
139 return -ENOMEM;
140
141 bd = backlight_device_register(name, connector->kdev, connector,
142 &gud_connector_backlight_ops, &props);
143 kfree(name);
144 if (IS_ERR(bd))
145 return PTR_ERR(bd);
146
147 gconn->backlight = bd;
148
149 return 0;
150 }
151
gud_connector_detect(struct drm_connector * connector,struct drm_modeset_acquire_ctx * ctx,bool force)152 static int gud_connector_detect(struct drm_connector *connector,
153 struct drm_modeset_acquire_ctx *ctx, bool force)
154 {
155 struct gud_device *gdrm = to_gud_device(connector->dev);
156 int idx, ret;
157 u8 status;
158
159 if (!drm_dev_enter(connector->dev, &idx))
160 return connector_status_disconnected;
161
162 if (force) {
163 ret = gud_usb_set(gdrm, GUD_REQ_SET_CONNECTOR_FORCE_DETECT,
164 connector->index, NULL, 0);
165 if (ret) {
166 ret = connector_status_unknown;
167 goto exit;
168 }
169 }
170
171 ret = gud_usb_get_u8(gdrm, GUD_REQ_GET_CONNECTOR_STATUS, connector->index, &status);
172 if (ret) {
173 ret = connector_status_unknown;
174 goto exit;
175 }
176
177 switch (status & GUD_CONNECTOR_STATUS_CONNECTED_MASK) {
178 case GUD_CONNECTOR_STATUS_DISCONNECTED:
179 ret = connector_status_disconnected;
180 break;
181 case GUD_CONNECTOR_STATUS_CONNECTED:
182 ret = connector_status_connected;
183 break;
184 default:
185 ret = connector_status_unknown;
186 break;
187 }
188
189 if (status & GUD_CONNECTOR_STATUS_CHANGED)
190 connector->epoch_counter += 1;
191 exit:
192 drm_dev_exit(idx);
193
194 return ret;
195 }
196
197 struct gud_connector_get_edid_ctx {
198 void *buf;
199 size_t len;
200 bool edid_override;
201 };
202
gud_connector_get_edid_block(void * data,u8 * buf,unsigned int block,size_t len)203 static int gud_connector_get_edid_block(void *data, u8 *buf, unsigned int block, size_t len)
204 {
205 struct gud_connector_get_edid_ctx *ctx = data;
206 size_t start = block * EDID_LENGTH;
207
208 ctx->edid_override = false;
209
210 if (start + len > ctx->len)
211 return -1;
212
213 memcpy(buf, ctx->buf + start, len);
214
215 return 0;
216 }
217
gud_connector_get_modes(struct drm_connector * connector)218 static int gud_connector_get_modes(struct drm_connector *connector)
219 {
220 struct gud_device *gdrm = to_gud_device(connector->dev);
221 struct gud_display_mode_req *reqmodes = NULL;
222 struct gud_connector_get_edid_ctx edid_ctx;
223 unsigned int i, num_modes = 0;
224 const struct drm_edid *drm_edid = NULL;
225 int idx, ret;
226
227 if (!drm_dev_enter(connector->dev, &idx))
228 return 0;
229
230 edid_ctx.edid_override = true;
231 edid_ctx.buf = kmalloc(GUD_CONNECTOR_MAX_EDID_LEN, GFP_KERNEL);
232 if (!edid_ctx.buf)
233 goto out;
234
235 ret = gud_usb_get(gdrm, GUD_REQ_GET_CONNECTOR_EDID, connector->index,
236 edid_ctx.buf, GUD_CONNECTOR_MAX_EDID_LEN);
237 if (ret > 0 && ret % EDID_LENGTH) {
238 gud_conn_err(connector, "Invalid EDID size", ret);
239 } else if (ret > 0) {
240 edid_ctx.len = ret;
241 drm_edid = drm_edid_read_custom(connector, gud_connector_get_edid_block, &edid_ctx);
242 }
243
244 kfree(edid_ctx.buf);
245 drm_edid_connector_update(connector, drm_edid);
246
247 if (drm_edid && edid_ctx.edid_override)
248 goto out;
249
250 reqmodes = kmalloc_array(GUD_CONNECTOR_MAX_NUM_MODES, sizeof(*reqmodes), GFP_KERNEL);
251 if (!reqmodes)
252 goto out;
253
254 ret = gud_usb_get(gdrm, GUD_REQ_GET_CONNECTOR_MODES, connector->index,
255 reqmodes, GUD_CONNECTOR_MAX_NUM_MODES * sizeof(*reqmodes));
256 if (ret <= 0)
257 goto out;
258 if (ret % sizeof(*reqmodes)) {
259 gud_conn_err(connector, "Invalid display mode array size", ret);
260 goto out;
261 }
262
263 num_modes = ret / sizeof(*reqmodes);
264
265 for (i = 0; i < num_modes; i++) {
266 struct drm_display_mode *mode;
267
268 mode = drm_mode_create(connector->dev);
269 if (!mode) {
270 num_modes = i;
271 goto out;
272 }
273
274 gud_to_display_mode(mode, &reqmodes[i]);
275 drm_mode_probed_add(connector, mode);
276 }
277 out:
278 if (!num_modes)
279 num_modes = drm_edid_connector_add_modes(connector);
280
281 kfree(reqmodes);
282 drm_edid_free(drm_edid);
283 drm_dev_exit(idx);
284
285 return num_modes;
286 }
287
gud_connector_atomic_check(struct drm_connector * connector,struct drm_atomic_state * state)288 static int gud_connector_atomic_check(struct drm_connector *connector,
289 struct drm_atomic_state *state)
290 {
291 struct drm_connector_state *new_state;
292 struct drm_crtc_state *new_crtc_state;
293 struct drm_connector_state *old_state;
294
295 new_state = drm_atomic_get_new_connector_state(state, connector);
296 if (!new_state->crtc)
297 return 0;
298
299 old_state = drm_atomic_get_old_connector_state(state, connector);
300 new_crtc_state = drm_atomic_get_new_crtc_state(state, new_state->crtc);
301
302 if (old_state->tv.margins.left != new_state->tv.margins.left ||
303 old_state->tv.margins.right != new_state->tv.margins.right ||
304 old_state->tv.margins.top != new_state->tv.margins.top ||
305 old_state->tv.margins.bottom != new_state->tv.margins.bottom ||
306 old_state->tv.legacy_mode != new_state->tv.legacy_mode ||
307 old_state->tv.brightness != new_state->tv.brightness ||
308 old_state->tv.contrast != new_state->tv.contrast ||
309 old_state->tv.flicker_reduction != new_state->tv.flicker_reduction ||
310 old_state->tv.overscan != new_state->tv.overscan ||
311 old_state->tv.saturation != new_state->tv.saturation ||
312 old_state->tv.hue != new_state->tv.hue)
313 new_crtc_state->connectors_changed = true;
314
315 return 0;
316 }
317
318 static const struct drm_connector_helper_funcs gud_connector_helper_funcs = {
319 .detect_ctx = gud_connector_detect,
320 .get_modes = gud_connector_get_modes,
321 .atomic_check = gud_connector_atomic_check,
322 };
323
gud_connector_late_register(struct drm_connector * connector)324 static int gud_connector_late_register(struct drm_connector *connector)
325 {
326 struct gud_connector *gconn = to_gud_connector(connector);
327
328 if (gconn->initial_brightness < 0)
329 return 0;
330
331 return gud_connector_backlight_register(gconn);
332 }
333
gud_connector_early_unregister(struct drm_connector * connector)334 static void gud_connector_early_unregister(struct drm_connector *connector)
335 {
336 struct gud_connector *gconn = to_gud_connector(connector);
337
338 backlight_device_unregister(gconn->backlight);
339 cancel_work_sync(&gconn->backlight_work);
340 }
341
gud_connector_destroy(struct drm_connector * connector)342 static void gud_connector_destroy(struct drm_connector *connector)
343 {
344 struct gud_connector *gconn = to_gud_connector(connector);
345
346 drm_connector_cleanup(connector);
347 kfree(gconn->properties);
348 kfree(gconn);
349 }
350
gud_connector_reset(struct drm_connector * connector)351 static void gud_connector_reset(struct drm_connector *connector)
352 {
353 struct gud_connector *gconn = to_gud_connector(connector);
354
355 drm_atomic_helper_connector_reset(connector);
356 connector->state->tv = gconn->initial_tv_state;
357 /* Set margins from command line */
358 drm_atomic_helper_connector_tv_margins_reset(connector);
359 if (gconn->initial_brightness >= 0)
360 connector->state->tv.brightness = gconn->initial_brightness;
361 }
362
363 static const struct drm_connector_funcs gud_connector_funcs = {
364 .fill_modes = drm_helper_probe_single_connector_modes,
365 .late_register = gud_connector_late_register,
366 .early_unregister = gud_connector_early_unregister,
367 .destroy = gud_connector_destroy,
368 .reset = gud_connector_reset,
369 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
370 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
371 };
372
373 /*
374 * The tv.mode property is shared among the connectors and its enum names are
375 * driver specific. This means that if more than one connector uses tv.mode,
376 * the enum names has to be the same.
377 */
gud_connector_add_tv_mode(struct gud_device * gdrm,struct drm_connector * connector)378 static int gud_connector_add_tv_mode(struct gud_device *gdrm, struct drm_connector *connector)
379 {
380 size_t buf_len = GUD_CONNECTOR_TV_MODE_MAX_NUM * GUD_CONNECTOR_TV_MODE_NAME_LEN;
381 const char *modes[GUD_CONNECTOR_TV_MODE_MAX_NUM];
382 unsigned int i, num_modes;
383 char *buf;
384 int ret;
385
386 buf = kmalloc(buf_len, GFP_KERNEL);
387 if (!buf)
388 return -ENOMEM;
389
390 ret = gud_usb_get(gdrm, GUD_REQ_GET_CONNECTOR_TV_MODE_VALUES,
391 connector->index, buf, buf_len);
392 if (ret < 0)
393 goto free;
394 if (!ret || ret % GUD_CONNECTOR_TV_MODE_NAME_LEN) {
395 ret = -EIO;
396 goto free;
397 }
398
399 num_modes = ret / GUD_CONNECTOR_TV_MODE_NAME_LEN;
400 for (i = 0; i < num_modes; i++)
401 modes[i] = &buf[i * GUD_CONNECTOR_TV_MODE_NAME_LEN];
402
403 ret = drm_mode_create_tv_properties_legacy(connector->dev, num_modes, modes);
404 free:
405 kfree(buf);
406 if (ret < 0)
407 gud_conn_err(connector, "Failed to add TV modes", ret);
408
409 return ret;
410 }
411
412 static struct drm_property *
gud_connector_property_lookup(struct drm_connector * connector,u16 prop)413 gud_connector_property_lookup(struct drm_connector *connector, u16 prop)
414 {
415 struct drm_mode_config *config = &connector->dev->mode_config;
416
417 switch (prop) {
418 case GUD_PROPERTY_TV_LEFT_MARGIN:
419 return config->tv_left_margin_property;
420 case GUD_PROPERTY_TV_RIGHT_MARGIN:
421 return config->tv_right_margin_property;
422 case GUD_PROPERTY_TV_TOP_MARGIN:
423 return config->tv_top_margin_property;
424 case GUD_PROPERTY_TV_BOTTOM_MARGIN:
425 return config->tv_bottom_margin_property;
426 case GUD_PROPERTY_TV_MODE:
427 return config->legacy_tv_mode_property;
428 case GUD_PROPERTY_TV_BRIGHTNESS:
429 return config->tv_brightness_property;
430 case GUD_PROPERTY_TV_CONTRAST:
431 return config->tv_contrast_property;
432 case GUD_PROPERTY_TV_FLICKER_REDUCTION:
433 return config->tv_flicker_reduction_property;
434 case GUD_PROPERTY_TV_OVERSCAN:
435 return config->tv_overscan_property;
436 case GUD_PROPERTY_TV_SATURATION:
437 return config->tv_saturation_property;
438 case GUD_PROPERTY_TV_HUE:
439 return config->tv_hue_property;
440 default:
441 return ERR_PTR(-EINVAL);
442 }
443 }
444
gud_connector_tv_state_val(u16 prop,struct drm_tv_connector_state * state)445 static unsigned int *gud_connector_tv_state_val(u16 prop, struct drm_tv_connector_state *state)
446 {
447 switch (prop) {
448 case GUD_PROPERTY_TV_LEFT_MARGIN:
449 return &state->margins.left;
450 case GUD_PROPERTY_TV_RIGHT_MARGIN:
451 return &state->margins.right;
452 case GUD_PROPERTY_TV_TOP_MARGIN:
453 return &state->margins.top;
454 case GUD_PROPERTY_TV_BOTTOM_MARGIN:
455 return &state->margins.bottom;
456 case GUD_PROPERTY_TV_MODE:
457 return &state->legacy_mode;
458 case GUD_PROPERTY_TV_BRIGHTNESS:
459 return &state->brightness;
460 case GUD_PROPERTY_TV_CONTRAST:
461 return &state->contrast;
462 case GUD_PROPERTY_TV_FLICKER_REDUCTION:
463 return &state->flicker_reduction;
464 case GUD_PROPERTY_TV_OVERSCAN:
465 return &state->overscan;
466 case GUD_PROPERTY_TV_SATURATION:
467 return &state->saturation;
468 case GUD_PROPERTY_TV_HUE:
469 return &state->hue;
470 default:
471 return ERR_PTR(-EINVAL);
472 }
473 }
474
gud_connector_add_properties(struct gud_device * gdrm,struct gud_connector * gconn)475 static int gud_connector_add_properties(struct gud_device *gdrm, struct gud_connector *gconn)
476 {
477 struct drm_connector *connector = &gconn->connector;
478 struct drm_device *drm = &gdrm->drm;
479 struct gud_property_req *properties;
480 unsigned int i, num_properties;
481 int ret;
482
483 properties = kcalloc(GUD_CONNECTOR_PROPERTIES_MAX_NUM, sizeof(*properties), GFP_KERNEL);
484 if (!properties)
485 return -ENOMEM;
486
487 ret = gud_usb_get(gdrm, GUD_REQ_GET_CONNECTOR_PROPERTIES, connector->index,
488 properties, GUD_CONNECTOR_PROPERTIES_MAX_NUM * sizeof(*properties));
489 if (ret <= 0)
490 goto out;
491 if (ret % sizeof(*properties)) {
492 ret = -EIO;
493 goto out;
494 }
495
496 num_properties = ret / sizeof(*properties);
497 ret = 0;
498
499 gconn->properties = kcalloc(num_properties, sizeof(*gconn->properties), GFP_KERNEL);
500 if (!gconn->properties) {
501 ret = -ENOMEM;
502 goto out;
503 }
504
505 for (i = 0; i < num_properties; i++) {
506 u16 prop = le16_to_cpu(properties[i].prop);
507 u64 val = le64_to_cpu(properties[i].val);
508 struct drm_property *property;
509 unsigned int *state_val;
510
511 drm_dbg(drm, "property: %u = %llu(0x%llx)\n", prop, val, val);
512
513 switch (prop) {
514 case GUD_PROPERTY_TV_LEFT_MARGIN:
515 fallthrough;
516 case GUD_PROPERTY_TV_RIGHT_MARGIN:
517 fallthrough;
518 case GUD_PROPERTY_TV_TOP_MARGIN:
519 fallthrough;
520 case GUD_PROPERTY_TV_BOTTOM_MARGIN:
521 ret = drm_mode_create_tv_margin_properties(drm);
522 if (ret)
523 goto out;
524 break;
525 case GUD_PROPERTY_TV_MODE:
526 ret = gud_connector_add_tv_mode(gdrm, connector);
527 if (ret)
528 goto out;
529 break;
530 case GUD_PROPERTY_TV_BRIGHTNESS:
531 fallthrough;
532 case GUD_PROPERTY_TV_CONTRAST:
533 fallthrough;
534 case GUD_PROPERTY_TV_FLICKER_REDUCTION:
535 fallthrough;
536 case GUD_PROPERTY_TV_OVERSCAN:
537 fallthrough;
538 case GUD_PROPERTY_TV_SATURATION:
539 fallthrough;
540 case GUD_PROPERTY_TV_HUE:
541 /* This is a no-op if already added. */
542 ret = drm_mode_create_tv_properties_legacy(drm, 0, NULL);
543 if (ret)
544 goto out;
545 break;
546 case GUD_PROPERTY_BACKLIGHT_BRIGHTNESS:
547 if (val > 100) {
548 ret = -EINVAL;
549 goto out;
550 }
551 gconn->initial_brightness = val;
552 break;
553 default:
554 /* New ones might show up in future devices, skip those we don't know. */
555 drm_dbg(drm, "Ignoring unknown property: %u\n", prop);
556 continue;
557 }
558
559 gconn->properties[gconn->num_properties++] = prop;
560
561 if (prop == GUD_PROPERTY_BACKLIGHT_BRIGHTNESS)
562 continue; /* not a DRM property */
563
564 property = gud_connector_property_lookup(connector, prop);
565 if (WARN_ON(IS_ERR(property)))
566 continue;
567
568 state_val = gud_connector_tv_state_val(prop, &gconn->initial_tv_state);
569 if (WARN_ON(IS_ERR(state_val)))
570 continue;
571
572 *state_val = val;
573 drm_object_attach_property(&connector->base, property, 0);
574 }
575 out:
576 kfree(properties);
577
578 return ret;
579 }
580
gud_connector_fill_properties(struct drm_connector_state * connector_state,struct gud_property_req * properties)581 int gud_connector_fill_properties(struct drm_connector_state *connector_state,
582 struct gud_property_req *properties)
583 {
584 struct gud_connector *gconn = to_gud_connector(connector_state->connector);
585 unsigned int i;
586
587 for (i = 0; i < gconn->num_properties; i++) {
588 u16 prop = gconn->properties[i];
589 u64 val;
590
591 if (prop == GUD_PROPERTY_BACKLIGHT_BRIGHTNESS) {
592 val = connector_state->tv.brightness;
593 } else {
594 unsigned int *state_val;
595
596 state_val = gud_connector_tv_state_val(prop, &connector_state->tv);
597 if (WARN_ON_ONCE(IS_ERR(state_val)))
598 return PTR_ERR(state_val);
599
600 val = *state_val;
601 }
602
603 properties[i].prop = cpu_to_le16(prop);
604 properties[i].val = cpu_to_le64(val);
605 }
606
607 return gconn->num_properties;
608 }
609
gud_connector_create(struct gud_device * gdrm,unsigned int index,struct gud_connector_descriptor_req * desc)610 static int gud_connector_create(struct gud_device *gdrm, unsigned int index,
611 struct gud_connector_descriptor_req *desc)
612 {
613 struct drm_device *drm = &gdrm->drm;
614 struct gud_connector *gconn;
615 struct drm_connector *connector;
616 struct drm_encoder *encoder;
617 int ret, connector_type;
618 u32 flags;
619
620 gconn = kzalloc(sizeof(*gconn), GFP_KERNEL);
621 if (!gconn)
622 return -ENOMEM;
623
624 INIT_WORK(&gconn->backlight_work, gud_connector_backlight_update_status_work);
625 gconn->initial_brightness = -ENODEV;
626 flags = le32_to_cpu(desc->flags);
627 connector = &gconn->connector;
628
629 drm_dbg(drm, "Connector: index=%u type=%u flags=0x%x\n", index, desc->connector_type, flags);
630
631 switch (desc->connector_type) {
632 case GUD_CONNECTOR_TYPE_PANEL:
633 connector_type = DRM_MODE_CONNECTOR_USB;
634 break;
635 case GUD_CONNECTOR_TYPE_VGA:
636 connector_type = DRM_MODE_CONNECTOR_VGA;
637 break;
638 case GUD_CONNECTOR_TYPE_DVI:
639 connector_type = DRM_MODE_CONNECTOR_DVID;
640 break;
641 case GUD_CONNECTOR_TYPE_COMPOSITE:
642 connector_type = DRM_MODE_CONNECTOR_Composite;
643 break;
644 case GUD_CONNECTOR_TYPE_SVIDEO:
645 connector_type = DRM_MODE_CONNECTOR_SVIDEO;
646 break;
647 case GUD_CONNECTOR_TYPE_COMPONENT:
648 connector_type = DRM_MODE_CONNECTOR_Component;
649 break;
650 case GUD_CONNECTOR_TYPE_DISPLAYPORT:
651 connector_type = DRM_MODE_CONNECTOR_DisplayPort;
652 break;
653 case GUD_CONNECTOR_TYPE_HDMI:
654 connector_type = DRM_MODE_CONNECTOR_HDMIA;
655 break;
656 default: /* future types */
657 connector_type = DRM_MODE_CONNECTOR_USB;
658 break;
659 }
660
661 drm_connector_helper_add(connector, &gud_connector_helper_funcs);
662 ret = drm_connector_init(drm, connector, &gud_connector_funcs, connector_type);
663 if (ret) {
664 kfree(connector);
665 return ret;
666 }
667
668 if (WARN_ON(connector->index != index))
669 return -EINVAL;
670
671 if (flags & GUD_CONNECTOR_FLAGS_POLL_STATUS)
672 connector->polled = (DRM_CONNECTOR_POLL_CONNECT | DRM_CONNECTOR_POLL_DISCONNECT);
673 if (flags & GUD_CONNECTOR_FLAGS_INTERLACE)
674 connector->interlace_allowed = true;
675 if (flags & GUD_CONNECTOR_FLAGS_DOUBLESCAN)
676 connector->doublescan_allowed = true;
677
678 ret = gud_connector_add_properties(gdrm, gconn);
679 if (ret) {
680 gud_conn_err(connector, "Failed to add properties", ret);
681 return ret;
682 }
683
684 /* The first connector is attached to the existing simple pipe encoder */
685 if (!connector->index) {
686 encoder = &gdrm->pipe.encoder;
687 } else {
688 encoder = &gconn->encoder;
689
690 ret = drm_simple_encoder_init(drm, encoder, DRM_MODE_ENCODER_NONE);
691 if (ret)
692 return ret;
693
694 encoder->possible_crtcs = 1;
695 }
696
697 return drm_connector_attach_encoder(connector, encoder);
698 }
699
gud_get_connectors(struct gud_device * gdrm)700 int gud_get_connectors(struct gud_device *gdrm)
701 {
702 struct gud_connector_descriptor_req *descs;
703 unsigned int i, num_connectors;
704 int ret;
705
706 descs = kmalloc_array(GUD_CONNECTORS_MAX_NUM, sizeof(*descs), GFP_KERNEL);
707 if (!descs)
708 return -ENOMEM;
709
710 ret = gud_usb_get(gdrm, GUD_REQ_GET_CONNECTORS, 0,
711 descs, GUD_CONNECTORS_MAX_NUM * sizeof(*descs));
712 if (ret < 0)
713 goto free;
714 if (!ret || ret % sizeof(*descs)) {
715 ret = -EIO;
716 goto free;
717 }
718
719 num_connectors = ret / sizeof(*descs);
720
721 for (i = 0; i < num_connectors; i++) {
722 ret = gud_connector_create(gdrm, i, &descs[i]);
723 if (ret)
724 goto free;
725 }
726 free:
727 kfree(descs);
728
729 return ret;
730 }
731