Home | History | Annotate | Line # | Download | only in gvt
      1  1.1  riastrad /*	$NetBSD: page_track.c,v 1.2 2021/12/18 23:45:31 riastradh Exp $	*/
      2  1.1  riastrad 
      3  1.1  riastrad /*
      4  1.1  riastrad  * Copyright(c) 2011-2017 Intel Corporation. All rights reserved.
      5  1.1  riastrad  *
      6  1.1  riastrad  * Permission is hereby granted, free of charge, to any person obtaining a
      7  1.1  riastrad  * copy of this software and associated documentation files (the "Software"),
      8  1.1  riastrad  * to deal in the Software without restriction, including without limitation
      9  1.1  riastrad  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
     10  1.1  riastrad  * and/or sell copies of the Software, and to permit persons to whom the
     11  1.1  riastrad  * Software is furnished to do so, subject to the following conditions:
     12  1.1  riastrad  *
     13  1.1  riastrad  * The above copyright notice and this permission notice (including the next
     14  1.1  riastrad  * paragraph) shall be included in all copies or substantial portions of the
     15  1.1  riastrad  * Software.
     16  1.1  riastrad  *
     17  1.1  riastrad  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
     18  1.1  riastrad  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
     19  1.1  riastrad  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
     20  1.1  riastrad  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
     21  1.1  riastrad  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
     22  1.1  riastrad  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
     23  1.1  riastrad  * SOFTWARE.
     24  1.1  riastrad  */
     25  1.1  riastrad #include <sys/cdefs.h>
     26  1.1  riastrad __KERNEL_RCSID(0, "$NetBSD: page_track.c,v 1.2 2021/12/18 23:45:31 riastradh Exp $");
     27  1.1  riastrad 
     28  1.1  riastrad #include "i915_drv.h"
     29  1.1  riastrad #include "gvt.h"
     30  1.1  riastrad 
     31  1.1  riastrad /**
     32  1.1  riastrad  * intel_vgpu_find_page_track - find page track rcord of guest page
     33  1.1  riastrad  * @vgpu: a vGPU
     34  1.1  riastrad  * @gfn: the gfn of guest page
     35  1.1  riastrad  *
     36  1.1  riastrad  * Returns:
     37  1.1  riastrad  * A pointer to struct intel_vgpu_page_track if found, else NULL returned.
     38  1.1  riastrad  */
     39  1.1  riastrad struct intel_vgpu_page_track *intel_vgpu_find_page_track(
     40  1.1  riastrad 		struct intel_vgpu *vgpu, unsigned long gfn)
     41  1.1  riastrad {
     42  1.1  riastrad 	return radix_tree_lookup(&vgpu->page_track_tree, gfn);
     43  1.1  riastrad }
     44  1.1  riastrad 
     45  1.1  riastrad /**
     46  1.1  riastrad  * intel_vgpu_register_page_track - register a guest page to be tacked
     47  1.1  riastrad  * @vgpu: a vGPU
     48  1.1  riastrad  * @gfn: the gfn of guest page
     49  1.1  riastrad  * @handler: page track handler
     50  1.1  riastrad  * @priv: tracker private
     51  1.1  riastrad  *
     52  1.1  riastrad  * Returns:
     53  1.1  riastrad  * zero on success, negative error code if failed.
     54  1.1  riastrad  */
     55  1.1  riastrad int intel_vgpu_register_page_track(struct intel_vgpu *vgpu, unsigned long gfn,
     56  1.1  riastrad 		gvt_page_track_handler_t handler, void *priv)
     57  1.1  riastrad {
     58  1.1  riastrad 	struct intel_vgpu_page_track *track;
     59  1.1  riastrad 	int ret;
     60  1.1  riastrad 
     61  1.1  riastrad 	track = intel_vgpu_find_page_track(vgpu, gfn);
     62  1.1  riastrad 	if (track)
     63  1.1  riastrad 		return -EEXIST;
     64  1.1  riastrad 
     65  1.1  riastrad 	track = kzalloc(sizeof(*track), GFP_KERNEL);
     66  1.1  riastrad 	if (!track)
     67  1.1  riastrad 		return -ENOMEM;
     68  1.1  riastrad 
     69  1.1  riastrad 	track->handler = handler;
     70  1.1  riastrad 	track->priv_data = priv;
     71  1.1  riastrad 
     72  1.1  riastrad 	ret = radix_tree_insert(&vgpu->page_track_tree, gfn, track);
     73  1.1  riastrad 	if (ret) {
     74  1.1  riastrad 		kfree(track);
     75  1.1  riastrad 		return ret;
     76  1.1  riastrad 	}
     77  1.1  riastrad 
     78  1.1  riastrad 	return 0;
     79  1.1  riastrad }
     80  1.1  riastrad 
     81  1.1  riastrad /**
     82  1.1  riastrad  * intel_vgpu_unregister_page_track - unregister the tracked guest page
     83  1.1  riastrad  * @vgpu: a vGPU
     84  1.1  riastrad  * @gfn: the gfn of guest page
     85  1.1  riastrad  *
     86  1.1  riastrad  */
     87  1.1  riastrad void intel_vgpu_unregister_page_track(struct intel_vgpu *vgpu,
     88  1.1  riastrad 		unsigned long gfn)
     89  1.1  riastrad {
     90  1.1  riastrad 	struct intel_vgpu_page_track *track;
     91  1.1  riastrad 
     92  1.1  riastrad 	track = radix_tree_delete(&vgpu->page_track_tree, gfn);
     93  1.1  riastrad 	if (track) {
     94  1.1  riastrad 		if (track->tracked)
     95  1.1  riastrad 			intel_gvt_hypervisor_disable_page_track(vgpu, gfn);
     96  1.1  riastrad 		kfree(track);
     97  1.1  riastrad 	}
     98  1.1  riastrad }
     99  1.1  riastrad 
    100  1.1  riastrad /**
    101  1.1  riastrad  * intel_vgpu_enable_page_track - set write-protection on guest page
    102  1.1  riastrad  * @vgpu: a vGPU
    103  1.1  riastrad  * @gfn: the gfn of guest page
    104  1.1  riastrad  *
    105  1.1  riastrad  * Returns:
    106  1.1  riastrad  * zero on success, negative error code if failed.
    107  1.1  riastrad  */
    108  1.1  riastrad int intel_vgpu_enable_page_track(struct intel_vgpu *vgpu, unsigned long gfn)
    109  1.1  riastrad {
    110  1.1  riastrad 	struct intel_vgpu_page_track *track;
    111  1.1  riastrad 	int ret;
    112  1.1  riastrad 
    113  1.1  riastrad 	track = intel_vgpu_find_page_track(vgpu, gfn);
    114  1.1  riastrad 	if (!track)
    115  1.1  riastrad 		return -ENXIO;
    116  1.1  riastrad 
    117  1.1  riastrad 	if (track->tracked)
    118  1.1  riastrad 		return 0;
    119  1.1  riastrad 
    120  1.1  riastrad 	ret = intel_gvt_hypervisor_enable_page_track(vgpu, gfn);
    121  1.1  riastrad 	if (ret)
    122  1.1  riastrad 		return ret;
    123  1.1  riastrad 	track->tracked = true;
    124  1.1  riastrad 	return 0;
    125  1.1  riastrad }
    126  1.1  riastrad 
    127  1.1  riastrad /**
    128  1.1  riastrad  * intel_vgpu_enable_page_track - cancel write-protection on guest page
    129  1.1  riastrad  * @vgpu: a vGPU
    130  1.1  riastrad  * @gfn: the gfn of guest page
    131  1.1  riastrad  *
    132  1.1  riastrad  * Returns:
    133  1.1  riastrad  * zero on success, negative error code if failed.
    134  1.1  riastrad  */
    135  1.1  riastrad int intel_vgpu_disable_page_track(struct intel_vgpu *vgpu, unsigned long gfn)
    136  1.1  riastrad {
    137  1.1  riastrad 	struct intel_vgpu_page_track *track;
    138  1.1  riastrad 	int ret;
    139  1.1  riastrad 
    140  1.1  riastrad 	track = intel_vgpu_find_page_track(vgpu, gfn);
    141  1.1  riastrad 	if (!track)
    142  1.1  riastrad 		return -ENXIO;
    143  1.1  riastrad 
    144  1.1  riastrad 	if (!track->tracked)
    145  1.1  riastrad 		return 0;
    146  1.1  riastrad 
    147  1.1  riastrad 	ret = intel_gvt_hypervisor_disable_page_track(vgpu, gfn);
    148  1.1  riastrad 	if (ret)
    149  1.1  riastrad 		return ret;
    150  1.1  riastrad 	track->tracked = false;
    151  1.1  riastrad 	return 0;
    152  1.1  riastrad }
    153  1.1  riastrad 
    154  1.1  riastrad /**
    155  1.1  riastrad  * intel_vgpu_page_track_handler - called when write to write-protected page
    156  1.1  riastrad  * @vgpu: a vGPU
    157  1.1  riastrad  * @gpa: the gpa of this write
    158  1.1  riastrad  * @data: the writed data
    159  1.1  riastrad  * @bytes: the length of this write
    160  1.1  riastrad  *
    161  1.1  riastrad  * Returns:
    162  1.1  riastrad  * zero on success, negative error code if failed.
    163  1.1  riastrad  */
    164  1.1  riastrad int intel_vgpu_page_track_handler(struct intel_vgpu *vgpu, u64 gpa,
    165  1.1  riastrad 		void *data, unsigned int bytes)
    166  1.1  riastrad {
    167  1.1  riastrad 	struct intel_vgpu_page_track *page_track;
    168  1.1  riastrad 	int ret = 0;
    169  1.1  riastrad 
    170  1.1  riastrad 	mutex_lock(&vgpu->vgpu_lock);
    171  1.1  riastrad 
    172  1.1  riastrad 	page_track = intel_vgpu_find_page_track(vgpu, gpa >> PAGE_SHIFT);
    173  1.1  riastrad 	if (!page_track) {
    174  1.1  riastrad 		ret = -ENXIO;
    175  1.1  riastrad 		goto out;
    176  1.1  riastrad 	}
    177  1.1  riastrad 
    178  1.1  riastrad 	if (unlikely(vgpu->failsafe)) {
    179  1.1  riastrad 		/* Remove write protection to prevent furture traps. */
    180  1.1  riastrad 		intel_vgpu_disable_page_track(vgpu, gpa >> PAGE_SHIFT);
    181  1.1  riastrad 	} else {
    182  1.1  riastrad 		ret = page_track->handler(page_track, gpa, data, bytes);
    183  1.1  riastrad 		if (ret)
    184  1.1  riastrad 			gvt_err("guest page write error, gpa %llx\n", gpa);
    185  1.1  riastrad 	}
    186  1.1  riastrad 
    187  1.1  riastrad out:
    188  1.1  riastrad 	mutex_unlock(&vgpu->vgpu_lock);
    189  1.1  riastrad 	return ret;
    190  1.1  riastrad }
    191