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