| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  * Copyright (C) 2014-2016 Broadcom Corporation | 
					
						
							|  |  |  |  * Copyright (c) 2017 Red Hat, Inc. | 
					
						
							|  |  |  |  * Written by Prem Mallappa, Eric Auger | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is free software; you can redistribute it and/or modify | 
					
						
							|  |  |  |  * it under the terms of the GNU General Public License version 2 as | 
					
						
							|  |  |  |  * published by the Free Software Foundation. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * This program is distributed in the hope that it will be useful, | 
					
						
							|  |  |  |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
					
						
							|  |  |  |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
					
						
							|  |  |  |  * GNU General Public License for more details. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Author: Prem Mallappa <pmallapp@broadcom.com> | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "qemu/osdep.h"
 | 
					
						
							|  |  |  | #include "trace.h"
 | 
					
						
							|  |  |  | #include "exec/target_page.h"
 | 
					
						
							| 
									
										
										
										
											2019-07-09 17:20:52 +02:00
										 |  |  | #include "hw/core/cpu.h"
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | #include "hw/qdev-properties.h"
 | 
					
						
							|  |  |  | #include "qapi/error.h"
 | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | #include "qemu/jhash.h"
 | 
					
						
							| 
									
										
										
										
											2019-05-23 16:35:07 +02:00
										 |  |  | #include "qemu/module.h"
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | #include "qemu/error-report.h"
 | 
					
						
							|  |  |  | #include "hw/arm/smmu-common.h"
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | #include "smmu-internal.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | /* IOTLB Management */ | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:07 +02:00
										 |  |  | static guint smmu_iotlb_key_hash(gconstpointer v) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     SMMUIOTLBKey *key = (SMMUIOTLBKey *)v; | 
					
						
							|  |  |  |     uint32_t a, b, c; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     /* Jenkins hash */ | 
					
						
							|  |  |  |     a = b = c = JHASH_INITVAL + sizeof(*key); | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |     a += key->asid + key->vmid + key->level + key->tg; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:07 +02:00
										 |  |  |     b += extract64(key->iova, 0, 32); | 
					
						
							|  |  |  |     c += extract64(key->iova, 32, 32); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     __jhash_mix(a, b, c); | 
					
						
							|  |  |  |     __jhash_final(a, b, c); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     return c; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static gboolean smmu_iotlb_key_equal(gconstpointer v1, gconstpointer v2) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |     SMMUIOTLBKey *k1 = (SMMUIOTLBKey *)v1, *k2 = (SMMUIOTLBKey *)v2; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:07 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |     return (k1->asid == k2->asid) && (k1->iova == k2->iova) && | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |            (k1->level == k2->level) && (k1->tg == k2->tg) && | 
					
						
							|  |  |  |            (k1->vmid == k2->vmid); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:07 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  | SMMUIOTLBKey smmu_get_iotlb_key(uint16_t asid, uint16_t vmid, uint64_t iova, | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |                                 uint8_t tg, uint8_t level) | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:07 +02:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |     SMMUIOTLBKey key = {.asid = asid, .vmid = vmid, .iova = iova, | 
					
						
							|  |  |  |                         .tg = tg, .level = level}; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:07 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  |     return key; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:08 +02:00
										 |  |  | SMMUTLBEntry *smmu_iotlb_lookup(SMMUState *bs, SMMUTransCfg *cfg, | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |                                 SMMUTransTableInfo *tt, hwaddr iova) | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:06 +02:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |     uint8_t tg = (tt->granule_sz - 10) / 2; | 
					
						
							|  |  |  |     uint8_t inputsize = 64 - tt->tsz; | 
					
						
							|  |  |  |     uint8_t stride = tt->granule_sz - 3; | 
					
						
							|  |  |  |     uint8_t level = 4 - (inputsize - 4) / stride; | 
					
						
							|  |  |  |     SMMUTLBEntry *entry = NULL; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     while (level <= 3) { | 
					
						
							|  |  |  |         uint64_t subpage_size = 1ULL << level_shift(level, tt->granule_sz); | 
					
						
							|  |  |  |         uint64_t mask = subpage_size - 1; | 
					
						
							|  |  |  |         SMMUIOTLBKey key; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |         key = smmu_get_iotlb_key(cfg->asid, cfg->s2cfg.vmid, | 
					
						
							|  |  |  |                                  iova & ~mask, tg, level); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |         entry = g_hash_table_lookup(bs->iotlb, &key); | 
					
						
							|  |  |  |         if (entry) { | 
					
						
							|  |  |  |             break; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  |         level++; | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:06 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  |     if (entry) { | 
					
						
							|  |  |  |         cfg->iotlb_hits++; | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |         trace_smmu_iotlb_lookup_hit(cfg->asid, cfg->s2cfg.vmid, iova, | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:06 +02:00
										 |  |  |                                     cfg->iotlb_hits, cfg->iotlb_misses, | 
					
						
							|  |  |  |                                     100 * cfg->iotlb_hits / | 
					
						
							|  |  |  |                                     (cfg->iotlb_hits + cfg->iotlb_misses)); | 
					
						
							|  |  |  |     } else { | 
					
						
							|  |  |  |         cfg->iotlb_misses++; | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |         trace_smmu_iotlb_lookup_miss(cfg->asid, cfg->s2cfg.vmid, iova, | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:06 +02:00
										 |  |  |                                      cfg->iotlb_hits, cfg->iotlb_misses, | 
					
						
							|  |  |  |                                      100 * cfg->iotlb_hits / | 
					
						
							|  |  |  |                                      (cfg->iotlb_hits + cfg->iotlb_misses)); | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  |     return entry; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:08 +02:00
										 |  |  | void smmu_iotlb_insert(SMMUState *bs, SMMUTransCfg *cfg, SMMUTLBEntry *new) | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:06 +02:00
										 |  |  | { | 
					
						
							|  |  |  |     SMMUIOTLBKey *key = g_new0(SMMUIOTLBKey, 1); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |     uint8_t tg = (new->granule - 10) / 2; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:06 +02:00
										 |  |  | 
 | 
					
						
							|  |  |  |     if (g_hash_table_size(bs->iotlb) >= SMMU_IOTLB_MAX_SIZE) { | 
					
						
							|  |  |  |         smmu_iotlb_inv_all(bs); | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |     *key = smmu_get_iotlb_key(cfg->asid, cfg->s2cfg.vmid, new->entry.iova, | 
					
						
							|  |  |  |                               tg, new->level); | 
					
						
							|  |  |  |     trace_smmu_iotlb_insert(cfg->asid, cfg->s2cfg.vmid, new->entry.iova, | 
					
						
							|  |  |  |                             tg, new->level); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:08 +02:00
										 |  |  |     g_hash_table_insert(bs->iotlb, key, new); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:06 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2022-12-16 22:49:24 +01:00
										 |  |  | void smmu_iotlb_inv_all(SMMUState *s) | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | { | 
					
						
							|  |  |  |     trace_smmu_iotlb_inv_all(); | 
					
						
							|  |  |  |     g_hash_table_remove_all(s->iotlb); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static gboolean smmu_hash_remove_by_asid(gpointer key, gpointer value, | 
					
						
							|  |  |  |                                          gpointer user_data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     uint16_t asid = *(uint16_t *)user_data; | 
					
						
							|  |  |  |     SMMUIOTLBKey *iotlb_key = (SMMUIOTLBKey *)key; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:07 +02:00
										 |  |  |     return SMMU_IOTLB_ASID(*iotlb_key) == asid; | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:51 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  | static gboolean smmu_hash_remove_by_vmid(gpointer key, gpointer value, | 
					
						
							|  |  |  |                                          gpointer user_data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     uint16_t vmid = *(uint16_t *)user_data; | 
					
						
							|  |  |  |     SMMUIOTLBKey *iotlb_key = (SMMUIOTLBKey *)key; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     return SMMU_IOTLB_VMID(*iotlb_key) == vmid; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  | static gboolean smmu_hash_remove_by_asid_vmid_iova(gpointer key, gpointer value, | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |                                               gpointer user_data) | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |     SMMUTLBEntry *iter = (SMMUTLBEntry *)value; | 
					
						
							|  |  |  |     IOMMUTLBEntry *entry = &iter->entry; | 
					
						
							|  |  |  |     SMMUIOTLBPageInvInfo *info = (SMMUIOTLBPageInvInfo *)user_data; | 
					
						
							|  |  |  |     SMMUIOTLBKey iotlb_key = *(SMMUIOTLBKey *)key; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     if (info->asid >= 0 && info->asid != SMMU_IOTLB_ASID(iotlb_key)) { | 
					
						
							|  |  |  |         return false; | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |     if (info->vmid >= 0 && info->vmid != SMMU_IOTLB_VMID(iotlb_key)) { | 
					
						
							|  |  |  |         return false; | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:11 +02:00
										 |  |  |     return ((info->iova & ~entry->addr_mask) == entry->iova) || | 
					
						
							|  |  |  |            ((entry->iova & ~info->mask) == info->iova); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  | void smmu_iotlb_inv_iova(SMMUState *s, int asid, int vmid, dma_addr_t iova, | 
					
						
							| 
									
										
										
										
											2022-12-16 22:49:24 +01:00
										 |  |  |                          uint8_t tg, uint64_t num_pages, uint8_t ttl) | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2021-03-09 11:27:40 +01:00
										 |  |  |     /* if tg is not set we use 4KB range invalidation */ | 
					
						
							|  |  |  |     uint8_t granule = tg ? tg * 2 + 10 : 12; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2021-03-09 11:27:39 +01:00
										 |  |  |     if (ttl && (num_pages == 1) && (asid >= 0)) { | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |         SMMUIOTLBKey key = smmu_get_iotlb_key(asid, vmid, iova, tg, ttl); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2021-03-09 11:27:40 +01:00
										 |  |  |         if (g_hash_table_remove(s->iotlb, &key)) { | 
					
						
							|  |  |  |             return; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  |         /*
 | 
					
						
							|  |  |  |          * if the entry is not found, let's see if it does not | 
					
						
							|  |  |  |          * belong to a larger IOTLB entry | 
					
						
							|  |  |  |          */ | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:11 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2021-03-09 11:27:40 +01:00
										 |  |  |     SMMUIOTLBPageInvInfo info = { | 
					
						
							|  |  |  |         .asid = asid, .iova = iova, | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |         .vmid = vmid, | 
					
						
							| 
									
										
										
										
											2021-03-09 11:27:40 +01:00
										 |  |  |         .mask = (num_pages * 1 << granule) - 1}; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:11 +02:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2021-03-09 11:27:40 +01:00
										 |  |  |     g_hash_table_foreach_remove(s->iotlb, | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |                                 smmu_hash_remove_by_asid_vmid_iova, | 
					
						
							| 
									
										
										
										
											2021-03-09 11:27:40 +01:00
										 |  |  |                                 &info); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2022-12-16 22:49:24 +01:00
										 |  |  | void smmu_iotlb_inv_asid(SMMUState *s, uint16_t asid) | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | { | 
					
						
							|  |  |  |     trace_smmu_iotlb_inv_asid(asid); | 
					
						
							|  |  |  |     g_hash_table_foreach_remove(s->iotlb, smmu_hash_remove_by_asid, &asid); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:51 +01:00
										 |  |  | inline void smmu_iotlb_inv_vmid(SMMUState *s, uint16_t vmid) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     trace_smmu_iotlb_inv_vmid(vmid); | 
					
						
							|  |  |  |     g_hash_table_foreach_remove(s->iotlb, smmu_hash_remove_by_vmid, &vmid); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | /* VMSAv8-64 Translation */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * get_pte - Get the content of a page table entry located at | 
					
						
							|  |  |  |  * @base_addr[@index] | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int get_pte(dma_addr_t baseaddr, uint32_t index, uint64_t *pte, | 
					
						
							|  |  |  |                    SMMUPTWEventInfo *info) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     int ret; | 
					
						
							|  |  |  |     dma_addr_t addr = baseaddr + index * sizeof(*pte); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     /* TODO: guarantee 64-bit single-copy atomicity */ | 
					
						
							| 
									
										
										
											
												dma: Let dma_memory_read/write() take MemTxAttrs argument
Let devices specify transaction attributes when calling
dma_memory_read() or dma_memory_write().
Patch created mechanically using spatch with this script:
  @@
  expression E1, E2, E3, E4;
  @@
  (
  - dma_memory_read(E1, E2, E3, E4)
  + dma_memory_read(E1, E2, E3, E4, MEMTXATTRS_UNSPECIFIED)
  |
  - dma_memory_write(E1, E2, E3, E4)
  + dma_memory_write(E1, E2, E3, E4, MEMTXATTRS_UNSPECIFIED)
  )
Reviewed-by: Richard Henderson <richard.henderson@linaro.org>
Reviewed-by: Li Qiang <liq3ea@gmail.com>
Reviewed-by: Edgar E. Iglesias <edgar.iglesias@xilinx.com>
Signed-off-by: Philippe Mathieu-Daudé <philmd@redhat.com>
Acked-by: Stefan Hajnoczi <stefanha@redhat.com>
Message-Id: <20211223115554.3155328-6-philmd@redhat.com>
											
										 
											2020-09-03 10:08:29 +02:00
										 |  |  |     ret = dma_memory_read(&address_space_memory, addr, pte, sizeof(*pte), | 
					
						
							|  |  |  |                           MEMTXATTRS_UNSPECIFIED); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  |     if (ret != MEMTX_OK) { | 
					
						
							|  |  |  |         info->type = SMMU_PTW_ERR_WALK_EABT; | 
					
						
							|  |  |  |         info->addr = addr; | 
					
						
							|  |  |  |         return -EINVAL; | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  |     trace_smmu_get_pte(baseaddr, index, addr, *pte); | 
					
						
							|  |  |  |     return 0; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* VMSAv8-64 Translation Table Format Descriptor Decoding */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * get_page_pte_address - returns the L3 descriptor output address, | 
					
						
							|  |  |  |  * ie. the page frame | 
					
						
							|  |  |  |  * ARM ARM spec: Figure D4-17 VMSAv8-64 level 3 descriptor format | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static inline hwaddr get_page_pte_address(uint64_t pte, int granule_sz) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     return PTE_ADDRESS(pte, granule_sz); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * get_table_pte_address - return table descriptor output address, | 
					
						
							|  |  |  |  * ie. address of next level table | 
					
						
							|  |  |  |  * ARM ARM Figure D4-16 VMSAv8-64 level0, level1, and level 2 descriptor formats | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static inline hwaddr get_table_pte_address(uint64_t pte, int granule_sz) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     return PTE_ADDRESS(pte, granule_sz); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							|  |  |  |  * get_block_pte_address - return block descriptor output address and block size | 
					
						
							|  |  |  |  * ARM ARM Figure D4-16 VMSAv8-64 level0, level1, and level 2 descriptor formats | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static inline hwaddr get_block_pte_address(uint64_t pte, int level, | 
					
						
							|  |  |  |                                            int granule_sz, uint64_t *bsz) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2018-05-18 17:48:07 +01:00
										 |  |  |     int n = level_shift(level, granule_sz); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-05-18 17:48:07 +01:00
										 |  |  |     *bsz = 1ULL << n; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     return PTE_ADDRESS(pte, n); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | SMMUTransTableInfo *select_tt(SMMUTransCfg *cfg, dma_addr_t iova) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     bool tbi = extract64(iova, 55, 1) ? TBI1(cfg->tbi) : TBI0(cfg->tbi); | 
					
						
							|  |  |  |     uint8_t tbi_byte = tbi * 8; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     if (cfg->tt[0].tsz && | 
					
						
							|  |  |  |         !extract64(iova, 64 - cfg->tt[0].tsz, cfg->tt[0].tsz - tbi_byte)) { | 
					
						
							|  |  |  |         /* there is a ttbr0 region and we are in it (high bits all zero) */ | 
					
						
							|  |  |  |         return &cfg->tt[0]; | 
					
						
							|  |  |  |     } else if (cfg->tt[1].tsz && | 
					
						
							| 
									
										
										
										
											2023-02-14 17:19:22 +00:00
										 |  |  |         sextract64(iova, 64 - cfg->tt[1].tsz, cfg->tt[1].tsz - tbi_byte) == -1) { | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         /* there is a ttbr1 region and we are in it (high bits all one) */ | 
					
						
							|  |  |  |         return &cfg->tt[1]; | 
					
						
							|  |  |  |     } else if (!cfg->tt[0].tsz) { | 
					
						
							|  |  |  |         /* ttbr0 region is "everything not in the ttbr1 region" */ | 
					
						
							|  |  |  |         return &cfg->tt[0]; | 
					
						
							|  |  |  |     } else if (!cfg->tt[1].tsz) { | 
					
						
							|  |  |  |         /* ttbr1 region is "everything not in the ttbr0 region" */ | 
					
						
							|  |  |  |         return &cfg->tt[1]; | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  |     /* in the gap between the two regions, this is a Translation fault */ | 
					
						
							|  |  |  |     return NULL; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /**
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:49 +01:00
										 |  |  |  * smmu_ptw_64_s1 - VMSAv8-64 Walk of the page tables for a given IOVA | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |  * @cfg: translation config | 
					
						
							|  |  |  |  * @iova: iova to translate | 
					
						
							|  |  |  |  * @perm: access type | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:08 +02:00
										 |  |  |  * @tlbe: SMMUTLBEntry (out) | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |  * @info: handle to an error info | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Return 0 on success, < 0 on error. In case of error, @info is filled | 
					
						
							|  |  |  |  * and tlbe->perm is set to IOMMU_NONE. | 
					
						
							|  |  |  |  * Upon success, @tlbe is filled with translated_addr and entry | 
					
						
							|  |  |  |  * permission rights. | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:49 +01:00
										 |  |  | static int smmu_ptw_64_s1(SMMUTransCfg *cfg, | 
					
						
							|  |  |  |                           dma_addr_t iova, IOMMUAccessFlags perm, | 
					
						
							|  |  |  |                           SMMUTLBEntry *tlbe, SMMUPTWEventInfo *info) | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | { | 
					
						
							|  |  |  |     dma_addr_t baseaddr, indexmask; | 
					
						
							|  |  |  |     int stage = cfg->stage; | 
					
						
							|  |  |  |     SMMUTransTableInfo *tt = select_tt(cfg, iova); | 
					
						
							|  |  |  |     uint8_t level, granule_sz, inputsize, stride; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     if (!tt || tt->disabled) { | 
					
						
							|  |  |  |         info->type = SMMU_PTW_ERR_TRANSLATION; | 
					
						
							|  |  |  |         goto error; | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     granule_sz = tt->granule_sz; | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:49 +01:00
										 |  |  |     stride = VMSA_STRIDE(granule_sz); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     inputsize = 64 - tt->tsz; | 
					
						
							|  |  |  |     level = 4 - (inputsize - 4) / stride; | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:49 +01:00
										 |  |  |     indexmask = VMSA_IDXMSK(inputsize, stride, level); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     baseaddr = extract64(tt->ttb, 0, 48); | 
					
						
							|  |  |  |     baseaddr &= ~indexmask; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:49 +01:00
										 |  |  |     while (level < VMSA_LEVELS) { | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         uint64_t subpage_size = 1ULL << level_shift(level, granule_sz); | 
					
						
							|  |  |  |         uint64_t mask = subpage_size - 1; | 
					
						
							|  |  |  |         uint32_t offset = iova_level_offset(iova, inputsize, level, granule_sz); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |         uint64_t pte, gpa; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         dma_addr_t pte_addr = baseaddr + offset * sizeof(pte); | 
					
						
							|  |  |  |         uint8_t ap; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         if (get_pte(baseaddr, offset, &pte, info)) { | 
					
						
							|  |  |  |                 goto error; | 
					
						
							|  |  |  |         } | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:49 +01:00
										 |  |  |         trace_smmu_ptw_level(stage, level, iova, subpage_size, | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |                              baseaddr, offset, pte); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         if (is_invalid_pte(pte) || is_reserved_pte(pte, level)) { | 
					
						
							|  |  |  |             trace_smmu_ptw_invalid_pte(stage, level, baseaddr, | 
					
						
							|  |  |  |                                        pte_addr, offset, pte); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |             break; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |         if (is_table_pte(pte, level)) { | 
					
						
							|  |  |  |             ap = PTE_APTABLE(pte); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:14 +02:00
										 |  |  |             if (is_permission_fault(ap, perm) && !tt->had) { | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |                 info->type = SMMU_PTW_ERR_PERMISSION; | 
					
						
							|  |  |  |                 goto error; | 
					
						
							|  |  |  |             } | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |             baseaddr = get_table_pte_address(pte, granule_sz); | 
					
						
							|  |  |  |             level++; | 
					
						
							|  |  |  |             continue; | 
					
						
							|  |  |  |         } else if (is_page_pte(pte, level)) { | 
					
						
							|  |  |  |             gpa = get_page_pte_address(pte, granule_sz); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |             trace_smmu_ptw_page_pte(stage, level, iova, | 
					
						
							|  |  |  |                                     baseaddr, pte_addr, pte, gpa); | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |         } else { | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |             uint64_t block_size; | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |             gpa = get_block_pte_address(pte, level, granule_sz, | 
					
						
							|  |  |  |                                         &block_size); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |             trace_smmu_ptw_block_pte(stage, level, baseaddr, | 
					
						
							|  |  |  |                                      pte_addr, pte, iova, gpa, | 
					
						
							|  |  |  |                                      block_size >> 20); | 
					
						
							|  |  |  |         } | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |         ap = PTE_AP(pte); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         if (is_permission_fault(ap, perm)) { | 
					
						
							|  |  |  |             info->type = SMMU_PTW_ERR_PERMISSION; | 
					
						
							|  |  |  |             goto error; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:09 +02:00
										 |  |  |         tlbe->entry.translated_addr = gpa; | 
					
						
							|  |  |  |         tlbe->entry.iova = iova & ~mask; | 
					
						
							|  |  |  |         tlbe->entry.addr_mask = mask; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:08 +02:00
										 |  |  |         tlbe->entry.perm = PTE_AP_TO_PERM(ap); | 
					
						
							|  |  |  |         tlbe->level = level; | 
					
						
							|  |  |  |         tlbe->granule = granule_sz; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:05 +02:00
										 |  |  |         return 0; | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     info->type = SMMU_PTW_ERR_TRANSLATION; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | error: | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:49 +01:00
										 |  |  |     info->stage = 1; | 
					
						
							| 
									
										
										
										
											2020-07-28 17:08:08 +02:00
										 |  |  |     tlbe->entry.perm = IOMMU_NONE; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     return -EINVAL; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * smmu_ptw_64_s2 - VMSAv8-64 Walk of the page tables for a given ipa | 
					
						
							|  |  |  |  * for stage-2. | 
					
						
							|  |  |  |  * @cfg: translation config | 
					
						
							|  |  |  |  * @ipa: ipa to translate | 
					
						
							|  |  |  |  * @perm: access type | 
					
						
							|  |  |  |  * @tlbe: SMMUTLBEntry (out) | 
					
						
							|  |  |  |  * @info: handle to an error info | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * Return 0 on success, < 0 on error. In case of error, @info is filled | 
					
						
							|  |  |  |  * and tlbe->perm is set to IOMMU_NONE. | 
					
						
							|  |  |  |  * Upon success, @tlbe is filled with translated_addr and entry | 
					
						
							|  |  |  |  * permission rights. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | static int smmu_ptw_64_s2(SMMUTransCfg *cfg, | 
					
						
							|  |  |  |                           dma_addr_t ipa, IOMMUAccessFlags perm, | 
					
						
							|  |  |  |                           SMMUTLBEntry *tlbe, SMMUPTWEventInfo *info) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     const int stage = 2; | 
					
						
							|  |  |  |     int granule_sz = cfg->s2cfg.granule_sz; | 
					
						
							|  |  |  |     /* ARM DDI0487I.a: Table D8-7. */ | 
					
						
							|  |  |  |     int inputsize = 64 - cfg->s2cfg.tsz; | 
					
						
							|  |  |  |     int level = get_start_level(cfg->s2cfg.sl0, granule_sz); | 
					
						
							|  |  |  |     int stride = VMSA_STRIDE(granule_sz); | 
					
						
							|  |  |  |     int idx = pgd_concat_idx(level, granule_sz, ipa); | 
					
						
							|  |  |  |     /*
 | 
					
						
							|  |  |  |      * Get the ttb from concatenated structure. | 
					
						
							|  |  |  |      * The offset is the idx * size of each ttb(number of ptes * (sizeof(pte)) | 
					
						
							|  |  |  |      */ | 
					
						
							|  |  |  |     uint64_t baseaddr = extract64(cfg->s2cfg.vttb, 0, 48) + (1 << stride) * | 
					
						
							|  |  |  |                                   idx * sizeof(uint64_t); | 
					
						
							|  |  |  |     dma_addr_t indexmask = VMSA_IDXMSK(inputsize, stride, level); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     baseaddr &= ~indexmask; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     /*
 | 
					
						
							|  |  |  |      * On input, a stage 2 Translation fault occurs if the IPA is outside the | 
					
						
							|  |  |  |      * range configured by the relevant S2T0SZ field of the STE. | 
					
						
							|  |  |  |      */ | 
					
						
							|  |  |  |     if (ipa >= (1ULL << inputsize)) { | 
					
						
							|  |  |  |         info->type = SMMU_PTW_ERR_TRANSLATION; | 
					
						
							|  |  |  |         goto error; | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     while (level < VMSA_LEVELS) { | 
					
						
							|  |  |  |         uint64_t subpage_size = 1ULL << level_shift(level, granule_sz); | 
					
						
							|  |  |  |         uint64_t mask = subpage_size - 1; | 
					
						
							|  |  |  |         uint32_t offset = iova_level_offset(ipa, inputsize, level, granule_sz); | 
					
						
							|  |  |  |         uint64_t pte, gpa; | 
					
						
							|  |  |  |         dma_addr_t pte_addr = baseaddr + offset * sizeof(pte); | 
					
						
							|  |  |  |         uint8_t s2ap; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         if (get_pte(baseaddr, offset, &pte, info)) { | 
					
						
							|  |  |  |                 goto error; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  |         trace_smmu_ptw_level(stage, level, ipa, subpage_size, | 
					
						
							|  |  |  |                              baseaddr, offset, pte); | 
					
						
							|  |  |  |         if (is_invalid_pte(pte) || is_reserved_pte(pte, level)) { | 
					
						
							|  |  |  |             trace_smmu_ptw_invalid_pte(stage, level, baseaddr, | 
					
						
							|  |  |  |                                        pte_addr, offset, pte); | 
					
						
							|  |  |  |             break; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         if (is_table_pte(pte, level)) { | 
					
						
							|  |  |  |             baseaddr = get_table_pte_address(pte, granule_sz); | 
					
						
							|  |  |  |             level++; | 
					
						
							|  |  |  |             continue; | 
					
						
							|  |  |  |         } else if (is_page_pte(pte, level)) { | 
					
						
							|  |  |  |             gpa = get_page_pte_address(pte, granule_sz); | 
					
						
							|  |  |  |             trace_smmu_ptw_page_pte(stage, level, ipa, | 
					
						
							|  |  |  |                                     baseaddr, pte_addr, pte, gpa); | 
					
						
							|  |  |  |         } else { | 
					
						
							|  |  |  |             uint64_t block_size; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |             gpa = get_block_pte_address(pte, level, granule_sz, | 
					
						
							|  |  |  |                                         &block_size); | 
					
						
							|  |  |  |             trace_smmu_ptw_block_pte(stage, level, baseaddr, | 
					
						
							|  |  |  |                                      pte_addr, pte, ipa, gpa, | 
					
						
							|  |  |  |                                      block_size >> 20); | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         /*
 | 
					
						
							|  |  |  |          * If S2AFFD and PTE.AF are 0 => fault. (5.2. Stream Table Entry) | 
					
						
							|  |  |  |          * An Access fault takes priority over a Permission fault. | 
					
						
							|  |  |  |          */ | 
					
						
							|  |  |  |         if (!PTE_AF(pte) && !cfg->s2cfg.affd) { | 
					
						
							|  |  |  |             info->type = SMMU_PTW_ERR_ACCESS; | 
					
						
							|  |  |  |             goto error; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         s2ap = PTE_AP(pte); | 
					
						
							|  |  |  |         if (is_permission_fault_s2(s2ap, perm)) { | 
					
						
							|  |  |  |             info->type = SMMU_PTW_ERR_PERMISSION; | 
					
						
							|  |  |  |             goto error; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         /*
 | 
					
						
							|  |  |  |          * The address output from the translation causes a stage 2 Address | 
					
						
							|  |  |  |          * Size fault if it exceeds the effective PA output range. | 
					
						
							|  |  |  |          */ | 
					
						
							|  |  |  |         if (gpa >= (1ULL << cfg->s2cfg.eff_ps)) { | 
					
						
							|  |  |  |             info->type = SMMU_PTW_ERR_ADDR_SIZE; | 
					
						
							|  |  |  |             goto error; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         tlbe->entry.translated_addr = gpa; | 
					
						
							|  |  |  |         tlbe->entry.iova = ipa & ~mask; | 
					
						
							|  |  |  |         tlbe->entry.addr_mask = mask; | 
					
						
							|  |  |  |         tlbe->entry.perm = s2ap; | 
					
						
							|  |  |  |         tlbe->level = level; | 
					
						
							|  |  |  |         tlbe->granule = granule_sz; | 
					
						
							|  |  |  |         return 0; | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  |     info->type = SMMU_PTW_ERR_TRANSLATION; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | error: | 
					
						
							|  |  |  |     info->stage = 2; | 
					
						
							|  |  |  |     tlbe->entry.perm = IOMMU_NONE; | 
					
						
							|  |  |  |     return -EINVAL; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * smmu_ptw - Walk the page tables for an IOVA, according to @cfg | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * @cfg: translation configuration | 
					
						
							|  |  |  |  * @iova: iova to translate | 
					
						
							|  |  |  |  * @perm: tentative access type | 
					
						
							|  |  |  |  * @tlbe: returned entry | 
					
						
							|  |  |  |  * @info: ptw event handle | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  * return 0 on success | 
					
						
							|  |  |  |  */ | 
					
						
							| 
									
										
										
										
											2022-12-16 22:49:24 +01:00
										 |  |  | int smmu_ptw(SMMUTransCfg *cfg, dma_addr_t iova, IOMMUAccessFlags perm, | 
					
						
							|  |  |  |              SMMUTLBEntry *tlbe, SMMUPTWEventInfo *info) | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2023-05-25 10:37:50 +01:00
										 |  |  |     if (cfg->stage == 1) { | 
					
						
							|  |  |  |         return smmu_ptw_64_s1(cfg, iova, perm, tlbe, info); | 
					
						
							|  |  |  |     } else if (cfg->stage == 2) { | 
					
						
							|  |  |  |         /*
 | 
					
						
							|  |  |  |          * If bypassing stage 1(or unimplemented), the input address is passed | 
					
						
							|  |  |  |          * directly to stage 2 as IPA. If the input address of a transaction | 
					
						
							|  |  |  |          * exceeds the size of the IAS, a stage 1 Address Size fault occurs. | 
					
						
							|  |  |  |          * For AA64, IAS = OAS according to (IHI 0070.E.a) "3.4 Address sizes" | 
					
						
							|  |  |  |          */ | 
					
						
							|  |  |  |         if (iova >= (1ULL << cfg->oas)) { | 
					
						
							|  |  |  |             info->type = SMMU_PTW_ERR_ADDR_SIZE; | 
					
						
							|  |  |  |             info->stage = 1; | 
					
						
							|  |  |  |             tlbe->entry.perm = IOMMU_NONE; | 
					
						
							|  |  |  |             return -EINVAL; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         return smmu_ptw_64_s2(cfg, iova, perm, tlbe, info); | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     g_assert_not_reached(); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | } | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | /**
 | 
					
						
							|  |  |  |  * The bus number is used for lookup when SID based invalidation occurs. | 
					
						
							|  |  |  |  * In that case we lazily populate the SMMUPciBus array from the bus hash | 
					
						
							|  |  |  |  * table. At the time the SMMUPciBus is created (smmu_find_add_as), the bus | 
					
						
							|  |  |  |  * numbers may not be always initialized yet. | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | SMMUPciBus *smmu_find_smmu_pcibus(SMMUState *s, uint8_t bus_num) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     SMMUPciBus *smmu_pci_bus = s->smmu_pcibus_by_bus_num[bus_num]; | 
					
						
							| 
									
										
										
										
											2020-03-05 16:09:14 +00:00
										 |  |  |     GHashTableIter iter; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-03-05 16:09:14 +00:00
										 |  |  |     if (smmu_pci_bus) { | 
					
						
							|  |  |  |         return smmu_pci_bus; | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-03-05 16:09:14 +00:00
										 |  |  |     g_hash_table_iter_init(&iter, s->smmu_pcibus_by_busptr); | 
					
						
							|  |  |  |     while (g_hash_table_iter_next(&iter, NULL, (void **)&smmu_pci_bus)) { | 
					
						
							|  |  |  |         if (pci_bus_num(smmu_pci_bus->bus) == bus_num) { | 
					
						
							|  |  |  |             s->smmu_pcibus_by_bus_num[bus_num] = smmu_pci_bus; | 
					
						
							|  |  |  |             return smmu_pci_bus; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         } | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2020-03-05 16:09:14 +00:00
										 |  |  | 
 | 
					
						
							|  |  |  |     return NULL; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static AddressSpace *smmu_find_add_as(PCIBus *bus, void *opaque, int devfn) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     SMMUState *s = opaque; | 
					
						
							|  |  |  |     SMMUPciBus *sbus = g_hash_table_lookup(s->smmu_pcibus_by_busptr, bus); | 
					
						
							|  |  |  |     SMMUDevice *sdev; | 
					
						
							| 
									
										
										
										
											2018-09-25 14:02:32 +01:00
										 |  |  |     static unsigned int index; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  |     if (!sbus) { | 
					
						
							|  |  |  |         sbus = g_malloc0(sizeof(SMMUPciBus) + | 
					
						
							|  |  |  |                          sizeof(SMMUDevice *) * SMMU_PCI_DEVFN_MAX); | 
					
						
							|  |  |  |         sbus->bus = bus; | 
					
						
							|  |  |  |         g_hash_table_insert(s->smmu_pcibus_by_busptr, bus, sbus); | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     sdev = sbus->pbdev[devfn]; | 
					
						
							|  |  |  |     if (!sdev) { | 
					
						
							| 
									
										
										
										
											2018-09-25 14:02:32 +01:00
										 |  |  |         char *name = g_strdup_printf("%s-%d-%d", s->mrtypename, devfn, index++); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         sdev = sbus->pbdev[devfn] = g_new0(SMMUDevice, 1); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         sdev->smmu = s; | 
					
						
							|  |  |  |         sdev->bus = bus; | 
					
						
							|  |  |  |         sdev->devfn = devfn; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         memory_region_init_iommu(&sdev->iommu, sizeof(sdev->iommu), | 
					
						
							|  |  |  |                                  s->mrtypename, | 
					
						
							| 
									
										
										
										
											2023-02-14 17:19:21 +00:00
										 |  |  |                                  OBJECT(s), name, UINT64_MAX); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |         address_space_init(&sdev->as, | 
					
						
							|  |  |  |                            MEMORY_REGION(&sdev->iommu), name); | 
					
						
							|  |  |  |         trace_smmu_add_mr(name); | 
					
						
							|  |  |  |         g_free(name); | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     return &sdev->as; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | IOMMUMemoryRegion *smmu_iommu_mr(SMMUState *s, uint32_t sid) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     uint8_t bus_n, devfn; | 
					
						
							|  |  |  |     SMMUPciBus *smmu_bus; | 
					
						
							|  |  |  |     SMMUDevice *smmu; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     bus_n = PCI_BUS_NUM(sid); | 
					
						
							|  |  |  |     smmu_bus = smmu_find_smmu_pcibus(s, bus_n); | 
					
						
							|  |  |  |     if (smmu_bus) { | 
					
						
							| 
									
										
										
										
											2018-07-09 14:51:34 +01:00
										 |  |  |         devfn = SMMU_PCI_DEVFN(sid); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  |         smmu = smmu_bus->pbdev[devfn]; | 
					
						
							|  |  |  |         if (smmu) { | 
					
						
							|  |  |  |             return &smmu->iommu; | 
					
						
							|  |  |  |         } | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  |     return NULL; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | /* Unmap all notifiers attached to @mr */ | 
					
						
							| 
									
										
										
										
											2022-12-16 22:49:23 +01:00
										 |  |  | static void smmu_inv_notifiers_mr(IOMMUMemoryRegion *mr) | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | { | 
					
						
							|  |  |  |     IOMMUNotifier *n; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     trace_smmu_inv_notifiers_mr(mr->parent_obj.name); | 
					
						
							|  |  |  |     IOMMU_NOTIFIER_FOREACH(n, mr) { | 
					
						
							| 
									
										
										
										
											2023-02-23 14:59:23 +08:00
										 |  |  |         memory_region_unmap_iommu_notifier_range(n); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  |     } | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | /* Unmap all notifiers of all mr's */ | 
					
						
							|  |  |  | void smmu_inv_notifiers_all(SMMUState *s) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2019-04-29 17:35:57 +01:00
										 |  |  |     SMMUDevice *sdev; | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2019-04-29 17:35:57 +01:00
										 |  |  |     QLIST_FOREACH(sdev, &s->devices_with_notifiers, next) { | 
					
						
							|  |  |  |         smmu_inv_notifiers_mr(&sdev->iommu); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  |     } | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | static void smmu_base_realize(DeviceState *dev, Error **errp) | 
					
						
							|  |  |  | { | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     SMMUState *s = ARM_SMMU(dev); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     SMMUBaseClass *sbc = ARM_SMMU_GET_CLASS(dev); | 
					
						
							|  |  |  |     Error *local_err = NULL; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     sbc->parent_realize(dev, &local_err); | 
					
						
							|  |  |  |     if (local_err) { | 
					
						
							|  |  |  |         error_propagate(errp, local_err); | 
					
						
							|  |  |  |         return; | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  |     s->configs = g_hash_table_new_full(NULL, NULL, NULL, g_free); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  |     s->iotlb = g_hash_table_new_full(smmu_iotlb_key_hash, smmu_iotlb_key_equal, | 
					
						
							|  |  |  |                                      g_free, g_free); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     s->smmu_pcibus_by_busptr = g_hash_table_new(NULL, NULL); | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |     if (s->primary_bus) { | 
					
						
							|  |  |  |         pci_setup_iommu(s->primary_bus, smmu_find_add_as, s); | 
					
						
							|  |  |  |     } else { | 
					
						
							|  |  |  |         error_setg(errp, "SMMU is not attached to any PCI bus!"); | 
					
						
							|  |  |  |     } | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2022-12-14 14:27:10 +00:00
										 |  |  | static void smmu_base_reset_hold(Object *obj) | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2022-12-14 14:27:10 +00:00
										 |  |  |     SMMUState *s = ARM_SMMU(obj); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  | 
 | 
					
						
							|  |  |  |     g_hash_table_remove_all(s->configs); | 
					
						
							| 
									
										
										
										
											2018-06-26 17:50:42 +01:00
										 |  |  |     g_hash_table_remove_all(s->iotlb); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static Property smmu_dev_properties[] = { | 
					
						
							|  |  |  |     DEFINE_PROP_UINT8("bus_num", SMMUState, bus_num, 0), | 
					
						
							| 
									
										
										
										
											2023-01-17 20:30:14 +01:00
										 |  |  |     DEFINE_PROP_LINK("primary-bus", SMMUState, primary_bus, | 
					
						
							|  |  |  |                      TYPE_PCI_BUS, PCIBus *), | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     DEFINE_PROP_END_OF_LIST(), | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void smmu_base_class_init(ObjectClass *klass, void *data) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     DeviceClass *dc = DEVICE_CLASS(klass); | 
					
						
							| 
									
										
										
										
											2022-12-14 14:27:10 +00:00
										 |  |  |     ResettableClass *rc = RESETTABLE_CLASS(klass); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     SMMUBaseClass *sbc = ARM_SMMU_CLASS(klass); | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2020-01-10 19:30:32 +04:00
										 |  |  |     device_class_set_props(dc, smmu_dev_properties); | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  |     device_class_set_parent_realize(dc, smmu_base_realize, | 
					
						
							|  |  |  |                                     &sbc->parent_realize); | 
					
						
							| 
									
										
										
										
											2022-12-14 14:27:10 +00:00
										 |  |  |     rc->phases.hold = smmu_base_reset_hold; | 
					
						
							| 
									
										
										
										
											2018-05-04 18:05:51 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static const TypeInfo smmu_base_info = { | 
					
						
							|  |  |  |     .name          = TYPE_ARM_SMMU, | 
					
						
							|  |  |  |     .parent        = TYPE_SYS_BUS_DEVICE, | 
					
						
							|  |  |  |     .instance_size = sizeof(SMMUState), | 
					
						
							|  |  |  |     .class_data    = NULL, | 
					
						
							|  |  |  |     .class_size    = sizeof(SMMUBaseClass), | 
					
						
							|  |  |  |     .class_init    = smmu_base_class_init, | 
					
						
							|  |  |  |     .abstract      = true, | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static void smmu_base_register_types(void) | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     type_register_static(&smmu_base_info); | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | type_init(smmu_base_register_types) | 
					
						
							|  |  |  | 
 |