87997aaa1b
Fix this: root@omap4430-panda:~# cat /debug/iommu/ducati/mem [ 62.725708] Unable to handle kernel NULL pointer dereference at virtual addre ss 0000001c [ 62.725708] pgd = e6240000 [ 62.737091] [0000001c] *pgd=a7168831, *pte=00000000, *ppte=00000000 [ 62.743682] Internal error: Oops: 17 [#1] SMP [ 62.743682] Modules linked in: omap_iommu_debug omap_iovmm virtio_rpmsg_bus o map_remoteproc remoteproc virtio_ring virtio mailbox_mach mailbox [ 62.743682] CPU: 0 Not tainted (3.3.0-rc1-00265-g382f84e-dirty #682) [ 62.743682] PC is at debug_read_mem+0x5c/0xac [omap_iommu_debug] [ 62.743682] LR is at 0x1004 [ 62.777832] pc : [<bf033178>] lr : [<00001004>] psr: 60000013 [ 62.777832] sp : e72c7f40 ip : c0763c00 fp : 00000001 [ 62.777832] r10: 00000000 r9 : 00000000 r8 : e72c7f80 [ 62.777832] r7 : e6ffdc08 r6 : bed1ac78 r5 : 00001000 r4 : e7276000 [ 62.777832] r3 : e60f3460 r2 : 00000000 r1 : e60f38c0 r0 : 00000000 [ 62.777832] Flags: nZCv IRQs on FIQs on Mode SVC_32 ISA ARM Segment user [ 62.816375] Control: 10c53c7d Table: a624004a DAC: 00000015 [ 62.816375] Process cat (pid: 1176, stack limit = 0xe72c62f8) [ 62.828369] Stack: (0xe72c7f40 to 0xe72c8000) ... [ 62.884185] [<bf033178>] (debug_read_mem+0x5c/0xac [omap_iommu_debug]) from [<c010e354>] (vfs_read+0xac/0x130) [ 62.884185] [<c010e354>] (vfs_read+0xac/0x130) from [<c010e4a8>] (sys_read+0x40/0x70) [ 62.884185] [<c010e4a8>] (sys_read+0x40/0x70) from [<c0014a00>] (ret_fast_syscall+0x0/0x3c) Fix also its 'echo bla > /debug/iommu/ducati/mem' Oops sibling, too. Signed-off-by: Ohad Ben-Cohen <ohad@wizery.com> Cc: Tony Lindgren <tony@atomide.com> Cc: Hiroshi Doyu <hdoyu@nvidia.com> Cc: Laurent Pinchart <laurent.pinchart@ideasonboard.com> Cc: Russell King <linux@arm.linux.org.uk> Cc: Joerg Roedel <Joerg.Roedel@amd.com> Cc: stable@vger.kernel.org Signed-off-by: Joerg Roedel <joerg.roedel@amd.com>
450 lines
9.8 KiB
C
450 lines
9.8 KiB
C
/*
|
|
* omap iommu: debugfs interface
|
|
*
|
|
* Copyright (C) 2008-2009 Nokia Corporation
|
|
*
|
|
* Written by Hiroshi DOYU <Hiroshi.DOYU@nokia.com>
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/err.h>
|
|
#include <linux/clk.h>
|
|
#include <linux/io.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/uaccess.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/debugfs.h>
|
|
|
|
#include <plat/iommu.h>
|
|
#include <plat/iovmm.h>
|
|
|
|
#include <plat/iopgtable.h>
|
|
|
|
#define MAXCOLUMN 100 /* for short messages */
|
|
|
|
static DEFINE_MUTEX(iommu_debug_lock);
|
|
|
|
static struct dentry *iommu_debug_root;
|
|
|
|
static ssize_t debug_read_ver(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
u32 ver = omap_iommu_arch_version();
|
|
char buf[MAXCOLUMN], *p = buf;
|
|
|
|
p += sprintf(p, "H/W version: %d.%d\n", (ver >> 4) & 0xf , ver & 0xf);
|
|
|
|
return simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
|
|
}
|
|
|
|
static ssize_t debug_read_regs(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct device *dev = file->private_data;
|
|
struct omap_iommu *obj = dev_to_omap_iommu(dev);
|
|
char *p, *buf;
|
|
ssize_t bytes;
|
|
|
|
buf = kmalloc(count, GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
p = buf;
|
|
|
|
mutex_lock(&iommu_debug_lock);
|
|
|
|
bytes = omap_iommu_dump_ctx(obj, p, count);
|
|
bytes = simple_read_from_buffer(userbuf, count, ppos, buf, bytes);
|
|
|
|
mutex_unlock(&iommu_debug_lock);
|
|
kfree(buf);
|
|
|
|
return bytes;
|
|
}
|
|
|
|
static ssize_t debug_read_tlb(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct device *dev = file->private_data;
|
|
struct omap_iommu *obj = dev_to_omap_iommu(dev);
|
|
char *p, *buf;
|
|
ssize_t bytes, rest;
|
|
|
|
buf = kmalloc(count, GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
p = buf;
|
|
|
|
mutex_lock(&iommu_debug_lock);
|
|
|
|
p += sprintf(p, "%8s %8s\n", "cam:", "ram:");
|
|
p += sprintf(p, "-----------------------------------------\n");
|
|
rest = count - (p - buf);
|
|
p += omap_dump_tlb_entries(obj, p, rest);
|
|
|
|
bytes = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
|
|
|
|
mutex_unlock(&iommu_debug_lock);
|
|
kfree(buf);
|
|
|
|
return bytes;
|
|
}
|
|
|
|
static ssize_t debug_write_pagetable(struct file *file,
|
|
const char __user *userbuf, size_t count, loff_t *ppos)
|
|
{
|
|
struct iotlb_entry e;
|
|
struct cr_regs cr;
|
|
int err;
|
|
struct device *dev = file->private_data;
|
|
struct omap_iommu *obj = dev_to_omap_iommu(dev);
|
|
char buf[MAXCOLUMN], *p = buf;
|
|
|
|
count = min(count, sizeof(buf));
|
|
|
|
mutex_lock(&iommu_debug_lock);
|
|
if (copy_from_user(p, userbuf, count)) {
|
|
mutex_unlock(&iommu_debug_lock);
|
|
return -EFAULT;
|
|
}
|
|
|
|
sscanf(p, "%x %x", &cr.cam, &cr.ram);
|
|
if (!cr.cam || !cr.ram) {
|
|
mutex_unlock(&iommu_debug_lock);
|
|
return -EINVAL;
|
|
}
|
|
|
|
omap_iotlb_cr_to_e(&cr, &e);
|
|
err = omap_iopgtable_store_entry(obj, &e);
|
|
if (err)
|
|
dev_err(obj->dev, "%s: fail to store cr\n", __func__);
|
|
|
|
mutex_unlock(&iommu_debug_lock);
|
|
return count;
|
|
}
|
|
|
|
#define dump_ioptable_entry_one(lv, da, val) \
|
|
({ \
|
|
int __err = 0; \
|
|
ssize_t bytes; \
|
|
const int maxcol = 22; \
|
|
const char *str = "%d: %08x %08x\n"; \
|
|
bytes = snprintf(p, maxcol, str, lv, da, val); \
|
|
p += bytes; \
|
|
len -= bytes; \
|
|
if (len < maxcol) \
|
|
__err = -ENOMEM; \
|
|
__err; \
|
|
})
|
|
|
|
static ssize_t dump_ioptable(struct omap_iommu *obj, char *buf, ssize_t len)
|
|
{
|
|
int i;
|
|
u32 *iopgd;
|
|
char *p = buf;
|
|
|
|
spin_lock(&obj->page_table_lock);
|
|
|
|
iopgd = iopgd_offset(obj, 0);
|
|
for (i = 0; i < PTRS_PER_IOPGD; i++, iopgd++) {
|
|
int j, err;
|
|
u32 *iopte;
|
|
u32 da;
|
|
|
|
if (!*iopgd)
|
|
continue;
|
|
|
|
if (!(*iopgd & IOPGD_TABLE)) {
|
|
da = i << IOPGD_SHIFT;
|
|
|
|
err = dump_ioptable_entry_one(1, da, *iopgd);
|
|
if (err)
|
|
goto out;
|
|
continue;
|
|
}
|
|
|
|
iopte = iopte_offset(iopgd, 0);
|
|
|
|
for (j = 0; j < PTRS_PER_IOPTE; j++, iopte++) {
|
|
if (!*iopte)
|
|
continue;
|
|
|
|
da = (i << IOPGD_SHIFT) + (j << IOPTE_SHIFT);
|
|
err = dump_ioptable_entry_one(2, da, *iopgd);
|
|
if (err)
|
|
goto out;
|
|
}
|
|
}
|
|
out:
|
|
spin_unlock(&obj->page_table_lock);
|
|
|
|
return p - buf;
|
|
}
|
|
|
|
static ssize_t debug_read_pagetable(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct device *dev = file->private_data;
|
|
struct omap_iommu *obj = dev_to_omap_iommu(dev);
|
|
char *p, *buf;
|
|
size_t bytes;
|
|
|
|
buf = (char *)__get_free_page(GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
p = buf;
|
|
|
|
p += sprintf(p, "L: %8s %8s\n", "da:", "pa:");
|
|
p += sprintf(p, "-----------------------------------------\n");
|
|
|
|
mutex_lock(&iommu_debug_lock);
|
|
|
|
bytes = PAGE_SIZE - (p - buf);
|
|
p += dump_ioptable(obj, p, bytes);
|
|
|
|
bytes = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
|
|
|
|
mutex_unlock(&iommu_debug_lock);
|
|
free_page((unsigned long)buf);
|
|
|
|
return bytes;
|
|
}
|
|
|
|
static ssize_t debug_read_mmap(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct device *dev = file->private_data;
|
|
struct omap_iommu *obj = dev_to_omap_iommu(dev);
|
|
char *p, *buf;
|
|
struct iovm_struct *tmp;
|
|
int uninitialized_var(i);
|
|
ssize_t bytes;
|
|
|
|
buf = (char *)__get_free_page(GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
p = buf;
|
|
|
|
p += sprintf(p, "%-3s %-8s %-8s %6s %8s\n",
|
|
"No", "start", "end", "size", "flags");
|
|
p += sprintf(p, "-------------------------------------------------\n");
|
|
|
|
mutex_lock(&iommu_debug_lock);
|
|
|
|
list_for_each_entry(tmp, &obj->mmap, list) {
|
|
size_t len;
|
|
const char *str = "%3d %08x-%08x %6x %8x\n";
|
|
const int maxcol = 39;
|
|
|
|
len = tmp->da_end - tmp->da_start;
|
|
p += snprintf(p, maxcol, str,
|
|
i, tmp->da_start, tmp->da_end, len, tmp->flags);
|
|
|
|
if (PAGE_SIZE - (p - buf) < maxcol)
|
|
break;
|
|
i++;
|
|
}
|
|
|
|
bytes = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
|
|
|
|
mutex_unlock(&iommu_debug_lock);
|
|
free_page((unsigned long)buf);
|
|
|
|
return bytes;
|
|
}
|
|
|
|
static ssize_t debug_read_mem(struct file *file, char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct device *dev = file->private_data;
|
|
char *p, *buf;
|
|
struct iovm_struct *area;
|
|
ssize_t bytes;
|
|
|
|
count = min_t(ssize_t, count, PAGE_SIZE);
|
|
|
|
buf = (char *)__get_free_page(GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
p = buf;
|
|
|
|
mutex_lock(&iommu_debug_lock);
|
|
|
|
area = omap_find_iovm_area(dev, (u32)ppos);
|
|
if (!area) {
|
|
bytes = -EINVAL;
|
|
goto err_out;
|
|
}
|
|
memcpy(p, area->va, count);
|
|
p += count;
|
|
|
|
bytes = simple_read_from_buffer(userbuf, count, ppos, buf, p - buf);
|
|
err_out:
|
|
mutex_unlock(&iommu_debug_lock);
|
|
free_page((unsigned long)buf);
|
|
|
|
return bytes;
|
|
}
|
|
|
|
static ssize_t debug_write_mem(struct file *file, const char __user *userbuf,
|
|
size_t count, loff_t *ppos)
|
|
{
|
|
struct device *dev = file->private_data;
|
|
struct iovm_struct *area;
|
|
char *p, *buf;
|
|
|
|
count = min_t(size_t, count, PAGE_SIZE);
|
|
|
|
buf = (char *)__get_free_page(GFP_KERNEL);
|
|
if (!buf)
|
|
return -ENOMEM;
|
|
p = buf;
|
|
|
|
mutex_lock(&iommu_debug_lock);
|
|
|
|
if (copy_from_user(p, userbuf, count)) {
|
|
count = -EFAULT;
|
|
goto err_out;
|
|
}
|
|
|
|
area = omap_find_iovm_area(dev, (u32)ppos);
|
|
if (!area) {
|
|
count = -EINVAL;
|
|
goto err_out;
|
|
}
|
|
memcpy(area->va, p, count);
|
|
err_out:
|
|
mutex_unlock(&iommu_debug_lock);
|
|
free_page((unsigned long)buf);
|
|
|
|
return count;
|
|
}
|
|
|
|
static int debug_open_generic(struct inode *inode, struct file *file)
|
|
{
|
|
file->private_data = inode->i_private;
|
|
return 0;
|
|
}
|
|
|
|
#define DEBUG_FOPS(name) \
|
|
static const struct file_operations debug_##name##_fops = { \
|
|
.open = debug_open_generic, \
|
|
.read = debug_read_##name, \
|
|
.write = debug_write_##name, \
|
|
.llseek = generic_file_llseek, \
|
|
};
|
|
|
|
#define DEBUG_FOPS_RO(name) \
|
|
static const struct file_operations debug_##name##_fops = { \
|
|
.open = debug_open_generic, \
|
|
.read = debug_read_##name, \
|
|
.llseek = generic_file_llseek, \
|
|
};
|
|
|
|
DEBUG_FOPS_RO(ver);
|
|
DEBUG_FOPS_RO(regs);
|
|
DEBUG_FOPS_RO(tlb);
|
|
DEBUG_FOPS(pagetable);
|
|
DEBUG_FOPS_RO(mmap);
|
|
DEBUG_FOPS(mem);
|
|
|
|
#define __DEBUG_ADD_FILE(attr, mode) \
|
|
{ \
|
|
struct dentry *dent; \
|
|
dent = debugfs_create_file(#attr, mode, parent, \
|
|
dev, &debug_##attr##_fops); \
|
|
if (!dent) \
|
|
return -ENOMEM; \
|
|
}
|
|
|
|
#define DEBUG_ADD_FILE(name) __DEBUG_ADD_FILE(name, 600)
|
|
#define DEBUG_ADD_FILE_RO(name) __DEBUG_ADD_FILE(name, 400)
|
|
|
|
static int iommu_debug_register(struct device *dev, void *data)
|
|
{
|
|
struct platform_device *pdev = to_platform_device(dev);
|
|
struct omap_iommu *obj = platform_get_drvdata(pdev);
|
|
struct omap_iommu_arch_data *arch_data;
|
|
struct dentry *d, *parent;
|
|
|
|
if (!obj || !obj->dev)
|
|
return -EINVAL;
|
|
|
|
arch_data = kzalloc(sizeof(*arch_data), GFP_KERNEL);
|
|
if (!arch_data)
|
|
return -ENOMEM;
|
|
|
|
arch_data->iommu_dev = obj;
|
|
|
|
dev->archdata.iommu = arch_data;
|
|
|
|
d = debugfs_create_dir(obj->name, iommu_debug_root);
|
|
if (!d)
|
|
goto nomem;
|
|
parent = d;
|
|
|
|
d = debugfs_create_u8("nr_tlb_entries", 400, parent,
|
|
(u8 *)&obj->nr_tlb_entries);
|
|
if (!d)
|
|
goto nomem;
|
|
|
|
DEBUG_ADD_FILE_RO(ver);
|
|
DEBUG_ADD_FILE_RO(regs);
|
|
DEBUG_ADD_FILE_RO(tlb);
|
|
DEBUG_ADD_FILE(pagetable);
|
|
DEBUG_ADD_FILE_RO(mmap);
|
|
DEBUG_ADD_FILE(mem);
|
|
|
|
return 0;
|
|
|
|
nomem:
|
|
kfree(arch_data);
|
|
return -ENOMEM;
|
|
}
|
|
|
|
static int iommu_debug_unregister(struct device *dev, void *data)
|
|
{
|
|
if (!dev->archdata.iommu)
|
|
return 0;
|
|
|
|
kfree(dev->archdata.iommu);
|
|
|
|
dev->archdata.iommu = NULL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __init iommu_debug_init(void)
|
|
{
|
|
struct dentry *d;
|
|
int err;
|
|
|
|
d = debugfs_create_dir("iommu", NULL);
|
|
if (!d)
|
|
return -ENOMEM;
|
|
iommu_debug_root = d;
|
|
|
|
err = omap_foreach_iommu_device(d, iommu_debug_register);
|
|
if (err)
|
|
goto err_out;
|
|
return 0;
|
|
|
|
err_out:
|
|
debugfs_remove_recursive(iommu_debug_root);
|
|
return err;
|
|
}
|
|
module_init(iommu_debug_init)
|
|
|
|
static void __exit iommu_debugfs_exit(void)
|
|
{
|
|
debugfs_remove_recursive(iommu_debug_root);
|
|
omap_foreach_iommu_device(NULL, iommu_debug_unregister);
|
|
}
|
|
module_exit(iommu_debugfs_exit)
|
|
|
|
MODULE_DESCRIPTION("omap iommu: debugfs interface");
|
|
MODULE_AUTHOR("Hiroshi DOYU <Hiroshi.DOYU@nokia.com>");
|
|
MODULE_LICENSE("GPL v2");
|