// SPDX-License-Identifier: GPL-2.0-only /* * Copyright 2021 Microsoft * * Portions of this code is derived from hyperv_fb.c */ #include #include #include #include "hyperv_drm.h" #define VMBUS_RING_BUFSIZE (256 * 1024) #define VMBUS_VSP_TIMEOUT (10 * HZ) #define SYNTHVID_VERSION(major, minor) ((minor) << 16 | (major)) #define SYNTHVID_VER_GET_MAJOR(ver) (ver & 0x0000ffff) #define SYNTHVID_VER_GET_MINOR(ver) ((ver & 0xffff0000) >> 16) #define SYNTHVID_VERSION_WIN7 SYNTHVID_VERSION(3, 0) #define SYNTHVID_VERSION_WIN8 SYNTHVID_VERSION(3, 2) #define SYNTHVID_VERSION_WIN10 SYNTHVID_VERSION(3, 5) #define SYNTHVID_DEPTH_WIN7 16 #define SYNTHVID_DEPTH_WIN8 32 #define SYNTHVID_FB_SIZE_WIN7 (4 * 1024 * 1024) #define SYNTHVID_FB_SIZE_WIN8 (8 * 1024 * 1024) #define SYNTHVID_WIDTH_MAX_WIN7 1600 #define SYNTHVID_HEIGHT_MAX_WIN7 1200 enum pipe_msg_type { PIPE_MSG_INVALID, PIPE_MSG_DATA, PIPE_MSG_MAX }; enum synthvid_msg_type { SYNTHVID_ERROR = 0, SYNTHVID_VERSION_REQUEST = 1, SYNTHVID_VERSION_RESPONSE = 2, SYNTHVID_VRAM_LOCATION = 3, SYNTHVID_VRAM_LOCATION_ACK = 4, SYNTHVID_SITUATION_UPDATE = 5, SYNTHVID_SITUATION_UPDATE_ACK = 6, SYNTHVID_POINTER_POSITION = 7, SYNTHVID_POINTER_SHAPE = 8, SYNTHVID_FEATURE_CHANGE = 9, SYNTHVID_DIRT = 10, SYNTHVID_RESOLUTION_REQUEST = 13, SYNTHVID_RESOLUTION_RESPONSE = 14, SYNTHVID_MAX = 15 }; struct pipe_msg_hdr { u32 type; u32 size; /* size of message after this field */ } __packed; struct hvd_screen_info { u16 width; u16 height; } __packed; struct synthvid_msg_hdr { u32 type; u32 size; /* size of this header + payload after this field */ } __packed; struct synthvid_version_req { u32 version; } __packed; struct synthvid_version_resp { u32 version; u8 is_accepted; u8 max_video_outputs; } __packed; struct synthvid_vram_location { u64 user_ctx; u8 is_vram_gpa_specified; u64 vram_gpa; } __packed; struct synthvid_vram_location_ack { u64 user_ctx; } __packed; struct video_output_situation { u8 active; u32 vram_offset; u8 depth_bits; u32 width_pixels; u32 height_pixels; u32 pitch_bytes; } __packed; struct synthvid_situation_update { u64 user_ctx; u8 video_output_count; struct video_output_situation video_output[1]; } __packed; struct synthvid_situation_update_ack { u64 user_ctx; } __packed; struct synthvid_pointer_position { u8 is_visible; u8 video_output; s32 image_x; s32 image_y; } __packed; #define SYNTHVID_CURSOR_MAX_X 96 #define SYNTHVID_CURSOR_MAX_Y 96 #define SYNTHVID_CURSOR_ARGB_PIXEL_SIZE 4 #define SYNTHVID_CURSOR_MAX_SIZE (SYNTHVID_CURSOR_MAX_X * \ SYNTHVID_CURSOR_MAX_Y * SYNTHVID_CURSOR_ARGB_PIXEL_SIZE) #define SYNTHVID_CURSOR_COMPLETE (-1) struct synthvid_pointer_shape { u8 part_idx; u8 is_argb; u32 width; /* SYNTHVID_CURSOR_MAX_X at most */ u32 height; /* SYNTHVID_CURSOR_MAX_Y at most */ u32 hot_x; /* hotspot relative to upper-left of pointer image */ u32 hot_y; u8 data[4]; } __packed; struct synthvid_feature_change { u8 is_dirt_needed; u8 is_ptr_pos_needed; u8 is_ptr_shape_needed; u8 is_situ_needed; } __packed; struct rect { s32 x1, y1; /* top left corner */ s32 x2, y2; /* bottom right corner, exclusive */ } __packed; struct synthvid_dirt { u8 video_output; u8 dirt_count; struct rect rect[1]; } __packed; #define SYNTHVID_EDID_BLOCK_SIZE 128 #define SYNTHVID_MAX_RESOLUTION_COUNT 64 struct synthvid_supported_resolution_req { u8 maximum_resolution_count; } __packed; struct synthvid_supported_resolution_resp { u8 edid_block[SYNTHVID_EDID_BLOCK_SIZE]; u8 resolution_count; u8 default_resolution_index; u8 is_standard; struct hvd_screen_info supported_resolution[SYNTHVID_MAX_RESOLUTION_COUNT]; } __packed; struct synthvid_msg { struct pipe_msg_hdr pipe_hdr; struct synthvid_msg_hdr vid_hdr; union { struct synthvid_version_req ver_req; struct synthvid_version_resp ver_resp; struct synthvid_vram_location vram; struct synthvid_vram_location_ack vram_ack; struct synthvid_situation_update situ; struct synthvid_situation_update_ack situ_ack; struct synthvid_pointer_position ptr_pos; struct synthvid_pointer_shape ptr_shape; struct synthvid_feature_change feature_chg; struct synthvid_dirt dirt; struct synthvid_supported_resolution_req resolution_req; struct synthvid_supported_resolution_resp resolution_resp; }; } __packed; static inline bool hyperv_version_ge(u32 ver1, u32 ver2) { if (SYNTHVID_VER_GET_MAJOR(ver1) > SYNTHVID_VER_GET_MAJOR(ver2) || (SYNTHVID_VER_GET_MAJOR(ver1) == SYNTHVID_VER_GET_MAJOR(ver2) && SYNTHVID_VER_GET_MINOR(ver1) >= SYNTHVID_VER_GET_MINOR(ver2))) return true; return false; } static inline int hyperv_sendpacket(struct hv_device *hdev, struct synthvid_msg *msg) { static atomic64_t request_id = ATOMIC64_INIT(0); struct hyperv_drm_device *hv = hv_get_drvdata(hdev); int ret; msg->pipe_hdr.type = PIPE_MSG_DATA; msg->pipe_hdr.size = msg->vid_hdr.size; ret = vmbus_sendpacket(hdev->channel, msg, msg->vid_hdr.size + sizeof(struct pipe_msg_hdr), atomic64_inc_return(&request_id), VM_PKT_DATA_INBAND, 0); if (ret) drm_err(&hv->dev, "Unable to send packet via vmbus\n"); return ret; } static int hyperv_negotiate_version(struct hv_device *hdev, u32 ver) { struct hyperv_drm_device *hv = hv_get_drvdata(hdev); struct synthvid_msg *msg = (struct synthvid_msg *)hv->init_buf; struct drm_device *dev = &hv->dev; unsigned long t; memset(msg, 0, sizeof(struct synthvid_msg)); msg->vid_hdr.type = SYNTHVID_VERSION_REQUEST; msg->vid_hdr.size = sizeof(struct synthvid_msg_hdr) + sizeof(struct synthvid_version_req); msg->ver_req.version = ver; hyperv_sendpacket(hdev, msg); t = wait_for_completion_timeout(&hv->wait, VMBUS_VSP_TIMEOUT); if (!t) { drm_err(dev, "Time out on waiting version response\n"); return -ETIMEDOUT; } if (!msg->ver_resp.is_accepted) { drm_err(dev, "Version request not accepted\n"); return -ENODEV; } hv->synthvid_version = ver; drm_info(dev, "Synthvid Version major %d, minor %d\n", SYNTHVID_VER_GET_MAJOR(ver), SYNTHVID_VER_GET_MINOR(ver)); return 0; } int hyperv_update_vram_location(struct hv_device *hdev, phys_addr_t vram_pp) { struct hyperv_drm_device *hv = hv_get_drvdata(hdev); struct synthvid_msg *msg = (struct synthvid_msg *)hv->init_buf; struct drm_device *dev = &hv->dev; unsigned long t; memset(msg, 0, sizeof(struct synthvid_msg)); msg->vid_hdr.type = SYNTHVID_VRAM_LOCATION; msg->vid_hdr.size = sizeof(struct synthvid_msg_hdr) + sizeof(struct synthvid_vram_location); msg->vram.user_ctx = vram_pp; msg->vram.vram_gpa = vram_pp; msg->vram.is_vram_gpa_specified = 1; hyperv_sendpacket(hdev, msg); t = wait_for_completion_timeout(&hv->wait, VMBUS_VSP_TIMEOUT); if (!t) { drm_err(dev, "Time out on waiting vram location ack\n"); return -ETIMEDOUT; } if (msg->vram_ack.user_ctx != vram_pp) { drm_err(dev, "Unable to set VRAM location\n"); return -ENODEV; } return 0; } int hyperv_update_situation(struct hv_device *hdev, u8 active, u32 bpp, u32 w, u32 h, u32 pitch) { struct synthvid_msg msg; memset(&msg, 0, sizeof(struct synthvid_msg)); msg.vid_hdr.type = SYNTHVID_SITUATION_UPDATE; msg.vid_hdr.size = sizeof(struct synthvid_msg_hdr) + sizeof(struct synthvid_situation_update); msg.situ.user_ctx = 0; msg.situ.video_output_count = 1; msg.situ.video_output[0].active = active; /* vram_offset should always be 0 */ msg.situ.video_output[0].vram_offset = 0; msg.situ.video_output[0].depth_bits = bpp; msg.situ.video_output[0].width_pixels = w; msg.situ.video_output[0].height_pixels = h; msg.situ.video_output[0].pitch_bytes = pitch; hyperv_sendpacket(hdev, &msg); return 0; } int hyperv_update_dirt(struct hv_device *hdev, struct drm_rect *rect) { struct hyperv_drm_device *hv = hv_get_drvdata(hdev); struct synthvid_msg msg; if (!hv->dirt_needed) return 0; memset(&msg, 0, sizeof(struct synthvid_msg)); msg.vid_hdr.type = SYNTHVID_DIRT; msg.vid_hdr.size = sizeof(struct synthvid_msg_hdr) + sizeof(struct synthvid_dirt); msg.dirt.video_output = 0; msg.dirt.dirt_count = 1; msg.dirt.rect[0].x1 = rect->x1; msg.dirt.rect[0].y1 = rect->y1; msg.dirt.rect[0].x2 = rect->x2; msg.dirt.rect[0].y2 = rect->y2; hyperv_sendpacket(hdev, &msg); return 0; } static int hyperv_get_supported_resolution(struct hv_device *hdev) { struct hyperv_drm_device *hv = hv_get_drvdata(hdev); struct synthvid_msg *msg = (struct synthvid_msg *)hv->init_buf; struct drm_device *dev = &hv->dev; unsigned long t; u8 index; int i; memset(msg, 0, sizeof(struct synthvid_msg)); msg->vid_hdr.type = SYNTHVID_RESOLUTION_REQUEST; msg->vid_hdr.size = sizeof(struct synthvid_msg_hdr) + sizeof(struct synthvid_supported_resolution_req); msg->resolution_req.maximum_resolution_count = SYNTHVID_MAX_RESOLUTION_COUNT; hyperv_sendpacket(hdev, msg); t = wait_for_completion_timeout(&hv->wait, VMBUS_VSP_TIMEOUT); if (!t) { drm_err(dev, "Time out on waiting resolution response\n"); return -ETIMEDOUT; } if (msg->resolution_resp.resolution_count == 0) { drm_err(dev, "No supported resolutions\n"); return -ENODEV; } index = msg->resolution_resp.default_resolution_index; if (index >= msg->resolution_resp.resolution_count) { drm_err(dev, "Invalid resolution index: %d\n", index); return -ENODEV; } for (i = 0; i < msg->resolution_resp.resolution_count; i++) { hv->screen_width_max = max_t(u32, hv->screen_width_max, msg->resolution_resp.supported_resolution[i].width); hv->screen_height_max = max_t(u32, hv->screen_height_max, msg->resolution_resp.supported_resolution[i].height); } hv->preferred_width = msg->resolution_resp.supported_resolution[index].width; hv->preferred_height = msg->resolution_resp.supported_resolution[index].height; return 0; } static void hyperv_receive_sub(struct hv_device *hdev) { struct hyperv_drm_device *hv = hv_get_drvdata(hdev); struct synthvid_msg *msg; if (!hv) return; msg = (struct synthvid_msg *)hv->recv_buf; /* Complete the wait event */ if (msg->vid_hdr.type == SYNTHVID_VERSION_RESPONSE || msg->vid_hdr.type == SYNTHVID_RESOLUTION_RESPONSE || msg->vid_hdr.type == SYNTHVID_VRAM_LOCATION_ACK) { memcpy(hv->init_buf, msg, VMBUS_MAX_PACKET_SIZE); complete(&hv->wait); return; } if (msg->vid_hdr.type == SYNTHVID_FEATURE_CHANGE) hv->dirt_needed = msg->feature_chg.is_dirt_needed; } static void hyperv_receive(void *ctx) { struct hv_device *hdev = ctx; struct hyperv_drm_device *hv = hv_get_drvdata(hdev); struct synthvid_msg *recv_buf; u32 bytes_recvd; u64 req_id; int ret; if (!hv) return; recv_buf = (struct synthvid_msg *)hv->recv_buf; do { ret = vmbus_recvpacket(hdev->channel, recv_buf, VMBUS_MAX_PACKET_SIZE, &bytes_recvd, &req_id); if (bytes_recvd > 0 && recv_buf->pipe_hdr.type == PIPE_MSG_DATA) hyperv_receive_sub(hdev); } while (bytes_recvd > 0 && ret == 0); } int hyperv_connect_vsp(struct hv_device *hdev) { struct hyperv_drm_device *hv = hv_get_drvdata(hdev); struct drm_device *dev = &hv->dev; int ret; ret = vmbus_open(hdev->channel, VMBUS_RING_BUFSIZE, VMBUS_RING_BUFSIZE, NULL, 0, hyperv_receive, hdev); if (ret) { drm_err(dev, "Unable to open vmbus channel\n"); return ret; } /* Negotiate the protocol version with host */ switch (vmbus_proto_version) { case VERSION_WIN10: case VERSION_WIN10_V5: ret = hyperv_negotiate_version(hdev, SYNTHVID_VERSION_WIN10); if (!ret) break; fallthrough; case VERSION_WIN8: case VERSION_WIN8_1: ret = hyperv_negotiate_version(hdev, SYNTHVID_VERSION_WIN8); if (!ret) break; fallthrough; case VERSION_WS2008: case VERSION_WIN7: ret = hyperv_negotiate_version(hdev, SYNTHVID_VERSION_WIN7); break; default: ret = hyperv_negotiate_version(hdev, SYNTHVID_VERSION_WIN10); break; } if (ret) { drm_err(dev, "Synthetic video device version not accepted %d\n", ret); goto error; } if (hv->synthvid_version == SYNTHVID_VERSION_WIN7) hv->screen_depth = SYNTHVID_DEPTH_WIN7; else hv->screen_depth = SYNTHVID_DEPTH_WIN8; if (hyperv_version_ge(hv->synthvid_version, SYNTHVID_VERSION_WIN10)) { ret = hyperv_get_supported_resolution(hdev); if (ret) drm_err(dev, "Failed to get supported resolution from host, use default\n"); } else { hv->screen_width_max = SYNTHVID_WIDTH_MAX_WIN7; hv->screen_height_max = SYNTHVID_HEIGHT_MAX_WIN7; } hv->mmio_megabytes = hdev->channel->offermsg.offer.mmio_megabytes; return 0; error: vmbus_close(hdev->channel); return ret; }