|
@@ -170,8 +170,7 @@ static void __iomem *__ioremap_caller(resource_size_t phys_addr,
|
|
|
(unsigned long long)phys_addr,
|
|
|
(unsigned long long)(phys_addr + size),
|
|
|
prot_val, new_prot_val);
|
|
|
- free_memtype(phys_addr, phys_addr + size);
|
|
|
- return NULL;
|
|
|
+ goto err_free_memtype;
|
|
|
}
|
|
|
prot_val = new_prot_val;
|
|
|
}
|
|
@@ -197,26 +196,25 @@ static void __iomem *__ioremap_caller(resource_size_t phys_addr,
|
|
|
*/
|
|
|
area = get_vm_area_caller(size, VM_IOREMAP, caller);
|
|
|
if (!area)
|
|
|
- return NULL;
|
|
|
+ goto err_free_memtype;
|
|
|
area->phys_addr = phys_addr;
|
|
|
vaddr = (unsigned long) area->addr;
|
|
|
|
|
|
- if (kernel_map_sync_memtype(phys_addr, size, prot_val)) {
|
|
|
- free_memtype(phys_addr, phys_addr + size);
|
|
|
- free_vm_area(area);
|
|
|
- return NULL;
|
|
|
- }
|
|
|
+ if (kernel_map_sync_memtype(phys_addr, size, prot_val))
|
|
|
+ goto err_free_area;
|
|
|
|
|
|
- if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot)) {
|
|
|
- free_memtype(phys_addr, phys_addr + size);
|
|
|
- free_vm_area(area);
|
|
|
- return NULL;
|
|
|
- }
|
|
|
+ if (ioremap_page_range(vaddr, vaddr + size, phys_addr, prot))
|
|
|
+ goto err_free_area;
|
|
|
|
|
|
ret_addr = (void __iomem *) (vaddr + offset);
|
|
|
mmiotrace_ioremap(unaligned_phys_addr, unaligned_size, ret_addr);
|
|
|
|
|
|
return ret_addr;
|
|
|
+err_free_area:
|
|
|
+ free_vm_area(area);
|
|
|
+err_free_memtype:
|
|
|
+ free_memtype(phys_addr, phys_addr + size);
|
|
|
+ return NULL;
|
|
|
}
|
|
|
|
|
|
/**
|