#define pr_fmt(fmt) "papr-sysparm: " fmt
#include <linux/anon_inodes.h>
#include <linux/bug.h>
#include <linux/file.h>
#include <linux/fs.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/miscdevice.h>
#include <linux/printk.h>
#include <linux/slab.h>
#include <linux/uaccess.h>
#include <asm/machdep.h>
#include <asm/papr-sysparm.h>
#include <asm/rtas-work-area.h>
#include <asm/rtas.h>
struct papr_sysparm_buf *papr_sysparm_buf_alloc(void)
{
struct papr_sysparm_buf *buf = kzalloc_obj(*buf);
return buf;
}
void papr_sysparm_buf_free(struct papr_sysparm_buf *buf)
{
kfree(buf);
}
static size_t papr_sysparm_buf_get_length(const struct papr_sysparm_buf *buf)
{
return be16_to_cpu(buf->len);
}
static void papr_sysparm_buf_set_length(struct papr_sysparm_buf *buf, size_t length)
{
WARN_ONCE(length > sizeof(buf->val),
"bogus length %zu, clamping to safe value", length);
length = min(sizeof(buf->val), length);
buf->len = cpu_to_be16(length);
}
static void papr_sysparm_buf_clamp_length(struct papr_sysparm_buf *buf)
{
papr_sysparm_buf_set_length(buf, papr_sysparm_buf_get_length(buf));
}
static bool papr_sysparm_buf_can_submit(const struct papr_sysparm_buf *buf)
{
if (papr_sysparm_buf_get_length(buf) > sizeof(buf->val))
return false;
return true;
}
int papr_sysparm_get(papr_sysparm_t param, struct papr_sysparm_buf *buf)
{
const s32 token = rtas_function_token(RTAS_FN_IBM_GET_SYSTEM_PARAMETER);
struct rtas_work_area *work_area;
s32 fwrc;
int ret;
might_sleep();
if (WARN_ON(!buf))
return -EFAULT;
if (token == RTAS_UNKNOWN_SERVICE)
return -ENOENT;
if (!papr_sysparm_buf_can_submit(buf))
return -EINVAL;
work_area = rtas_work_area_alloc(sizeof(*buf));
memcpy(rtas_work_area_raw_buf(work_area), buf, sizeof(*buf));
do {
fwrc = rtas_call(token, 3, 1, NULL, param.token,
rtas_work_area_phys(work_area),
rtas_work_area_size(work_area));
} while (rtas_busy_delay(fwrc));
switch (fwrc) {
case 0:
ret = 0;
memcpy(buf, rtas_work_area_raw_buf(work_area), sizeof(*buf));
papr_sysparm_buf_clamp_length(buf);
break;
case -3:
ret = -EOPNOTSUPP;
break;
case -9002:
ret = -EPERM;
break;
case -9999:
ret = -EINVAL;
break;
default:
pr_err("unexpected ibm,get-system-parameter result %d\n", fwrc);
fallthrough;
case -1:
ret = -EIO;
break;
}
rtas_work_area_free(work_area);
return ret;
}
int papr_sysparm_set(papr_sysparm_t param, const struct papr_sysparm_buf *buf)
{
const s32 token = rtas_function_token(RTAS_FN_IBM_SET_SYSTEM_PARAMETER);
struct rtas_work_area *work_area;
s32 fwrc;
int ret;
might_sleep();
if (WARN_ON(!buf))
return -EFAULT;
if (token == RTAS_UNKNOWN_SERVICE)
return -ENOENT;
if (!papr_sysparm_buf_can_submit(buf))
return -EINVAL;
work_area = rtas_work_area_alloc(sizeof(*buf));
memcpy(rtas_work_area_raw_buf(work_area), buf, sizeof(*buf));
do {
fwrc = rtas_call(token, 2, 1, NULL, param.token,
rtas_work_area_phys(work_area));
} while (rtas_busy_delay(fwrc));
switch (fwrc) {
case 0:
ret = 0;
break;
case -3:
ret = -EOPNOTSUPP;
break;
case -9002:
ret = -EPERM;
break;
case -9999:
ret = -EINVAL;
break;
default:
pr_err("unexpected ibm,set-system-parameter result %d\n", fwrc);
fallthrough;
case -1:
ret = -EIO;
break;
}
rtas_work_area_free(work_area);
return ret;
}
static struct papr_sysparm_buf *
papr_sysparm_buf_from_user(const struct papr_sysparm_io_block __user *user_iob)
{
struct papr_sysparm_buf *kern_spbuf;
long err;
u16 len;
if (get_user(len, &user_iob->length))
return ERR_PTR(-EFAULT);
static_assert(sizeof(user_iob->data) >= PAPR_SYSPARM_MAX_INPUT);
static_assert(sizeof(kern_spbuf->val) >= PAPR_SYSPARM_MAX_INPUT);
if (len > PAPR_SYSPARM_MAX_INPUT)
return ERR_PTR(-EINVAL);
kern_spbuf = papr_sysparm_buf_alloc();
if (!kern_spbuf)
return ERR_PTR(-ENOMEM);
papr_sysparm_buf_set_length(kern_spbuf, len);
if (len > 0 && copy_from_user(kern_spbuf->val, user_iob->data, len)) {
err = -EFAULT;
goto free_sysparm_buf;
}
return kern_spbuf;
free_sysparm_buf:
papr_sysparm_buf_free(kern_spbuf);
return ERR_PTR(err);
}
static int papr_sysparm_buf_to_user(const struct papr_sysparm_buf *kern_spbuf,
struct papr_sysparm_io_block __user *user_iob)
{
u16 len_out = papr_sysparm_buf_get_length(kern_spbuf);
if (put_user(len_out, &user_iob->length))
return -EFAULT;
static_assert(sizeof(user_iob->data) >= PAPR_SYSPARM_MAX_OUTPUT);
static_assert(sizeof(kern_spbuf->val) >= PAPR_SYSPARM_MAX_OUTPUT);
if (copy_to_user(user_iob->data, kern_spbuf->val, PAPR_SYSPARM_MAX_OUTPUT))
return -EFAULT;
return 0;
}
static long papr_sysparm_ioctl_get(struct papr_sysparm_io_block __user *user_iob)
{
struct papr_sysparm_buf *kern_spbuf;
papr_sysparm_t param;
long ret;
if (get_user(param.token, &user_iob->parameter))
return -EFAULT;
kern_spbuf = papr_sysparm_buf_from_user(user_iob);
if (IS_ERR(kern_spbuf))
return PTR_ERR(kern_spbuf);
ret = papr_sysparm_get(param, kern_spbuf);
if (ret)
goto free_sysparm_buf;
ret = papr_sysparm_buf_to_user(kern_spbuf, user_iob);
if (ret)
goto free_sysparm_buf;
ret = 0;
free_sysparm_buf:
papr_sysparm_buf_free(kern_spbuf);
return ret;
}
static long papr_sysparm_ioctl_set(struct papr_sysparm_io_block __user *user_iob)
{
struct papr_sysparm_buf *kern_spbuf;
papr_sysparm_t param;
long ret;
if (get_user(param.token, &user_iob->parameter))
return -EFAULT;
kern_spbuf = papr_sysparm_buf_from_user(user_iob);
if (IS_ERR(kern_spbuf))
return PTR_ERR(kern_spbuf);
ret = papr_sysparm_set(param, kern_spbuf);
if (ret)
goto free_sysparm_buf;
ret = 0;
free_sysparm_buf:
papr_sysparm_buf_free(kern_spbuf);
return ret;
}
static long papr_sysparm_ioctl(struct file *filp, unsigned int ioctl, unsigned long arg)
{
void __user *argp = (__force void __user *)arg;
long ret;
switch (ioctl) {
case PAPR_SYSPARM_IOC_GET:
ret = papr_sysparm_ioctl_get(argp);
break;
case PAPR_SYSPARM_IOC_SET:
if (filp->f_mode & FMODE_WRITE)
ret = papr_sysparm_ioctl_set(argp);
else
ret = -EBADF;
break;
default:
ret = -ENOIOCTLCMD;
break;
}
return ret;
}
static const struct file_operations papr_sysparm_ops = {
.unlocked_ioctl = papr_sysparm_ioctl,
};
static struct miscdevice papr_sysparm_dev = {
.minor = MISC_DYNAMIC_MINOR,
.name = "papr-sysparm",
.fops = &papr_sysparm_ops,
};
static __init int papr_sysparm_init(void)
{
if (!rtas_function_implemented(RTAS_FN_IBM_GET_SYSTEM_PARAMETER))
return -ENODEV;
return misc_register(&papr_sysparm_dev);
}
machine_device_initcall(pseries, papr_sysparm_init);