18c2ecf20Sopenharmony_ci/*
28c2ecf20Sopenharmony_ci * Copyright(c) 2011-2017 Intel Corporation. All rights reserved.
38c2ecf20Sopenharmony_ci *
48c2ecf20Sopenharmony_ci * Permission is hereby granted, free of charge, to any person obtaining a
58c2ecf20Sopenharmony_ci * copy of this software and associated documentation files (the "Software"),
68c2ecf20Sopenharmony_ci * to deal in the Software without restriction, including without limitation
78c2ecf20Sopenharmony_ci * the rights to use, copy, modify, merge, publish, distribute, sublicense,
88c2ecf20Sopenharmony_ci * and/or sell copies of the Software, and to permit persons to whom the
98c2ecf20Sopenharmony_ci * Software is furnished to do so, subject to the following conditions:
108c2ecf20Sopenharmony_ci *
118c2ecf20Sopenharmony_ci * The above copyright notice and this permission notice (including the next
128c2ecf20Sopenharmony_ci * paragraph) shall be included in all copies or substantial portions of the
138c2ecf20Sopenharmony_ci * Software.
148c2ecf20Sopenharmony_ci *
158c2ecf20Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
168c2ecf20Sopenharmony_ci * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
178c2ecf20Sopenharmony_ci * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
188c2ecf20Sopenharmony_ci * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
198c2ecf20Sopenharmony_ci * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
208c2ecf20Sopenharmony_ci * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
218c2ecf20Sopenharmony_ci * SOFTWARE.
228c2ecf20Sopenharmony_ci */
238c2ecf20Sopenharmony_ci#include "i915_drv.h"
248c2ecf20Sopenharmony_ci#include "gvt.h"
258c2ecf20Sopenharmony_ci
268c2ecf20Sopenharmony_ci/**
278c2ecf20Sopenharmony_ci * intel_vgpu_find_page_track - find page track rcord of guest page
288c2ecf20Sopenharmony_ci * @vgpu: a vGPU
298c2ecf20Sopenharmony_ci * @gfn: the gfn of guest page
308c2ecf20Sopenharmony_ci *
318c2ecf20Sopenharmony_ci * Returns:
328c2ecf20Sopenharmony_ci * A pointer to struct intel_vgpu_page_track if found, else NULL returned.
338c2ecf20Sopenharmony_ci */
348c2ecf20Sopenharmony_cistruct intel_vgpu_page_track *intel_vgpu_find_page_track(
358c2ecf20Sopenharmony_ci		struct intel_vgpu *vgpu, unsigned long gfn)
368c2ecf20Sopenharmony_ci{
378c2ecf20Sopenharmony_ci	return radix_tree_lookup(&vgpu->page_track_tree, gfn);
388c2ecf20Sopenharmony_ci}
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci/**
418c2ecf20Sopenharmony_ci * intel_vgpu_register_page_track - register a guest page to be tacked
428c2ecf20Sopenharmony_ci * @vgpu: a vGPU
438c2ecf20Sopenharmony_ci * @gfn: the gfn of guest page
448c2ecf20Sopenharmony_ci * @handler: page track handler
458c2ecf20Sopenharmony_ci * @priv: tracker private
468c2ecf20Sopenharmony_ci *
478c2ecf20Sopenharmony_ci * Returns:
488c2ecf20Sopenharmony_ci * zero on success, negative error code if failed.
498c2ecf20Sopenharmony_ci */
508c2ecf20Sopenharmony_ciint intel_vgpu_register_page_track(struct intel_vgpu *vgpu, unsigned long gfn,
518c2ecf20Sopenharmony_ci		gvt_page_track_handler_t handler, void *priv)
528c2ecf20Sopenharmony_ci{
538c2ecf20Sopenharmony_ci	struct intel_vgpu_page_track *track;
548c2ecf20Sopenharmony_ci	int ret;
558c2ecf20Sopenharmony_ci
568c2ecf20Sopenharmony_ci	track = intel_vgpu_find_page_track(vgpu, gfn);
578c2ecf20Sopenharmony_ci	if (track)
588c2ecf20Sopenharmony_ci		return -EEXIST;
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_ci	track = kzalloc(sizeof(*track), GFP_KERNEL);
618c2ecf20Sopenharmony_ci	if (!track)
628c2ecf20Sopenharmony_ci		return -ENOMEM;
638c2ecf20Sopenharmony_ci
648c2ecf20Sopenharmony_ci	track->handler = handler;
658c2ecf20Sopenharmony_ci	track->priv_data = priv;
668c2ecf20Sopenharmony_ci
678c2ecf20Sopenharmony_ci	ret = radix_tree_insert(&vgpu->page_track_tree, gfn, track);
688c2ecf20Sopenharmony_ci	if (ret) {
698c2ecf20Sopenharmony_ci		kfree(track);
708c2ecf20Sopenharmony_ci		return ret;
718c2ecf20Sopenharmony_ci	}
728c2ecf20Sopenharmony_ci
738c2ecf20Sopenharmony_ci	return 0;
748c2ecf20Sopenharmony_ci}
758c2ecf20Sopenharmony_ci
768c2ecf20Sopenharmony_ci/**
778c2ecf20Sopenharmony_ci * intel_vgpu_unregister_page_track - unregister the tracked guest page
788c2ecf20Sopenharmony_ci * @vgpu: a vGPU
798c2ecf20Sopenharmony_ci * @gfn: the gfn of guest page
808c2ecf20Sopenharmony_ci *
818c2ecf20Sopenharmony_ci */
828c2ecf20Sopenharmony_civoid intel_vgpu_unregister_page_track(struct intel_vgpu *vgpu,
838c2ecf20Sopenharmony_ci		unsigned long gfn)
848c2ecf20Sopenharmony_ci{
858c2ecf20Sopenharmony_ci	struct intel_vgpu_page_track *track;
868c2ecf20Sopenharmony_ci
878c2ecf20Sopenharmony_ci	track = radix_tree_delete(&vgpu->page_track_tree, gfn);
888c2ecf20Sopenharmony_ci	if (track) {
898c2ecf20Sopenharmony_ci		if (track->tracked)
908c2ecf20Sopenharmony_ci			intel_gvt_hypervisor_disable_page_track(vgpu, gfn);
918c2ecf20Sopenharmony_ci		kfree(track);
928c2ecf20Sopenharmony_ci	}
938c2ecf20Sopenharmony_ci}
948c2ecf20Sopenharmony_ci
958c2ecf20Sopenharmony_ci/**
968c2ecf20Sopenharmony_ci * intel_vgpu_enable_page_track - set write-protection on guest page
978c2ecf20Sopenharmony_ci * @vgpu: a vGPU
988c2ecf20Sopenharmony_ci * @gfn: the gfn of guest page
998c2ecf20Sopenharmony_ci *
1008c2ecf20Sopenharmony_ci * Returns:
1018c2ecf20Sopenharmony_ci * zero on success, negative error code if failed.
1028c2ecf20Sopenharmony_ci */
1038c2ecf20Sopenharmony_ciint intel_vgpu_enable_page_track(struct intel_vgpu *vgpu, unsigned long gfn)
1048c2ecf20Sopenharmony_ci{
1058c2ecf20Sopenharmony_ci	struct intel_vgpu_page_track *track;
1068c2ecf20Sopenharmony_ci	int ret;
1078c2ecf20Sopenharmony_ci
1088c2ecf20Sopenharmony_ci	track = intel_vgpu_find_page_track(vgpu, gfn);
1098c2ecf20Sopenharmony_ci	if (!track)
1108c2ecf20Sopenharmony_ci		return -ENXIO;
1118c2ecf20Sopenharmony_ci
1128c2ecf20Sopenharmony_ci	if (track->tracked)
1138c2ecf20Sopenharmony_ci		return 0;
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	ret = intel_gvt_hypervisor_enable_page_track(vgpu, gfn);
1168c2ecf20Sopenharmony_ci	if (ret)
1178c2ecf20Sopenharmony_ci		return ret;
1188c2ecf20Sopenharmony_ci	track->tracked = true;
1198c2ecf20Sopenharmony_ci	return 0;
1208c2ecf20Sopenharmony_ci}
1218c2ecf20Sopenharmony_ci
1228c2ecf20Sopenharmony_ci/**
1238c2ecf20Sopenharmony_ci * intel_vgpu_enable_page_track - cancel write-protection on guest page
1248c2ecf20Sopenharmony_ci * @vgpu: a vGPU
1258c2ecf20Sopenharmony_ci * @gfn: the gfn of guest page
1268c2ecf20Sopenharmony_ci *
1278c2ecf20Sopenharmony_ci * Returns:
1288c2ecf20Sopenharmony_ci * zero on success, negative error code if failed.
1298c2ecf20Sopenharmony_ci */
1308c2ecf20Sopenharmony_ciint intel_vgpu_disable_page_track(struct intel_vgpu *vgpu, unsigned long gfn)
1318c2ecf20Sopenharmony_ci{
1328c2ecf20Sopenharmony_ci	struct intel_vgpu_page_track *track;
1338c2ecf20Sopenharmony_ci	int ret;
1348c2ecf20Sopenharmony_ci
1358c2ecf20Sopenharmony_ci	track = intel_vgpu_find_page_track(vgpu, gfn);
1368c2ecf20Sopenharmony_ci	if (!track)
1378c2ecf20Sopenharmony_ci		return -ENXIO;
1388c2ecf20Sopenharmony_ci
1398c2ecf20Sopenharmony_ci	if (!track->tracked)
1408c2ecf20Sopenharmony_ci		return 0;
1418c2ecf20Sopenharmony_ci
1428c2ecf20Sopenharmony_ci	ret = intel_gvt_hypervisor_disable_page_track(vgpu, gfn);
1438c2ecf20Sopenharmony_ci	if (ret)
1448c2ecf20Sopenharmony_ci		return ret;
1458c2ecf20Sopenharmony_ci	track->tracked = false;
1468c2ecf20Sopenharmony_ci	return 0;
1478c2ecf20Sopenharmony_ci}
1488c2ecf20Sopenharmony_ci
1498c2ecf20Sopenharmony_ci/**
1508c2ecf20Sopenharmony_ci * intel_vgpu_page_track_handler - called when write to write-protected page
1518c2ecf20Sopenharmony_ci * @vgpu: a vGPU
1528c2ecf20Sopenharmony_ci * @gpa: the gpa of this write
1538c2ecf20Sopenharmony_ci * @data: the writed data
1548c2ecf20Sopenharmony_ci * @bytes: the length of this write
1558c2ecf20Sopenharmony_ci *
1568c2ecf20Sopenharmony_ci * Returns:
1578c2ecf20Sopenharmony_ci * zero on success, negative error code if failed.
1588c2ecf20Sopenharmony_ci */
1598c2ecf20Sopenharmony_ciint intel_vgpu_page_track_handler(struct intel_vgpu *vgpu, u64 gpa,
1608c2ecf20Sopenharmony_ci		void *data, unsigned int bytes)
1618c2ecf20Sopenharmony_ci{
1628c2ecf20Sopenharmony_ci	struct intel_vgpu_page_track *page_track;
1638c2ecf20Sopenharmony_ci	int ret = 0;
1648c2ecf20Sopenharmony_ci
1658c2ecf20Sopenharmony_ci	mutex_lock(&vgpu->vgpu_lock);
1668c2ecf20Sopenharmony_ci
1678c2ecf20Sopenharmony_ci	page_track = intel_vgpu_find_page_track(vgpu, gpa >> PAGE_SHIFT);
1688c2ecf20Sopenharmony_ci	if (!page_track) {
1698c2ecf20Sopenharmony_ci		ret = -ENXIO;
1708c2ecf20Sopenharmony_ci		goto out;
1718c2ecf20Sopenharmony_ci	}
1728c2ecf20Sopenharmony_ci
1738c2ecf20Sopenharmony_ci	if (unlikely(vgpu->failsafe)) {
1748c2ecf20Sopenharmony_ci		/* Remove write protection to prevent furture traps. */
1758c2ecf20Sopenharmony_ci		intel_vgpu_disable_page_track(vgpu, gpa >> PAGE_SHIFT);
1768c2ecf20Sopenharmony_ci	} else {
1778c2ecf20Sopenharmony_ci		ret = page_track->handler(page_track, gpa, data, bytes);
1788c2ecf20Sopenharmony_ci		if (ret)
1798c2ecf20Sopenharmony_ci			gvt_err("guest page write error, gpa %llx\n", gpa);
1808c2ecf20Sopenharmony_ci	}
1818c2ecf20Sopenharmony_ci
1828c2ecf20Sopenharmony_ciout:
1838c2ecf20Sopenharmony_ci	mutex_unlock(&vgpu->vgpu_lock);
1848c2ecf20Sopenharmony_ci	return ret;
1858c2ecf20Sopenharmony_ci}
186