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