2 * Copyright (C) Fuzhou Rockchip Electronics Co.Ltd
3 * Author:Mark Yao <mark.yao@rock-chips.com>
5 * This software is licensed under the terms of the GNU General Public
6 * License version 2, as published by the Free Software Foundation, and
7 * may be copied, distributed, and modified under those terms.
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
15 #include <linux/kernel.h>
18 #include <drm/drm_atomic.h>
19 #include <drm/drm_fb_helper.h>
20 #include <drm/drm_crtc_helper.h>
22 #include "rockchip_drm_drv.h"
23 #include "rockchip_drm_fb.h"
24 #include "rockchip_drm_gem.h"
26 #define to_rockchip_fb(x) container_of(x, struct rockchip_drm_fb, fb)
28 struct rockchip_drm_fb
{
29 struct drm_framebuffer fb
;
30 struct drm_gem_object
*obj
[ROCKCHIP_MAX_FB_BUFFER
];
33 struct drm_gem_object
*rockchip_fb_get_gem_obj(struct drm_framebuffer
*fb
,
36 struct rockchip_drm_fb
*rk_fb
= to_rockchip_fb(fb
);
38 if (plane
>= ROCKCHIP_MAX_FB_BUFFER
)
41 return rk_fb
->obj
[plane
];
44 static void rockchip_drm_fb_destroy(struct drm_framebuffer
*fb
)
46 struct rockchip_drm_fb
*rockchip_fb
= to_rockchip_fb(fb
);
49 for (i
= 0; i
< ROCKCHIP_MAX_FB_BUFFER
; i
++)
50 drm_gem_object_unreference_unlocked(rockchip_fb
->obj
[i
]);
52 drm_framebuffer_cleanup(fb
);
56 static int rockchip_drm_fb_create_handle(struct drm_framebuffer
*fb
,
57 struct drm_file
*file_priv
,
60 struct rockchip_drm_fb
*rockchip_fb
= to_rockchip_fb(fb
);
62 return drm_gem_handle_create(file_priv
,
63 rockchip_fb
->obj
[0], handle
);
66 static const struct drm_framebuffer_funcs rockchip_drm_fb_funcs
= {
67 .destroy
= rockchip_drm_fb_destroy
,
68 .create_handle
= rockchip_drm_fb_create_handle
,
71 static struct rockchip_drm_fb
*
72 rockchip_fb_alloc(struct drm_device
*dev
, const struct drm_mode_fb_cmd2
*mode_cmd
,
73 struct drm_gem_object
**obj
, unsigned int num_planes
)
75 struct rockchip_drm_fb
*rockchip_fb
;
79 rockchip_fb
= kzalloc(sizeof(*rockchip_fb
), GFP_KERNEL
);
81 return ERR_PTR(-ENOMEM
);
83 drm_helper_mode_fill_fb_struct(&rockchip_fb
->fb
, mode_cmd
);
85 for (i
= 0; i
< num_planes
; i
++)
86 rockchip_fb
->obj
[i
] = obj
[i
];
88 ret
= drm_framebuffer_init(dev
, &rockchip_fb
->fb
,
89 &rockchip_drm_fb_funcs
);
91 dev_err(dev
->dev
, "Failed to initialize framebuffer: %d\n",
100 static struct drm_framebuffer
*
101 rockchip_user_fb_create(struct drm_device
*dev
, struct drm_file
*file_priv
,
102 const struct drm_mode_fb_cmd2
*mode_cmd
)
104 struct rockchip_drm_fb
*rockchip_fb
;
105 struct drm_gem_object
*objs
[ROCKCHIP_MAX_FB_BUFFER
];
106 struct drm_gem_object
*obj
;
113 hsub
= drm_format_horz_chroma_subsampling(mode_cmd
->pixel_format
);
114 vsub
= drm_format_vert_chroma_subsampling(mode_cmd
->pixel_format
);
115 num_planes
= min(drm_format_num_planes(mode_cmd
->pixel_format
),
116 ROCKCHIP_MAX_FB_BUFFER
);
118 for (i
= 0; i
< num_planes
; i
++) {
119 unsigned int width
= mode_cmd
->width
/ (i
? hsub
: 1);
120 unsigned int height
= mode_cmd
->height
/ (i
? vsub
: 1);
121 unsigned int min_size
;
123 obj
= drm_gem_object_lookup(file_priv
, mode_cmd
->handles
[i
]);
125 dev_err(dev
->dev
, "Failed to lookup GEM object\n");
127 goto err_gem_object_unreference
;
130 min_size
= (height
- 1) * mode_cmd
->pitches
[i
] +
131 mode_cmd
->offsets
[i
] +
132 width
* drm_format_plane_cpp(mode_cmd
->pixel_format
, i
);
134 if (obj
->size
< min_size
) {
135 drm_gem_object_unreference_unlocked(obj
);
137 goto err_gem_object_unreference
;
142 rockchip_fb
= rockchip_fb_alloc(dev
, mode_cmd
, objs
, i
);
143 if (IS_ERR(rockchip_fb
)) {
144 ret
= PTR_ERR(rockchip_fb
);
145 goto err_gem_object_unreference
;
148 return &rockchip_fb
->fb
;
150 err_gem_object_unreference
:
151 for (i
--; i
>= 0; i
--)
152 drm_gem_object_unreference_unlocked(objs
[i
]);
156 static void rockchip_drm_output_poll_changed(struct drm_device
*dev
)
158 struct rockchip_drm_private
*private = dev
->dev_private
;
159 struct drm_fb_helper
*fb_helper
= &private->fbdev_helper
;
162 drm_fb_helper_hotplug_event(fb_helper
);
165 static void rockchip_crtc_wait_for_update(struct drm_crtc
*crtc
)
167 struct rockchip_drm_private
*priv
= crtc
->dev
->dev_private
;
168 int pipe
= drm_crtc_index(crtc
);
169 const struct rockchip_crtc_funcs
*crtc_funcs
= priv
->crtc_funcs
[pipe
];
171 if (crtc_funcs
&& crtc_funcs
->wait_for_update
)
172 crtc_funcs
->wait_for_update(crtc
);
176 * We can't use drm_atomic_helper_wait_for_vblanks() because rk3288 and rk3066
177 * have hardware counters for neither vblanks nor scanlines, which results in
179 * | <-- HW vsync irq and reg take effect
181 * get_vblank and wait --> |
182 * | <-- handle_vblank, vblank->count + 1
185 * | <-- HW vsync irq and reg take effect
187 * This function is equivalent but uses rockchip_crtc_wait_for_update() instead
188 * of waiting for vblank_count to change.
191 rockchip_atomic_wait_for_complete(struct drm_device
*dev
, struct drm_atomic_state
*old_state
)
193 struct drm_crtc_state
*old_crtc_state
;
194 struct drm_crtc
*crtc
;
197 for_each_crtc_in_state(old_state
, crtc
, old_crtc_state
, i
) {
198 /* No one cares about the old state, so abuse it for tracking
199 * and store whether we hold a vblank reference (and should do a
200 * vblank wait) in the ->enable boolean.
202 old_crtc_state
->enable
= false;
204 if (!crtc
->state
->active
)
207 if (!drm_atomic_helper_framebuffer_changed(dev
,
211 ret
= drm_crtc_vblank_get(crtc
);
215 old_crtc_state
->enable
= true;
218 for_each_crtc_in_state(old_state
, crtc
, old_crtc_state
, i
) {
219 if (!old_crtc_state
->enable
)
222 rockchip_crtc_wait_for_update(crtc
);
223 drm_crtc_vblank_put(crtc
);
228 rockchip_atomic_commit_tail(struct drm_atomic_state
*state
)
230 struct drm_device
*dev
= state
->dev
;
232 drm_atomic_helper_commit_modeset_disables(dev
, state
);
234 drm_atomic_helper_commit_modeset_enables(dev
, state
);
236 drm_atomic_helper_commit_planes(dev
, state
, true);
238 drm_atomic_helper_commit_hw_done(state
);
240 rockchip_atomic_wait_for_complete(dev
, state
);
242 drm_atomic_helper_cleanup_planes(dev
, state
);
245 static struct drm_mode_config_helper_funcs rockchip_mode_config_helpers
= {
246 .atomic_commit_tail
= rockchip_atomic_commit_tail
,
249 static const struct drm_mode_config_funcs rockchip_drm_mode_config_funcs
= {
250 .fb_create
= rockchip_user_fb_create
,
251 .output_poll_changed
= rockchip_drm_output_poll_changed
,
252 .atomic_check
= drm_atomic_helper_check
,
253 .atomic_commit
= drm_atomic_helper_commit
,
256 struct drm_framebuffer
*
257 rockchip_drm_framebuffer_init(struct drm_device
*dev
,
258 const struct drm_mode_fb_cmd2
*mode_cmd
,
259 struct drm_gem_object
*obj
)
261 struct rockchip_drm_fb
*rockchip_fb
;
263 rockchip_fb
= rockchip_fb_alloc(dev
, mode_cmd
, &obj
, 1);
264 if (IS_ERR(rockchip_fb
))
267 return &rockchip_fb
->fb
;
270 void rockchip_drm_mode_config_init(struct drm_device
*dev
)
272 dev
->mode_config
.min_width
= 0;
273 dev
->mode_config
.min_height
= 0;
276 * set max width and height as default value(4096x4096).
277 * this value would be used to check framebuffer size limitation
278 * at drm_mode_addfb().
280 dev
->mode_config
.max_width
= 4096;
281 dev
->mode_config
.max_height
= 4096;
283 dev
->mode_config
.funcs
= &rockchip_drm_mode_config_funcs
;
284 dev
->mode_config
.helper_private
= &rockchip_mode_config_helpers
;