mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
176 lines
3.5 KiB
176 lines
3.5 KiB
// SPDX-License-Identifier: GPL-2.0-only |
|
/* |
|
* Architecture specific debugfs files |
|
* |
|
* Copyright (C) 2007, Intel Corp. |
|
* Huang Ying <[email protected]> |
|
*/ |
|
#include <linux/debugfs.h> |
|
#include <linux/uaccess.h> |
|
#include <linux/export.h> |
|
#include <linux/slab.h> |
|
#include <linux/init.h> |
|
#include <linux/stat.h> |
|
#include <linux/io.h> |
|
#include <linux/mm.h> |
|
|
|
#include <asm/setup.h> |
|
|
|
struct dentry *arch_debugfs_dir; |
|
EXPORT_SYMBOL(arch_debugfs_dir); |
|
|
|
#ifdef CONFIG_DEBUG_BOOT_PARAMS |
|
struct setup_data_node { |
|
u64 paddr; |
|
u32 type; |
|
u32 len; |
|
}; |
|
|
|
static ssize_t setup_data_read(struct file *file, char __user *user_buf, |
|
size_t count, loff_t *ppos) |
|
{ |
|
struct setup_data_node *node = file->private_data; |
|
unsigned long remain; |
|
loff_t pos = *ppos; |
|
void *p; |
|
u64 pa; |
|
|
|
if (pos < 0) |
|
return -EINVAL; |
|
|
|
if (pos >= node->len) |
|
return 0; |
|
|
|
if (count > node->len - pos) |
|
count = node->len - pos; |
|
|
|
pa = node->paddr + pos; |
|
|
|
/* Is it direct data or invalid indirect one? */ |
|
if (!(node->type & SETUP_INDIRECT) || node->type == SETUP_INDIRECT) |
|
pa += sizeof(struct setup_data); |
|
|
|
p = memremap(pa, count, MEMREMAP_WB); |
|
if (!p) |
|
return -ENOMEM; |
|
|
|
remain = copy_to_user(user_buf, p, count); |
|
|
|
memunmap(p); |
|
|
|
if (remain) |
|
return -EFAULT; |
|
|
|
*ppos = pos + count; |
|
|
|
return count; |
|
} |
|
|
|
static const struct file_operations fops_setup_data = { |
|
.read = setup_data_read, |
|
.open = simple_open, |
|
.llseek = default_llseek, |
|
}; |
|
|
|
static void __init |
|
create_setup_data_node(struct dentry *parent, int no, |
|
struct setup_data_node *node) |
|
{ |
|
struct dentry *d; |
|
char buf[16]; |
|
|
|
sprintf(buf, "%d", no); |
|
d = debugfs_create_dir(buf, parent); |
|
|
|
debugfs_create_x32("type", S_IRUGO, d, &node->type); |
|
debugfs_create_file("data", S_IRUGO, d, node, &fops_setup_data); |
|
} |
|
|
|
static int __init create_setup_data_nodes(struct dentry *parent) |
|
{ |
|
struct setup_data_node *node; |
|
struct setup_data *data; |
|
int error; |
|
struct dentry *d; |
|
u64 pa_data; |
|
int no = 0; |
|
|
|
d = debugfs_create_dir("setup_data", parent); |
|
|
|
pa_data = boot_params.hdr.setup_data; |
|
|
|
while (pa_data) { |
|
node = kmalloc(sizeof(*node), GFP_KERNEL); |
|
if (!node) { |
|
error = -ENOMEM; |
|
goto err_dir; |
|
} |
|
|
|
data = memremap(pa_data, sizeof(*data), MEMREMAP_WB); |
|
if (!data) { |
|
kfree(node); |
|
error = -ENOMEM; |
|
goto err_dir; |
|
} |
|
|
|
if (data->type == SETUP_INDIRECT && |
|
((struct setup_indirect *)data->data)->type != SETUP_INDIRECT) { |
|
node->paddr = ((struct setup_indirect *)data->data)->addr; |
|
node->type = ((struct setup_indirect *)data->data)->type; |
|
node->len = ((struct setup_indirect *)data->data)->len; |
|
} else { |
|
node->paddr = pa_data; |
|
node->type = data->type; |
|
node->len = data->len; |
|
} |
|
|
|
create_setup_data_node(d, no, node); |
|
pa_data = data->next; |
|
|
|
memunmap(data); |
|
no++; |
|
} |
|
|
|
return 0; |
|
|
|
err_dir: |
|
debugfs_remove_recursive(d); |
|
return error; |
|
} |
|
|
|
static struct debugfs_blob_wrapper boot_params_blob = { |
|
.data = &boot_params, |
|
.size = sizeof(boot_params), |
|
}; |
|
|
|
static int __init boot_params_kdebugfs_init(void) |
|
{ |
|
struct dentry *dbp; |
|
int error; |
|
|
|
dbp = debugfs_create_dir("boot_params", arch_debugfs_dir); |
|
|
|
debugfs_create_x16("version", S_IRUGO, dbp, &boot_params.hdr.version); |
|
debugfs_create_blob("data", S_IRUGO, dbp, &boot_params_blob); |
|
|
|
error = create_setup_data_nodes(dbp); |
|
if (error) |
|
debugfs_remove_recursive(dbp); |
|
|
|
return error; |
|
} |
|
#endif /* CONFIG_DEBUG_BOOT_PARAMS */ |
|
|
|
static int __init arch_kdebugfs_init(void) |
|
{ |
|
int error = 0; |
|
|
|
arch_debugfs_dir = debugfs_create_dir("x86", NULL); |
|
|
|
#ifdef CONFIG_DEBUG_BOOT_PARAMS |
|
error = boot_params_kdebugfs_init(); |
|
#endif |
|
|
|
return error; |
|
} |
|
arch_initcall(arch_kdebugfs_init);
|
|
|