cachepc-linux

Fork of AMDESE/linux with modifications for CachePC side-channel attack
git clone https://git.sinitax.com/sinitax/cachepc-linux
Log | Files | Refs | README | LICENSE | sfeed.txt

hyperv_drm_modeset.c (6369B)


      1// SPDX-License-Identifier: GPL-2.0-only
      2/*
      3 * Copyright 2021 Microsoft
      4 */
      5
      6#include <linux/hyperv.h>
      7
      8#include <drm/drm_damage_helper.h>
      9#include <drm/drm_drv.h>
     10#include <drm/drm_fb_helper.h>
     11#include <drm/drm_format_helper.h>
     12#include <drm/drm_fourcc.h>
     13#include <drm/drm_gem_atomic_helper.h>
     14#include <drm/drm_gem_framebuffer_helper.h>
     15#include <drm/drm_gem_shmem_helper.h>
     16#include <drm/drm_probe_helper.h>
     17#include <drm/drm_simple_kms_helper.h>
     18
     19#include "hyperv_drm.h"
     20
     21static int hyperv_blit_to_vram_rect(struct drm_framebuffer *fb,
     22				    const struct iosys_map *map,
     23				    struct drm_rect *rect)
     24{
     25	struct hyperv_drm_device *hv = to_hv(fb->dev);
     26	void __iomem *dst = hv->vram;
     27	void *vmap = map->vaddr; /* TODO: Use mapping abstraction properly */
     28	int idx;
     29
     30	if (!drm_dev_enter(&hv->dev, &idx))
     31		return -ENODEV;
     32
     33	dst += drm_fb_clip_offset(fb->pitches[0], fb->format, rect);
     34	drm_fb_memcpy_toio(dst, fb->pitches[0], vmap, fb, rect);
     35
     36	drm_dev_exit(idx);
     37
     38	return 0;
     39}
     40
     41static int hyperv_blit_to_vram_fullscreen(struct drm_framebuffer *fb,
     42					  const struct iosys_map *map)
     43{
     44	struct drm_rect fullscreen = {
     45		.x1 = 0,
     46		.x2 = fb->width,
     47		.y1 = 0,
     48		.y2 = fb->height,
     49	};
     50	return hyperv_blit_to_vram_rect(fb, map, &fullscreen);
     51}
     52
     53static int hyperv_connector_get_modes(struct drm_connector *connector)
     54{
     55	struct hyperv_drm_device *hv = to_hv(connector->dev);
     56	int count;
     57
     58	count = drm_add_modes_noedid(connector,
     59				     connector->dev->mode_config.max_width,
     60				     connector->dev->mode_config.max_height);
     61	drm_set_preferred_mode(connector, hv->preferred_width,
     62			       hv->preferred_height);
     63
     64	return count;
     65}
     66
     67static const struct drm_connector_helper_funcs hyperv_connector_helper_funcs = {
     68	.get_modes = hyperv_connector_get_modes,
     69};
     70
     71static const struct drm_connector_funcs hyperv_connector_funcs = {
     72	.fill_modes = drm_helper_probe_single_connector_modes,
     73	.destroy = drm_connector_cleanup,
     74	.reset = drm_atomic_helper_connector_reset,
     75	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
     76	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
     77};
     78
     79static inline int hyperv_conn_init(struct hyperv_drm_device *hv)
     80{
     81	drm_connector_helper_add(&hv->connector, &hyperv_connector_helper_funcs);
     82	return drm_connector_init(&hv->dev, &hv->connector,
     83				  &hyperv_connector_funcs,
     84				  DRM_MODE_CONNECTOR_VIRTUAL);
     85}
     86
     87static int hyperv_check_size(struct hyperv_drm_device *hv, int w, int h,
     88			     struct drm_framebuffer *fb)
     89{
     90	u32 pitch = w * (hv->screen_depth / 8);
     91
     92	if (fb)
     93		pitch = fb->pitches[0];
     94
     95	if (pitch * h > hv->fb_size)
     96		return -EINVAL;
     97
     98	return 0;
     99}
    100
    101static void hyperv_pipe_enable(struct drm_simple_display_pipe *pipe,
    102			       struct drm_crtc_state *crtc_state,
    103			       struct drm_plane_state *plane_state)
    104{
    105	struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev);
    106	struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(plane_state);
    107
    108	hyperv_hide_hw_ptr(hv->hdev);
    109	hyperv_update_situation(hv->hdev, 1,  hv->screen_depth,
    110				crtc_state->mode.hdisplay,
    111				crtc_state->mode.vdisplay,
    112				plane_state->fb->pitches[0]);
    113	hyperv_blit_to_vram_fullscreen(plane_state->fb, &shadow_plane_state->data[0]);
    114}
    115
    116static int hyperv_pipe_check(struct drm_simple_display_pipe *pipe,
    117			     struct drm_plane_state *plane_state,
    118			     struct drm_crtc_state *crtc_state)
    119{
    120	struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev);
    121	struct drm_framebuffer *fb = plane_state->fb;
    122
    123	if (fb->format->format != DRM_FORMAT_XRGB8888)
    124		return -EINVAL;
    125
    126	if (fb->pitches[0] * fb->height > hv->fb_size) {
    127		drm_err(&hv->dev, "fb size requested by %s for %dX%d (pitch %d) greater than %ld\n",
    128			current->comm, fb->width, fb->height, fb->pitches[0], hv->fb_size);
    129		return -EINVAL;
    130	}
    131
    132	return 0;
    133}
    134
    135static void hyperv_pipe_update(struct drm_simple_display_pipe *pipe,
    136			       struct drm_plane_state *old_state)
    137{
    138	struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev);
    139	struct drm_plane_state *state = pipe->plane.state;
    140	struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(state);
    141	struct drm_rect rect;
    142
    143	if (drm_atomic_helper_damage_merged(old_state, state, &rect)) {
    144		hyperv_blit_to_vram_rect(state->fb, &shadow_plane_state->data[0], &rect);
    145		hyperv_update_dirt(hv->hdev, &rect);
    146	}
    147}
    148
    149static const struct drm_simple_display_pipe_funcs hyperv_pipe_funcs = {
    150	.enable	= hyperv_pipe_enable,
    151	.check = hyperv_pipe_check,
    152	.update	= hyperv_pipe_update,
    153	DRM_GEM_SIMPLE_DISPLAY_PIPE_SHADOW_PLANE_FUNCS,
    154};
    155
    156static const uint32_t hyperv_formats[] = {
    157	DRM_FORMAT_XRGB8888,
    158};
    159
    160static const uint64_t hyperv_modifiers[] = {
    161	DRM_FORMAT_MOD_LINEAR,
    162	DRM_FORMAT_MOD_INVALID
    163};
    164
    165static inline int hyperv_pipe_init(struct hyperv_drm_device *hv)
    166{
    167	int ret;
    168
    169	ret = drm_simple_display_pipe_init(&hv->dev,
    170					   &hv->pipe,
    171					   &hyperv_pipe_funcs,
    172					   hyperv_formats,
    173					   ARRAY_SIZE(hyperv_formats),
    174					   hyperv_modifiers,
    175					   &hv->connector);
    176	if (ret)
    177		return ret;
    178
    179	drm_plane_enable_fb_damage_clips(&hv->pipe.plane);
    180
    181	return 0;
    182}
    183
    184static enum drm_mode_status
    185hyperv_mode_valid(struct drm_device *dev,
    186		  const struct drm_display_mode *mode)
    187{
    188	struct hyperv_drm_device *hv = to_hv(dev);
    189
    190	if (hyperv_check_size(hv, mode->hdisplay, mode->vdisplay, NULL))
    191		return MODE_BAD;
    192
    193	return MODE_OK;
    194}
    195
    196static const struct drm_mode_config_funcs hyperv_mode_config_funcs = {
    197	.fb_create = drm_gem_fb_create_with_dirty,
    198	.mode_valid = hyperv_mode_valid,
    199	.atomic_check = drm_atomic_helper_check,
    200	.atomic_commit = drm_atomic_helper_commit,
    201};
    202
    203int hyperv_mode_config_init(struct hyperv_drm_device *hv)
    204{
    205	struct drm_device *dev = &hv->dev;
    206	int ret;
    207
    208	ret = drmm_mode_config_init(dev);
    209	if (ret) {
    210		drm_err(dev, "Failed to initialized mode setting.\n");
    211		return ret;
    212	}
    213
    214	dev->mode_config.min_width = 0;
    215	dev->mode_config.min_height = 0;
    216	dev->mode_config.max_width = hv->screen_width_max;
    217	dev->mode_config.max_height = hv->screen_height_max;
    218
    219	dev->mode_config.preferred_depth = hv->screen_depth;
    220	dev->mode_config.prefer_shadow = 0;
    221
    222	dev->mode_config.funcs = &hyperv_mode_config_funcs;
    223
    224	ret = hyperv_conn_init(hv);
    225	if (ret) {
    226		drm_err(dev, "Failed to initialized connector.\n");
    227		return ret;
    228	}
    229
    230	ret = hyperv_pipe_init(hv);
    231	if (ret) {
    232		drm_err(dev, "Failed to initialized pipe.\n");
    233		return ret;
    234	}
    235
    236	drm_mode_config_reset(dev);
    237
    238	return 0;
    239}