|
@@ -78,6 +78,9 @@ typedef struct MapCache {
|
|
|
uint8_t *last_address_vaddr;
|
|
|
unsigned long max_mcache_size;
|
|
|
unsigned int mcache_bucket_shift;
|
|
|
+
|
|
|
+ phys_offset_to_gaddr_t phys_offset_to_gaddr;
|
|
|
+ void *opaque;
|
|
|
} MapCache;
|
|
|
|
|
|
static MapCache *mapcache;
|
|
@@ -91,13 +94,16 @@ static inline int test_bits(int nr, int size, const unsigned long *addr)
|
|
|
return 0;
|
|
|
}
|
|
|
|
|
|
-void xen_map_cache_init(void)
|
|
|
+void xen_map_cache_init(phys_offset_to_gaddr_t f, void *opaque)
|
|
|
{
|
|
|
unsigned long size;
|
|
|
struct rlimit rlimit_as;
|
|
|
|
|
|
mapcache = g_malloc0(sizeof (MapCache));
|
|
|
|
|
|
+ mapcache->phys_offset_to_gaddr = f;
|
|
|
+ mapcache->opaque = opaque;
|
|
|
+
|
|
|
QTAILQ_INIT(&mapcache->locked_entries);
|
|
|
mapcache->last_address_index = -1;
|
|
|
|
|
@@ -193,9 +199,14 @@ uint8_t *xen_map_cache(target_phys_addr_t phys_addr, target_phys_addr_t size,
|
|
|
uint8_t lock)
|
|
|
{
|
|
|
MapCacheEntry *entry, *pentry = NULL;
|
|
|
- target_phys_addr_t address_index = phys_addr >> MCACHE_BUCKET_SHIFT;
|
|
|
- target_phys_addr_t address_offset = phys_addr & (MCACHE_BUCKET_SIZE - 1);
|
|
|
+ target_phys_addr_t address_index;
|
|
|
+ target_phys_addr_t address_offset;
|
|
|
target_phys_addr_t __size = size;
|
|
|
+ bool translated = false;
|
|
|
+
|
|
|
+tryagain:
|
|
|
+ address_index = phys_addr >> MCACHE_BUCKET_SHIFT;
|
|
|
+ address_offset = phys_addr & (MCACHE_BUCKET_SIZE - 1);
|
|
|
|
|
|
trace_xen_map_cache(phys_addr);
|
|
|
|
|
@@ -237,6 +248,11 @@ uint8_t *xen_map_cache(target_phys_addr_t phys_addr, target_phys_addr_t size,
|
|
|
if(!test_bits(address_offset >> XC_PAGE_SHIFT, size >> XC_PAGE_SHIFT,
|
|
|
entry->valid_mapping)) {
|
|
|
mapcache->last_address_index = -1;
|
|
|
+ if (!translated && mapcache->phys_offset_to_gaddr) {
|
|
|
+ phys_addr = mapcache->phys_offset_to_gaddr(phys_addr, size, mapcache->opaque);
|
|
|
+ translated = true;
|
|
|
+ goto tryagain;
|
|
|
+ }
|
|
|
trace_xen_map_cache_return(NULL);
|
|
|
return NULL;
|
|
|
}
|