Uwe Kleine-König (The Capable Hub)hwmon: Use named initializers for arrays of i2c_device_data4a9e6a96 months agoHistory
333 lines · 7.3 KB · C
RawDownload
// SPDX-License-Identifier: GPL-2.0+/* * Hardware monitoring driver for MAX127. * * Copyright (c) 2020 Facebook Inc. */ #include <linux/err.h>#include <linux/hwmon.h>#include <linux/i2c.h>#include <linux/init.h>#include <linux/module.h> /* * MAX127 Control Byte. Refer to MAX127 datasheet, Table 1 "Control-Byte * Format" for details. */#define MAX127_CTRL_START	BIT(7)#define MAX127_CTRL_SEL_SHIFT	4#define MAX127_CTRL_RNG		BIT(3)#define MAX127_CTRL_BIP		BIT(2)#define MAX127_CTRL_PD1		BIT(1)#define MAX127_CTRL_PD0		BIT(0) #define MAX127_NUM_CHANNELS	8#define MAX127_SET_CHANNEL(ch)	(((ch) & 7) << MAX127_CTRL_SEL_SHIFT) /* * MAX127 channel input ranges. Refer to MAX127 datasheet, Table 3 "Range * and Polarity Selection" for details. */#define MAX127_FULL_RANGE	10000	/* 10V */#define MAX127_HALF_RANGE	5000	/* 5V */ /* * MAX127 returns 2 bytes at read: *   - the first byte contains data[11:4]. *   - the second byte contains data[3:0] (MSB) and 4 dummy 0s (LSB). * Refer to MAX127 datasheet, "Read a Conversion (Read Cycle)" section * for details. */#define MAX127_DATA_LEN		2#define MAX127_DATA_SHIFT	4 #define MAX127_SIGN_BIT		BIT(11) struct max127_data {	struct i2c_client *client;	u8 ctrl_byte[MAX127_NUM_CHANNELS];}; static int max127_select_channel(struct i2c_client *client, u8 ctrl_byte){	int status;	struct i2c_msg msg = {		.addr = client->addr,		.flags = 0,		.len = sizeof(ctrl_byte),		.buf = &ctrl_byte,	}; 	status = i2c_transfer(client->adapter, &msg, 1);	if (status < 0)		return status;	if (status != 1)		return -EIO; 	return 0;} static int max127_read_channel(struct i2c_client *client, long *val){	int status;	u8 i2c_data[MAX127_DATA_LEN];	struct i2c_msg msg = {		.addr = client->addr,		.flags = I2C_M_RD,		.len = sizeof(i2c_data),		.buf = i2c_data,	}; 	status = i2c_transfer(client->adapter, &msg, 1);	if (status < 0)		return status;	if (status != 1)		return -EIO; 	*val = (i2c_data[1] >> MAX127_DATA_SHIFT) |		((u16)i2c_data[0] << MAX127_DATA_SHIFT);	return 0;} static long max127_process_raw(u8 ctrl_byte, long raw){	long scale, weight; 	/*	 * MAX127's data coding is binary in unipolar mode with 1 LSB =	 * (Full-Scale/4096) and two’s complement binary in bipolar mode	 * with 1 LSB = [(2 x |FS|)/4096].	 * Refer to MAX127 datasheet, "Transfer Function" section for	 * details.	 */	scale = (ctrl_byte & MAX127_CTRL_RNG) ? MAX127_FULL_RANGE :						MAX127_HALF_RANGE;	if (ctrl_byte & MAX127_CTRL_BIP) {		weight = (raw & MAX127_SIGN_BIT);		raw &= ~MAX127_SIGN_BIT;		raw -= weight;		raw *= 2;	} 	return raw * scale / 4096;} static int max127_read_input(struct max127_data *data, int channel, long *val){	long raw;	int status;	struct i2c_client *client = data->client;	u8 ctrl_byte = data->ctrl_byte[channel]; 	status = max127_select_channel(client, ctrl_byte);	if (status)		return status; 	status = max127_read_channel(client, &raw);	if (status)		return status; 	*val = max127_process_raw(ctrl_byte, raw);	return 0;} static int max127_read_min(struct max127_data *data, int channel, long *val){	u8 rng_bip = (data->ctrl_byte[channel] >> 2) & 3;	static const int min_input_map[4] = {		0,			/* RNG=0, BIP=0 */		-MAX127_HALF_RANGE,	/* RNG=0, BIP=1 */		0,			/* RNG=1, BIP=0 */		-MAX127_FULL_RANGE,	/* RNG=1, BIP=1 */	}; 	*val = min_input_map[rng_bip];	return 0;} static int max127_read_max(struct max127_data *data, int channel, long *val){	u8 rng_bip = (data->ctrl_byte[channel] >> 2) & 3;	static const int max_input_map[4] = {		MAX127_HALF_RANGE,	/* RNG=0, BIP=0 */		MAX127_HALF_RANGE,	/* RNG=0, BIP=1 */		MAX127_FULL_RANGE,	/* RNG=1, BIP=0 */		MAX127_FULL_RANGE,	/* RNG=1, BIP=1 */	}; 	*val = max_input_map[rng_bip];	return 0;} static int max127_write_min(struct max127_data *data, int channel, long val){	u8 ctrl; 	ctrl = data->ctrl_byte[channel];	if (val <= -MAX127_FULL_RANGE) {		ctrl |= (MAX127_CTRL_RNG | MAX127_CTRL_BIP);	} else if (val < 0) {		ctrl |= MAX127_CTRL_BIP;		ctrl &= ~MAX127_CTRL_RNG;	} else {		ctrl &= ~MAX127_CTRL_BIP;	}	data->ctrl_byte[channel] = ctrl;	return 0;} static int max127_write_max(struct max127_data *data, int channel, long val){	if (val >= MAX127_FULL_RANGE)		data->ctrl_byte[channel] |= MAX127_CTRL_RNG;	else		data->ctrl_byte[channel] &= ~MAX127_CTRL_RNG;	return 0;} static umode_t max127_is_visible(const void *_data,				 enum hwmon_sensor_types type,				 u32 attr, int channel){	if (type == hwmon_in) {		switch (attr) {		case hwmon_in_input:			return 0444; 		case hwmon_in_min:		case hwmon_in_max:			return 0644; 		default:			break;		}	} 	return 0;} static int max127_read(struct device *dev, enum hwmon_sensor_types type,			u32 attr, int channel, long *val){	int status;	struct max127_data *data = dev_get_drvdata(dev); 	if (type != hwmon_in)		return -EOPNOTSUPP; 	switch (attr) {	case hwmon_in_input:		status = max127_read_input(data, channel, val);		break; 	case hwmon_in_min:		status = max127_read_min(data, channel, val);		break; 	case hwmon_in_max:		status = max127_read_max(data, channel, val);		break; 	default:		status = -EOPNOTSUPP;		break;	} 	return status;} static int max127_write(struct device *dev, enum hwmon_sensor_types type,			u32 attr, int channel, long val){	int status;	struct max127_data *data = dev_get_drvdata(dev); 	if (type != hwmon_in)		return -EOPNOTSUPP; 	switch (attr) {	case hwmon_in_min:		status = max127_write_min(data, channel, val);		break; 	case hwmon_in_max:		status = max127_write_max(data, channel, val);		break; 	default:		status = -EOPNOTSUPP;		break;	} 	return status;} static const struct hwmon_ops max127_hwmon_ops = {	.is_visible = max127_is_visible,	.read = max127_read,	.write = max127_write,}; static const struct hwmon_channel_info * const max127_info[] = {	HWMON_CHANNEL_INFO(in,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX,			   HWMON_I_INPUT | HWMON_I_MIN | HWMON_I_MAX),	NULL,}; static const struct hwmon_chip_info max127_chip_info = {	.ops = &max127_hwmon_ops,	.info = max127_info,}; static int max127_probe(struct i2c_client *client){	int i;	struct device *hwmon_dev;	struct max127_data *data;	struct device *dev = &client->dev; 	data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL);	if (!data)		return -ENOMEM; 	data->client = client;	for (i = 0; i < ARRAY_SIZE(data->ctrl_byte); i++)		data->ctrl_byte[i] = (MAX127_CTRL_START |				      MAX127_SET_CHANNEL(i)); 	hwmon_dev = devm_hwmon_device_register_with_info(dev, client->name,							 data,							 &max127_chip_info,							 NULL); 	return PTR_ERR_OR_ZERO(hwmon_dev);} static const struct i2c_device_id max127_id[] = {	{ .name = "max127" },	{ }};MODULE_DEVICE_TABLE(i2c, max127_id); static struct i2c_driver max127_driver = {	.driver = {		.name	= "max127",	},	.probe		= max127_probe,	.id_table	= max127_id,}; module_i2c_driver(max127_driver); MODULE_LICENSE("GPL");MODULE_AUTHOR("Mike Choi <mikechoi@fb.com>");MODULE_AUTHOR("Tao Ren <rentao.bupt@gmail.com>");MODULE_DESCRIPTION("MAX127 Hardware Monitoring driver");

Keyboard shortcuts

General

Show keyboard shortcuts
?
Focus the current search
/

Issues and pull requests

Open filters
f

Issues, pull requests and Inbox

Select next item
j↓
Select previous item
k↑
Open selected item
Enter
Dismiss filters or clear selection
Esc

Repository code

Go to file
t