Commit | Line | Data |
---|---|---|
96f60e37 RK |
1 | /* |
2 | * Copyright (C) 2012 Russell King | |
3 | * | |
4 | * This program is free software; you can redistribute it and/or modify | |
5 | * it under the terms of the GNU General Public License version 2 as | |
6 | * published by the Free Software Foundation. | |
7 | */ | |
8 | #include <drm/drmP.h> | |
9 | #include <drm/drm_crtc_helper.h> | |
10 | #include <drm/drm_fb_helper.h> | |
11 | #include "armada_drm.h" | |
12 | #include "armada_fb.h" | |
13 | #include "armada_gem.h" | |
14 | #include "armada_hw.h" | |
15 | ||
16 | static void armada_fb_destroy(struct drm_framebuffer *fb) | |
17 | { | |
18 | struct armada_framebuffer *dfb = drm_fb_to_armada_fb(fb); | |
19 | ||
20 | drm_framebuffer_cleanup(&dfb->fb); | |
21 | drm_gem_object_unreference_unlocked(&dfb->obj->obj); | |
22 | kfree(dfb); | |
23 | } | |
24 | ||
25 | static int armada_fb_create_handle(struct drm_framebuffer *fb, | |
26 | struct drm_file *dfile, unsigned int *handle) | |
27 | { | |
28 | struct armada_framebuffer *dfb = drm_fb_to_armada_fb(fb); | |
29 | return drm_gem_handle_create(dfile, &dfb->obj->obj, handle); | |
30 | } | |
31 | ||
32 | static const struct drm_framebuffer_funcs armada_fb_funcs = { | |
33 | .destroy = armada_fb_destroy, | |
34 | .create_handle = armada_fb_create_handle, | |
35 | }; | |
36 | ||
37 | struct armada_framebuffer *armada_framebuffer_create(struct drm_device *dev, | |
38 | struct drm_mode_fb_cmd2 *mode, struct armada_gem_object *obj) | |
39 | { | |
40 | struct armada_framebuffer *dfb; | |
41 | uint8_t format, config; | |
42 | int ret; | |
43 | ||
44 | switch (mode->pixel_format) { | |
45 | #define FMT(drm, fmt, mod) \ | |
46 | case DRM_FORMAT_##drm: \ | |
47 | format = CFG_##fmt; \ | |
48 | config = mod; \ | |
49 | break | |
50 | FMT(RGB565, 565, CFG_SWAPRB); | |
51 | FMT(BGR565, 565, 0); | |
52 | FMT(ARGB1555, 1555, CFG_SWAPRB); | |
53 | FMT(ABGR1555, 1555, 0); | |
54 | FMT(RGB888, 888PACK, CFG_SWAPRB); | |
55 | FMT(BGR888, 888PACK, 0); | |
56 | FMT(XRGB8888, X888, CFG_SWAPRB); | |
57 | FMT(XBGR8888, X888, 0); | |
58 | FMT(ARGB8888, 8888, CFG_SWAPRB); | |
59 | FMT(ABGR8888, 8888, 0); | |
60 | FMT(YUYV, 422PACK, CFG_YUV2RGB | CFG_SWAPYU | CFG_SWAPUV); | |
61 | FMT(UYVY, 422PACK, CFG_YUV2RGB); | |
62 | FMT(VYUY, 422PACK, CFG_YUV2RGB | CFG_SWAPUV); | |
63 | FMT(YVYU, 422PACK, CFG_YUV2RGB | CFG_SWAPYU); | |
64 | FMT(YUV422, 422, CFG_YUV2RGB); | |
65 | FMT(YVU422, 422, CFG_YUV2RGB | CFG_SWAPUV); | |
66 | FMT(YUV420, 420, CFG_YUV2RGB); | |
67 | FMT(YVU420, 420, CFG_YUV2RGB | CFG_SWAPUV); | |
68 | FMT(C8, PSEUDO8, 0); | |
69 | #undef FMT | |
70 | default: | |
71 | return ERR_PTR(-EINVAL); | |
72 | } | |
73 | ||
74 | dfb = kzalloc(sizeof(*dfb), GFP_KERNEL); | |
75 | if (!dfb) { | |
76 | DRM_ERROR("failed to allocate Armada fb object\n"); | |
77 | return ERR_PTR(-ENOMEM); | |
78 | } | |
79 | ||
80 | dfb->fmt = format; | |
81 | dfb->mod = config; | |
82 | dfb->obj = obj; | |
83 | ||
84 | drm_helper_mode_fill_fb_struct(&dfb->fb, mode); | |
85 | ||
86 | ret = drm_framebuffer_init(dev, &dfb->fb, &armada_fb_funcs); | |
87 | if (ret) { | |
88 | kfree(dfb); | |
89 | return ERR_PTR(ret); | |
90 | } | |
91 | ||
92 | /* | |
93 | * Take a reference on our object as we're successful - the | |
94 | * caller already holds a reference, which keeps us safe for | |
95 | * the above call, but the caller will drop their reference | |
96 | * to it. Hence we need to take our own reference. | |
97 | */ | |
98 | drm_gem_object_reference(&obj->obj); | |
99 | ||
100 | return dfb; | |
101 | } | |
102 | ||
103 | static struct drm_framebuffer *armada_fb_create(struct drm_device *dev, | |
104 | struct drm_file *dfile, struct drm_mode_fb_cmd2 *mode) | |
105 | { | |
106 | struct armada_gem_object *obj; | |
107 | struct armada_framebuffer *dfb; | |
108 | int ret; | |
109 | ||
110 | DRM_DEBUG_DRIVER("w%u h%u pf%08x f%u p%u,%u,%u\n", | |
111 | mode->width, mode->height, mode->pixel_format, | |
112 | mode->flags, mode->pitches[0], mode->pitches[1], | |
113 | mode->pitches[2]); | |
114 | ||
115 | /* We can only handle a single plane at the moment */ | |
116 | if (drm_format_num_planes(mode->pixel_format) > 1 && | |
117 | (mode->handles[0] != mode->handles[1] || | |
118 | mode->handles[0] != mode->handles[2])) { | |
119 | ret = -EINVAL; | |
120 | goto err; | |
121 | } | |
122 | ||
123 | obj = armada_gem_object_lookup(dev, dfile, mode->handles[0]); | |
124 | if (!obj) { | |
125 | ret = -ENOENT; | |
126 | goto err; | |
127 | } | |
128 | ||
129 | if (obj->obj.import_attach && !obj->sgt) { | |
130 | ret = armada_gem_map_import(obj); | |
131 | if (ret) | |
132 | goto err_unref; | |
133 | } | |
134 | ||
135 | /* Framebuffer objects must have a valid device address for scanout */ | |
136 | if (obj->dev_addr == DMA_ERROR_CODE) { | |
137 | ret = -EINVAL; | |
138 | goto err_unref; | |
139 | } | |
140 | ||
141 | dfb = armada_framebuffer_create(dev, mode, obj); | |
142 | if (IS_ERR(dfb)) { | |
143 | ret = PTR_ERR(dfb); | |
144 | goto err; | |
145 | } | |
146 | ||
147 | drm_gem_object_unreference_unlocked(&obj->obj); | |
148 | ||
149 | return &dfb->fb; | |
150 | ||
151 | err_unref: | |
152 | drm_gem_object_unreference_unlocked(&obj->obj); | |
153 | err: | |
154 | DRM_ERROR("failed to initialize framebuffer: %d\n", ret); | |
155 | return ERR_PTR(ret); | |
156 | } | |
157 | ||
158 | static void armada_output_poll_changed(struct drm_device *dev) | |
159 | { | |
160 | struct armada_private *priv = dev->dev_private; | |
161 | struct drm_fb_helper *fbh = priv->fbdev; | |
162 | ||
163 | if (fbh) | |
164 | drm_fb_helper_hotplug_event(fbh); | |
165 | } | |
166 | ||
167 | const struct drm_mode_config_funcs armada_drm_mode_config_funcs = { | |
168 | .fb_create = armada_fb_create, | |
169 | .output_poll_changed = armada_output_poll_changed, | |
170 | }; |