4 * Copyright (C) 2013 IBM
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
21 #include <linux/delay.h>
22 #include <linux/of_platform.h>
24 #include <asm/machdep.h>
27 * This will return sensor information to driver based on the requested sensor
28 * handle. A handle is an opaque id for the powernv, read by the driver from the
31 int opal_get_sensor_data(u32 sensor_hndl, u32 *sensor_data)
37 token = opal_async_get_token_interruptible();
41 ret = opal_sensor_read(sensor_hndl, token, &data);
43 case OPAL_ASYNC_COMPLETION:
44 ret = opal_async_wait_response(token, &msg);
46 pr_err("%s: Failed to wait for the async response, %d\n",
51 ret = opal_error_code(opal_get_async_rc(msg));
52 *sensor_data = be32_to_cpu(data);
57 *sensor_data = be32_to_cpu(data);
60 case OPAL_WRONG_STATE:
65 ret = opal_error_code(ret);
70 opal_async_release_token(token);
73 EXPORT_SYMBOL_GPL(opal_get_sensor_data);
75 int opal_get_sensor_data_u64(u32 sensor_hndl, u64 *sensor_data)
81 if (!opal_check_token(OPAL_SENSOR_READ_U64)) {
84 ret = opal_get_sensor_data(sensor_hndl, &sdata);
90 token = opal_async_get_token_interruptible();
94 ret = opal_sensor_read_u64(sensor_hndl, token, &data);
96 case OPAL_ASYNC_COMPLETION:
97 ret = opal_async_wait_response(token, &msg);
99 pr_err("%s: Failed to wait for the async response, %d\n",
104 ret = opal_error_code(opal_get_async_rc(msg));
105 *sensor_data = be64_to_cpu(data);
110 *sensor_data = be64_to_cpu(data);
113 case OPAL_WRONG_STATE:
118 ret = opal_error_code(ret);
123 opal_async_release_token(token);
126 EXPORT_SYMBOL_GPL(opal_get_sensor_data_u64);
128 int __init opal_sensor_init(void)
130 struct platform_device *pdev;
131 struct device_node *sensor;
133 sensor = of_find_node_by_path("/ibm,opal/sensors");
135 pr_err("Opal node 'sensors' not found\n");
139 pdev = of_platform_device_create(sensor, "opal-sensor", NULL);
142 return PTR_ERR_OR_ZERO(pdev);