1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 */
4
5 #include <linux/moduleparam.h>
6
7 #include <drm/drm_atomic_helper.h>
8 #include <drm/drm_gem_framebuffer_helper.h>
9 #include <drm/drm_probe_helper.h>
10
11 #include "bochs.h"
12
13 static int defx = 1024;
14 static int defy = 768;
15
16 module_param(defx, int, 0444);
17 module_param(defy, int, 0444);
18 MODULE_PARM_DESC(defx, "default x resolution");
19 MODULE_PARM_DESC(defy, "default y resolution");
20
21 /* ---------------------------------------------------------------------- */
22
23 static const uint32_t bochs_formats[] = {
24 DRM_FORMAT_XRGB8888,
25 DRM_FORMAT_BGRX8888,
26 };
27
bochs_plane_update(struct bochs_device * bochs,struct drm_plane_state * state)28 static void bochs_plane_update(struct bochs_device *bochs,
29 struct drm_plane_state *state)
30 {
31 struct drm_gem_vram_object *gbo;
32 s64 gpu_addr;
33
34 if (!state->fb || !bochs->stride)
35 return;
36
37 gbo = drm_gem_vram_of_gem(state->fb->obj[0]);
38 gpu_addr = drm_gem_vram_offset(gbo);
39 if (WARN_ON_ONCE(gpu_addr < 0))
40 return; /* Bug: we didn't pin the BO to VRAM in prepare_fb. */
41
42 bochs_hw_setbase(bochs,
43 state->crtc_x,
44 state->crtc_y,
45 state->fb->pitches[0],
46 state->fb->offsets[0] + gpu_addr);
47 bochs_hw_setformat(bochs, state->fb->format);
48 }
49
bochs_pipe_enable(struct drm_simple_display_pipe * pipe,struct drm_crtc_state * crtc_state,struct drm_plane_state * plane_state)50 static void bochs_pipe_enable(struct drm_simple_display_pipe *pipe,
51 struct drm_crtc_state *crtc_state,
52 struct drm_plane_state *plane_state)
53 {
54 struct bochs_device *bochs = pipe->crtc.dev->dev_private;
55
56 bochs_hw_setmode(bochs, &crtc_state->mode);
57 bochs_plane_update(bochs, plane_state);
58 }
59
bochs_pipe_update(struct drm_simple_display_pipe * pipe,struct drm_plane_state * old_state)60 static void bochs_pipe_update(struct drm_simple_display_pipe *pipe,
61 struct drm_plane_state *old_state)
62 {
63 struct bochs_device *bochs = pipe->crtc.dev->dev_private;
64
65 bochs_plane_update(bochs, pipe->plane.state);
66 }
67
68 static const struct drm_simple_display_pipe_funcs bochs_pipe_funcs = {
69 .enable = bochs_pipe_enable,
70 .update = bochs_pipe_update,
71 .prepare_fb = drm_gem_vram_simple_display_pipe_prepare_fb,
72 .cleanup_fb = drm_gem_vram_simple_display_pipe_cleanup_fb,
73 };
74
bochs_connector_get_modes(struct drm_connector * connector)75 static int bochs_connector_get_modes(struct drm_connector *connector)
76 {
77 struct bochs_device *bochs =
78 container_of(connector, struct bochs_device, connector);
79 int count = 0;
80
81 if (bochs->edid)
82 count = drm_add_edid_modes(connector, bochs->edid);
83
84 if (!count) {
85 count = drm_add_modes_noedid(connector, 8192, 8192);
86 drm_set_preferred_mode(connector, defx, defy);
87 }
88 return count;
89 }
90
91 static const struct drm_connector_helper_funcs bochs_connector_connector_helper_funcs = {
92 .get_modes = bochs_connector_get_modes,
93 };
94
95 static const struct drm_connector_funcs bochs_connector_connector_funcs = {
96 .fill_modes = drm_helper_probe_single_connector_modes,
97 .destroy = drm_connector_cleanup,
98 .reset = drm_atomic_helper_connector_reset,
99 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
100 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
101 };
102
bochs_connector_init(struct drm_device * dev)103 static void bochs_connector_init(struct drm_device *dev)
104 {
105 struct bochs_device *bochs = dev->dev_private;
106 struct drm_connector *connector = &bochs->connector;
107
108 drm_connector_init(dev, connector, &bochs_connector_connector_funcs,
109 DRM_MODE_CONNECTOR_VIRTUAL);
110 drm_connector_helper_add(connector,
111 &bochs_connector_connector_helper_funcs);
112
113 bochs_hw_load_edid(bochs);
114 if (bochs->edid) {
115 DRM_INFO("Found EDID data blob.\n");
116 drm_connector_attach_edid_property(connector);
117 drm_connector_update_edid_property(connector, bochs->edid);
118 }
119 }
120
121 static struct drm_framebuffer *
bochs_gem_fb_create(struct drm_device * dev,struct drm_file * file,const struct drm_mode_fb_cmd2 * mode_cmd)122 bochs_gem_fb_create(struct drm_device *dev, struct drm_file *file,
123 const struct drm_mode_fb_cmd2 *mode_cmd)
124 {
125 if (mode_cmd->pixel_format != DRM_FORMAT_XRGB8888 &&
126 mode_cmd->pixel_format != DRM_FORMAT_BGRX8888)
127 return ERR_PTR(-EINVAL);
128
129 return drm_gem_fb_create(dev, file, mode_cmd);
130 }
131
132 const struct drm_mode_config_funcs bochs_mode_funcs = {
133 .fb_create = bochs_gem_fb_create,
134 .mode_valid = drm_vram_helper_mode_valid,
135 .atomic_check = drm_atomic_helper_check,
136 .atomic_commit = drm_atomic_helper_commit,
137 };
138
bochs_kms_init(struct bochs_device * bochs)139 int bochs_kms_init(struct bochs_device *bochs)
140 {
141 int ret;
142
143 ret = drmm_mode_config_init(bochs->dev);
144 if (ret)
145 return ret;
146
147 bochs->dev->mode_config.max_width = 8192;
148 bochs->dev->mode_config.max_height = 8192;
149
150 bochs->dev->mode_config.fb_base = bochs->fb_base;
151 bochs->dev->mode_config.preferred_depth = 24;
152 bochs->dev->mode_config.prefer_shadow = 0;
153 bochs->dev->mode_config.prefer_shadow_fbdev = 1;
154 bochs->dev->mode_config.fbdev_use_iomem = true;
155 bochs->dev->mode_config.quirk_addfb_prefer_host_byte_order = true;
156
157 bochs->dev->mode_config.funcs = &bochs_mode_funcs;
158
159 bochs_connector_init(bochs->dev);
160 drm_simple_display_pipe_init(bochs->dev,
161 &bochs->pipe,
162 &bochs_pipe_funcs,
163 bochs_formats,
164 ARRAY_SIZE(bochs_formats),
165 NULL,
166 &bochs->connector);
167
168 drm_mode_config_reset(bochs->dev);
169
170 return 0;
171 }
172