|
@@ -30,11 +30,14 @@
|
|
* See Documentation/io_mapping.txt
|
|
* See Documentation/io_mapping.txt
|
|
*/
|
|
*/
|
|
|
|
|
|
-/* this struct isn't actually defined anywhere */
|
|
|
|
-struct io_mapping;
|
|
|
|
-
|
|
|
|
#ifdef CONFIG_HAVE_ATOMIC_IOMAP
|
|
#ifdef CONFIG_HAVE_ATOMIC_IOMAP
|
|
|
|
|
|
|
|
+struct io_mapping {
|
|
|
|
+ resource_size_t base;
|
|
|
|
+ unsigned long size;
|
|
|
|
+ pgprot_t prot;
|
|
|
|
+};
|
|
|
|
+
|
|
/*
|
|
/*
|
|
* For small address space machines, mapping large objects
|
|
* For small address space machines, mapping large objects
|
|
* into the kernel virtual space isn't practical. Where
|
|
* into the kernel virtual space isn't practical. Where
|
|
@@ -43,23 +46,40 @@ struct io_mapping;
|
|
*/
|
|
*/
|
|
|
|
|
|
static inline struct io_mapping *
|
|
static inline struct io_mapping *
|
|
-io_mapping_create_wc(unsigned long base, unsigned long size)
|
|
|
|
|
|
+io_mapping_create_wc(resource_size_t base, unsigned long size)
|
|
{
|
|
{
|
|
- return (struct io_mapping *) base;
|
|
|
|
|
|
+ struct io_mapping *iomap;
|
|
|
|
+
|
|
|
|
+ if (!is_io_mapping_possible(base, size))
|
|
|
|
+ return NULL;
|
|
|
|
+
|
|
|
|
+ iomap = kmalloc(sizeof(*iomap), GFP_KERNEL);
|
|
|
|
+ if (!iomap)
|
|
|
|
+ return NULL;
|
|
|
|
+
|
|
|
|
+ iomap->base = base;
|
|
|
|
+ iomap->size = size;
|
|
|
|
+ iomap->prot = pgprot_writecombine(__pgprot(__PAGE_KERNEL));
|
|
|
|
+ return iomap;
|
|
}
|
|
}
|
|
|
|
|
|
static inline void
|
|
static inline void
|
|
io_mapping_free(struct io_mapping *mapping)
|
|
io_mapping_free(struct io_mapping *mapping)
|
|
{
|
|
{
|
|
|
|
+ kfree(mapping);
|
|
}
|
|
}
|
|
|
|
|
|
/* Atomic map/unmap */
|
|
/* Atomic map/unmap */
|
|
static inline void *
|
|
static inline void *
|
|
io_mapping_map_atomic_wc(struct io_mapping *mapping, unsigned long offset)
|
|
io_mapping_map_atomic_wc(struct io_mapping *mapping, unsigned long offset)
|
|
{
|
|
{
|
|
- offset += (unsigned long) mapping;
|
|
|
|
- return iomap_atomic_prot_pfn(offset >> PAGE_SHIFT, KM_USER0,
|
|
|
|
- __pgprot(__PAGE_KERNEL_WC));
|
|
|
|
|
|
+ resource_size_t phys_addr;
|
|
|
|
+ unsigned long pfn;
|
|
|
|
+
|
|
|
|
+ BUG_ON(offset >= mapping->size);
|
|
|
|
+ phys_addr = mapping->base + offset;
|
|
|
|
+ pfn = (unsigned long) (phys_addr >> PAGE_SHIFT);
|
|
|
|
+ return iomap_atomic_prot_pfn(pfn, KM_USER0, mapping->prot);
|
|
}
|
|
}
|
|
|
|
|
|
static inline void
|
|
static inline void
|
|
@@ -71,8 +91,9 @@ io_mapping_unmap_atomic(void *vaddr)
|
|
static inline void *
|
|
static inline void *
|
|
io_mapping_map_wc(struct io_mapping *mapping, unsigned long offset)
|
|
io_mapping_map_wc(struct io_mapping *mapping, unsigned long offset)
|
|
{
|
|
{
|
|
- offset += (unsigned long) mapping;
|
|
|
|
- return ioremap_wc(offset, PAGE_SIZE);
|
|
|
|
|
|
+ BUG_ON(offset >= mapping->size);
|
|
|
|
+ resource_size_t phys_addr = mapping->base + offset;
|
|
|
|
+ return ioremap_wc(phys_addr, PAGE_SIZE);
|
|
}
|
|
}
|
|
|
|
|
|
static inline void
|
|
static inline void
|
|
@@ -83,9 +104,12 @@ io_mapping_unmap(void *vaddr)
|
|
|
|
|
|
#else
|
|
#else
|
|
|
|
|
|
|
|
+/* this struct isn't actually defined anywhere */
|
|
|
|
+struct io_mapping;
|
|
|
|
+
|
|
/* Create the io_mapping object*/
|
|
/* Create the io_mapping object*/
|
|
static inline struct io_mapping *
|
|
static inline struct io_mapping *
|
|
-io_mapping_create_wc(unsigned long base, unsigned long size)
|
|
|
|
|
|
+io_mapping_create_wc(resource_size_t base, unsigned long size)
|
|
{
|
|
{
|
|
return (struct io_mapping *) ioremap_wc(base, size);
|
|
return (struct io_mapping *) ioremap_wc(base, size);
|
|
}
|
|
}
|