162306a36Sopenharmony_ci/*
262306a36Sopenharmony_ci * Copyright(c) 2011-2017 Intel Corporation. All rights reserved.
362306a36Sopenharmony_ci *
462306a36Sopenharmony_ci * Permission is hereby granted, free of charge, to any person obtaining a
562306a36Sopenharmony_ci * copy of this software and associated documentation files (the "Software"),
662306a36Sopenharmony_ci * to deal in the Software without restriction, including without limitation
762306a36Sopenharmony_ci * the rights to use, copy, modify, merge, publish, distribute, sublicense,
862306a36Sopenharmony_ci * and/or sell copies of the Software, and to permit persons to whom the
962306a36Sopenharmony_ci * Software is furnished to do so, subject to the following conditions:
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci * The above copyright notice and this permission notice (including the next
1262306a36Sopenharmony_ci * paragraph) shall be included in all copies or substantial portions of the
1362306a36Sopenharmony_ci * Software.
1462306a36Sopenharmony_ci *
1562306a36Sopenharmony_ci * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
1662306a36Sopenharmony_ci * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
1762306a36Sopenharmony_ci * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
1862306a36Sopenharmony_ci * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
1962306a36Sopenharmony_ci * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
2062306a36Sopenharmony_ci * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
2162306a36Sopenharmony_ci * SOFTWARE.
2262306a36Sopenharmony_ci */
2362306a36Sopenharmony_ci#include "i915_drv.h"
2462306a36Sopenharmony_ci#include "gvt.h"
2562306a36Sopenharmony_ci
2662306a36Sopenharmony_ci/**
2762306a36Sopenharmony_ci * intel_vgpu_find_page_track - find page track rcord of guest page
2862306a36Sopenharmony_ci * @vgpu: a vGPU
2962306a36Sopenharmony_ci * @gfn: the gfn of guest page
3062306a36Sopenharmony_ci *
3162306a36Sopenharmony_ci * Returns:
3262306a36Sopenharmony_ci * A pointer to struct intel_vgpu_page_track if found, else NULL returned.
3362306a36Sopenharmony_ci */
3462306a36Sopenharmony_cistruct intel_vgpu_page_track *intel_vgpu_find_page_track(
3562306a36Sopenharmony_ci		struct intel_vgpu *vgpu, unsigned long gfn)
3662306a36Sopenharmony_ci{
3762306a36Sopenharmony_ci	return radix_tree_lookup(&vgpu->page_track_tree, gfn);
3862306a36Sopenharmony_ci}
3962306a36Sopenharmony_ci
4062306a36Sopenharmony_ci/**
4162306a36Sopenharmony_ci * intel_vgpu_register_page_track - register a guest page to be tacked
4262306a36Sopenharmony_ci * @vgpu: a vGPU
4362306a36Sopenharmony_ci * @gfn: the gfn of guest page
4462306a36Sopenharmony_ci * @handler: page track handler
4562306a36Sopenharmony_ci * @priv: tracker private
4662306a36Sopenharmony_ci *
4762306a36Sopenharmony_ci * Returns:
4862306a36Sopenharmony_ci * zero on success, negative error code if failed.
4962306a36Sopenharmony_ci */
5062306a36Sopenharmony_ciint intel_vgpu_register_page_track(struct intel_vgpu *vgpu, unsigned long gfn,
5162306a36Sopenharmony_ci		gvt_page_track_handler_t handler, void *priv)
5262306a36Sopenharmony_ci{
5362306a36Sopenharmony_ci	struct intel_vgpu_page_track *track;
5462306a36Sopenharmony_ci	int ret;
5562306a36Sopenharmony_ci
5662306a36Sopenharmony_ci	track = intel_vgpu_find_page_track(vgpu, gfn);
5762306a36Sopenharmony_ci	if (track)
5862306a36Sopenharmony_ci		return -EEXIST;
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ci	track = kzalloc(sizeof(*track), GFP_KERNEL);
6162306a36Sopenharmony_ci	if (!track)
6262306a36Sopenharmony_ci		return -ENOMEM;
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	track->handler = handler;
6562306a36Sopenharmony_ci	track->priv_data = priv;
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_ci	ret = radix_tree_insert(&vgpu->page_track_tree, gfn, track);
6862306a36Sopenharmony_ci	if (ret) {
6962306a36Sopenharmony_ci		kfree(track);
7062306a36Sopenharmony_ci		return ret;
7162306a36Sopenharmony_ci	}
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci	return 0;
7462306a36Sopenharmony_ci}
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_ci/**
7762306a36Sopenharmony_ci * intel_vgpu_unregister_page_track - unregister the tracked guest page
7862306a36Sopenharmony_ci * @vgpu: a vGPU
7962306a36Sopenharmony_ci * @gfn: the gfn of guest page
8062306a36Sopenharmony_ci *
8162306a36Sopenharmony_ci */
8262306a36Sopenharmony_civoid intel_vgpu_unregister_page_track(struct intel_vgpu *vgpu,
8362306a36Sopenharmony_ci		unsigned long gfn)
8462306a36Sopenharmony_ci{
8562306a36Sopenharmony_ci	struct intel_vgpu_page_track *track;
8662306a36Sopenharmony_ci
8762306a36Sopenharmony_ci	track = radix_tree_delete(&vgpu->page_track_tree, gfn);
8862306a36Sopenharmony_ci	if (track) {
8962306a36Sopenharmony_ci		if (track->tracked)
9062306a36Sopenharmony_ci			intel_gvt_page_track_remove(vgpu, gfn);
9162306a36Sopenharmony_ci		kfree(track);
9262306a36Sopenharmony_ci	}
9362306a36Sopenharmony_ci}
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci/**
9662306a36Sopenharmony_ci * intel_vgpu_enable_page_track - set write-protection on guest page
9762306a36Sopenharmony_ci * @vgpu: a vGPU
9862306a36Sopenharmony_ci * @gfn: the gfn of guest page
9962306a36Sopenharmony_ci *
10062306a36Sopenharmony_ci * Returns:
10162306a36Sopenharmony_ci * zero on success, negative error code if failed.
10262306a36Sopenharmony_ci */
10362306a36Sopenharmony_ciint intel_vgpu_enable_page_track(struct intel_vgpu *vgpu, unsigned long gfn)
10462306a36Sopenharmony_ci{
10562306a36Sopenharmony_ci	struct intel_vgpu_page_track *track;
10662306a36Sopenharmony_ci	int ret;
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	track = intel_vgpu_find_page_track(vgpu, gfn);
10962306a36Sopenharmony_ci	if (!track)
11062306a36Sopenharmony_ci		return -ENXIO;
11162306a36Sopenharmony_ci
11262306a36Sopenharmony_ci	if (track->tracked)
11362306a36Sopenharmony_ci		return 0;
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_ci	ret = intel_gvt_page_track_add(vgpu, gfn);
11662306a36Sopenharmony_ci	if (ret)
11762306a36Sopenharmony_ci		return ret;
11862306a36Sopenharmony_ci	track->tracked = true;
11962306a36Sopenharmony_ci	return 0;
12062306a36Sopenharmony_ci}
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci/**
12362306a36Sopenharmony_ci * intel_vgpu_disable_page_track - cancel write-protection on guest page
12462306a36Sopenharmony_ci * @vgpu: a vGPU
12562306a36Sopenharmony_ci * @gfn: the gfn of guest page
12662306a36Sopenharmony_ci *
12762306a36Sopenharmony_ci * Returns:
12862306a36Sopenharmony_ci * zero on success, negative error code if failed.
12962306a36Sopenharmony_ci */
13062306a36Sopenharmony_ciint intel_vgpu_disable_page_track(struct intel_vgpu *vgpu, unsigned long gfn)
13162306a36Sopenharmony_ci{
13262306a36Sopenharmony_ci	struct intel_vgpu_page_track *track;
13362306a36Sopenharmony_ci	int ret;
13462306a36Sopenharmony_ci
13562306a36Sopenharmony_ci	track = intel_vgpu_find_page_track(vgpu, gfn);
13662306a36Sopenharmony_ci	if (!track)
13762306a36Sopenharmony_ci		return -ENXIO;
13862306a36Sopenharmony_ci
13962306a36Sopenharmony_ci	if (!track->tracked)
14062306a36Sopenharmony_ci		return 0;
14162306a36Sopenharmony_ci
14262306a36Sopenharmony_ci	ret = intel_gvt_page_track_remove(vgpu, gfn);
14362306a36Sopenharmony_ci	if (ret)
14462306a36Sopenharmony_ci		return ret;
14562306a36Sopenharmony_ci	track->tracked = false;
14662306a36Sopenharmony_ci	return 0;
14762306a36Sopenharmony_ci}
14862306a36Sopenharmony_ci
14962306a36Sopenharmony_ci/**
15062306a36Sopenharmony_ci * intel_vgpu_page_track_handler - called when write to write-protected page
15162306a36Sopenharmony_ci * @vgpu: a vGPU
15262306a36Sopenharmony_ci * @gpa: the gpa of this write
15362306a36Sopenharmony_ci * @data: the writed data
15462306a36Sopenharmony_ci * @bytes: the length of this write
15562306a36Sopenharmony_ci *
15662306a36Sopenharmony_ci * Returns:
15762306a36Sopenharmony_ci * zero on success, negative error code if failed.
15862306a36Sopenharmony_ci */
15962306a36Sopenharmony_ciint intel_vgpu_page_track_handler(struct intel_vgpu *vgpu, u64 gpa,
16062306a36Sopenharmony_ci		void *data, unsigned int bytes)
16162306a36Sopenharmony_ci{
16262306a36Sopenharmony_ci	struct intel_vgpu_page_track *page_track;
16362306a36Sopenharmony_ci	int ret = 0;
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_ci	page_track = intel_vgpu_find_page_track(vgpu, gpa >> PAGE_SHIFT);
16662306a36Sopenharmony_ci	if (!page_track)
16762306a36Sopenharmony_ci		return -ENXIO;
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	if (unlikely(vgpu->failsafe)) {
17062306a36Sopenharmony_ci		/* Remove write protection to prevent furture traps. */
17162306a36Sopenharmony_ci		intel_gvt_page_track_remove(vgpu, gpa >> PAGE_SHIFT);
17262306a36Sopenharmony_ci	} else {
17362306a36Sopenharmony_ci		ret = page_track->handler(page_track, gpa, data, bytes);
17462306a36Sopenharmony_ci		if (ret)
17562306a36Sopenharmony_ci			gvt_err("guest page write error, gpa %llx\n", gpa);
17662306a36Sopenharmony_ci	}
17762306a36Sopenharmony_ci
17862306a36Sopenharmony_ci	return ret;
17962306a36Sopenharmony_ci}
180