14029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta/* 24029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * PowerNV system parameter code 34029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * 44029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * Copyright (C) 2013 IBM 54029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * 64029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * This program is free software; you can redistribute it and/or modify 74029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * it under the terms of the GNU General Public License as published by 84029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * the Free Software Foundation; either version 2 of the License, or 94029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * (at your option) any later version. 104029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * 114029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * This program is distributed in the hope that it will be useful, 124029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * but WITHOUT ANY WARRANTY; without even the implied warranty of 134029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 144029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * GNU General Public License for more details. 154029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * 164029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * You should have received a copy of the GNU General Public License 174029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * along with this program; if not, write to the Free Software 184029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 194029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta */ 204029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 214029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#include <linux/kobject.h> 224029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#include <linux/mutex.h> 234029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#include <linux/slab.h> 244029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#include <linux/of.h> 254029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#include <linux/gfp.h> 264029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#include <linux/stat.h> 274029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#include <asm/opal.h> 284029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 294029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta#define MAX_PARAM_DATA_LEN 64 304029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 314029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptastatic DEFINE_MUTEX(opal_sysparam_mutex); 324029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptastatic struct kobject *sysparam_kobj; 334029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptastatic void *param_data_buf; 344029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 354029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptastruct param_attr { 364029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct list_head list; 374029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta u32 param_id; 384029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta u32 param_size; 394029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct kobj_attribute kobj_attr; 404029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta}; 414029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 42b8569d230416c490065098684adf13c1751cb830Joel Stanleystatic ssize_t opal_get_sys_param(u32 param_id, u32 length, void *buffer) 434029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta{ 444029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct opal_msg msg; 45b8569d230416c490065098684adf13c1751cb830Joel Stanley ssize_t ret; 46b8569d230416c490065098684adf13c1751cb830Joel Stanley int token; 474029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 484029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta token = opal_async_get_token_interruptible(); 494029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (token < 0) { 504029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (token != -ERESTARTSYS) 514029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("%s: Couldn't get the token, returning\n", 524029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta __func__); 534029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = token; 544029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out; 554029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 564029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 574029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = opal_get_param(token, param_id, (u64)buffer, length); 584029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (ret != OPAL_ASYNC_COMPLETION) 594029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_token; 604029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 614029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = opal_async_wait_response(token, &msg); 624029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (ret) { 63b8569d230416c490065098684adf13c1751cb830Joel Stanley pr_err("%s: Failed to wait for the async response, %zd\n", 644029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta __func__, ret); 654029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_token; 664029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 674029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 68bb4398e1de739a13e06589fc04cbb2267ba59800Anton Blanchard ret = be64_to_cpu(msg.params[1]); 694029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 704029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_token: 714029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta opal_async_release_token(token); 724029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout: 734029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta return ret; 744029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta} 754029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 764029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptastatic int opal_set_sys_param(u32 param_id, u32 length, void *buffer) 774029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta{ 784029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct opal_msg msg; 794029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta int ret, token; 804029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 814029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta token = opal_async_get_token_interruptible(); 824029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (token < 0) { 834029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (token != -ERESTARTSYS) 844029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("%s: Couldn't get the token, returning\n", 854029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta __func__); 864029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = token; 874029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out; 884029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 894029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 904029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = opal_set_param(token, param_id, (u64)buffer, length); 914029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 924029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (ret != OPAL_ASYNC_COMPLETION) 934029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_token; 944029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 954029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = opal_async_wait_response(token, &msg); 964029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (ret) { 974029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("%s: Failed to wait for the async response, %d\n", 984029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta __func__, ret); 994029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_token; 1004029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 1014029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 102bb4398e1de739a13e06589fc04cbb2267ba59800Anton Blanchard ret = be64_to_cpu(msg.params[1]); 1034029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1044029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_token: 1054029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta opal_async_release_token(token); 1064029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout: 1074029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta return ret; 1084029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta} 1094029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1104029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptastatic ssize_t sys_param_show(struct kobject *kobj, 1114029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct kobj_attribute *kobj_attr, char *buf) 1124029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta{ 1134029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct param_attr *attr = container_of(kobj_attr, struct param_attr, 1144029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kobj_attr); 115b8569d230416c490065098684adf13c1751cb830Joel Stanley ssize_t ret; 1164029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1174029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta mutex_lock(&opal_sysparam_mutex); 1184029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = opal_get_sys_param(attr->param_id, attr->param_size, 1194029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta param_data_buf); 1204029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (ret) 1214029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out; 1224029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1234029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta memcpy(buf, param_data_buf, attr->param_size); 1244029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 125ba9a32b176c31ec4d3d7314bb2e529a85423f7a4Joel Stanley ret = attr->param_size; 1264029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout: 1274029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta mutex_unlock(&opal_sysparam_mutex); 128ba9a32b176c31ec4d3d7314bb2e529a85423f7a4Joel Stanley return ret; 1294029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta} 1304029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1314029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptastatic ssize_t sys_param_store(struct kobject *kobj, 1324029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct kobj_attribute *kobj_attr, const char *buf, size_t count) 1334029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta{ 1344029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct param_attr *attr = container_of(kobj_attr, struct param_attr, 1354029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kobj_attr); 136b8569d230416c490065098684adf13c1751cb830Joel Stanley ssize_t ret; 1374029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 13885390378f0a6abf3bdb10c3d504d77862a2d0ec9Joel Stanley /* MAX_PARAM_DATA_LEN is sizeof(param_data_buf) */ 13985390378f0a6abf3bdb10c3d504d77862a2d0ec9Joel Stanley if (count > MAX_PARAM_DATA_LEN) 14085390378f0a6abf3bdb10c3d504d77862a2d0ec9Joel Stanley count = MAX_PARAM_DATA_LEN; 14185390378f0a6abf3bdb10c3d504d77862a2d0ec9Joel Stanley 1424029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta mutex_lock(&opal_sysparam_mutex); 1434029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta memcpy(param_data_buf, buf, count); 1444029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta ret = opal_set_sys_param(attr->param_id, attr->param_size, 1454029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta param_data_buf); 1464029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta mutex_unlock(&opal_sysparam_mutex); 147ba9a32b176c31ec4d3d7314bb2e529a85423f7a4Joel Stanley if (!ret) 148ba9a32b176c31ec4d3d7314bb2e529a85423f7a4Joel Stanley ret = count; 149ba9a32b176c31ec4d3d7314bb2e529a85423f7a4Joel Stanley return ret; 1504029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta} 1514029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1524029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptavoid __init opal_sys_param_init(void) 1534029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta{ 1544029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct device_node *sysparam; 1554029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta struct param_attr *attr; 1564029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta u32 *id, *size; 1574029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta int count, i; 1584029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta u8 *perm; 1594029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1604029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!opal_kobj) { 1614029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_warn("SYSPARAM: opal kobject is not available\n"); 1624029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out; 1634029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 1644029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1654029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta sysparam_kobj = kobject_create_and_add("sysparams", opal_kobj); 1664029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!sysparam_kobj) { 1674029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Failed to create sysparam kobject\n"); 1684029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out; 1694029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 1704029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1714029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta /* Allocate big enough buffer for any get/set transactions */ 1724029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta param_data_buf = kzalloc(MAX_PARAM_DATA_LEN, GFP_KERNEL); 1734029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!param_data_buf) { 1744029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Failed to allocate memory for param data " 1754029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta "buf\n"); 1764029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_kobj_put; 1774029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 1784029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1794029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta sysparam = of_find_node_by_path("/ibm,opal/sysparams"); 1804029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!sysparam) { 1814029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Opal sysparam node not found\n"); 1824029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_param_buf; 1834029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 1844029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1854029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!of_device_is_compatible(sysparam, "ibm,opal-sysparams")) { 1864029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Opal sysparam node not compatible\n"); 1874029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_node_put; 1884029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 1894029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1904029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta /* Number of parameters exposed through DT */ 1914029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta count = of_property_count_strings(sysparam, "param-name"); 1924029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (count < 0) { 1934029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: No string found of property param-name in " 1944029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta "the node %s\n", sysparam->name); 1954029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_node_put; 1964029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 1974029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 1984029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta id = kzalloc(sizeof(*id) * count, GFP_KERNEL); 1994029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!id) { 2004029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Failed to allocate memory to read parameter " 2014029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta "id\n"); 2024029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_node_put; 2034029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2044029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2054029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta size = kzalloc(sizeof(*size) * count, GFP_KERNEL); 2064029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!size) { 2074029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Failed to allocate memory to read parameter " 2084029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta "size\n"); 2094029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_free_id; 2104029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2114029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2124029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta perm = kzalloc(sizeof(*perm) * count, GFP_KERNEL); 2134029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!perm) { 2144029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Failed to allocate memory to read supported " 2154029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta "action on the parameter"); 2164029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_free_size; 2174029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2184029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2194029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (of_property_read_u32_array(sysparam, "param-id", id, count)) { 2204029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Missing property param-id in the DT\n"); 2214029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_free_perm; 2224029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2234029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2244029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (of_property_read_u32_array(sysparam, "param-len", size, count)) { 22516003d235bdb4d1ebcecfe4915c6e6d8c95f4a0cJoel Stanley pr_err("SYSPARAM: Missing property param-len in the DT\n"); 2264029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_free_perm; 2274029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2284029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2294029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2304029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (of_property_read_u8_array(sysparam, "param-perm", perm, count)) { 23116003d235bdb4d1ebcecfe4915c6e6d8c95f4a0cJoel Stanley pr_err("SYSPARAM: Missing property param-perm in the DT\n"); 2324029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_free_perm; 2334029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2344029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2354029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta attr = kzalloc(sizeof(*attr) * count, GFP_KERNEL); 2364029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (!attr) { 2374029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Failed to allocate memory for parameter " 2384029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta "attributes\n"); 2394029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_free_perm; 2404029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2414029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2424029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta /* For each of the parameters, populate the parameter attributes */ 2434029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta for (i = 0; i < count; i++) { 24463aecfb20a6629f1ca91d7a052f87988ceb6dd53Joel Stanley if (size[i] > MAX_PARAM_DATA_LEN) { 24563aecfb20a6629f1ca91d7a052f87988ceb6dd53Joel Stanley pr_warn("SYSPARAM: Not creating parameter %d as size " 24663aecfb20a6629f1ca91d7a052f87988ceb6dd53Joel Stanley "exceeds buffer length\n", i); 24763aecfb20a6629f1ca91d7a052f87988ceb6dd53Joel Stanley continue; 24863aecfb20a6629f1ca91d7a052f87988ceb6dd53Joel Stanley } 24963aecfb20a6629f1ca91d7a052f87988ceb6dd53Joel Stanley 2504029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta sysfs_attr_init(&attr[i].kobj_attr.attr); 2514029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta attr[i].param_id = id[i]; 2524029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta attr[i].param_size = size[i]; 2534029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (of_property_read_string_index(sysparam, "param-name", i, 2544029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta &attr[i].kobj_attr.attr.name)) 2554029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta continue; 2564029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2574029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta /* If the parameter is read-only or read-write */ 2584029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta switch (perm[i] & 3) { 2594029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta case OPAL_SYSPARAM_READ: 2604029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta attr[i].kobj_attr.attr.mode = S_IRUGO; 2614029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta break; 2624029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta case OPAL_SYSPARAM_WRITE: 2631bd098903fda069cb96fe8b5cb4595b46c683385Anton Blanchard attr[i].kobj_attr.attr.mode = S_IWUSR; 2644029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta break; 2654029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta case OPAL_SYSPARAM_RW: 2661bd098903fda069cb96fe8b5cb4595b46c683385Anton Blanchard attr[i].kobj_attr.attr.mode = S_IRUGO | S_IWUSR; 2674029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta break; 2684029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta default: 2694029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta break; 2704029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2714029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2724029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta attr[i].kobj_attr.show = sys_param_show; 2734029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta attr[i].kobj_attr.store = sys_param_store; 2744029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2754029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta if (sysfs_create_file(sysparam_kobj, &attr[i].kobj_attr.attr)) { 2764029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta pr_err("SYSPARAM: Failed to create sysfs file %s\n", 2774029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta attr[i].kobj_attr.attr.name); 2784029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta goto out_free_attr; 2794029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2804029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta } 2814029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2824029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(perm); 2834029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(size); 2844029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(id); 2854029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta of_node_put(sysparam); 2864029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta return; 2874029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta 2884029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_free_attr: 2894029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(attr); 2904029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_free_perm: 2914029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(perm); 2924029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_free_size: 2934029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(size); 2944029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_free_id: 2954029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(id); 2964029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_node_put: 2974029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta of_node_put(sysparam); 2984029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_param_buf: 2994029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kfree(param_data_buf); 3004029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout_kobj_put: 3014029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta kobject_put(sysparam_kobj); 3024029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Guptaout: 3034029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta return; 3044029cd66545f0a45258eda5313b7559bfeaaaae4Neelesh Gupta} 305